Cpp swerve drive project for team 5162 I made over the summer. One wheel module works well, untested with a full drive train of 4 wheels. Autonomous is incomplete and buggy, but ideally can map out a field and autonomously path the robot to any given point.