- GPS mode: check if mag is connected, otherwise display error message
- forgot to remove comment on servo assignment