Update COM and Kinematics Code

Base and L1 Updates