Create State Manager Firmware Component

[robberwick]

State Manager

Issue Description

The State Manager component is responsible for controlling the robot based on a given state request and the current state of the robot. It comprises subcomponents such as V PID, W PID, Mixer, Servo Manager, and Stoker. Each subcomponent has specific responsibilities in achieving and maintaining the desired linear and angular velocities.

Tasks

• [ ] Implement the State Manager firmware component.
• [ ] Implement subcomponents: V PID, W PID, Mixer, Servo Manager, and Stoker.
• [ ] Ensure coordination between subcomponents to achieve the desired state.

Additional Information

More detailed information about the State Manager component can be found in the architecture document.

[markmellors]

I think this is now completely addressed