add test code

Signed-off-by: Chris Evich <chris-arduino@anonomail.me>