Added Documentation and other

Generated Doxygen
Sensor initialization
Microcontroller Port Reservation
Motor Port Reservation
Misc changes