This merge requests completes issue #7 (closed). Before merging this needs to be tested with a board connected via serial.