Small fix and add a sim mode to hubo_motion interface