Moved include source to include files

RobotC doesn't like when there are multiple source files, so for now
I've moved all RobotC source into header files
Moved main() task to nxt_control.c