Added functionality for kinematics 1-9

This is going to take forever