Created Autonomous Program

Created a new autonomous that should grab the goal and put it into the
parking zone, and added some functions to coord.c, coord.h, and made
more stable.