Added waypoint on boolean to miabot low level to switch between wp and vel control