The functions are written in C Functions include inverse, forward kinematics, and Jacobian.
Some helper functions for calculation are also included, and those functions can be run directly.
If any problem, please email [email protected] or [email protected]