Implements inverse kinematics update, compiles, not tested