/C2022

Code for FRC Team 1678's 2022 Rapid React robot

Primary LanguageJavaOtherNOASSERTION

Team 1678 2022 Robot Code

Introduction

This repository contains 2022 Rapid React robot code for FRC Team 1678 Citrus Circuits.

Our robot, Margie, features:

  • Field-Relative swerve drive
  • Five, Two, and One Ball scoring autonomous modes
  • Defensive autonomous modes to obfuscate opponent cargo
  • Fully automated color sorting
  • Fully automated third Cargo rejection sequence
  • Fully automated one-button traverse climb sequence

And more!

Code Structure

We use an implementation of TimedRobot. Our robot code is primarily structured around our Subsystem manager, which periodically calls methods in each Subsystem.

Our indexing, shooting, and climb logic is contained within our Superstructure file. This file houses the state machine behind the wrong color ejection, third ball rejection, and shooting. Additionally, our operator commands and auto-climb sequence are also contained here.

Our robot is entirely driven by Falcon 500 motors and their respective Talon FX speed controllers. We use Thad House's Pi Pico code to read from a Rev V3 color sensor due to concerns with the onboard I2C port. Our vision is powered by a Limelight 2 Plus. Other sensors used consist of CANCoders for swerve azimuth, a Pigeon 2 to read yaw and roll, internal sensors within the Falcon 500s, and IR Break Beam sensors within the ball tunnel.

Notable Files

Credits & References Used

  • FRC Team 254's Goal Tracking and Pose Estimation
  • FRC Team 364's Base Falcon Swerve
  • FRC Team 1323's Subsystem Manager and Loopers
  • FRC Team 4277's Waypoint Reader
  • Thad House's Pico Color Sensor