This invention relates to a safe
obstacle avoidance control method for
greenhouse inspection drones. Addressing the camera
blind spot avoidance and obstacle collision avoidance constraints in the
drone's strategy for monitoring diseased and pest-infested
crop areas and inspecting tomato maturity and yield, this invention constructs a geometric relationship between the flight path evolution trajectory and the line-of-
sight cone based on dual quaternions. A
pose-integrated safe tracking and control scheme based on a
geometric control obstacle function is proposed. This includes modeling safe collision avoidance constraints and line-of-
sight occlusion avoidance constraints; constructing a
geometric control obstacle function based on the motion derivation trajectory using the geometric relationship between the obstacle
occlusion line-of-
sight cone and the
drone's motion state, based on a unified description of dual quaternions; and embedding the
safety constraints of the control obstacle function into a quadratic
programming solver. This achieves safe collision avoidance while ensuring the camera's
line of sight can always monitor the local diseased area, mitigating the risk of obstacle
occlusion during flight path monitoring.