lots of imporvements to IK, planning smoothness