Uploaded SwerveTest.c

Somewhat functional, may be useful for learning off of.