Autonomous methods changed
Fixed gyro stabilzation, finished first program