@@ -261,7 +261,10 @@ def actuation_mapping_fn(
261
261
return A
262
262
263
263
def forward_kinematics_fn (
264
- params : Dict [str , Array ], q : Array , s : Array , eps : float = global_eps
264
+ params : Dict [str , Array ],
265
+ q : Array ,
266
+ s : Array ,
267
+ eps : float = global_eps
265
268
) -> Array :
266
269
"""
267
270
Evaluate the forward kinematics the tip of the links
@@ -294,7 +297,10 @@ def forward_kinematics_fn(
294
297
return chi
295
298
296
299
def jacobian_fn (
297
- params : Dict [str , Array ], q : Array , s : Array , eps : float = global_eps
300
+ params : Dict [str , Array ],
301
+ q : Array ,
302
+ s : Array ,
303
+ eps : float = global_eps
298
304
) -> Array :
299
305
"""
300
306
Evaluate the forward kinematics the tip of the links
@@ -329,7 +335,10 @@ def jacobian_fn(
329
335
return J
330
336
331
337
def dynamical_matrices_fn (
332
- params : Dict [str , Array ], q : Array , q_d : Array , eps : float = 1e4 * global_eps
338
+ params : Dict [str , Array ],
339
+ q : Array ,
340
+ q_d : Array ,
341
+ eps : float = 1e4 * global_eps
333
342
) -> Tuple [Array , Array , Array , Array , Array , Array ]:
334
343
"""
335
344
Compute the dynamical matrices of the system.
@@ -377,7 +386,11 @@ def dynamical_matrices_fn(
377
386
378
387
return B , C , G , K , D , alpha
379
388
380
- def kinetic_energy_fn (params : Dict [str , Array ], q : Array , q_d : Array ) -> Array :
389
+ def kinetic_energy_fn (
390
+ params : Dict [str , Array ],
391
+ q : Array ,
392
+ q_d : Array
393
+ ) -> Array :
381
394
"""
382
395
Compute the kinetic energy of the system.
383
396
Args:
0 commit comments