Add initial Motor RPM measurement driver module
MAVLink no longer transmit control/PID debug values
Publish debug key/value to GCS and fix wrong 'is not equal' check
Add feed forward to attitude velocity setpoint