Added beginning of field map
Started implementing swerve
Added encoder and turret classes, and started implementing state machine