; Transformation für Cadmium
; scj, 07.10.17

;;;;;;;;;;;;;;;;;;;;
(Defun C:TRAFO (/ )
; Transformation für Cadmium
; scj, 07.10.17

(setq Ax 917.799 Ay 405.015 Az -20.151
      Bx 943.421 By 455.961 Bz -35.0277
      Cx 906.819 Cy 482.61  Cz -49.7119)

;Erzeugung der Länge der Vektoren  
 (setq |A->B| (distance (list Ax Ay Az) (list Bx By Bz)))
 (setq |A->C| (distance (list Ax Ay Az) (list Cx Cy Cz)))
 (setq |B->C| (distance (list Bx By Bz) (list Cx Cy Cz)))

;Berechnung der Winkels B->A->C (Cosinus-Satz)
 (setq cosa (+ (* |A->B| |A->B|)(* |A->C| |A->C|)))
 (setq cosa (- cosa (* |B->C| |B->C|)))
 (setq cosa (/ cosa (* 2 |A->B| |A->C|)))

; Berechnung der transformierten Koordinaten von C
 (setq CCx (* |A->C| cosa))
 (setq sina (sqrt (- 1 (* cosa cosa))))
 (setq CCy (* |A->C| sina))
;
; A' = 0,	0,	0
; B' = |A->C|, 	0, 	0 
; C' = C'x,	C'y,	0
(setq CC (list
	    (list 0 0 0)
	    (list |A->B| 0 0)
	    (list CCx CCy 0)
	 )
) 

)