got the kinematics sorted. Next up -- fix power issues, start adding sensors