ＭＡＴＬＡＢを使った三次元座標の回転を求めたい

質問

二つの三次元座標(X,Y,Z)と(X',Y',Z')の回転および移動距離を求めたいのですが、どのようにして求めることができるのでしょうか？色々行列の本を読んでみたのですが、文系出身だったので内容がきちんと理解できていません。ご指導よろしくお願いします。

回答No.1

ICE_FALCON

回転というのは原点から見てでしょうか？
それなら、
[THETA,PHI,R] = cart2sph(X,Y,Z);
[THETA_,PHI_,R_] = cart2sph(X_,Y_,Z_);
D_THETA = THETA_ - THETA %方位角の回転[rad]
D_THETA = PHI_ - PHI %仰角の回転[rad]
距離は
D_R = sqrt(sum(([X_ Y_ Z_]-[X Y Z]).^2))

お礼

どうもありがとうございます！さっそくやってみたいと思います。