File: coe-light-object.l

package info (click to toggle)
euslisp 9.31%2Bdfsg-3
  • links: PTS, VCS
  • area: main
  • in suites: forky, sid, trixie
  • size: 55,448 kB
  • sloc: ansic: 41,610; lisp: 3,339; makefile: 286; sh: 238; asm: 138; python: 53
file content (105 lines) | stat: -rw-r--r-- 11,538 bytes parent folder | download | duplicates (2)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
;;
;; DO NOT EDIT THIS FILE
;; this file is automatically generated from euslisp+euslib version 
;;
;;
(defclass coe-light-object
  :super cascaded-link
  :slots (sensors
         ))
(defmethod coe-light-object
  (:init
   (&rest args &key (name "coe-light") (pos (float-vector 0 0 0)) (rot (unit-matrix 3)) &allow-other-keys)
   (let (c bc
         blink0
                 )
     (send-super* :init :name name args)

     ;; definition of link

     ;; definition of :coe-light-bodyset2
     (setq bc (list
       (instance faceset :init :faces (list
         (instance face :init :vertices (list (float-vector 47.6314 -27.5 140.0) (float-vector 55.0 0.0 140.0) (float-vector 47.6314 27.5 140.0) (float-vector 27.5 47.6314 140.0) (float-vector 3.197442e-14 55.0 140.0) (float-vector -27.5 47.6314 140.0) (float-vector -47.6314 27.5 140.0) (float-vector -55.0 6.394885e-14 140.0) (float-vector -47.6314 -27.5 140.0) (float-vector -27.5 -47.6314 140.0) (float-vector -9.237056e-14 -55.0 140.0) (float-vector 27.5 -47.6314 140.0)))
         (instance face :init :vertices (list (float-vector 55.0 0.0 0.0) (float-vector 47.6314 -27.5 0.0) (float-vector 27.5 -47.6314 0.0) (float-vector -9.237056e-14 -55.0 0.0) (float-vector -27.5 -47.6314 0.0) (float-vector -47.6314 -27.5 0.0) (float-vector -55.0 6.394885e-14 0.0) (float-vector -47.6314 27.5 0.0) (float-vector -27.5 47.6314 0.0) (float-vector 3.197442e-14 55.0 0.0) (float-vector 27.5 47.6314 0.0) (float-vector 47.6314 27.5 0.0)))
         (instance face :init :vertices (list (float-vector 47.6314 -27.5 140.0) (float-vector 47.6314 -27.5 0.0) (float-vector 55.0 0.0 0.0) (float-vector 55.0 0.0 140.0)))
         (instance face :init :vertices (list (float-vector 27.5 -47.6314 140.0) (float-vector 27.5 -47.6314 0.0) (float-vector 47.6314 -27.5 0.0) (float-vector 47.6314 -27.5 140.0)))
         (instance face :init :vertices (list (float-vector -9.237056e-14 -55.0 140.0) (float-vector -9.237056e-14 -55.0 0.0) (float-vector 27.5 -47.6314 0.0) (float-vector 27.5 -47.6314 140.0)))
         (instance face :init :vertices (list (float-vector -27.5 -47.6314 140.0) (float-vector -27.5 -47.6314 0.0) (float-vector -9.237056e-14 -55.0 0.0) (float-vector -9.237056e-14 -55.0 140.0)))
         (instance face :init :vertices (list (float-vector -47.6314 -27.5 140.0) (float-vector -47.6314 -27.5 0.0) (float-vector -27.5 -47.6314 0.0) (float-vector -27.5 -47.6314 140.0)))
         (instance face :init :vertices (list (float-vector -55.0 6.394885e-14 140.0) (float-vector -55.0 6.394885e-14 0.0) (float-vector -47.6314 -27.5 0.0) (float-vector -47.6314 -27.5 140.0)))
         (instance face :init :vertices (list (float-vector -47.6314 27.5 140.0) (float-vector -47.6314 27.5 0.0) (float-vector -55.0 6.394885e-14 0.0) (float-vector -55.0 6.394885e-14 140.0)))
         (instance face :init :vertices (list (float-vector -27.5 47.6314 140.0) (float-vector -27.5 47.6314 0.0) (float-vector -47.6314 27.5 0.0) (float-vector -47.6314 27.5 140.0)))
         (instance face :init :vertices (list (float-vector 3.197442e-14 55.0 140.0) (float-vector 3.197442e-14 55.0 0.0) (float-vector -27.5 47.6314 0.0) (float-vector -27.5 47.6314 140.0)))
         (instance face :init :vertices (list (float-vector 27.5 47.6314 140.0) (float-vector 27.5 47.6314 0.0) (float-vector 3.197442e-14 55.0 0.0) (float-vector 3.197442e-14 55.0 140.0)))
         (instance face :init :vertices (list (float-vector 47.6314 27.5 140.0) (float-vector 47.6314 27.5 0.0) (float-vector 27.5 47.6314 0.0) (float-vector 27.5 47.6314 140.0)))
         (instance face :init :vertices (list (float-vector 55.0 0.0 140.0) (float-vector 55.0 0.0 0.0) (float-vector 47.6314 27.5 0.0) (float-vector 47.6314 27.5 140.0)))
       ))
       (instance faceset :init :faces (list
         (instance face :init :vertices (list (float-vector 65.0 30.0 620.0) (float-vector -65.0 30.0 620.0) (float-vector -65.0 -30.0 620.0) (float-vector 65.0 -30.0 620.0)))
         (instance face :init :vertices (list (float-vector -65.0 30.0 140.0) (float-vector 65.0 30.0 140.0) (float-vector 65.0 -30.0 140.0) (float-vector -65.0 -30.0 140.0)))
         (instance face :init :vertices (list (float-vector 65.0 30.0 620.0) (float-vector 65.0 30.0 140.0) (float-vector -65.0 30.0 140.0) (float-vector -65.0 30.0 620.0)))
         (instance face :init :vertices (list (float-vector 65.0 -30.0 620.0) (float-vector 65.0 -30.0 140.0) (float-vector 65.0 30.0 140.0) (float-vector 65.0 30.0 620.0)))
         (instance face :init :vertices (list (float-vector -65.0 -30.0 620.0) (float-vector -65.0 -30.0 140.0) (float-vector 65.0 -30.0 140.0) (float-vector 65.0 -30.0 620.0)))
         (instance face :init :vertices (list (float-vector -65.0 30.0 620.0) (float-vector -65.0 30.0 140.0) (float-vector -65.0 -30.0 140.0) (float-vector -65.0 -30.0 620.0)))
       ))
       (instance faceset :init :faces (list
         (instance face :init :vertices (list (float-vector 375.0 20.0 645.0) (float-vector -65.0 20.0 645.0) (float-vector -65.0 -20.0 645.0) (float-vector 375.0 -20.0 645.0)))
         (instance face :init :vertices (list (float-vector -65.0 20.0 615.0) (float-vector 375.0 20.0 615.0) (float-vector 375.0 -20.0 615.0) (float-vector -65.0 -20.0 615.0)))
         (instance face :init :vertices (list (float-vector 375.0 20.0 645.0) (float-vector 375.0 20.0 615.0) (float-vector -65.0 20.0 615.0) (float-vector -65.0 20.0 645.0)))
         (instance face :init :vertices (list (float-vector 375.0 -20.0 645.0) (float-vector 375.0 -20.0 615.0) (float-vector 375.0 20.0 615.0) (float-vector 375.0 20.0 645.0)))
         (instance face :init :vertices (list (float-vector -65.0 -20.0 645.0) (float-vector -65.0 -20.0 615.0) (float-vector 375.0 -20.0 615.0) (float-vector 375.0 -20.0 645.0)))
         (instance face :init :vertices (list (float-vector -65.0 20.0 645.0) (float-vector -65.0 20.0 615.0) (float-vector -65.0 -20.0 615.0) (float-vector -65.0 -20.0 645.0)))
       ))
       (instance faceset :init :faces (list
         (instance face :init :vertices (list (float-vector 530.0 0.0 620.0) (float-vector 523.149 -34.4415 620.0) (float-vector 503.64 -63.6396 620.0) (float-vector 474.442 -83.1492 620.0) (float-vector 440.0 -90.0 620.0) (float-vector 405.558 -83.1492 620.0) (float-vector 376.36 -63.6396 620.0) (float-vector 356.851 -34.4415 620.0) (float-vector 350.0 4.906382e-13 620.0) (float-vector 356.851 34.4415 620.0) (float-vector 376.36 63.6396 620.0) (float-vector 405.558 83.1492 620.0) (float-vector 440.0 90.0 620.0) (float-vector 474.442 83.1492 620.0) (float-vector 503.64 63.6396 620.0) (float-vector 523.149 34.4415 620.0)))
         (instance face :init :vertices (list (float-vector 490.813 -21.0476 730.0) (float-vector 523.149 -34.4415 620.0) (float-vector 530.0 0.0 620.0) (float-vector 495.0 0.0 730.0)))
         (instance face :init :vertices (list (float-vector 478.891 -38.8909 730.0) (float-vector 503.64 -63.6396 620.0) (float-vector 523.149 -34.4415 620.0) (float-vector 490.813 -21.0476 730.0)))
         (instance face :init :vertices (list (float-vector 461.048 -50.8134 730.0) (float-vector 474.442 -83.1492 620.0) (float-vector 503.64 -63.6396 620.0) (float-vector 478.891 -38.8909 730.0)))
         (instance face :init :vertices (list (float-vector 440.0 -55.0 730.0) (float-vector 440.0 -90.0 620.0) (float-vector 474.442 -83.1492 620.0) (float-vector 461.048 -50.8134 730.0)))
         (instance face :init :vertices (list (float-vector 418.952 -50.8134 730.0) (float-vector 405.558 -83.1492 620.0) (float-vector 440.0 -90.0 620.0) (float-vector 440.0 -55.0 730.0)))
         (instance face :init :vertices (list (float-vector 401.109 -38.8909 730.0) (float-vector 376.36 -63.6396 620.0) (float-vector 405.558 -83.1492 620.0) (float-vector 418.952 -50.8134 730.0)))
         (instance face :init :vertices (list (float-vector 389.187 -21.0476 730.0) (float-vector 356.851 -34.4415 620.0) (float-vector 376.36 -63.6396 620.0) (float-vector 401.109 -38.8909 730.0)))
         (instance face :init :vertices (list (float-vector 385.0 2.998344e-13 730.0) (float-vector 350.0 4.906382e-13 620.0) (float-vector 356.851 -34.4415 620.0) (float-vector 389.187 -21.0476 730.0)))
         (instance face :init :vertices (list (float-vector 389.187 21.0476 730.0) (float-vector 356.851 34.4415 620.0) (float-vector 350.0 4.906382e-13 620.0) (float-vector 385.0 2.998344e-13 730.0)))
         (instance face :init :vertices (list (float-vector 401.109 38.8909 730.0) (float-vector 376.36 63.6396 620.0) (float-vector 356.851 34.4415 620.0) (float-vector 389.187 21.0476 730.0)))
         (instance face :init :vertices (list (float-vector 418.952 50.8134 730.0) (float-vector 405.558 83.1492 620.0) (float-vector 376.36 63.6396 620.0) (float-vector 401.109 38.8909 730.0)))
         (instance face :init :vertices (list (float-vector 440.0 55.0 730.0) (float-vector 440.0 90.0 620.0) (float-vector 405.558 83.1492 620.0) (float-vector 418.952 50.8134 730.0)))
         (instance face :init :vertices (list (float-vector 461.048 50.8134 730.0) (float-vector 474.442 83.1492 620.0) (float-vector 440.0 90.0 620.0) (float-vector 440.0 55.0 730.0)))
         (instance face :init :vertices (list (float-vector 478.891 38.8909 730.0) (float-vector 503.64 63.6396 620.0) (float-vector 474.442 83.1492 620.0) (float-vector 461.048 50.8134 730.0)))
         (instance face :init :vertices (list (float-vector 490.813 21.0476 730.0) (float-vector 523.149 34.4415 620.0) (float-vector 503.64 63.6396 620.0) (float-vector 478.891 38.8909 730.0)))
         (instance face :init :vertices (list (float-vector 495.0 0.0 730.0) (float-vector 530.0 0.0 620.0) (float-vector 523.149 34.4415 620.0) (float-vector 490.813 21.0476 730.0)))
         (instance face :init :vertices (list (float-vector 490.813 -21.0476 730.0) (float-vector 495.0 0.0 730.0) (float-vector 490.813 21.0476 730.0) (float-vector 478.891 38.8909 730.0) (float-vector 461.048 50.8134 730.0) (float-vector 440.0 55.0 730.0) (float-vector 418.952 50.8134 730.0) (float-vector 401.109 38.8909 730.0) (float-vector 389.187 21.0476 730.0) (float-vector 385.0 2.998344e-13 730.0) (float-vector 389.187 -21.0476 730.0) (float-vector 401.109 -38.8909 730.0) (float-vector 418.952 -50.8134 730.0) (float-vector 440.0 -55.0 730.0) (float-vector 461.048 -50.8134 730.0) (float-vector 478.891 -38.8909 730.0)))
       ))
       ))
     (dolist (b (cdr bc)) (send (car bc) :assoc b))
     (send (elt bc 0) :set-color :gray50)
     (send (elt bc 1) :set-color :gray50)
     (send (elt bc 2) :set-color :gray50)
     (send (elt bc 3) :set-color :orange)
     (setq blink0 (instance bodyset-link :init (make-cascoords) :bodies bc :name :coe-light-bodyset2 :weight 1 :centroid (float-vector 0.0 0.0 0.0) :inertia-tensor #2f((1.0 0.0 0.0) (0.0 1.0 0.0) (0.0 0.0 1.0))))

     ;; definition of assoc
     (send self :assoc blink0)

     ;; definition of end-coords

     ;; definition of joint


     ;; init-ending 
     (setq links (list blink0))
     (setq joint-list (list))
     (send self :init-ending)
     (send self :move-to (make-coords :pos pos :rot rot))
     (send-all links :worldcoords)

     self))

  (:handle (&rest args) (forward-message-to-all (list ) args))
  (:attention (&rest args) (forward-message-to-all (list ) args))
  (:button (&rest args) (forward-message-to-all (list ) args))
  )

(defun coe-light (&rest args) (instance* coe-light-object :init args))
;; (format *error-output* "(instance coe-light-object :init) for generating model~%")