KMat

Add convenience operators
Kinematics

Fix CoM Chain iterator function
Remove some unwanted matrices
Remove left side mass constants
Kinematics Testing
Kinematics

Add CoM Calculation
Add SetChain Method for convenience
Kinematics Testing