Added rest of holonomic drive. MORE COMMENTS!!

The long lines look weird on a small screen.