[FEATURE] Some controls for custom servo #27
Description
Describe the solution you'd like
Add some controls to be able to move the custom servo for testing. For now, having some preset position (maybe 3?) and having a control to change between them would be good. This can be controlled from the controller or from the keyboard for testing purposes. The dual cam already uses a servo, so it might be possible to base the code for the custom servo off of the dual cam controls.