Added autonomous command framework.
Fixes and implementing CommandGroup
Added Directional Drive (Polar Implementation needed)