[LISP函数-向量]：两个矢量的叉积

eachy · 发表于 2005-8-31 18:59:21

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

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

×

;; ! ****************************************************************************
;; ! GE_VecCrossProduct
;; ! ****************************************************************************
;; ! Function : Computes the cross products of two vectors
;; !
;; ! Arguments: 'v1' - First vector
;; ! 'v2' - Second Vector
;; !
;; ! Returns : 'v' - The cross product of the two vectors
;; !
;; ! Comments: The cross product of two vectors is a vector in a plane
;; ! perpendicular to the two vectors. This direction is the normal
;; ! to the plane of the two vectors
;; ! Theory: Say you have two vectors
;; ! A= ax i + ay j + az k
;; ! B= bx i + by j + bz k
;; !
;; ! then A X B = (ay bz - az by) i + (az bx - ax bz) j + (ax by - ay bx) k
;; ! (C) 1999-2004, Four Dimension Technologies, Bangalore
;; ! e-mail : [email]rakesh.rao@4d-technologies.com[/email]
;; ! Web : [url]www.4d-technologies.com[/url]
;; ! ****************************************************************************
;; 矢量差积
;|两个矢量的叉积
　　　　| i 　j 　k　|
v1xv2 = | x1　y1　z1 |= (y1z2-y2z1, z1x2-z2x1, x1y2-x2y1)
　　　　| x2　y2　z2 |
　　　　　　
|;
(defun GE_VecCrossProduct (v1 v2)
(list (-
(* (cadr v1) (caddr v2))
(* (cadr v2) (caddr v1))
)
(-
(* (caddr v1) (car v2))
(* (caddr v2) (car v1))
)
(-
(* (car v1) (cadr v2))
(* (car v2) (cadr v1))
)
)
)

;; ! **************************************************************************** 
;; ! GE_VecCrossProduct 
;; ! **************************************************************************** 
;; ! Function : Computes the cross products of two vectors 
;; ! 
;; ! Arguments: 'v1' - First vector 
;; !            'v2' - Second Vector 
;; ! 
;; ! Returns  : 'v'  - The cross product of the two vectors 
;; ! 
;; ! Comments:  The cross product of two vectors is a vector in a plane 
;; !            perpendicular to the two vectors. This direction is the normal 
;; !            to the plane of the two vectors 
;; ! Theory:    Say you have two vectors 
;; !            A= ax i +  ay j + az k 
;; !            B= bx i +  by j + bz k 
;; ! 
;; ! then A X B = (ay bz - az by) i + (az bx - ax bz) j + (ax by - ay bx) k 
;; ! (C) 1999-2004, Four Dimension Technologies, Bangalore 
;; ! e-mail   : [email]rakesh.rao@4d-technologies.com[/email] 
;; ! Web      : [url]www.4d-technologies.com[/url] 
;; ! **************************************************************************** 
;; 矢量差积 
;|两个矢量的叉积 
　　　　| i 　j 　k　| 
v1xv2 = | x1　y1　z1 |= (y1z2-y2z1, z1x2-z2x1, x1y2-x2y1) 
　　　　| x2　y2　z2 | 
　　　　　　 
|; 
(defun GE_VecCrossProduct (v1 v2) 
  (list        (- 
          (* (cadr v1) (caddr v2)) 
          (* (cadr v2) (caddr v1)) 
        ) 
        (- 
          (* (caddr v1) (car v2)) 
          (* (caddr v2) (car v1)) 
        ) 
        (- 
          (* (car v1) (cadr v2)) 
          (* (car v2) (cadr v1)) 
        ) 
  ) 
)

aeo · 发表于 2005-9-1 23:14:44

v1 v2一定要3d一下!

eachy · 发表于 2005-9-4 23:48:23

