C code for a team of autonomous robots. MEAM 510 Mechatronics