Added a basic Servo.h and Servo.c

also some lint in Motor.c
Added a file for testing the library functions

QA is very important :D
Added old joystick library (implemented it :P )

Lint in "motor.c" as well.
Changed order of header inclusion

Still doesn't work; files are more self-dependent now though: #includes
are in the correct order.
New testing program :P
Updated header files with new #incldue system

Also deleted some trash.
BUGFIX: Will now compile! :D

All the default values are now declared in their respective header
files.
Lint: made formatting more concise.
Merge pull request #17 from OlyCow/libraries

Core updates
Merge branch 'swerve-drive'

Conflicts:
	RobotC/Headers/global vars.h
Merge pull request #19 from OlyCow/master

Updated (core) libraries and some (pseudo-) swerve drive code.