Enabling the gps feature will always enable the gps sensor instead of
waiting for gps data
Fix status of rc boxes in serial output
Fix some gcc warnings
Add some consts here and there