...
Centre Console Communications:
Between power and drive fsm:
Create a struct that is protected by a mutex.
Power fsm will update its state
Drive fsm will read power state
Both fsms will/can update the error status, and both fsms will read the error status.
To MCI:
Current drive state, (forward, reverse, cuise, off?)
...