allow user to set path for robot to follow

finalize setup

add compass and motor shiii

simple move-straight case working!

improve rotation geometry, workinig for horiz path!

works for more complicated zig-zag case

clean code