inverse kinematics

Code for Algo and NPU for inverse kinematics