finished gets & sets and debugged

Finished adding the getters and setters in all .h files.

*Debugged Programs

*Made Mainprogram.c to include the main programs

*Added included files to Robot.h