A module for generating the forward kinematics of a robot from a URDF. It can generate the forward kinematics represented as a dual quaternion or a transformation matrix. urdf2casadi
works both in python 2 and 3, and any platform that supports CasADi
and urdf_parser_py
.
This module is implemented in Python, and was intended to explore a CasADi approach to forward kinematics and rigid body dynamics algorithms based on URDFs. For a more real-time control applicable alternative, consider the Pinocchio library.
With ROS:
- Get ROS (actually anything that installs
urdfdom_py
/urdf_parser_py
will do). - Get CasADi (e.g.
pip install casadi
). - Run
pip install --user .
in the folder.
Without ROS:
- Change the
urdfdom-py
tourdf-parser-py
inrequirements.txt
(line 3) and insetup.py
(line 20). - Get CasADi (e.g.
pip install casadi
). - Run
pip install --user .
in the folder (--user
specifies that it is a local install).
import casadi as cs
from urdf2casadi import urdfparser as u2c
urdf_path = "../urdf/ur5_mod.urdf"
root_link = "base_link"
end_link = "tool0"
robot_parser = u2c.URDFparser()
fk_dict = robot_parser.get_forward_kinematics(root_link, end_link)
print fk_dict.keys()
# should give ['q', 'upper', 'lower', 'dual_quaternion_fk', 'joint_names', 'T_fk', 'joint_list', 'quaternion_fk']
forward_kinematics = fk_dict["T_fk"]
print forward_kinematics([0.3, 0.3, 0.3, 0., 0.3, 0.7])
The results were published in "Robot Dynamics with URDF & CasADi" at ICCMA 2019. [Preprint]
@inproceedings{urdf2casadi,
title={Robot Dynamics with URDF \& CasADi},
author={Johannessen, Lill Maria Gjerde and Arbo, Mathias Hauan and Gravdahl, Jan Tommy},
booktitle={2019 7th International Conference on Control, Mechatronics and Automation (ICCMA)},
year={2019},
organization={IEEE}
}
- Forward kinematics with SE(3) matrix
- Forward kinematics of rotation with quaternion
- Dual Quaternions as alternative to SE(3) matrices
- Dynamics from links and their inertia tags
- Denavit Hartenberg?
- Move numerical to a test folder
- Examples