Code for our 2025 robot
Front Left Drive Motor - 2 Front Left Angle Motor - 1 Front Left canCoder - 1 Front Right Drive Motor - 9 Front Right Angle Motor - 8 Front Right canCoder - 2 Back Left Drive Motor - 0 Back Left Angle Motor - 19 Back Left canCoder - 4 Back Right Drive Motor - 11 Back Right Angle Motor - 10 Back Right canCoder - 3
Elevator Left - 4 Elevator Right - 7 Climber Right - 12 Coral - 5 Algae - 18 Voltage Converters for Orange Pi and LEDS - 16 RoboRIO - 20 CANivore - 21 VRM - 22 Algae Wrist Motor - 3 Algae Wrist CanCoder - 48
0 - Coral Outtake Beam Brake 1 - Elevator Touch Sensor 3 - Coral Intake Beam Brake
0 - LEDs