rewrite all the ISIRController to be a top layer of the swig_isir_controller to control robot in the XDE simulator