Kinematics

Add Battery Mass
Finalize calculateCoM code
Kinematics Testing