Swerve Team 1160's code to run swerve Uses Ether's inverse kinematics to find wheel modules PID control to set wheel speeds and rotation Forward kinematics for odometry Path planning and following (in progress)