[LISP函数-矩阵]：构造一个平移矩阵

eachy

2. 
   
3. ;;构造一个平移矩阵
   
4. ;;;--------------------------------------------------------------------;
   
5. ;;;       Function:  MAKE-TRANSLATION-MATRIX                           ;
   
6. ;;;                                                                    ;
   
7. ;;;    Description:  This function converts a variant vector list      ;
   
8. ;;;                  (a list of three numbers) into a vector matrix.   ;
   
9. ;;;                                                                    ;
   
10. ;;;                  Required Functions:                               ;
    
11. ;;;                                                                    ;
    
12. ;;;                                                                    ;
    
13. ;;;                  Example:  A vector list '( 5 5 5 ) is passed to   ;
    
14. ;;;                  make-translation-matrix. The function then        ;
    
15. ;;;                  translates this value to a matrix list.           ;
    
16. ;;;                  using the following logic.                        ;
    
17. ;;;                                                                    ;
    
18. ;;;                        make a translation matrix from                 ;
    
19. ;;;                        1,2 or 3 dim vector v represented as:          ;
    
20. ;;;                                 list (x), (x y) or (x y z)             ;
    
21. ;;;                                                                    ;
    
22. ;;;                                                                    ;
    
23. ;;;      Arguments:                                                    ;
    
24. ;;;             vector =  a valid vector list such as:                 ;
    
25. ;;;                       '( 5 5 5) or '( 1.2 4.5 200.00)              ;
    
26. ;;;      or vector =  a valid safearray variant vector list of doubles ;
    
27. ;;;                                                                    ;
    
28. ;;; Returned Value:  A matrix List such as:                            ;
    
