煤矿井下多旋翼飞行器避障控制方法研究

Research on obstacle avoidance control method of multi-rotor aircraft in coal mine

  • 摘要: 多旋翼飞行器以其机械结构简单、可悬停和多方向飞行的优点,在煤矿井下生产巡检方面具有良好的应用前景。但多旋翼飞行器移动速度较快,飞行时易受外界各种因素的影响,难以建立精确的数学模型,使得飞行控制算法的设计较为复杂,现有基于激光雷达的同步定位与地图构建方法难以满足多旋翼飞行器快速飞行的实时性要求。针对上述问题,研究了一种利用虚拟远程操控技术对煤矿井下多旋翼飞行器进行避障的控制方法。构建了煤矿井下巷道多旋翼飞行器虚拟远程操控系统,根据煤矿巷道初始信息在虚拟远程操控系统中建立虚拟巷道模型及全局导航地图,获得飞行器移动过程中已知的静态障碍物信息,建立已知的静态环境模型,减少多旋翼飞行器运动过程中对环境感知建模的任务量,提高虚拟远程操控的运行效率。在巡检过程中,多旋翼飞行器通过自身携带的传感设备检测移动方向的动态障碍物信息,虚拟远程操控系统将动态障碍物信息实时重建于初始虚拟巷道模型中,对虚拟环境状态进行实时更新,为飞行器局部避障控制提供可靠的环境依据;虚拟远程操控系统通过读取障碍物与飞行器的位置数据和移动速度信息,采用复合虚拟势场(CVFF)避障控制算法进行避障路径规划,如果检测到前方障碍物对飞行器移动产生较大威胁,远程操控人员可根据规划的避障路径对飞行器进行远程干预,实现了自主避障飞行和人为远程干预控制。为提高飞行器对动态障碍物的感知效率和精度,在虚拟势场(VFF)算法的基础上引入飞行器与障碍物、目标点之间的相对速度影响,提出了一种CVFF避障控制算法。从静态和动态障碍物避障路径2个方面对CVFF避障控制算法进行仿真验证,结果表明:静态情况下,相比VFF算法,CVFF避障控制算法在减少了迭代次数的同时,也缩短了飞行器的轨迹长度;动态情况下,飞行器成功避开了提前设定的2个动态障碍物,顺利到达设定目标点,验证了采用CVFF算法的煤矿井下多旋翼飞行器避障控制方法的有效性。

     

    Abstract: Multi-rotor aircraft has a good application prospect in coal mine production inspection because of its advantages of simple structure, hovering and multi-directional flight. However, multi-rotor aircraft moves at a high speed, and the aircraft is easily influenced by various external factors during flying. It is difficult to establish a precise mathematical model. The design of a flight control algorithm is complicated. The existing synchronous positioning and map construction method based on laser radar is difficult to meet the real-time requirement of rapid flying of the multi-rotor aircraft. In view of the above problems, an obstacle avoidance control method of multi-rotor aircraft in coal mine by using remote virtual control technology is studied. The virtual remote control system of the multi-rotor aircraft in coal mine underground roadway is constructed. The virtual roadway model and the global navigation map are established in the virtual remote control system according to the initial information of the coal mine roadway. The known static obstacle information in the moving process of the aircraft is obtained, and the known static environment model is established. The task quantity of environment perception modeling in the moving process of the multi-rotor aircraft is reduced, and the operation efficiency of virtual remote control can be improved. In the inspection process, the multi-rotor aircraft detects dynamic obstacle information in the moving direction through sensing equipment carried by the multi-rotor aircraft. The remote control system reconstructs the dynamic obstacle information in an initial virtual roadway model in real-time according to obstacle data. The virtual environment state is updated in real-time to provide a reliable environment basis for local obstacle avoidance control of the aircraft. The remote control system uses the compound virtual force field (CVFF) obstacle avoidance control algorithm to plan the obstacle avoidance path by reading the positioning data and moving speed information of obstacles and aircraft. If the obstacle in front is detected to pose a great threat to the movement of the aircraft, the remote controller can implement remote intervention on the aircraft according to the planned obstacle avoidance path. The system realizes autonomous obstacle avoidance flight and human remote intervention control. In order to improve the perception efficiency and accuracy of aircraft to dynamic obstacles, a CVFF obstacle avoidance control algorithm is studied based on virtual force field (VFF) algorithm by introducing the influence of relative velocity between aircraft and obstacles and target points. The CVFF obstacle avoidance control algorithm is verified by simulation from two aspects of static and dynamic obstacle avoidance paths. The results show that under static conditions, compared with the VFF algorithm, the CVFF algorithm reduces the number of iterations and also shortens the trajectory length of the aircraft. Under dynamic conditions, the aircraft successfully avoids the two dynamic obstacles set in advance and successfully reaches the set target point. The effectiveness of the obstacle avoidance control method of multi-rotor aircraft using the CVFF algorithm is verified.

     

/

返回文章
返回