Finishing off implementation for simple robot