Added field oriented drive system

Also included gyro control commands