Added monitor class

This will monitor the serial line for the positions of the sensors.
Added more tests to the Monitor class