BUGFIX! + "Swerve Test.c" now uses enums :D

And some other crucial bugfixes :)