Fixed some kinematic issues. Still need to deal with gravity.