29. ;;;                      (make-translation-matrix '( 5 5 5 ))             ;
    
30. ;;;                                                                       ;
    
31. ;;;                            Returns List In A Variant Array:           ;
    
32. ;;;                                ((1.0 0.0 0.0 5.0)                     ;
    
33. ;;;                                  (0.0 1.0 0.0 5.0)                    ;
    
34. ;;;                                  (0.0 0.0 1.0 5.0)                    ;
    
35. ;;;                                  (0.0 0.0 0.0 1.0)                    ;
    
36. ;;;                                )                                      ;
    
37. ;;;                                                                       ;
    
38. ;;;       Usage: (make-translation-matrix '( 5 5 5 ))   or             ;
    
39. ;;;              (make-translation-matrix (vlax-3d-point '( 5 5 5 )))  ;
    
40. ;;;                                                                    ;
    
41. ;;;--------------------------------------------------------------------;
    
42. (defun make-translation-matrix (vector)
    
43.   (if (> (vlax-variant-type vector) 8192)
    
44.     (setq vector (vlax-safearray->list (vlax-variant-value vector)))
    
45.   )
    
46.   (setq        tm (vlax-tmatrix
    
47.              (list (list 1 0 0 (car vector))
    
48.                    (list 0 1 0 (check-vector-elem (cadr vector)))
    
49.                    (list 0 0 1 (check-vector-elem (caddr vector)))
    
50.                    '(0 0 0 1)
    
51.              )
    
52.            )
    
53.   )
    
54.   ;; Convert to a Variant Array of Doubles here ->
    
55.   (setq        TransDataA
    
56.          (vlax-make-safearray vlax-vbDouble (cons 0 3) (cons 0 3))
    
57.   )
    
58.   (vlax-safearray-fill TransDataA tm)
    
59.   (setq        TransData (vlax-make-variant
    
60.                     TransDataA
    
61.                     (logior vlax-vbarray vlax-vbDouble)
    
62.                   )
    
63.   )
    
64. 
    
65. )

<br /> ;;构造一个平移矩阵<br /> ;;;--------------------------------------------------------------------;<br /> ;;;       Function:  MAKE-TRANSLATION-MATRIX                           ;<br /> ;;;                                                                    ;<br /> ;;;    Description:  This function converts a variant vector list      ;<br /> ;;;                  (a list of three numbers) into a vector matrix.   ;<br /> ;;;                                                                    ;<br /> ;;;                  Required Functions:                               ;<br /> ;;;                                                                    ;<br /> ;;;                                                                    ;<br /> ;;;                  Example:  A vector list '( 5 5 5 ) is passed to   ;<br /> ;;;                  make-translation-matrix. The function then        ;<br /> ;;;                  translates this value to a matrix list.           ;<br /> ;;;                  using the following logic.                        ;<br /> ;;;                                                                    ;<br /> ;;;                        make a translation matrix from                 ;<br /> ;;;                        1,2 or 3 dim vector v represented as:          ;<br /> ;;;                                 list (x), (x y) or (x y z)             ;<br /> ;;;                                                                    ;<br /> ;;;                                                                    ;<br /> ;;;      Arguments:                                                    ;<br /> ;;;             vector =  a valid vector list such as:                 ;<br /> ;;;                       '( 5 5 5) or '( 1.2 4.5 200.00)              ;<br /> ;;;      or vector =  a valid safearray variant vector list of doubles ;<br /> ;;;                                                                    ;<br /> ;;; Returned Value:  A matrix List such as:                            ;<br /> ;;;                      (make-translation-matrix '( 5 5 5 ))             ;<br /> ;;;                                                                       ;<br /> ;;;                            Returns List In A Variant Array:           ;<br /> ;;;                                ((1.0 0.0 0.0 5.0)                     ;<br /> ;;;                                  (0.0 1.0 0.0 5.0)                    ;<br /> ;;;                                  (0.0 0.0 1.0 5.0)                    ;<br /> ;;;                                  (0.0 0.0 0.0 1.0)                    ;<br /> ;;;                                )                                      ;<br /> ;;;                                                                       ;<br /> ;;;       Usage: (make-translation-matrix '( 5 5 5 ))   or             ;<br /> ;;;              (make-translation-matrix (vlax-3d-point '( 5 5 5 )))  ;<br /> ;;;                                                                    ;<br /> ;;;--------------------------------------------------------------------;<br /> (defun make-translation-matrix (vector)<br />   (if (> (vlax-variant-type vector) 8192)<br />     (setq vector (vlax-safearray->list (vlax-variant-value vector)))<br />   )<br />   (setq        tm (vlax-tmatrix<br />              (list (list 1 0 0 (car vector))<br />                    (list 0 1 0 (check-vector-elem (cadr vector)))<br />                    (list 0 0 1 (check-vector-elem (caddr vector)))<br />                    '(0 0 0 1)<br />              )<br />            )<br />   )<br />   ;; Convert to a Variant Array of Doubles here -><br />   (setq        TransDataA<br />          (vlax-make-safearray vlax-vbDouble (cons 0 3) (cons 0 3))<br />   )<br />   (vlax-safearray-fill TransDataA tm)<br />   (setq        TransData (vlax-make-variant<br />                     TransDataA<br />                     (logior vlax-vbarray vlax-vbDouble)<br />                   )<br />   )<br /> <br /> )

liuyj

check-vector-elem 未定义

eachy

2. 
   
3. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
   
4. ;;;  Matrix Operations                                                 ;
   
5. ;;;--------------------------------------------------------------------;
   
6. ;;;       Function:  CHECK-VECTOR-ELEM                                 ;
   
7. ;;;                                                                    ;
   
8. ;;;    Description:  This function check the integrity of the elem     ;
   
9. ;;;                  argument. This guarantees a number value for      ;
   
10. ;;;                  functions that require this check.                ;
    
11. ;;;                                                                    ;
    
12. ;;;                  Required Functions:                               ;
    
13. ;;;                      check-vector-elem                             ;
    
14. ;;;                                                                    ;
    
15. ;;;      Arguments:                                                    ;
    
16. ;;;               elem =  a valid number or nil                        ;
    
17. ;;;                                                                    ;
    
18. ;;; Returned Value:  A number. If the argument elem is nil.            ;
    
19. ;;;                  check-vector returns 0 otherwise it returns the   ;
    
20. ;;;                  argument.                                         ;
    
21. ;;;                                                                       ;
    
22. ;;;          Usage: (check-vector-elem 0)                              ;
    
23. ;;;--------------------------------------------------------------------;
    
24. (defun check-vector-elem (elem)
    
25.   (if (null elem)
    
26.     0
    
27.     elem
    
28.   )
    
29. )

<br /> ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;<br /> ;;;  Matrix Operations                                                 ;<br /> ;;;--------------------------------------------------------------------;<br /> ;;;       Function:  CHECK-VECTOR-ELEM                                 ;<br /> ;;;                                                                    ;<br /> ;;;    Description:  This function check the integrity of the elem     ;<br /> ;;;                  argument. This guarantees a number value for      ;<br /> ;;;                  functions that require this check.                ;<br /> ;;;                                                                    ;<br /> ;;;                  Required Functions:                               ;<br /> ;;;                      check-vector-elem                             ;<br /> ;;;                                                                    ;<br /> ;;;      Arguments:                                                    ;<br /> ;;;               elem =  a valid number or nil                        ;<br /> ;;;                                                                    ;<br /> ;;; Returned Value:  A number. If the argument elem is nil.            ;<br /> ;;;                  check-vector returns 0 otherwise it returns the   ;<br /> ;;;                  argument.                                         ;<br /> ;;;                                                                       ;<br /> ;;;          Usage: (check-vector-elem 0)                              ;<br /> ;;;--------------------------------------------------------------------;<br /> (defun check-vector-elem (elem)<br />   (if (null elem)<br />     0<br />     elem<br />   )<br /> )