Просмотр исходного кода

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

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

rambo 1 неделя назад
Родитель
Сommit
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
                 )