[BenBernard]

If you simply can't wait that long, feel free to look at our AutoDrive command, which locks onto the current heading (yaw) from our navX when it starts and uses PID to maintain that heading as it drives. The same approach could be used for any gyro.