|
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