- [ ] Write the procedure to normalize headings - [ ] Write the procedure to recalculate global position and have the encoder procedures call them whenever they are called - [ ] Write procedure to navigate to X and Y coordinates