Java Code for Robot Programming leJOS NXJ