- reverted GCS heading change
- mapped tracking variables range to servo range correctly