Rewrote / ported / copied the Matlab Forward and Reverse Kinematics into Python named Kinematics.py
Merge branch 'master' of https://github.com/RyanCMitchell/METR4202_Billy_Mach2