Added really basic serial writing test. Need to get firmware looping back to go anywhere next