Robot code complete minus an actual sensor - includes debugging serial print commands