https://github.com/h2r/pidrone_pkg/blob/dd2d9a0007fffbc73455b95d65c877f427432f34/scripts/pid_controller.py#L376 the state machine has unconsidered cases. also, fly commands are only published after a step, and not a reset