Updated Arduino code to create simple protocol

Signed-off-by: Frank de Brabander <debrabander@gmail.com>