|
15 | 15 | from numpy import array
|
16 | 16 | from spatialmath import SE3, SE2
|
17 | 17 | import graphics as gph
|
18 |
| -from roboticstoolbox.models.graphical_puma560 import import_puma_560, Puma560 |
19 | 18 | from roboticstoolbox.robot.serial_link import SerialLink, Link
|
20 | 19 |
|
21 | 20 |
|
@@ -68,8 +67,8 @@ def test_import_stl():
|
68 | 67 | """
|
69 | 68 | This test will create a canvas with the Puma560 model loaded in.
|
70 | 69 | """
|
71 |
| - puma560 = import_puma_560(g_canvas) |
72 |
| - puma560.print_joint_poses() |
| 70 | + # puma560 = import_puma_560(g_canvas) |
| 71 | + # puma560.print_joint_poses() |
73 | 72 |
|
74 | 73 |
|
75 | 74 | def test_rotational_link():
|
@@ -143,70 +142,70 @@ def test_puma560_angle_change():
|
143 | 142 | This test loads in the Puma560 model and changes its angles over time.
|
144 | 143 | Joint angles are printed for validation.
|
145 | 144 | """
|
146 |
| - puma560 = import_puma_560(g_canvas) |
147 |
| - |
148 |
| - print("Prior Poses") |
149 |
| - puma560.print_joint_poses() |
150 |
| - |
151 |
| - sleep(2) |
152 |
| - |
153 |
| - # Get the poses for a ready-position |
154 |
| - puma = Puma560() |
155 |
| - poses = puma.fkine(puma.qr, alltout=True) |
156 |
| - |
157 |
| - puma560.set_joint_poses([ |
158 |
| - poses[0], |
159 |
| - poses[1], |
160 |
| - poses[2], |
161 |
| - poses[3], |
162 |
| - poses[4], |
163 |
| - poses[5], |
164 |
| - poses[6] |
165 |
| - ]) |
166 |
| - |
167 |
| - print("Final Poses") |
168 |
| - puma560.print_joint_poses() |
| 145 | + # puma560 = import_puma_560(g_canvas) |
| 146 | + # |
| 147 | + # print("Prior Poses") |
| 148 | + # puma560.print_joint_poses() |
| 149 | + # |
| 150 | + # sleep(2) |
| 151 | + # |
| 152 | + # # Get the poses for a ready-position |
| 153 | + # puma = Puma560() |
| 154 | + # poses = puma.fkine(puma.qr, alltout=True) |
| 155 | + # |
| 156 | + # puma560.set_joint_poses([ |
| 157 | + # poses[0], |
| 158 | + # poses[1], |
| 159 | + # poses[2], |
| 160 | + # poses[3], |
| 161 | + # poses[4], |
| 162 | + # poses[5], |
| 163 | + # poses[6] |
| 164 | + # ]) |
| 165 | + # |
| 166 | + # print("Final Poses") |
| 167 | + # puma560.print_joint_poses() |
169 | 168 |
|
170 | 169 |
|
171 | 170 | def test_clear_scene():
|
172 | 171 | """
|
173 | 172 | This test will import the Puma560 model, then after 2 seconds, clear the canvas of all models.
|
174 | 173 | """
|
175 |
| - puma560 = import_puma_560(g_canvas) |
176 |
| - puma560.set_reference_visibility(True) |
177 |
| - |
178 |
| - sleep(2) |
179 |
| - |
180 |
| - clear() |
181 |
| - del puma560 |
| 174 | + # puma560 = import_puma_560(g_canvas) |
| 175 | + # puma560.set_reference_visibility(True) |
| 176 | + # |
| 177 | + # sleep(2) |
| 178 | + # |
| 179 | + # clear() |
| 180 | + # del puma560 |
182 | 181 |
|
183 | 182 |
|
184 | 183 | def test_clear_scene_with_grid_updating():
|
185 | 184 | """
|
186 | 185 | This test will import the Puma560 model, then after 2 seconds, clear the canvas of all models.
|
187 | 186 | """
|
188 |
| - puma560 = import_puma_560(g_canvas) |
189 |
| - |
190 |
| - sleep(2) |
191 |
| - |
192 |
| - # Get the poses for a ready-position |
193 |
| - puma = Puma560() |
194 |
| - poses = puma.fkine(puma.qr, alltout=True) |
195 |
| - |
196 |
| - puma560.set_joint_poses([ |
197 |
| - poses[0], |
198 |
| - poses[1], |
199 |
| - poses[2], |
200 |
| - poses[3], |
201 |
| - poses[4], |
202 |
| - poses[5], |
203 |
| - poses[6] |
204 |
| - ]) |
205 |
| - |
206 |
| - sleep(2) |
207 |
| - |
208 |
| - clear() |
209 |
| - del puma560 |
| 187 | + # puma560 = import_puma_560(g_canvas) |
| 188 | + # |
| 189 | + # sleep(2) |
| 190 | + # |
| 191 | + # # Get the poses for a ready-position |
| 192 | + # puma = Puma560() |
| 193 | + # poses = puma.fkine(puma.qr, alltout=True) |
| 194 | + # |
| 195 | + # puma560.set_joint_poses([ |
| 196 | + # poses[0], |
| 197 | + # poses[1], |
| 198 | + # poses[2], |
| 199 | + # poses[3], |
| 200 | + # poses[4], |
| 201 | + # poses[5], |
| 202 | + # poses[6] |
| 203 | + # ]) |
| 204 | + # |
| 205 | + # sleep(2) |
| 206 | + # |
| 207 | + # clear() |
| 208 | + # del puma560 |
210 | 209 |
|
211 | 210 |
|
212 | 211 | # TODO
|
@@ -368,8 +367,6 @@ def test_seriallink():
|
368 | 367 | robot2 = gph.GraphicalRobot(g_canvas, '', seriallink=tl2)
|
369 | 368 |
|
370 | 369 |
|
371 |
| - |
372 |
| - |
373 | 370 | if __name__ == "__main__":
|
374 | 371 | # run the Puma demo by default
|
375 | 372 | test_puma560_angle_change()
|
0 commit comments