@@ -62,9 +62,7 @@ def test_A2(self):
62
62
ans = sm .SE3 .Rx (np .pi ) * sm .SE3 .Ry (np .pi ) * sm .SE3 .Tz (1.2 )
63
63
64
64
nt .assert_array_almost_equal (l0 .A (1.2 ).A , ans .A )
65
-
66
- with self .assertRaises (ValueError ):
67
- l0 .A ()
65
+ l0 .A ()
68
66
69
67
def test_qlim (self ):
70
68
l0 = rp .ELink (qlim = [- 1 , 1 ])
@@ -183,7 +181,6 @@ def test_collision(self):
183
181
self .assertIsInstance (col , gm .Shape )
184
182
185
183
self .assertIsInstance (col .base , sm .SE3 )
186
- self .assertIsInstance (col .scale , np .ndarray )
187
184
188
185
col .radius = 2
189
186
self .assertEqual (col .radius , 2 )
@@ -193,7 +190,7 @@ def test_collision(self):
193
190
194
191
def test_collision_fail (self ):
195
192
l0 = rp .ELink ()
196
- col = rp .Box ([1 , 1 , 1 ])
193
+ col = gm .Box ([1 , 1 , 1 ])
197
194
l0 .collision = col
198
195
199
196
with self .assertRaises (TypeError ):
@@ -204,7 +201,7 @@ def test_collision_fail(self):
204
201
205
202
def test_geometry_fail (self ):
206
203
l0 = rp .ELink ()
207
- col = rp .Box ([1 , 1 , 1 ])
204
+ col = gm .Box ([1 , 1 , 1 ])
208
205
l0 .geometry = col
209
206
l0 .geometry = [col , col ]
210
207
@@ -215,8 +212,8 @@ def test_geometry_fail(self):
215
212
l0 .geometry = 1
216
213
217
214
def test_dist (self ):
218
- s0 = rp .Box ([1 , 1 , 1 ], sm .SE3 (0 , 0 , 0 ))
219
- s1 = rp .Box ([1 , 1 , 1 ], sm .SE3 (3 , 0 , 0 ))
215
+ s0 = gm .Box ([1 , 1 , 1 ], base = sm .SE3 (0 , 0 , 0 ))
216
+ s1 = gm .Box ([1 , 1 , 1 ], base = sm .SE3 (3 , 0 , 0 ))
220
217
p = rp .models .Panda ()
221
218
link = p .links [3 ]
222
219
@@ -229,8 +226,8 @@ def test_dist(self):
229
226
self .assertAlmostEqual (d2 , None )
230
227
231
228
def test_collided (self ):
232
- s0 = rp .Box ([1 , 1 , 1 ], sm .SE3 (0 , 0 , 0 ))
233
- s1 = rp .Box ([1 , 1 , 1 ], sm .SE3 (3 , 0 , 0 ))
229
+ s0 = gm .Box ([1 , 1 , 1 ], base = sm .SE3 (0 , 0 , 0 ))
230
+ s1 = gm .Box ([1 , 1 , 1 ], base = sm .SE3 (3 , 0 , 0 ))
234
231
p = rp .models .Panda ()
235
232
link = p .links [3 ]
236
233
c0 = link .collided (s0 )
0 commit comments