>>725
追記
ワールド座標の原点周りに回転させた座標がほしいのですが、
上の式だとローカル座標で回転しているようです。

どうやったらワールド座標の原点を中心に回転した座標が得られるのでしょう?