last commit for the night

need lejos robot to test. Does not implement bluetooth controls yet (do
we want to implement?)