|
1 | 1 | #!/usr/bin/env python3
|
2 | 2 |
|
3 |
| -import unittest |
4 |
| -import warnings |
5 |
| - |
6 |
| -from spatialmath import SE3 |
7 |
| -from vpython import vector, box |
8 |
| -from numpy import array |
9 |
| -from math import pi |
10 |
| -import time |
11 |
| - |
12 |
| -from roboticstoolbox.backends.VPython.common_functions import \ |
13 |
| - get_pose_x_vec, get_pose_y_vec, get_pose_z_vec, get_pose_pos, \ |
14 |
| - vpython_to_se3, wrap_to_pi, close_localhost_session, \ |
15 |
| - x_axis_vector, y_axis_vector, z_axis_vector |
16 |
| -from roboticstoolbox.backends.VPython.canvas import GraphicsCanvas3D, \ |
17 |
| - draw_reference_frame_axes |
18 |
| -from roboticstoolbox.backends.VPython.graphicalrobot import GraphicalRobot, \ |
19 |
| - DefaultJoint, RotationalJoint, PrismaticJoint, StaticJoint, Gripper |
20 |
| -from roboticstoolbox.backends.VPython.stl import import_object_from_numpy_stl |
21 |
| -from roboticstoolbox.backends.VPython.grid import GraphicsGrid |
22 |
| - |
23 |
| - |
24 |
| -class TestVPython(unittest.TestCase): |
25 |
| - |
26 |
| - def setUp(self): |
27 |
| - self.robot_scene = GraphicsCanvas3D() |
28 |
| - |
29 |
| - # 0.707107 -0.707107 0 0 |
30 |
| - # 0.707107 0.707107 0 1 |
31 |
| - # 0 0 1 0.4 |
32 |
| - # 0 0 0 1 |
33 |
| - self.robot_se3 = SE3().Ty(1) * SE3().Tz(0.4) * SE3().Rz(45, 'deg') |
34 |
| - self.robot_structure = 1.0 |
35 |
| - self.se3 = SE3().Tx(3) |
36 |
| - warnings.simplefilter('ignore', category=ResourceWarning) |
37 |
| - |
38 |
| - @classmethod |
39 |
| - def tearDownClass(cls): |
40 |
| - with cls.assertRaises(cls, SystemExit): |
41 |
| - temp = GraphicsCanvas3D() |
42 |
| - close_localhost_session(temp) |
43 |
| - del temp |
44 |
| - # Give time for VPython to exit |
45 |
| - time.sleep(1) |
| 3 | +# import unittest |
| 4 | +# import warnings |
| 5 | + |
| 6 | +# from spatialmath import SE3 |
| 7 | +# from vpython import vector, box |
| 8 | +# from numpy import array |
| 9 | +# from math import pi |
| 10 | +# import time |
| 11 | + |
| 12 | +# from roboticstoolbox.backends.VPython.common_functions import \ |
| 13 | +# get_pose_x_vec, get_pose_y_vec, get_pose_z_vec, get_pose_pos, \ |
| 14 | +# vpython_to_se3, wrap_to_pi, close_localhost_session, \ |
| 15 | +# x_axis_vector, y_axis_vector, z_axis_vector |
| 16 | +# from roboticstoolbox.backends.VPython.canvas import GraphicsCanvas3D, \ |
| 17 | +# draw_reference_frame_axes |
| 18 | +# from roboticstoolbox.backends.VPython.graphicalrobot import GraphicalRobot, \ |
| 19 | +# DefaultJoint, RotationalJoint, PrismaticJoint, StaticJoint, Gripper |
| 20 | +# from roboticstoolbox.backends.VPython.stl import import_object_from_numpy_stl |
| 21 | +# from roboticstoolbox.backends.VPython.grid import GraphicsGrid |
| 22 | + |
| 23 | + |
| 24 | +# class TestVPython(unittest.TestCase): |
| 25 | + |
| 26 | +# def setUp(self): |
| 27 | +# self.robot_scene = GraphicsCanvas3D() |
| 28 | + |
| 29 | +# # 0.707107 -0.707107 0 0 |
| 30 | +# # 0.707107 0.707107 0 1 |
| 31 | +# # 0 0 1 0.4 |
| 32 | +# # 0 0 0 1 |
| 33 | +# self.robot_se3 = SE3().Ty(1) * SE3().Tz(0.4) * SE3().Rz(45, 'deg') |
| 34 | +# self.robot_structure = 1.0 |
| 35 | +# self.se3 = SE3().Tx(3) |
| 36 | +# warnings.simplefilter('ignore', category=ResourceWarning) |
| 37 | + |
| 38 | +# @classmethod |
| 39 | +# def tearDownClass(cls): |
| 40 | +# with cls.assertRaises(cls, SystemExit): |
| 41 | +# temp = GraphicsCanvas3D() |
| 42 | +# close_localhost_session(temp) |
| 43 | +# del temp |
| 44 | +# # Give time for VPython to exit |
| 45 | +# time.sleep(1) |
46 | 46 |
|
47 | 47 | #####################################################################
|
48 | 48 | # def test_get_pose_x_vector(self):
|
|
0 commit comments