Add test sequence to TestInit()
Add test sequence to TestInit()

The TestInit() function now runs through a series of tests on the hardware
components of the robot, logging the results to file based on user input
(X=Functional, B=Non functional).

Dreadbot/Dreadbot-VI