Added Planning Document and began Kinematics Functions