Fooling around with some stuff, no Big change. Some clean up
some stumps for further work in robot.cpp