logo
搜索
我的图书馆

发文章

发文工具

其他工具

留言交流
搜索
分享

【飞鸟集】UCS的变换矩阵及其逆变换矩阵

 求真我 2014-03-28
这里提供一个函数，得到当前UCS下的变化矩阵和逆变换矩阵。
普通浏览复制代码
  2. ;;;UCS到WCS的变换矩阵及其WCS到UCS的变换矩阵                             
  3. ;;;the transformation matrix of UCS to WCS and WCS to UCS.              
  4. (defun UCS2WCS (/ xdir ydir zdir UcsOrg WcsOrg matlst revlst matrix)
  5.   (defun AppendMatrix (lst org)
  6.     (append
  7.       (mapcar 'append lst (mapcar 'list org))
  8.       '((0. 0. 0. 1.))
  9.     )
  10.   )
  11.   (if (zerop (getvar "WORLDUCS"))                    ;如果不同于WCS 
  12.     (setq xdir   (getvar "UCSXDIR")                     ;X方向 
  13.              ydir   (getvar "UCSYDIR")                     ;Y方向 
  14.              zdir   (G:CrossProductor xdir ydir)         ;Z方向等于X方向叉乘Y方向 
  15.              UcsOrg (getvar "UCSORG")                  ;UCS原点 
  16.              WcsOrg (trans '(0 0 0) 0 1)                   ;WCS原点相对于UCS的坐标 
  17.              matLst (list xdir ydir zdir)                        ;UCS的旋转矩阵 
  18.              RevLst (trp matLst)                               ;UCS的旋转矩阵的逆 
  19.              matrix (list
  20.                       (AppendMatrix matlst WcsOrg)        ;UCS到WCS的变换矩阵
  21.                       (AppendMatrix RevLst UcsOrg)        ;WCS到UCS的变换矩阵
  22.                     )
  23.     )
  24.     (list
  25.       '((1. 0. 0. 0.) (0. 1. 0. 0.) (0. 0. 1. 0.) (0. 0. 0. 1.))  ;世界坐标系下是单位矩阵
  26.       '((1. 0. 0. 0.) (0. 1. 0. 0.) (0. 0. 1. 0.) (0. 0. 0. 1.))  ;世界坐标系下是单位矩阵
  27.     )
  28.   )
  29. )
  31. ;;; 矢量的点积                                                          
  32. ;;; VXV Returns the dot product of 2 vectors                            
  33. (defun vxv (v1 v2)
  34.   (apply '+ (mapcar '* v1 v2))
  35. )
  36. ;;; 矢量转置                                                            
  37. ;;; TRP Transpose a matrix -Doug Wilson-                                
  38. (defun trp (m)
  39.   (apply 'mapcar (cons 'list m))
  40. )
  41. ;;; 矢量的矩阵变换                                                      
  42. ;;; MXV Apply a transformation matrix to a vector -Vladimir Nesterovsky-
  43. (defun mxv (m v)
  44.   (mapcar (function (lambda (r) (vxv r v))) m)
  45. )
  46. ;;; 矩阵相乘                                                            
  47. ;;; MXM Multiply two matrices -Vladimir Nesterovsky-                    
  48. (defun mxm (m q)
  49.   (mapcar (function (lambda (r) (mxv (trp q) r))) m)
  50. )
  51. ;;;两矢量的叉积                                                         
  52. ;;; CrossProductor --vec1 * vec2                                        
  53. (defun G:CrossProductor (vec1 vec2 / a b c d e f)                 
  54.   (setq a (car   vec1))
  55.   (setq b (cadr  vec1))
  56.   (setq c (caddr vec1))
  57.   (setq d (car   vec2))
  58.   (setq e (cadr  vec2))
  59.   (setq f (caddr vec2))
  60.   (list
  61.     (- (* b f) (* c e))
  62.     (- (* c d) (* a f))
  63.     (- (* a e) (* b d))
  64.   )
  65. )
以下作为测试
普通浏览复制代码
  1.                                                   
  2. (defun c:test(/ ent obj mat)
  3.   (if (setq ent (car (entsel)))
  4.     (progn
  5.       (setq obj (vlax-ename->vla-object ent))
  6.       (setq mat (ucs2wcs))
  7.       (vla-TransformBy obj (vlax-tmatrix (car  mat)))                   ;UCS->WCS
  8.       (command ".select" ent pause)
  9.       (vla-TransformBy obj (vlax-tmatrix (cadr mat)))                  ;WCS->UCS
  10.     )
  11.   )
  12. )

    本站是提供个人知识管理的网络存储空间，所有内容均由用户发布，不代表本站观点。请注意甄别内容中的联系方式、诱导购买等信息，谨防诈骗。如发现有害或侵权内容，请点击一键举报。
    转藏 分享 献花（0）

    来自： 求真我 > 《cad板块》

    举报/认领

    0条评论

    发表

    请遵守用户 评论公约

    类似文章 更多