瀏覽代碼

```
feat(mcu): 增加相机转向控制逻辑优化

当转盘位置为-40度时,将相机转向-39度;
当转盘位置为40度时,将相机转向39度;
其他情况下,将相机转向角度减1的位置。
这样可以避免转盘在极限位置时的运动冲突问题。
```

rambo 1 周之前
父節點
當前提交
253c7a50c2
共有 1 個文件被更改,包括 16 次插入0 次删除
  1. 16 0
      python/mcu/ProgramItem.py

+ 16 - 0
python/mcu/ProgramItem.py

@@ -316,6 +316,22 @@ class ProgramItem(BaseClass):
                 self.last_camera_height = self.camera_height
                 await asyncio.sleep(0.01)
             if self.camera_angle is not None:
+                if self.turntable_position == -40:
+                    self.mcu.to_device_move(
+                        device_name="camera_steering", value=-39
+                    )
+                    logger.info("转盘位置首次运动===>,%s",-39)
+                elif self.turntable_position == 40:
+                    self.mcu.to_device_move(
+                        device_name="camera_steering", value=39
+                    )
+                    logger.info("转盘位置首次运动===>,%s",39)
+                else:
+                    self.mcu.to_device_move(
+                        device_name="camera_steering", value=self.camera_angle-1
+                    )
+                    logger.info("转盘位置首次运动===>,%s",self.camera_angle-1)
+                await asyncio.sleep(0.01)
                 self.mcu.to_device_move(
                     device_name="camera_steering", value=self.camera_angle
                 )