构造对齐变换矩阵（XD::Matrix:Align）

Lispboy · 发表于 2013-6-30 00:46:09

马上注册，结交更多好友，享用更多功能，让你轻松玩转社区。

您需要登录才可以下载或查看，没有账号？立即注册

×

;|
构造对齐矩阵
参数：
pj ---- 基点 ps1---- 源点1 ps2---- 源点2 pd1---- 目标点1 pd2---- 目标点2
返回值：矩阵
|;
(defun XD::Matrix:Align (pj ps1 pd1 ps2 pd2 / fromx fromy from tox toy to mMat )
(setq fromx (xdrx_vector_normalize (mapcar
'-
(trans ps2 1 0)
(trans ps1 1 0)
)
)
fromy (xdrx_vector_perpvector fromx)
fromz (xdrx_vector_crossproduct fromx fromy)
from (list (trans pj 1 0) fromx fromy fromz)
tox (xdrx_vector_normalize (mapcar
'-
(trans pd2 1 0)
(trans pd1 1 0)
)
)
toy (xdrx_vector_perpvector tox)
toz (xdrx_vector_crossproduct tox toy)
to (list (trans pd1 1 0) tox toy toz)
mMat (xdrx_matrix_aligncoordsystem from to)
)
mMat
)

;| 
构造对齐矩阵 
参数： 
   pj ---- 基点  ps1---- 源点1   ps2---- 源点2   pd1---- 目标点1   pd2---- 目标点2 
返回值：矩阵 
|; 
(defun XD::Matrix:Align (pj ps1 pd1 ps2 pd2 / fromx fromy from tox toy to mMat ) 
  (setq fromx (xdrx_vector_normalize (mapcar 
                                       '- 
                                       (trans ps2 1 0) 
                                       (trans ps1 1 0) 
                                     ) 
              ) 
        fromy (xdrx_vector_perpvector fromx) 
        fromz (xdrx_vector_crossproduct fromx fromy) 
        from (list (trans pj 1 0) fromx fromy fromz) 
        tox (xdrx_vector_normalize (mapcar 
                                     '- 
                                     (trans pd2 1 0) 
                                     (trans pd1 1 0) 
                                   ) 
            ) 
        toy (xdrx_vector_perpvector tox) 
        toz (xdrx_vector_crossproduct tox toy) 
        to (list (trans pd1 1 0) tox toy toz) 
        mMat (xdrx_matrix_aligncoordsystem from to) 
  ) 
  mMat 
)

hn10183051 · 发表于 2019-1-10 12:20:02

来个动图！！1

yuanziyou · 发表于 2021-3-3 20:47:38

xdrx_matrix_aligncoordsystem这个函数的源代码可以分享吗

账号		自动登录	找回密码
密码			立即注册

[几何] 构造对齐变换矩阵（XD::Matrix:Align）

马上注册，结交更多好友，享用更多功能，让你轻松玩转社区。

相关帖子

浏览过的版块