6940Swerve

This is 6940's swerve code repository.

• We are now trying to create a virtual robot with swerve.
• The code is mainly forked from 4201 and now it doesn't work well.