Currently there appear to be issues with gyro initialization. When testing, we found that it would often start at 140 degrees, however this could be fixed by manually triggering a call to Gyro.resetGyro() in testInit(). The code that covers this case could also include functionality to set our starting angle, since the tarmac isn't square to the field.
[ ] Get gyro to properly initialize to 0 on startup
[ ] Add shuffleboard option to specify robot orientation for starting on tarmac
Currently there appear to be issues with gyro initialization. When testing, we found that it would often start at 140 degrees, however this could be fixed by manually triggering a call to
Gyro.resetGyro()intestInit(). The code that covers this case could also include functionality to set our starting angle, since the tarmac isn't square to the field.