@@ -89,10 +89,10 @@ def test_exp2jac(self):
8989 # ZYX order
9090 gamma = np .r_ [1 , 0 , 0 ]
9191 nt .assert_array_almost_equal (exp2jac (gamma ), numjac (exp2r , gamma , SO = 3 ))
92- print (numjac (exp2r , gamma , SO = 3 ))
9392
9493 gamma = np .r_ [0.2 , 0.3 , 0.4 ]
9594 nt .assert_array_almost_equal (exp2jac (gamma ), numjac (exp2r , gamma , SO = 3 ))
95+
9696 gamma = np .r_ [0 , 0 , 0 ]
9797 nt .assert_array_almost_equal (exp2jac (gamma ), numjac (exp2r , gamma , SO = 3 ))
9898
@@ -187,7 +187,6 @@ def test_angvelxform_inv_dot_eul(self):
187187 gamma = [0.1 , 0.2 , 0.3 ]
188188 gamma_d = [2 , 3 , 4 ]
189189 H = numhess (lambda g : rotvelxform (g , representation = rep , inverse = True , full = False ), gamma )
190- Adot = np .zeros ((3 ,3 ))
191190 Adot = np .tensordot (H , gamma_d , (0 , 0 ))
192191 res = rotvelxform_inv_dot (gamma , gamma_d , representation = rep , full = False )
193192 nt .assert_array_almost_equal (Adot , res , decimal = 4 )
@@ -207,7 +206,6 @@ def test_angvelxform_dot_rpy_zyx(self):
207206 gamma = [0.1 , 0.2 , 0.3 ]
208207 gamma_d = [2 , 3 , 4 ]
209208 H = numhess (lambda g : rotvelxform (g , representation = rep , inverse = True , full = False ), gamma )
210- Adot = np .zeros ((3 ,3 ))
211209 Adot = np .tensordot (H , gamma_d , (0 , 0 ))
212210 res = rotvelxform_inv_dot (gamma , gamma_d , representation = rep , full = False )
213211 nt .assert_array_almost_equal (Adot , res , decimal = 4 )
@@ -218,7 +216,6 @@ def test_angvelxform_dot_exp(self):
218216 gamma = [0.1 , 0.2 , 0.3 ]
219217 gamma_d = [2 , 3 , 4 ]
220218 H = numhess (lambda g : rotvelxform (g , representation = rep , inverse = True , full = False ), gamma )
221- Adot = np .zeros ((3 ,3 ))
222219 Adot = np .tensordot (H , gamma_d , (0 , 0 ))
223220 res = rotvelxform_inv_dot (gamma , gamma_d , representation = rep , full = False )
224221 nt .assert_array_almost_equal (Adot , res , decimal = 4 )
0 commit comments