Code for LeJOS robot