Moving robot code into this repo