Getting start gate task going. It's not yet going through the state machine but will soon. IMU has also had basic (and probably somewhat inaccurate) pitch and roll added.