Developing some robot code