Added test package, minor mechcontroller changers
Merge branch 'master' of https://github.com/UBCSolarSimulation/Simulator.git