|
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