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 wanlinyang2018@u.northwestern.edu or jialeihu2019@u.northwestern.edu