.c's and .h's

Guys work on TeleOp.c, all other formatting is done