6
6
7
7
class RogueTest (unittest .TestCase ):
8
8
def setUp (self ):
9
- self .env , self . robot = herbpy . initialize ( sim = True )
9
+ self .env = openravepy . Environment ( )
10
10
self .fuze = prpy .rave .add_object (self .env , 'fuze_bottle' , 'objects/fuze_bottle.kinbody.xml' )
11
- self .robot .right_arm .SetActive ()
12
11
self .fuze_pose = numpy .eye (4 )
13
12
self .fuze_pose [0 :3 , 3 ] = [0.8 , - 0.3 , 0.4 ]
14
13
self .fuze .SetTransform (self .fuze_pose )
@@ -18,18 +17,6 @@ def tearDown(self):
18
17
self .env .Destroy ()
19
18
openravepy .RaveDestroy ()
20
19
21
- def test_Pointing (self ):
22
- self .robot .PointAt ([1 , 1 , 1 ])
23
- herbpy .action .Point (self .robot , [1 , 1 , 1 ])
24
-
25
- def test_Presenting (self ):
26
- self .robot .PresentAt ([0.5 , 0 , 1 ])
27
- herbpy .action .Present (self .robot , [0.5 , 0 , 1 ])
28
-
29
- def test_Sweeping (self ):
30
- self .robot .SweepAt ([0.5 , 0 , 0.5 ], [0.7 , 0 , 0.5 ])
31
- herbpy .action .Sweep (self .robot , [0.7 , 0 , 0.5 ], [0.5 , 0 , 0.5 ])
32
-
33
20
def test_GetPointFrom (self ):
34
21
kinbody_coord = prpy .util .GetPointFrom (self .fuze )
35
22
numpy .testing .assert_almost_equal (kinbody_coord , self .fuze_pose [0 :3 , 3 ])
@@ -49,32 +36,6 @@ def test_GetPointFrom(self):
49
36
transform_coord = prpy .util .GetPointFrom (self .fuze_pose )
50
37
numpy .testing .assert_almost_equal (transform_coord , self .fuze_pose [0 :3 , 3 ])
51
38
52
- def test_Exhibiting (self ):
53
- self .robot .Exhibit (self .fuze )
54
-
55
- @nottest
56
- def test_Nodding (self ):
57
- # TODO disabled until new head installed
58
- self .robot .NodYes ()
59
- self .robot .NodNo ()
60
-
61
- def test_HaltHand (self ):
62
- self .robot .HaltHand ()
63
- goal_pose = numpy .array ([5.03348748 , - 1.57569674 , 1.68788069 ,
64
- 2.06769058 , - 1.66834313 ,
65
- 1.53679821 , 0.21175342 ], dtype = 'float' )
66
- actual_pose = self .robot .GetActiveManipulator ().GetDOFValues ()
67
- numpy .testing .assert_array_almost_equal (goal_pose , actual_pose )
68
-
69
-
70
- def test_MiddleFinger (self ):
71
- self .robot .MiddleFinger ()
72
-
73
- @nottest
74
- def test_Wave (self ):
75
- # TODO disabled until rmh regenerates trajectories
76
- self .robot .Wave ()
77
-
78
39
if __name__ == '__main__' :
79
40
import rosunit
80
41
rosunit .unitrun (PKG , 'test_rogue' , RogueTest )
0 commit comments