"Fixed" multitasking
Merge branch 'irTest' of https://github.com/calpoly-robotics/swarm into irTest