Code: Implementing HuPf Algorithm for the inverse Kinematics of General 6R/P Manipulators - Capco, Jose (2019)