Kindr – Kinematics and Dynamics for Robotics