TODO: Add smart e-stop to the superstructure/better collision sensing Determine a more accurate moi, use characterization routines for this, even though were using torque current add cameras to advantagescope

115, 75