mode cleanup
sensors and servos
work toward transitions