Explorar o código

1进库时添加提升机构抬升动作

gf hai 1 ano
pai
achega
a389a89837
Modificáronse 1 ficheiros con 4 adicións e 0 borrados
  1. 4 0
      MPC/navigation.cpp

+ 4 - 0
MPC/navigation.cpp

@@ -722,6 +722,10 @@ bool Navigation::execute_InOut_space(NavMessage::NewAction action) {
             printf(" Enter space failed type:%d: MoveTo StreetNode failed\n", action.type());
             return false;
         }
+        //进库前提升机构上升
+        if (lifter_rise() == false){
+            printf(" Enter space | lifter rise failed, line:%d\n",__LINE__);
+        }
         //移动到库位点, 禁止任意方向// 不允许巡线中停下旋转(当无法到达目标点时,返回false)
         printf("inout ----------------------------------------\n");
         //计算车位朝向