TODO

• Create Code Framework
• Set up motors and sensors in RobotMap
• Adapt Swerve Drive Code to 2015 Control System
• Rewrite Drivetrain Subsystem for 3 Wheel Swerve
• Crab with Absolute Twist
• Develop a backup drive scheme for robot-centric
• Use hall-effect sensors to zero our steering motors
• Create a watchdog for steering that does not depend on encoders
• Create a generic drive commmand for autonomous movement
• Intake
• Outtake
• Retract and deploy getters
• Forklift PID
• Manual forklift control
• Various forklift setpoints
  • Ground
  • Scoring Platform
  • Step
  • Up 1 tote
  • Down 1 tote
• Indicator for if Forklift has reached setpoint
• Track how many totes we have
• Push out totes
• Arm PID
• Manual Arm control
• Various arm setpoints
  • Can on ground/can fallen on ground
  • Can on step/can fallen on landfill
  • Storing the arm
• Holding down totes with the arm
• Grab/release can
• Automatically pick up tote from diagonal
• Automatically pick up tote from front
• Automatically pick up can
• Autonomous landfill munching (Robot side)
• Autonomous landfill munching (Driver Station side)
• Autonomous scripting program (Robot side)
• Autonomous scripting program (Driver Station side)
• Develop Autonomous Commands
  • Do nothing
  • Drive forwards
  • Single tote
  • Single can
  • Tote and can
  • 2 tote
  • 2 can
  • 2 tote 2 can
  • Tote stack
  • 3 can
  • 1 can from step
  • 2 can from step
• Map out gamepads
• Access the 7th axis on gamepads
• Create a Logitech Gamepad class
• Brownout protection
• Tripping main breaker protection
• Improve WPILIB's testing mode
• Diagnostics (Robot side)
• Diagnostics (Driver Station side)
• Create warnings for the driver
  • Drawing too much current
  • Could not find tote
  • Steering reached its limit
  • Steering motor disabled
  • Brownouts
  • NavX is calibrating
  • A motor or sensor is unplugged
  • CAN Errors