TODO:
- Accelerometer -
- Gyro -
- define gyro channel -
- define gyro -
- autonomous
- State machines
- Create functions:
- Move(float distance) -
- Rotate(int degree) -
- Pickup() -
- Drop() -
- coordinate with other teams for strategy -
- gyro -
- accelerometer -
- teleop
- lift -
- Limit switches -
- grab arms -
- driving -
- joystick -
- Mecanum -
- Arcade drive -
- Use gyro and/or accelerometer to straighten driving, drive code may automatically do that if using mecanum wheels
- lift -
- update period -
- initiate robot -
- COMMENT ALL YOUR STUFF OR DEATH
- Make sure to double check everything
- NO POINTERS if possible