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
106
|
;;
;; DO NOT EDIT THIS FILE
;; this file is automatically generated from euslisp+euslib version
;;
;;
(defclass bidirectional-arrow-object
:super cascaded-link
:slots (sensors
))
(defmethod bidirectional-arrow-object
(:init
(&rest args &key (name "bidirectional-arrow") (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 :bidirectional-arrow-bodyset2
(setq bc (list
(instance faceset :init :faces (list
(instance face :init :vertices (list (float-vector 33.3333 140.0 8.572528e-15) (float-vector 30.796 140.0 12.7561) (float-vector 23.5702 140.0 23.5702) (float-vector 12.7561 140.0 30.796) (float-vector -3.021827e-13 140.0 33.3333) (float-vector -12.7561 140.0 30.796) (float-vector -23.5702 140.0 23.5702) (float-vector -30.796 140.0 12.7561) (float-vector -33.3333 140.0 -1.731453e-13) (float-vector -30.796 140.0 -12.7561) (float-vector -23.5702 140.0 -23.5702) (float-vector -12.7561 140.0 -30.796) (float-vector 3.164703e-14 140.0 -33.3333) (float-vector 12.7561 140.0 -30.796) (float-vector 23.5702 140.0 -23.5702) (float-vector 30.796 140.0 -12.7561)))
(instance face :init :vertices (list (float-vector 30.796 140.0 12.7561) (float-vector 33.3333 140.0 8.572528e-15) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector 33.3333 140.0 8.572528e-15) (float-vector 30.796 140.0 -12.7561) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector 30.796 140.0 -12.7561) (float-vector 23.5702 140.0 -23.5702) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector 23.5702 140.0 -23.5702) (float-vector 12.7561 140.0 -30.796) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector 12.7561 140.0 -30.796) (float-vector 3.164703e-14 140.0 -33.3333) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector 3.164703e-14 140.0 -33.3333) (float-vector -12.7561 140.0 -30.796) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector -12.7561 140.0 -30.796) (float-vector -23.5702 140.0 -23.5702) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector -23.5702 140.0 -23.5702) (float-vector -30.796 140.0 -12.7561) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector -30.796 140.0 -12.7561) (float-vector -33.3333 140.0 -1.731453e-13) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector -33.3333 140.0 -1.731453e-13) (float-vector -30.796 140.0 12.7561) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector -30.796 140.0 12.7561) (float-vector -23.5702 140.0 23.5702) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector -23.5702 140.0 23.5702) (float-vector -12.7561 140.0 30.796) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector -12.7561 140.0 30.796) (float-vector -3.021827e-13 140.0 33.3333) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector -3.021827e-13 140.0 33.3333) (float-vector 12.7561 140.0 30.796) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector 12.7561 140.0 30.796) (float-vector 23.5702 140.0 23.5702) (float-vector 0.0 200.0 2.189520e-14)))
(instance face :init :vertices (list (float-vector 23.5702 140.0 23.5702) (float-vector 30.796 140.0 12.7561) (float-vector 0.0 200.0 2.189520e-14)))
))
(instance faceset :init :faces (list
(instance face :init :vertices (list (float-vector 14.4338 140.0 8.33333) (float-vector 16.6667 140.0 8.572528e-15) (float-vector 14.4338 140.0 -8.33333) (float-vector 8.33333 140.0 -14.4338) (float-vector 9.769963e-15 140.0 -16.6667) (float-vector -8.33333 140.0 -14.4338) (float-vector -14.4338 140.0 -8.33333) (float-vector -16.6667 140.0 -1.185558e-14) (float-vector -14.4338 140.0 8.33333) (float-vector -8.33333 140.0 14.4338) (float-vector -3.019807e-14 140.0 16.6667) (float-vector 8.33333 140.0 14.4338)))
(instance face :init :vertices (list (float-vector 16.6667 60.0 -9.191041e-15) (float-vector 14.4338 60.0 8.33333) (float-vector 8.33333 60.0 14.4338) (float-vector -3.019807e-14 60.0 16.6667) (float-vector -8.33333 60.0 14.4338) (float-vector -14.4338 60.0 8.33333) (float-vector -16.6667 60.0 -2.961914e-14) (float-vector -14.4338 60.0 -8.33333) (float-vector -8.33333 60.0 -14.4338) (float-vector 9.769963e-15 60.0 -16.6667) (float-vector 8.33333 60.0 -14.4338) (float-vector 14.4338 60.0 -8.33333)))
(instance face :init :vertices (list (float-vector 14.4338 140.0 8.33333) (float-vector 14.4338 60.0 8.33333) (float-vector 16.6667 60.0 -9.191041e-15) (float-vector 16.6667 140.0 8.572528e-15)))
(instance face :init :vertices (list (float-vector 8.33333 140.0 14.4338) (float-vector 8.33333 60.0 14.4338) (float-vector 14.4338 60.0 8.33333) (float-vector 14.4338 140.0 8.33333)))
(instance face :init :vertices (list (float-vector -3.019807e-14 140.0 16.6667) (float-vector -3.019807e-14 60.0 16.6667) (float-vector 8.33333 60.0 14.4338) (float-vector 8.33333 140.0 14.4338)))
(instance face :init :vertices (list (float-vector -8.33333 140.0 14.4338) (float-vector -8.33333 60.0 14.4338) (float-vector -3.019807e-14 60.0 16.6667) (float-vector -3.019807e-14 140.0 16.6667)))
(instance face :init :vertices (list (float-vector -14.4338 140.0 8.33333) (float-vector -14.4338 60.0 8.33333) (float-vector -8.33333 60.0 14.4338) (float-vector -8.33333 140.0 14.4338)))
(instance face :init :vertices (list (float-vector -16.6667 140.0 -1.185558e-14) (float-vector -16.6667 60.0 -2.961914e-14) (float-vector -14.4338 60.0 8.33333) (float-vector -14.4338 140.0 8.33333)))
(instance face :init :vertices (list (float-vector -14.4338 140.0 -8.33333) (float-vector -14.4338 60.0 -8.33333) (float-vector -16.6667 60.0 -2.961914e-14) (float-vector -16.6667 140.0 -1.185558e-14)))
(instance face :init :vertices (list (float-vector -8.33333 140.0 -14.4338) (float-vector -8.33333 60.0 -14.4338) (float-vector -14.4338 60.0 -8.33333) (float-vector -14.4338 140.0 -8.33333)))
(instance face :init :vertices (list (float-vector 9.769963e-15 140.0 -16.6667) (float-vector 9.769963e-15 60.0 -16.6667) (float-vector -8.33333 60.0 -14.4338) (float-vector -8.33333 140.0 -14.4338)))
(instance face :init :vertices (list (float-vector 8.33333 140.0 -14.4338) (float-vector 8.33333 60.0 -14.4338) (float-vector 9.769963e-15 60.0 -16.6667) (float-vector 9.769963e-15 140.0 -16.6667)))
(instance face :init :vertices (list (float-vector 14.4338 140.0 -8.33333) (float-vector 14.4338 60.0 -8.33333) (float-vector 8.33333 60.0 -14.4338) (float-vector 8.33333 140.0 -14.4338)))
(instance face :init :vertices (list (float-vector 16.6667 140.0 8.572528e-15) (float-vector 16.6667 60.0 -9.191041e-15) (float-vector 14.4338 60.0 -8.33333) (float-vector 14.4338 140.0 -8.33333)))
))
(instance faceset :init :faces (list
(instance face :init :vertices (list (float-vector 33.3333 60.0 -9.191041e-15) (float-vector 30.796 60.0 12.7561) (float-vector 23.5702 60.0 23.5702) (float-vector 12.7561 60.0 30.796) (float-vector -3.021827e-13 60.0 33.3333) (float-vector -12.7561 60.0 30.796) (float-vector -23.5702 60.0 23.5702) (float-vector -30.796 60.0 12.7561) (float-vector -33.3333 60.0 -1.909089e-13) (float-vector -30.796 60.0 -12.7561) (float-vector -23.5702 60.0 -23.5702) (float-vector -12.7561 60.0 -30.796) (float-vector 3.164703e-14 60.0 -33.3333) (float-vector 12.7561 60.0 -30.796) (float-vector 23.5702 60.0 -23.5702) (float-vector 30.796 60.0 -12.7561)))
(instance face :init :vertices (list (float-vector 30.796 60.0 12.7561) (float-vector 33.3333 60.0 -9.191041e-15) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector 33.3333 60.0 -9.191041e-15) (float-vector 30.796 60.0 -12.7561) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector 30.796 60.0 -12.7561) (float-vector 23.5702 60.0 -23.5702) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector 23.5702 60.0 -23.5702) (float-vector 12.7561 60.0 -30.796) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector 12.7561 60.0 -30.796) (float-vector 3.164703e-14 60.0 -33.3333) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector 3.164703e-14 60.0 -33.3333) (float-vector -12.7561 60.0 -30.796) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector -12.7561 60.0 -30.796) (float-vector -23.5702 60.0 -23.5702) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector -23.5702 60.0 -23.5702) (float-vector -30.796 60.0 -12.7561) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector -30.796 60.0 -12.7561) (float-vector -33.3333 60.0 -1.909089e-13) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector -33.3333 60.0 -1.909089e-13) (float-vector -30.796 60.0 12.7561) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector -30.796 60.0 12.7561) (float-vector -23.5702 60.0 23.5702) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector -23.5702 60.0 23.5702) (float-vector -12.7561 60.0 30.796) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector -12.7561 60.0 30.796) (float-vector -3.021827e-13 60.0 33.3333) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector -3.021827e-13 60.0 33.3333) (float-vector 12.7561 60.0 30.796) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector 12.7561 60.0 30.796) (float-vector 23.5702 60.0 23.5702) (float-vector 0.0 0.0 -2.251372e-14)))
(instance face :init :vertices (list (float-vector 23.5702 60.0 23.5702) (float-vector 30.796 60.0 12.7561) (float-vector 0.0 0.0 -2.251372e-14)))
))
))
(dolist (b (cdr bc)) (send (car bc) :assoc b))
(send (elt bc 0) :set-color :red)
(send (elt bc 1) :set-color :red)
(send (elt bc 2) :set-color :red)
(setq blink0 (instance bodyset-link :init (make-cascoords) :bodies bc :name :bidirectional-arrow-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 bidirectional-arrow (&rest args) (instance* bidirectional-arrow-object :init args))
;; (format *error-output* "(instance bidirectional-arrow-object :init) for generating model~%")
|
