4
4
# Author: Ruben Smits <ruben dot smits at intermodalics dot eu>
5
5
# Author: Matthijs van der Burgh <MatthijsBurgh at outlook dot com>
6
6
# Maintainer: Ruben Smits <ruben dot smits at intermodalics dot eu>
7
+ # Maintainer: Matthijs van der Burgh <MatthijsBurgh at outlook dot com>
7
8
# URL: http://www.orocos.org/kdl
8
9
9
10
# This library is free software; you can redistribute it and/or
@@ -268,7 +269,7 @@ def compare_Jdot_Diff_vs_Solver(self, dt, representation):
268
269
q_dqdt = JntArray (q )
269
270
for i in range (q .rows ()):
270
271
q_dqdt [i ] += dt * qdot [i ]
271
-
272
+
272
273
F_bs_ee_q = Frame .Identity ()
273
274
F_bs_ee_q_dqdt = Frame .Identity ()
274
275
@@ -284,13 +285,13 @@ def compare_Jdot_Diff_vs_Solver(self, dt, representation):
284
285
285
286
changeJacRepresentation (jac_q , F_bs_ee_q , representation )
286
287
changeJacRepresentation (jac_q_dqdt , F_bs_ee_q_dqdt , representation )
287
-
288
+
288
289
Jdot_diff (jac_q , jac_q_dqdt , dt , jdot_by_diff )
289
290
290
291
jdot_by_solver = Jacobian (NrOfJoints )
291
292
self .jacdotsolver .setRepresentation (representation )
292
293
self .jacdotsolver .JntToJacDot (JntArrayVel (q_dqdt , qdot ), jdot_by_solver )
293
-
294
+
294
295
jdot_qdot_by_solver = Twist ()
295
296
MultiplyJacobian (jdot_by_solver , qdot , jdot_qdot_by_solver )
296
297
@@ -320,7 +321,7 @@ def testJacDot(self):
320
321
"err: {}" .format (jdot_qdot_solver , jdot_qdot_diff , representation , dt ,
321
322
eps_diff_vs_solver , err ))
322
323
dt *= 10
323
-
324
+
324
325
325
326
class KinfamTestTree (unittest .TestCase ):
326
327
0 commit comments