;;;--------------------------------------------------------------------;
;;; Function: VECTOR-NORM ;
;;; ;
;;; Description: This function returns the normal for the ;
;;; vector supplied. ;
;;; ;
;;; Required Functions: ;
;;; trace-vector ;
;;; ;
;;; Arguments: ;
;;; vect = a valid vector list such as: ;
;;; '( 5 5 5 ) ;
;;; ;
;;; Returned Value: A number representing the normal of the vector. ;
;;; ;
;;; Usage: (vector-norm '( 5 5 5)) ;
;;;--------------------------------------------------------------------;
(defun vector-norm (vect / nv TransDataA TransData)
(if (> (vlax-variant-type vect) 8192)
(setq vect (vlax-safearray->list (vlax-variant-value vect)))
)
(setq nv (sqrt (trace-vector (mapcar '* vect vect))))
;; Convert to a Variant Array of Doubles here ->
(if nv
(progn
(setq TransDataA (vlax-make-safearray vlax-vbDouble (cons 0 3)))
(vlax-safearray-fill TransDataA nv)
(setq TransData (vlax-make-variant
TransDataA
(logior vlax-vbarray vlax-vbDouble)
)
)
)
)
)
;;;--------------------------------------------------------------------;
;;; Function: TRACE-VECTOR ;
;;; ;
;;; Description: This function supplies the ;
;;; Sum of all the elements of a vector. ;
;;; ;
;;; Arguments: ;
;;; vect = a valid vector list such as: ;
;;; '( 5 5 5 ) ;
;;; ;
;;; Returned Value: A number representing the xxxxxx of the vector. ;
;;; ;
;;; Usage: (trace-vector '( 5 5 5)) ;
;;;--------------------------------------------------------------------;
(defun trace-vector (vect)
(if (> (vlax-variant-type vect) 8192)
(setq vect (vlax-safearray->list (vlax-variant-value vect)))
)
(if (null vect)
0
(+ (car vect) (trace-vector (cdr vect)))
)
)

;;;--------------------------------------------------------------------; 
;;;       Function:  VECTOR-NORM                                       ; 
;;;                                                                    ; 
;;;    Description:  This function returns the normal for the          ; 
;;;                  vector supplied.                                  ; 
;;;                                                                    ; 
;;;                  Required Functions:                               ; 
;;;                      trace-vector                                  ; 
;;;                                                                    ; 
;;;      Arguments:                                                    ; 
;;;               vect =  a valid vector list such as:                 ; 
;;;                       '( 5 5 5 )                                   ; 
;;;                                                                    ; 
;;; Returned Value:  A number representing the normal of the vector.   ; 
;;;                                                                       ; 
;;;          Usage: (vector-norm '( 5 5 5))                            ; 
;;;--------------------------------------------------------------------; 
(defun vector-norm (vect / nv TransDataA TransData) 
  (if (> (vlax-variant-type vect) 8192) 
    (setq vect (vlax-safearray->list (vlax-variant-value vect))) 
  ) 
  (setq nv (sqrt (trace-vector (mapcar '* vect vect)))) 
  ;; Convert to a Variant Array of Doubles here -> 
  (if nv 
    (progn 
      (setq TransDataA (vlax-make-safearray vlax-vbDouble (cons 0 3))) 
      (vlax-safearray-fill TransDataA nv) 
      (setq TransData (vlax-make-variant 
                        TransDataA 
                        (logior vlax-vbarray vlax-vbDouble) 
                      ) 
      ) 
    ) 
  ) 
) 
;;;--------------------------------------------------------------------; 
;;;       Function:  TRACE-VECTOR                                      ; 
;;;                                                                    ; 
;;;    Description:  This function supplies the                        ; 
;;;                  Sum of all the elements of a vector.              ; 
;;;                                                                    ; 
;;;      Arguments:                                                    ; 
;;;               vect =  a valid vector list such as:                 ; 
;;;                       '( 5 5 5 )                                   ; 
;;;                                                                    ; 
;;; Returned Value:  A number representing the xxxxxx of the vector.   ; 
;;;                                                                       ; 
;;;          Usage: (trace-vector '( 5 5 5))                           ; 
;;;--------------------------------------------------------------------; 
(defun trace-vector (vect) 
  (if (> (vlax-variant-type vect) 8192) 
    (setq vect (vlax-safearray->list (vlax-variant-value vect))) 
  ) 
  (if (null vect) 
    0 
    (+ (car vect) (trace-vector (cdr vect))) 
  ) 
)

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

[LISP函数-向量]：两个矢量的叉积

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

相关帖子