Got it working with collisions, now working on IK