fixed #12; depth/heading toggle fixed
fixed compiler error
Merge pull request #13 from BrianAdams/bug/12

fixed #12; depth/heading toggle fixed. Tested on rov.