scripts: mavsetp: changed the way offboard mode is switched