[BUG] Servo jitter

[benjaminwp18]

Describe the bug

Our GPIO library (LGPIO) uses software defined timers to control servos, which introduces serious servo jitter.

Possible Solution

We should see if using the Pixhawk/Navigator allows us to control servos with hardware defined timers. If that won't work, then we'll need to figure out using PiGPIO on Ubuntu.

[InvincibleRMC]

With MAVROS I think the two possible solutions are using a control servo plugin from mavros_extras which accepts RCOUT msg or the new Manual Control message using Bren's code in #119