robot controller wip