Updated compass control
motor handling changes
sonar handling
compass priority levels
updated motor speed values based on experimental results
updated the system control system identifier
Timing of compass tasks
Added subsystem test files
added integration test files