added robot control and a quick graphic representation