Lowered max velocities and accelerations
Changed IK to KDL