This repository contains some of the first-ever uses of trajectory optimization competitively in the FRC robotics competition.

The two models are:

• A double jointed arm (derived from the Lagrange equations of motion and motor models)
• A swerve drive robot (a robot with >3 wheels that can independently rotate and translate)