Fixed some messages.
Factored main loop.
Can clear the serial line, woo hoo.