|
4 | 4 |
|
5 | 5 | <xacro:macro name="gemini_335Le" params="
|
6 | 6 | parent
|
7 |
| - prefix:='camera' |
| 7 | + name:='camera' |
8 | 8 | *origin
|
9 | 9 | sim_gazebo:=false
|
10 | 10 | gz_fps:='5'
|
11 | 11 | gz_image_width:='848'
|
12 | 12 | gz_image_height:='530'">
|
13 | 13 |
|
14 | 14 | <!-- The original link started with camera_link -->
|
15 |
| - <joint name="${prefix}_gemini_mount_fixed_joint" type="fixed"> |
| 15 | + <joint name="${name}_gemini_mount_fixed_joint" type="fixed"> |
16 | 16 | <parent link="${parent}" />
|
17 |
| - <child link="${prefix}_link" /> |
| 17 | + <child link="${name}_link" /> |
18 | 18 | <xacro:insert_block name="origin"/>
|
19 | 19 | </joint>
|
20 | 20 |
|
21 | 21 | <link
|
22 |
| - name="${prefix}_link"> |
| 22 | + name="${name}_link"> |
23 | 23 | <inertial>
|
24 | 24 | <origin
|
25 | 25 | xyz="0.01235 -0.0020872 0.013243"
|
|
54 | 54 | </collision>
|
55 | 55 | </link>
|
56 | 56 |
|
57 |
| - <link name="${prefix}_bottom_screw_frame" /> |
| 57 | + <link name="${name}_bottom_screw_frame" /> |
58 | 58 | <joint
|
59 |
| - name="${prefix}_bottom_screw_frame_joint" |
| 59 | + name="${name}_bottom_screw_frame_joint" |
60 | 60 | type="fixed">
|
61 | 61 | <origin
|
62 | 62 | xyz="0 0 0"
|
63 | 63 | rpy="0 0 0" />
|
64 | 64 | <parent
|
65 |
| - link="${prefix}_link" /> |
| 65 | + link="${name}_link" /> |
66 | 66 | <child
|
67 |
| - link="${prefix}_bottom_screw_frame" /> |
| 67 | + link="${name}_bottom_screw_frame" /> |
68 | 68 | <axis
|
69 | 69 | xyz="0 0 0" />
|
70 | 70 | </joint>
|
71 | 71 |
|
72 |
| - <link name="${prefix}_infra2_frame" /> |
| 72 | + <link name="${name}_infra2_frame" /> |
73 | 73 | <joint
|
74 |
| - name="${prefix}_infra2_frame_joint" |
| 74 | + name="${name}_infra2_frame_joint" |
75 | 75 | type="fixed">
|
76 | 76 | <origin
|
77 | 77 | xyz="0.034005 -0.0475 0.014048"
|
78 | 78 | rpy="0 0 0" />
|
79 | 79 | <parent
|
80 |
| - link="${prefix}_link" /> |
| 80 | + link="${name}_link" /> |
81 | 81 | <child
|
82 |
| - link="${prefix}_infra2_frame" /> |
| 82 | + link="${name}_infra2_frame" /> |
83 | 83 | <axis
|
84 | 84 | xyz="0 0 0" />
|
85 | 85 | </joint>
|
86 | 86 |
|
87 |
| - <link name="${prefix}_infra2_optical_frame" /> |
| 87 | + <link name="${name}_infra2_optical_frame" /> |
88 | 88 | <joint
|
89 |
| - name="${prefix}_infra2_optical_frame_joint" |
| 89 | + name="${name}_infra2_optical_frame_joint" |
90 | 90 | type="fixed">
|
91 | 91 | <origin
|
92 | 92 | xyz="0 0 0"
|
93 | 93 | rpy="-1.5708 0 -1.5708" />
|
94 | 94 | <parent
|
95 |
| - link="${prefix}_infra2_frame" /> |
| 95 | + link="${name}_infra2_frame" /> |
96 | 96 | <child
|
97 |
| - link="${prefix}_infra2_optical_frame" /> |
| 97 | + link="${name}_infra2_optical_frame" /> |
98 | 98 | <axis
|
99 | 99 | xyz="0 0 0" />
|
100 | 100 | </joint>
|
101 | 101 |
|
102 | 102 |
|
103 |
| - <link name="${prefix}_infra1_frame" /> |
| 103 | + <link name="${name}_infra1_frame" /> |
104 | 104 | <joint
|
105 |
| - name="${prefix}_infra1_frame_joint" |
| 105 | + name="${name}_infra1_frame_joint" |
106 | 106 | type="fixed">
|
107 | 107 | <origin
|
108 | 108 | xyz="0.034005 0.0475 0.014048"
|
109 | 109 | rpy="0 0 0" />
|
110 | 110 | <parent
|
111 |
| - link="${prefix}_link" /> |
| 111 | + link="${name}_link" /> |
112 | 112 | <child
|
113 |
| - link="${prefix}_infra1_frame" /> |
| 113 | + link="${name}_infra1_frame" /> |
114 | 114 | <axis
|
115 | 115 | xyz="0 0 0" />
|
116 | 116 | </joint>
|
117 | 117 |
|
118 |
| - <link name="${prefix}_infra1_optical_frame" /> |
| 118 | + <link name="${name}_infra1_optical_frame" /> |
119 | 119 | <joint
|
120 |
| - name="${prefix}_infra1_optical_frame_joint" |
| 120 | + name="${name}_infra1_optical_frame_joint" |
121 | 121 | type="fixed">
|
122 | 122 | <origin
|
123 | 123 | xyz="0 0 0"
|
124 | 124 | rpy="-1.5708 0 -1.5708" />
|
125 | 125 | <parent
|
126 |
| - link="${prefix}_infra1_frame" /> |
| 126 | + link="${name}_infra1_frame" /> |
127 | 127 | <child
|
128 |
| - link="${prefix}_infra1_optical_frame" /> |
| 128 | + link="${name}_infra1_optical_frame" /> |
129 | 129 | <axis
|
130 | 130 | xyz="0 0 0" />
|
131 | 131 | </joint>
|
132 | 132 |
|
133 |
| - <link name="${prefix}_depth_frame" /> |
| 133 | + <link name="${name}_depth_frame" /> |
134 | 134 | <joint
|
135 |
| - name="${prefix}_depth_frame_joint" |
| 135 | + name="${name}_depth_frame_joint" |
136 | 136 | type="fixed">
|
137 | 137 | <parent
|
138 |
| - link="${prefix}_infra1_frame" /> |
| 138 | + link="${name}_infra1_frame" /> |
139 | 139 | <child
|
140 |
| - link="${prefix}_depth_frame" /> |
| 140 | + link="${name}_depth_frame" /> |
141 | 141 | <axis
|
142 | 142 | xyz="0 0 0" />
|
143 | 143 | </joint>
|
144 | 144 |
|
145 |
| - <link name="${prefix}_depth_optical_frame" /> |
| 145 | + <link name="${name}_depth_optical_frame" /> |
146 | 146 | <joint
|
147 |
| - name="${prefix}_depth_optical_frame_joint" |
| 147 | + name="${name}_depth_optical_frame_joint" |
148 | 148 | type="fixed">
|
149 | 149 | <parent
|
150 |
| - link="${prefix}_infra1_optical_frame" /> |
| 150 | + link="${name}_infra1_optical_frame" /> |
151 | 151 | <child
|
152 |
| - link="${prefix}_depth_optical_frame" /> |
| 152 | + link="${name}_depth_optical_frame" /> |
153 | 153 | <axis
|
154 | 154 | xyz="0 0 0" />
|
155 | 155 | </joint>
|
156 | 156 |
|
157 |
| - <link name="${prefix}_color_frame" /> |
| 157 | + <link name="${name}_color_frame" /> |
158 | 158 | <joint
|
159 |
| - name="${prefix}_frame_frame_joint" |
| 159 | + name="${name}_frame_frame_joint" |
160 | 160 | type="fixed">
|
161 | 161 | <origin
|
162 | 162 | xyz="0.034014 0.02375 0.014048"
|
163 | 163 | rpy="0 0 0" />
|
164 | 164 | <parent
|
165 |
| - link="${prefix}_link" /> |
| 165 | + link="${name}_link" /> |
166 | 166 | <child
|
167 |
| - link="${prefix}_color_frame" /> |
| 167 | + link="${name}_color_frame" /> |
168 | 168 | <axis
|
169 | 169 | xyz="0 0 0" />
|
170 | 170 | </joint>
|
171 | 171 |
|
172 |
| - <link name="${prefix}_color_optical_frame" /> |
| 172 | + <link name="${name}_color_optical_frame" /> |
173 | 173 | <joint
|
174 |
| - name="${prefix}_color_optical_frame_joint" |
| 174 | + name="${name}_color_optical_frame_joint" |
175 | 175 | type="fixed">
|
176 | 176 | <origin
|
177 | 177 | xyz="0 0 0"
|
178 | 178 | rpy="-1.5708 0 -1.5708" />
|
179 | 179 | <parent
|
180 |
| - link="${prefix}_color_frame" /> |
| 180 | + link="${name}_color_frame" /> |
181 | 181 | <child
|
182 |
| - link="${prefix}_color_optical_frame" /> |
| 182 | + link="${name}_color_optical_frame" /> |
183 | 183 | <axis
|
184 | 184 | xyz="0 0 0" />
|
185 | 185 | </joint>
|
186 | 186 |
|
187 |
| - <link name="${prefix}_imu_frame" /> |
| 187 | + <link name="${name}_imu_frame" /> |
188 | 188 | <joint
|
189 |
| - name="${prefix}_imu_frame_joint" |
| 189 | + name="${name}_imu_frame_joint" |
190 | 190 | type="fixed">
|
191 | 191 | <origin
|
192 | 192 | xyz="0.019757 0.03619 0.013358"
|
193 | 193 | rpy="0 0 0" />
|
194 | 194 | <parent
|
195 |
| - link="${prefix}_link" /> |
| 195 | + link="${name}_link" /> |
196 | 196 | <child
|
197 |
| - link="${prefix}_imu_frame" /> |
| 197 | + link="${name}_imu_frame" /> |
198 | 198 | <axis
|
199 | 199 | xyz="0 0 0" />
|
200 | 200 | </joint>
|
|
204 | 204 | <xacro:include filename="$(find realsense2_gz_description)/urdf/rgbd_camera.gazebo.xacro" />
|
205 | 205 | <!-- TODO: Upstream changes required for a triggered RBGD camera -->
|
206 | 206 | <xacro:gazebo_rgbd
|
207 |
| - name="${prefix}" |
208 |
| - gz_topic_name="${prefix}" |
| 207 | + name="${name}" |
| 208 | + gz_topic_name="${name}" |
209 | 209 | fps="${gz_fps}"
|
210 | 210 | image_width="${gz_image_width}"
|
211 | 211 | image_height="${gz_image_height}"
|
|
0 commit comments