Fix kinematics :)

Signed-off-by: eldr4d <nikofinas@gmail.com>