Added some Physics functions for Kinematics, as well as their test functions.
Merge https://github.com/Shermanzach/PhCalc