[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

CN116300971B - Traction sliding control method and device for civil aircraft, tractor and storage medium - Google Patents

Traction sliding control method and device for civil aircraft, tractor and storage medium Download PDF

Info

Publication number
CN116300971B
CN116300971B CN202310552995.1A CN202310552995A CN116300971B CN 116300971 B CN116300971 B CN 116300971B CN 202310552995 A CN202310552995 A CN 202310552995A CN 116300971 B CN116300971 B CN 116300971B
Authority
CN
China
Prior art keywords
tractor
taxiing
traction
obstacle
landing gear
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202310552995.1A
Other languages
Chinese (zh)
Other versions
CN116300971A (en
Inventor
秦嘉浩
白杰
张恩重
张威
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Civil Aviation University of China
Original Assignee
Civil Aviation University of China
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Civil Aviation University of China filed Critical Civil Aviation University of China
Priority to CN202310552995.1A priority Critical patent/CN116300971B/en
Publication of CN116300971A publication Critical patent/CN116300971A/en
Application granted granted Critical
Publication of CN116300971B publication Critical patent/CN116300971B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64FGROUND OR AIRCRAFT-CARRIER-DECK INSTALLATIONS SPECIALLY ADAPTED FOR USE IN CONNECTION WITH AIRCRAFT; DESIGNING, MANUFACTURING, ASSEMBLING, CLEANING, MAINTAINING OR REPAIRING AIRCRAFT, NOT OTHERWISE PROVIDED FOR; HANDLING, TRANSPORTING, TESTING OR INSPECTING AIRCRAFT COMPONENTS, NOT OTHERWISE PROVIDED FOR
    • B64F1/00Ground or aircraft-carrier-deck installations
    • B64F1/22Ground or aircraft-carrier-deck installations for handling aircraft
    • B64F1/223Ground or aircraft-carrier-deck installations for handling aircraft for towing aircraft
    • B64F1/225Vehicles specially adapted therefor, e.g. aircraft tow tractors
    • B64F1/227Vehicles specially adapted therefor, e.g. aircraft tow tractors for direct connection to aircraft, e.g. tow tractors without towing bars
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Electromagnetism (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses a traction sliding control method and device of a civil aircraft, a tractor and a medium. The method comprises the following steps: controlling a wheel holding mechanism on a tractor to approach and accurately butt-joint a front landing gear of a target aircraft in a first-fast-then-slow mode, and planning a global planning path from a sliding starting point to a sliding end point after the butt-joint is completed; adopting a pre-established traction sliding controller to track and control the global planning path so as to enable the tractor to stably slide the traction target plane; during traction and taxiing, if an obstacle is detected to appear in front of a taxiing path and the obstacle cannot be avoided in a slow-down mode, a new global planning path is planned again according to the current taxiing position point, the obstacle information and the taxiing target point. The technical scheme of the embodiment of the invention ensures the accuracy, the rapidity and the safety of the automatic docking of the tractor and the airplane and improves the safety and the reliability of the tractor and the airplane in the combined sliding process.

Description

民航飞机的牵引滑行控制方法、装置、牵引车及存储介质Towing taxiing control method, device, tractor and storage medium for civil aircraft

技术领域Technical Field

本发明涉及民航飞机的牵引导航技术领域,尤其涉及一种民航飞机的牵引滑行控制方法、装置、牵引车及存储介质。The present invention relates to the technical field of towing navigation of civil aircraft, and in particular to a towing taxiing control method, device, towing vehicle and storage medium of a civil aircraft.

背景技术Background Art

我国的航班数量随着发展日益剧增,随着航班数的增加,机场在飞机调度过程中的速度也需要提高。为了确保工作效率的提高,需要用到牵引车牵引飞机滑行至目标地点,也即,飞机起飞前的准备点处。The number of flights in my country has increased dramatically with the development of the country. With the increase in the number of flights, the speed of airports in the aircraft dispatching process also needs to be improved. In order to ensure the improvement of work efficiency, a tractor is needed to tow the aircraft to the target location, that is, the preparation point before the aircraft takes off.

相关技术中,可以采用无人驾驶的无杆牵引车将抱轮机构自动对接飞机前起落架,并在对接完成抱轮举升后,由牵引车牵引飞机从停机坪滑行至飞机起飞前准备点处。其难点之一是无杆牵引车与飞机自动对接过程中的精确性、快速性及安全性;另一难点是无杆牵引车和飞机在组合滑行过程中的安全性及可靠性。In the related technology, an unmanned barless tractor can be used to automatically dock the wheel-holding mechanism with the front landing gear of the aircraft. After the docking is completed and the wheel-holding mechanism is lifted, the tractor tows the aircraft from the apron to the preparation point before the aircraft takes off. One of the difficulties is the accuracy, speed and safety of the barless tractor and the aircraft in the automatic docking process; another difficulty is the safety and reliability of the barless tractor and the aircraft in the combined taxiing process.

发明内容Summary of the invention

本发明实施例提供了一种民航飞机的牵引滑行控制方法、装置、牵引车及存储介质,以实现在牵引车上的抱轮机构准确对接目标飞机的前起落架后,由牵引车平稳的牵引目标飞机滑行至滑行终点。The embodiment of the present invention provides a towing taxiing control method, device, towing vehicle and storage medium for a civil aircraft, so as to realize that after the wheel holding mechanism on the towing vehicle accurately docks with the front landing gear of the target aircraft, the towing vehicle stably tows the target aircraft to taxi to the taxiing end point.

根据本发明实施例的一方面,提供了一种民航飞机的牵引滑行控制方法,包括:According to one aspect of an embodiment of the present invention, a towing taxiing control method for a civil aircraft is provided, comprising:

控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径;Control the wheel-holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft in a fast-first-and-slow-later manner, and after docking, plan a global planning path from the taxiing start point to the taxiing end point;

采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行;Using a pre-established traction and taxiing controller, the global planning path is tracked and controlled so that the tractor can smoothly tow the target aircraft for taxiing;

在牵引滑行过程中,如果检测到滑行路径前方出现障碍物,则检测是否能够以减速慢行的方式避让该障碍物;During the traction sliding process, if an obstacle is detected in front of the sliding path, it is detected whether the obstacle can be avoided by slowing down;

若否,则根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程。If not, a new global planning path is replanned according to the current sliding position, obstacle information and sliding target point, and then the operation of using the pre-established traction sliding controller to perform trajectory tracking control on the global planning path is returned to the execution until the entire traction process is completed.

根据本发明实施例的另一方面,还提供了一种民航飞机的牵引滑行控制装置,包括:According to another aspect of an embodiment of the present invention, there is also provided a traction taxiing control device for a civil aircraft, comprising:

全局规划路径规划模块,用于控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径;The global planning path planning module is used to control the wheel holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft in a fast-first-then-slow manner, and after the docking is completed, plan the global planning path from the taxiing start point to the taxiing end point;

轨迹跟踪控制模块,用于采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行;A trajectory tracking control module is used to use a pre-established traction and taxiing controller to perform trajectory tracking control on the global planning path so that the tractor can stably tow the target aircraft for taxiing;

避让检测模块,用于在牵引滑行过程中,如果检测到滑行路径前方出现障碍物,则检测是否能够以减速慢行的方式避让该障碍物;The avoidance detection module is used to detect whether the obstacle can be avoided by slowing down if an obstacle is detected in front of the sliding path during the traction sliding process;

路径重规划模块,用于若否,则根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程。The path replanning module is used to replan a new global planning path according to the current sliding position point, obstacle information and sliding target point, and then return to execute the operation of using the pre-established traction sliding controller to perform trajectory tracking control on the global planning path until the entire traction process is completed.

根据本发明实施例的另一方面,还提供了一种牵引车,所述牵引车包括:According to another aspect of an embodiment of the present invention, a tractor is further provided, the tractor comprising:

至少一个处理器;以及at least one processor; and

与所述至少一个处理器通信连接的存储器;其中,a memory communicatively connected to the at least one processor; wherein,

所述存储器存储有可被所述至少一个处理器执行的计算机程序,所述计算机程序被所述至少一个处理器执行,以使所述至少一个处理器能够执行本发明任一实施例所述的民航飞机的牵引滑行控制方法。The memory stores a computer program executable by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the traction taxiing control method for a civil aircraft described in any embodiment of the present invention.

根据本发明实施例的另一方面,还提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使处理器执行时实现本发明任一实施例所述的民航飞机的牵引滑行控制方法。According to another aspect of an embodiment of the present invention, a computer-readable storage medium is provided, wherein the computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the traction taxiing control method for a civil aircraft described in any embodiment of the present invention when executed.

本发明实施例的技术方案,通过控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径;采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行;在牵引滑行过程中,如果检测到滑行路径前方出现障碍物,则检测是否能够以减速慢行的方式避让该障碍物;若否,则根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程的技术手段,实现在牵引车上的抱轮机构准确对接目标飞机的前起落架后,由牵引车平稳的牵引目标飞机滑行至滑行终点的技术效果,在保证牵引车和目标飞机自动对接的精确性、快速性及安全性的同时,提高了牵引车和飞机在组合滑行过程中的安全性及可靠性。The technical solution of the embodiment of the present invention controls the wheel holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft in a first fast and then slow manner, and after the docking is completed, plans a global planning path from the taxiing start point to the taxiing end point; adopts a pre-established traction taxiing controller to track the global planning path so that the tractor can stably tow the target aircraft for taxiing; during the traction taxiing process, if an obstacle is detected in front of the taxiing path, it is detected whether the obstacle can be avoided by slowing down; if not, according to the current taxiing position point, obstacle information and taxiing target point, a new global planning path is re-planned, and then returns to execute the operation of using the pre-established traction taxiing controller to track the global planning path until the entire traction process is completed. The technical means achieves the technical effect that after the wheel holding mechanism on the tractor accurately docks with the front landing gear of the target aircraft, the tractor stably tows the target aircraft to the taxiing end point, while ensuring the accuracy, speed and safety of the automatic docking of the tractor and the target aircraft, the safety and reliability of the tractor and the aircraft in the combined taxiing process are improved.

应当理解,本部分所描述的内容并非旨在标识本发明的实施例的关键或重要特征,也不用于限制本发明的范围。本发明的其它特征将通过以下的说明书而变得容易理解。It should be understood that the contents described in this section are not intended to identify the key or important features of the embodiments of the present invention, nor are they intended to limit the scope of the present invention. Other features of the present invention will become easily understood through the following description.

附图说明BRIEF DESCRIPTION OF THE DRAWINGS

为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the drawings required for use in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

图1是根据本发明实施例一提供的一种民航飞机的牵引滑行控制方法的流程图;FIG1 is a flow chart of a traction taxiing control method for a civil aircraft according to a first embodiment of the present invention;

图2是根据本发明实施例二提供的一种民航飞机的牵引滑行控制方法的流程图;FIG2 is a flow chart of a traction taxiing control method for a civil aircraft according to a second embodiment of the present invention;

图3是根据本发明实施例二提供的一种计算牵引车相对于前起落架的目标偏角的方式的流程图;3 is a flow chart of a method for calculating a target deflection angle of a tractor relative to a front landing gear according to a second embodiment of the present invention;

图4是本发明实施例的技术方案所适用的一种牵引车相对于前起落架偏转α角的正视图;FIG4 is a front view of a tractor to which the technical solution of an embodiment of the present invention is applicable, with the tractor deflected at an angle α relative to the front landing gear;

图5是本发明实施例的技术方案所适用的一种牵引车相对于前起落架偏转α角的俯视图;FIG5 is a top view of a tractor to which the technical solution of an embodiment of the present invention is applicable, with the tractor deflected at an angle α relative to the front landing gear;

图6是本发明实施例的技术方案所适用的一种牵引滑行系统的动力学模型示意图;FIG6 is a schematic diagram of a dynamic model of a traction sliding system applicable to the technical solution of an embodiment of the present invention;

图7是本发明实施例三提供的一种民航飞机的牵引滑行控制装置的结构图;7 is a structural diagram of a traction taxiing control device for a civil aircraft provided in Embodiment 3 of the present invention;

图8本发明实施例四提供的一种牵引车的示意图。FIG8 is a schematic diagram of a tractor provided in Embodiment 4 of the present invention.

具体实施方式DETAILED DESCRIPTION

为了使本技术领域的人员更好地理解本发明方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分的实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明保护的范围。In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.

需要说明的是,本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本发明的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。It should be noted that the terms "first", "second", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.

实施例一Embodiment 1

图1为本发明实施例一提供的一种民航飞机的牵引滑行控制方法的流程图,本实施例可适用于使用牵引车将车上的抱轮机构自动对接待牵引的目标飞机的前起落架,并在对接完成抱轮举升后牵引该目标飞机滑行至目标位置处的情况,该方法可以由民航飞机的牵引滑行控制装置来执行,该装置可以采用硬件和/或软件的形式实现,并一般可配置于牵引车中,由牵引车上的控制器执行。如图1所示,该方法包括:FIG1 is a flow chart of a towing taxiing control method for a civil aircraft provided in Embodiment 1 of the present invention. This embodiment is applicable to the case where a towing vehicle is used to automatically align the wheel-holding mechanism on the vehicle with the front landing gear of the target aircraft to be towed, and to tow the target aircraft to taxi to the target position after the docking is completed and the wheel-holding lifting is completed. The method can be executed by a towing taxiing control device of a civil aircraft, which can be implemented in the form of hardware and/or software, and can generally be configured in a towing vehicle and executed by a controller on the towing vehicle. As shown in FIG1 , the method includes:

S110、控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径。S110, controlling the wheel holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft in a first fast and then slow manner, and after the docking is completed, planning a global planning path from the taxiing start point to the taxiing end point.

在本实施例中,为了提高牵引车(典型的,无人驾驶的无杆牵引车)对接目标飞机的快速性和准确性,提出了控制牵引车上的抱轮机构以至少两种速度逐级靠近并对接目标飞机的前起落架的新的实现方式。具体的,当牵引车距离该目标飞机距离较远时,可以控制该牵引车快速朝向目标飞机所在方向进行移动。当牵引车距离该目标飞机距离较近时,可以控制该牵引车缓慢移动以准确与该目标飞机实现对接。In this embodiment, in order to improve the speed and accuracy of the tractor (typically, an unmanned poleless tractor) docking with the target aircraft, a new implementation method is proposed to control the wheel holding mechanism on the tractor to gradually approach and dock with the front landing gear of the target aircraft at at least two speeds. Specifically, when the tractor is far away from the target aircraft, the tractor can be controlled to move quickly toward the direction where the target aircraft is located. When the tractor is close to the target aircraft, the tractor can be controlled to move slowly to accurately dock with the target aircraft.

具体的,可以预先在该牵引车上设置两组或者多组视觉传感器,每组视觉传感器用于对不同远近距离的目标飞机进行相对距离以及相对位置关系的检测。相应的,可以根据不同组的视觉传感器的检测结果,灵活设置该牵引车的运动速度以及运动方向,以实现对接速度和对接精准性的有效兼顾。Specifically, two or more groups of visual sensors can be pre-installed on the tractor, and each group of visual sensors is used to detect the relative distance and relative position relationship of target aircraft at different distances. Accordingly, the movement speed and movement direction of the tractor can be flexibly set according to the detection results of different groups of visual sensors to achieve an effective balance between docking speed and docking accuracy.

可以理解的是,本领域技术人员可以根据实际情况设置视觉传感器的组数,以及不同远近距离时选择使用的运动速度,本实施例对此并不进行限制。It is understandable that those skilled in the art can set the number of visual sensor groups and select the movement speed to be used at different distances according to actual conditions, and this embodiment does not limit this.

在牵引车上的抱轮机构与目标飞机的前起落架完成对接后,可以通过目标飞机或者牵引车上设置的定位模块,确定由牵引车和目标飞机构成的整体(后文简称为牵引滑行系统)在机场中的位置,作为滑行起点。同时,还需要通过空管指令确定滑行终点,也即该目标飞机起飞前的准备点。在获取滑行起点和滑行终点后,通过结合机场的地图数据,以及预设的路径规划算法,可以规划出牵引滑行系统由滑行起点至滑行终点的全局规划路径。After the wheel-holding mechanism on the tractor is docked with the front landing gear of the target aircraft, the position of the whole composed of the tractor and the target aircraft (hereinafter referred to as the traction taxiing system) in the airport can be determined through the positioning module set on the target aircraft or the tractor as the taxiing starting point. At the same time, it is also necessary to determine the taxiing end point through air traffic control instructions, that is, the preparation point before the target aircraft takes off. After obtaining the taxiing start point and taxiing end point, by combining the airport map data and the preset path planning algorithm, the global planning path of the traction taxiing system from the taxiing start point to the taxiing end point can be planned.

其中,在规划得到全局规划路径时,可以采取最少用时或者最少转弯等约束条件进行约束,得到满足实际需求的全局规划路径。Among them, when planning to obtain the global planning path, constraints such as minimum time or minimum turns can be adopted to obtain a global planning path that meets actual needs.

S120、采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行。S120: Using a pre-established traction and taxiing controller, the global planning path is tracked and controlled so that the tractor can stably tow the target aircraft for taxiing.

其中,在完成全局路径规划后,可以控制该牵引车平稳的牵引目标飞机沿着全局规划路径由滑行起点滑行至滑行终点。After the global path planning is completed, the tractor can be controlled to steadily tow the target aircraft along the global planned path from the taxiing starting point to the taxiing end point.

在本实施例中,为了保证该牵引车平稳的牵引目标飞机进行滑行,提出在整个滑行过程中,进行有效的轨迹跟踪控制。具体的,首先构建得到一个牵引滑行控制器,通过在牵引滑行控制器设置成本控制函数以及约束条件,可以在不同的控制周期内,求解得到最优的控制量对牵引车的实时速度以及实时转角进行有效的控制。In this embodiment, in order to ensure that the tractor can smoothly tow the target aircraft for taxiing, it is proposed to perform effective trajectory tracking control during the entire taxiing process. Specifically, a traction taxiing controller is first constructed, and by setting a cost control function and constraint conditions in the traction taxiing controller, the optimal control amount can be solved in different control cycles to effectively control the real-time speed and real-time turning angle of the tractor.

S130、在牵引滑行过程中,检测到滑行路径前方是否出现障碍物,若是,则执行S140;否则,返回执行S120,直至完成整个牵引过程。S130. During the traction sliding process, it is detected whether there is an obstacle in front of the sliding path. If so, execute S140; otherwise, return to execute S120 until the entire traction process is completed.

在本实施例中,考虑到机场环境中的动态变化特征,需要实时对滑行路径的前方进行障碍物检测。如果前方没有障碍物,则可以按照原定的全局规划路径继续滑行,如果前方出现了障碍物,则需要对该障碍物进行安全的避让,例如,减速避让或者绕行避让等。In this embodiment, considering the dynamic change characteristics of the airport environment, it is necessary to detect obstacles in front of the taxiing path in real time. If there is no obstacle in front, the taxiing can continue according to the original global planning path. If an obstacle appears in front, it is necessary to avoid the obstacle safely, for example, by slowing down or detouring.

进一步的,考虑到减速避让的实现成本要远远低于绕行避让,在本实施例中,首先检测牵引滑行系统是否可以通过减速避让的方式,安全的避开该障碍物:若是,则可以通过减速慢行的方式,在保持现有的全局规划路线的基础上,安全的避让该障碍物后继续滑行;若否,则需要基于该障碍物的位置以及速度等信息,重新规划从当前滑行位置点到达滑行终点的新的全局规划路线,以通过绕行的方式安全的避开该障碍物。Furthermore, considering that the implementation cost of deceleration and avoidance is much lower than that of detour and avoidance, in this embodiment, it is first detected whether the traction sliding system can safely avoid the obstacle by deceleration and avoidance: if so, it can continue to slide by decelerating and driving slowly while maintaining the existing global planned route and safely avoiding the obstacle; if not, it is necessary to re-plan a new global planned route from the current sliding position to the sliding end point based on information such as the position and speed of the obstacle, so as to safely avoid the obstacle by detouring.

可以理解的是,S130的操作需要在整个滑行过程中实时进行,直至牵引车成功的将该目标飞机牵引至滑行终点。It is understandable that the operation of S130 needs to be performed in real time during the entire taxiing process until the tractor successfully tows the target aircraft to the taxiing end point.

S140、检测是否能够以减速慢行的方式避让该障碍物:若是,则执行S150;否则,执行S160。S140, detecting whether the obstacle can be avoided by decelerating and driving slowly: if so, executing S150; otherwise, executing S160.

在本实施例中,可以通过结合障碍物的当前位置点、运动速度和运动方向,以及牵引滑行系统的运动速度和运动方向,以及牵引滑行系统的减速性能等参数评估出该牵引滑行系统是否可以在保持现有的全局规划路线的基础上,以减速慢行的方式避让该障碍物。In this embodiment, by combining the current position point, movement speed and direction of the obstacle, the movement speed and direction of the traction sliding system, and the deceleration performance of the traction sliding system and other parameters, it can be evaluated whether the traction sliding system can avoid the obstacle by slowing down while maintaining the existing global planned route.

具体的,可以预先训练一个神经网络模型,该神经网络模型的输入为障碍物的当前位置点、运动速度和运动方向,牵引滑行系统的运动速度、当前位置点、减速性能参数以及全局规划路线等参数,输出为该牵引滑行系统是否能够以减速慢行的方式避让该障碍物的识别结果。Specifically, a neural network model can be pre-trained, the input of which is the current position, movement speed and direction of the obstacle, the movement speed, current position, deceleration performance parameters and global planned route of the traction sliding system, and the output is the identification result of whether the traction sliding system can avoid the obstacle by decelerating.

S150、执行减速避让策略后,返回执行S120,直至完成整个牵引过程。S150. After executing the deceleration and avoidance strategy, return to execute S120 until the entire traction process is completed.

其中,该减速避让策略可以定义该牵引车需要在什么时间段,以何种减速方式(例如,具体的刹车时间或者油门量设置值等)进行减速处理,或者,该牵引车需要在什么时间点将当前速度降至何种速度值等。Among them, the deceleration avoidance strategy can define the time period and deceleration method (for example, specific braking time or throttle setting value, etc.) in which the tractor needs to decelerate, or the time point in which the tractor needs to reduce the current speed to a certain speed value, etc.

同样的,该减速避让策略可以由上述神经网络模型直接输出,也可以根据预设的计算公式,结合障碍物的当前位置点、运动速度和运动方向,牵引滑行系统的运动速度、当前位置点、减速性能参数以及全局规划路线等参数实时计算得到。Similarly, the deceleration and avoidance strategy can be directly output by the above-mentioned neural network model, or it can be calculated in real time according to a preset calculation formula, combined with the current position point, movement speed and movement direction of the obstacle, the movement speed, current position point, deceleration performance parameters of the traction sliding system, and the global planned route and other parameters.

具体的,在执行减速避让策略成功的避让该障碍物后,可以按照预设的加速处理策略逐渐增加牵引滑行系统的速度,以按照正常的滑动速度继续朝向滑行终点前进。Specifically, after the obstacle is successfully avoided by executing the deceleration avoidance strategy, the speed of the traction sliding system can be gradually increased according to the preset acceleration processing strategy to continue to move toward the sliding end point at a normal sliding speed.

S160、根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行S120,直至完成整个牵引过程。S160, after replanning a new global planning path according to the current sliding position point, obstacle information and sliding target point, return to execute S120 until the entire traction process is completed.

在本实施例中,如果仅通过减速的方式无法成功避开该障碍物,则需要重新规划得到新的全局规划路线,并采用预先建立的牵引滑行控制器,对新规划的全局规划路径继续进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行。In this embodiment, if the obstacle cannot be successfully avoided by deceleration alone, it is necessary to re-plan a new global planning route and use a pre-established traction and taxiing controller to continue trajectory tracking control of the newly planned global planning path so that the tractor can smoothly tow the target aircraft for taxiing.

需要说明的是,在确定不能以减速慢行的方式避让该障碍物后,可以首先评估一下该障碍物避让该牵引滑行系统的第一避让成本,以及该牵引滑行系统避让该障碍物的第二避让成本,如果该第二避让成本远大于第一避让成本,则可以请求空管中心提示该障碍物进行避让,并同时执行相应的减速避让策略。It should be noted that after determining that the obstacle cannot be avoided by slowing down, the first avoidance cost of the traction taxiing system to avoid the obstacle and the second avoidance cost of the traction taxiing system to avoid the obstacle can be evaluated first. If the second avoidance cost is much greater than the first avoidance cost, the air traffic control center can be requested to prompt the obstacle to be avoided and at the same time execute the corresponding deceleration avoidance strategy.

本发明实施例的技术方案,通过控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径;采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行;在牵引滑行过程中,如果检测到滑行路径前方出现障碍物,则检测是否能够以减速慢行的方式避让该障碍物;若否,则根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程的技术手段,实现在牵引车上的抱轮机构准确对接目标飞机的前起落架后,由牵引车平稳的牵引目标飞机滑行至滑行终点的技术效果,在保证牵引车和目标飞机自动对接的精确性、快速性及安全性的同时,提高了牵引车和飞机在组合滑行过程中的安全性及可靠性。The technical solution of the embodiment of the present invention controls the wheel holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft in a first fast and then slow manner, and after the docking is completed, plans a global planning path from the taxiing start point to the taxiing end point; adopts a pre-established traction taxiing controller to track the global planning path so that the tractor can stably tow the target aircraft for taxiing; during the traction taxiing process, if an obstacle is detected in front of the taxiing path, it is detected whether the obstacle can be avoided by slowing down; if not, according to the current taxiing position point, obstacle information and taxiing target point, a new global planning path is re-planned, and then returns to execute the operation of using the pre-established traction taxiing controller to track the global planning path until the entire traction process is completed. The technical means achieves the technical effect that after the wheel holding mechanism on the tractor accurately docks with the front landing gear of the target aircraft, the tractor stably tows the target aircraft to the taxiing end point, while ensuring the accuracy, speed and safety of the automatic docking of the tractor and the target aircraft, the safety and reliability of the tractor and the aircraft in the combined taxiing process are improved.

实施例二Embodiment 2

图2为本发明实施例二提供的一种民航飞机的牵引滑行控制方法的流程图,本实施例以上述实施例为基础进行细化,在本实施例中,对控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径的操作进行具体化。FIG2 is a flow chart of a towing taxiing control method for a civil aircraft provided in a second embodiment of the present invention. This embodiment is refined on the basis of the above embodiment. In this embodiment, the operation of controlling the wheel holding mechanism on the towing vehicle to approach and accurately dock with the front landing gear of the target aircraft in a fast-first-then-slow manner, and after the docking is completed, planning a global planning path from the taxiing start point to the taxiing end point is concretized.

相应的,如图2所示,该方法包括:Accordingly, as shown in FIG2 , the method includes:

S210、通过牵引车上设置的远距离视觉相机实时采集目标飞机的第一前起落架图像,并根据第一前起落架图像,获取牵引车与前起落架间的第一实时距离和相对位置关系。S210, collecting a first front landing gear image of the target aircraft in real time through a long-distance visual camera arranged on the tractor, and obtaining a first real-time distance and relative position relationship between the tractor and the front landing gear according to the first front landing gear image.

在本实施例中,在牵引车上设置两组视觉传感器,每组视觉传感器中仅包括一个视觉相机,以实现通过两种速度控制牵引车移动,并对接该目标飞机。In this embodiment, two groups of visual sensors are arranged on the tractor, and each group of visual sensors includes only one visual camera, so as to control the movement of the tractor at two speeds and dock with the target aircraft.

可选的,可以在牵引车车顶中线附近设置远距离视觉相机,通过该远距离视觉相机对相对距离较远的飞机前机轮(也即,飞机前起落架)进行视觉识别,获取第一前起落架图像。Optionally, a long-distance visual camera may be arranged near the center line of the tractor roof, and the front wheels of the aircraft (ie, the front landing gear of the aircraft) at a relatively long distance may be visually identified by the long-distance visual camera to obtain a first front landing gear image.

在获取到该第一前起落架图像后,可以通过图像识别技术,获取目标飞机的前起落架所在的图像位置以及所占的像素大小。在获取到上述信息后,可以根据针对该远距离视觉相机的相机标定结果、以及该远距离视觉相机在该牵引车中的安装位置,确定出的真实空间与该远距离视觉相机的像素空间之间的映射关系。进而,可以根据上述映射关系,识别出牵引车与前起落架间的第一实时距离和相对位置关系。After acquiring the first front landing gear image, the image position of the front landing gear of the target aircraft and the pixel size occupied can be acquired through image recognition technology. After acquiring the above information, the mapping relationship between the real space and the pixel space of the long-distance vision camera can be determined based on the camera calibration result of the long-distance vision camera and the installation position of the long-distance vision camera in the tractor. Furthermore, the first real-time distance and relative position relationship between the tractor and the front landing gear can be identified based on the above mapping relationship.

S220、判断第一实时距离是否大于距离阈值:若是,则执行S230;否则,执行S240。S220, determine whether the first real-time distance is greater than a distance threshold: if so, execute S230; otherwise, execute S240.

在本实施例中,使用该距离阈值,作为牵引车移动速度的切换分界线。当牵引车与前起落架间的距离大于该距离阈值时,该牵引车可以以一个较大的速度快速靠近目标飞机的前起落架,当牵引车与前起落架间的距离小于或者等于该距离阈值时,该牵引车可以以一个较小的速度缓慢靠近目标飞机的前起落架,以兼顾对接速度和对接准确性。In this embodiment, the distance threshold is used as the switching boundary of the tractor's moving speed. When the distance between the tractor and the front landing gear is greater than the distance threshold, the tractor can quickly approach the front landing gear of the target aircraft at a higher speed. When the distance between the tractor and the front landing gear is less than or equal to the distance threshold, the tractor can slowly approach the front landing gear of the target aircraft at a lower speed to take into account both the docking speed and the docking accuracy.

其中,该距离阈值可以根据实际场景或者对接速度或者精度的需求进行预设,本实施例对此并不进行限制。The distance threshold may be preset according to actual scenarios or requirements for docking speed or accuracy, and this embodiment does not limit this.

S230、根据相对位置关系,控制牵引车上的抱轮机构以第一速度朝向该前起落架进行移动,并返回执行S210。S230. According to the relative position relationship, control the wheel holding mechanism on the tractor to move toward the front landing gear at a first speed, and return to execute S210.

在获取牵引车与前起落架之间的相对位置关系后,可以基于该相对位置关系,控制牵引车上的抱轮机构以第一速度朝向该前起落架进行移动,以实现快速的粗对准。After the relative position relationship between the tractor and the front landing gear is acquired, the wheel holding mechanism on the tractor can be controlled to move toward the front landing gear at a first speed based on the relative position relationship to achieve rapid coarse alignment.

S240、通过牵引车上设置的近距离视觉相机实时采集目标飞机的第二前起落架图像,并根据第二前起落架图像,计算牵引车相对于前起落架的目标偏角。S240, collecting a second front landing gear image of the target aircraft in real time through a close-range visual camera arranged on the tractor, and calculating a target deflection angle of the tractor relative to the front landing gear according to the second front landing gear image.

可选的,可以将近距离视觉相机固定安装在无杆牵引车中轴线上的抱轮机构前方车架上,该近距离视觉相机在工作情况下对环境进行视觉扫描,快速识别前方飞机的前起落架所在的位置。Optionally, a close-range vision camera may be fixedly mounted on the frame in front of the wheel-holding mechanism on the central axis of the rodless tractor. The close-range vision camera performs a visual scan of the environment when working and quickly identifies the position of the front landing gear of the aircraft in front.

具体的,可以根据实际的应用场景或者应用需求,选取远距离视觉相机和近距离视觉相机的型号和技术参数。一般来说,近距离视觉相机的采集精度一般高于远距离视觉相机的采集精度。Specifically, the models and technical parameters of long-distance vision cameras and short-distance vision cameras can be selected according to actual application scenarios or application requirements. Generally speaking, the acquisition accuracy of short-distance vision cameras is generally higher than that of long-distance vision cameras.

其中,当牵引车上的抱轮机构与目标飞机的前起落架距离很接近的时候,需要准确的确定出抱轮机构与前起落架之间的相对位置关系,以使得两者准确对接。也即,需要计算得到牵引车相对于前起落架的目标偏角。When the wheel-holding mechanism on the tractor is very close to the front landing gear of the target aircraft, the relative position relationship between the wheel-holding mechanism and the front landing gear needs to be accurately determined so that the two can be accurately docked. In other words, the target deflection angle of the tractor relative to the front landing gear needs to be calculated.

在本实施例的一个可选的实施方式中,如图3所示,根据第二前起落架图像,计算牵引车相对于前起落架的目标偏角的方式,可以包括:In an optional implementation of this embodiment, as shown in FIG3 , the method of calculating the target deflection angle of the tractor relative to the front landing gear according to the second front landing gear image may include:

S2401、在第二前起落架图像中识别前起落架轮廓,并根据所述前起落架轮廓的特征,识别牵引车相对于前起落架的偏转类型为左偏或者右偏。S2401. Identify a front landing gear contour in a second front landing gear image, and identify, based on features of the front landing gear contour, whether the deflection type of the tractor relative to the front landing gear is left deflection or right deflection.

在本实施例中,通过图像识别技术可以在该第二前起落架图像中识别前起落架轮廓。考虑到在存在左偏角的第二前起落架图像中可以看到轮毂的右侧,在存在右偏角的第二前起落架图像可以看到轮毂的左侧,由此,基于识别到的前起落架轮廓的特征,可判断出牵引车相对于前起落架的偏转类型为左偏或者右偏。In this embodiment, the nose landing gear contour can be identified in the second nose landing gear image by image recognition technology. Considering that the right side of the wheel hub can be seen in the second nose landing gear image with a left deflection angle, and the left side of the wheel hub can be seen in the second nose landing gear image with a right deflection angle, based on the features of the identified nose landing gear contour, it can be determined whether the deflection type of the tractor relative to the nose landing gear is left deflection or right deflection.

S2402、根据所述前起落架轮廓,获取飞机前轮的横向最大尺寸w’、纵向最大尺寸d以及前轮宽度b。S2402. According to the front landing gear profile, obtain the maximum lateral dimension w', maximum longitudinal dimension d and front wheel width b of the aircraft's front wheel.

其中,为了便于说明,在图4中示出了本发明实施例的技术方案所适用的一种牵引车相对于前起落架偏转角的正视图,在图5中示出了本发明实施例的技术方案所适用的一种牵引车相对于前起落架偏转角的俯视图。For the sake of convenience, FIG. 4 shows a tractor deflected relative to the front landing gear to which the technical solution of the embodiment of the present invention is applicable. FIG5 shows a front view of a tractor to which the technical solution of an embodiment of the present invention is applicable, and FIG6 shows a front view of a tractor to which the front landing gear is deflected relative to the front landing gear. Top view of the corner.

具体的,飞机轮胎的截面是由复杂的圆弧和线段构成的,进而可以采用带圆角半径为R的圆柱体模型来近似单个轮胎,即用半径为R的圆弧来拟合轮胎圆角。一般来说,在第二前起落架图像识别出的前起落架轮廓如图5所示,因此,可以直接在图5中测量得到飞机前轮的横向最大尺寸w’,纵向最大尺寸d(也即,前轮轮胎的直径),以及前轮轮胎的宽度b。在图5所示的示例中,可以通过下述各公式计算得到牵引车相对于前起落架的偏转角度Specifically, the cross section of an aircraft tire is composed of complex arcs and line segments, and thus a cylindrical model with a fillet radius of R can be used to approximate a single tire, that is, an arc with a radius of R is used to fit the tire fillet. Generally speaking, the contour of the front landing gear identified in the second front landing gear image is shown in FIG5 , and therefore, the maximum lateral dimension w', the maximum longitudinal dimension d (that is, the diameter of the front wheel tire), and the width b of the front wheel tire of the aircraft can be directly measured in FIG5 . In the example shown in FIG5 , the deflection angle of the tractor relative to the front landing gear can be calculated by the following formulas: .

;

;

;其中, ;in, .

显然,为了计算得到,有一个未知量R无法直接从前起落架轮廓中直接获取得到。Obviously, in order to calculate , there is an unknown quantity R that cannot be directly obtained from the front landing gear profile.

S2403、根据目标飞机的机轮轮胎型号,确定飞机前轮的轮胎直径d1、轮胎宽度b1以及轮胎圆弧半径R1之间的固定比例关系。S2403. Determine a fixed proportional relationship among the tire diameter d1, tire width b1, and tire arc radius R1 of the front wheel of the aircraft according to the wheel and tire model of the target aircraft.

可以理解的是,设定型号的民航飞机上拥有特定型号的飞机机轮,因此,在目标飞机的型号确定后,该目标飞机的机轮轮胎型号也被唯一确定。在目标飞机的机轮轮胎型号确定后,可知其轮胎直径d1与轮胎宽度b1和圆弧半径R1之间存在固定的比例关系,而这一比例关系在第二前起落架图像中识别到的前起落架轮廓中依然存在,因此,引入可以比例因子,即: It is understandable that the civil aircraft of the set model has a specific model of aircraft wheels. Therefore, after the model of the target aircraft is determined, the wheel and tire model of the target aircraft is also uniquely determined. After the wheel and tire model of the target aircraft is determined, it can be known that there is a fixed proportional relationship between its tire diameter d1, tire width b1 and arc radius R1, and this proportional relationship still exists in the front landing gear profile identified in the second front landing gear image. Therefore, the proportional factor can be introduced. and ,Right now: ;

S2404、根据飞机前轮的横向最大尺寸w’、纵向最大尺寸d、前轮宽度b以及所述固定比例关系,计算牵引车相对于前起落架的偏转角度。S2404. Calculate the deflection angle of the tractor relative to the front landing gear according to the maximum lateral dimension w', the maximum longitudinal dimension d, the front wheel width b and the fixed proportional relationship of the aircraft's front wheels.

通过将比例因子代入前述的计算公式,可以得到牵引车相对于前起落架的偏转角度By adding the scaling factor and Substitute the above The calculation formula can be used to obtain the deflection angle of the tractor relative to the front landing gear. .

具体的,根据飞机前轮的横向最大尺寸w’、纵向最大尺寸d、前轮宽度b以及所述固定比例关系,计算牵引车相对于前起落架的偏转角度,可以包括:Specifically, according to the maximum lateral dimension w', the maximum longitudinal dimension d, the width b of the front wheel of the aircraft, and the fixed proportional relationship, calculating the deflection angle of the tractor relative to the front landing gear may include:

根据所述固定比例关系,获取第一比例因子,以及第二比例因子According to the fixed proportional relationship, a first proportional factor is obtained. , and the second scaling factor ;

根据第一比例因子和第二比例因子,计算得到偏转调整因子According to the first scale factor and the second scale factor , calculate the deflection adjustment factor ;

其中,in, ;

根据飞机前轮的横向最大尺寸w’、纵向最大尺寸d、前轮宽度b、第一比例因子、第二比例因子以及偏转调整因子,计算牵引车相对于前起落架的偏转角度According to the maximum lateral dimension w', maximum longitudinal dimension d, width b, and first proportional factor of the aircraft's front wheel , Second scale factor and the deflection adjustment factor , calculate the deflection angle of the tractor relative to the front landing gear ;

其中,in, .

S2405、将所述偏转类型和所述偏转角度的组合,作为牵引车相对于前起落架的目标偏角。S2405: Use the combination of the deflection type and the deflection angle as a target deflection angle of the tractor relative to the front landing gear.

其中,目标偏角描述了该牵引车以左偏或者右偏的方式,相对于该前起落架的偏转角度。The target deflection angle describes the deflection angle of the tractor relative to the front landing gear in a left-biased or right-biased manner.

S250、控制牵引车上的抱轮机构按照所述目标偏角,以第二速度靠近并准确对接目标飞机的前起落架,其中,第一速度大于第二速度。S250, controlling the wheel holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft at a second speed according to the target deflection angle, wherein the first speed is greater than the second speed.

在通过近距离视觉相机准确确定出目标偏角后,可以控制牵引车上的抱轮机构以第二速度靠近并准确对接目标飞机的前起落架。After the target deviation angle is accurately determined by the close-range visual camera, the wheel-holding mechanism on the tractor can be controlled to approach and accurately dock with the front landing gear of the target aircraft at the second speed.

同样的,本领域技术人员可以根据实际应用场景和实际需求自定义设置第一速度和第二速度,本实施例对此并不进行限制。Similarly, those skilled in the art may customize the first speed and the second speed according to actual application scenarios and actual needs, and this embodiment does not limit this.

需要说明的是,当牵引车上的抱轮机构与目标飞机的前起落架实现自动对接后,该抱轮机构可以将将飞机前轮抱起举升,并在接收到下一步滑行指令后,带动该目标飞机进行滑行。It should be noted that when the wheel-holding mechanism on the tractor is automatically docked with the front landing gear of the target aircraft, the wheel-holding mechanism can lift the front wheels of the aircraft and drive the target aircraft to taxi after receiving the next taxiing instruction.

S260、通过牵引车上的定位模块确定滑行起点,并在接收的空管指令中识别滑行终点。S260: Determine the taxiing starting point through the positioning module on the tractor, and identify the taxiing end point in the received air traffic control instruction.

S270、使用作为启发函数,结合滑行起点、滑行终点以及机场地图,规划出由滑行起点至滑行终点的全局最优路径,作为全局规划路径。S270, use As a heuristic function, the global optimal path from the taxiing start point to the taxiing end point is planned in combination with the taxiing start point, the taxiing end point and the airport map as the global planning path.

在本实施例中,可以对现有的A*算法进行改进,完成对全局最优路径的规划。In this embodiment, the existing A* algorithm can be improved to complete the planning of the global optimal path.

其中,为启发因子,的取值由机场地图的大小确定;为当前节点与起点构成的矢量跟终点和当前节点构成的矢量之间的夹角;是前一个节点与当前节点构成的矢量跟下一个节点和当前节点构成的矢量之间的夹角;为安全因子,的取值由的大小确定,均为调整参数,的取值由的大小确定,的取值由的大小确定。in, As the inspiration factor, The value of is determined by the size of the airport map; The angle between the vector formed by the current node and the starting point and the vector formed by the end point and the current node; It is the angle between the vector formed by the previous node and the current node and the vector formed by the next node and the current node; is the safety factor, The value of The size is determined by , are adjustment parameters, The value of The size is determined by The value of The size is determined.

具体的,首先获取滑行起点以及滑行终点在机场地图中的坐标信息,之后基于机场地图并结合成本评价函数f(n),计算得到全局最优路径。其中,可以依据成本评价函数f(n)进行搜索,将搜索到满足的点作为下次搜索的起始点,重复此过程直到找到滑行终点,并将搜索过程中找到的各点形成最优路径。Specifically, first obtain the coordinate information of the taxi start point and the taxi end point in the airport map, and then calculate the global optimal path based on the airport map and the cost evaluation function f(n). Among them, the search can be performed according to the cost evaluation function f(n), and the searched point that satisfies the search is used as the starting point of the next search, and this process is repeated until the taxi end point is found, and the points found in the search process form the optimal path.

可选的,可以将成本评价函数定义为:Optionally, the cost evaluation function can be defined as: ;

其中,f(n)为当前节点n的成本评价函数,g(n)为滑行起点到当前节点n的实际成本,为当前节点到目标点的成本,也即启发函数。为了提高计算效率以及滑行过程的安全性,需要考虑查找的方向,滑行过程中的夹角信息,构建得到的启发函数为:Among them, f(n) is the cost evaluation function of the current node n, g(n) is the actual cost from the sliding starting point to the current node n, is the cost from the current node to the target point, which is also the heuristic function. In order to improve the calculation efficiency and the safety of the sliding process, it is necessary to consider the search direction and the angle information during the sliding process. The heuristic function constructed is:

.

其中,为启发因子,其决定方向信息在牵引滑行过程中所占的权重,其取值根据实际地图的大小确定,一般取5;为当前节点与起点构成的矢量跟终点和当前节点构成的矢量之间的夹角,其反映了搜索方向是指向了滑行终点。该值越小,搜索越朝着滑行终点进行;是前一个节点与当前节点构成的矢量跟下一个节点和当前节点构成的矢量之间的夹角,越大,夹角越大,危险系数越高;为安全因子,其决定了牵引车和目标飞机的纵向夹角对滑行安全的影响权重。in, is the heuristic factor, which determines the weight of the direction information in the traction sliding process. Its value is determined according to the size of the actual map and is generally 5; It is the angle between the vector formed by the current node and the starting point and the vector formed by the end point and the current node, which reflects that the search direction is pointing to the end point of the sliding. The smaller the value, the closer the search is to the end of the glide path; It is the angle between the vector formed by the previous node and the current node and the vector formed by the next node and the current node. The larger it is, the greater the angle is, and the higher the risk factor is; is the safety factor, which determines the influence weight of the longitudinal angle between the tractor and the target aircraft on taxiing safety.

角度小于时,取值为0,当时,取值为5,当时,取值为10,当取值为20;都为预设参数,当时,为0;当大于时,为1;当小于时,为0;当大于时,为1。when Angle less than hour, The value is 0. hour, The value is 5. hour, The value is 10. hour The value is 20; , are all preset parameters. Small hour, is 0; when Greater than hour, is 1; when Less than hour, is 0; when Greater than hour, is 1.

S280、采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行。S280: Using a pre-established traction and taxiing controller, the global planning path is tracked and controlled so that the tractor can stably tow the target aircraft for taxiing.

可选的,采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,可以包括:Optionally, using a pre-established traction and sliding controller to perform trajectory tracking control on the global planning path may include:

如图6所示,在大地坐标系XOY中,定义牵引车前轴中心为A点,后轴中心为B点,牵引车前后轮距为L1,牵引车与目标飞机的铰接点为H点,牵引车的前轮转角为,目标飞机两个主起落架连线的中点为C点,C点到铰接点的距离为L2,牵引车后轴中心B点到铰接点H点的距离为La,牵引车的横摆角为,目标飞机的横摆角为,牵引车和目标飞机铰接角为,得到牵引滑行系统的动力学模型示意图。As shown in Figure 6, in the geodetic coordinate system XOY, the center of the front axle of the tractor is defined as point A, the center of the rear axle is defined as point B, the front and rear wheel tracks of the tractor are defined as L1, the hinge point between the tractor and the target aircraft is defined as point H, and the front wheel turning angle of the tractor is defined as The midpoint of the line connecting the two main landing gears of the target aircraft is point C, the distance from point C to the hinge point is L2, the distance from the rear axle center point B to the hinge point H is La, and the yaw angle of the tractor is , the yaw angle of the target aircraft is , the articulation angle between the tractor and the target aircraft is , and obtain the schematic diagram of the dynamic model of the traction sliding system.

为状态量,为控制量建立飞机牵引模型:by is the state quantity, Model the aircraft traction for the control quantity:

;其中,代表对Z取导数; ;in, represents the derivative with respect to Z;

根据所述飞机牵引模型,构建得到四自由度线性误差模型的状态空间表达式:;其中,According to the aircraft traction model, the state space expression of the four-degree-of-freedom linear error model is constructed: ;in, ;

; ;

; ;

;

;

对所述四自由度线性误差模型的状态空间表达式进行离散化处理,在采样周期T下得到离散化模型为:The state space expression of the four-degree-of-freedom linear error model is discretized, and the discretized model is obtained under the sampling period T:

;

其中,为当前t0时刻的状态量,为t0+T时刻的状态量。in, , , ; is the state quantity at the current time t0, It is the state quantity at time t0+T.

构建每一个控制周期内的控制增量,并将离散的状态量和控制增量,组合成新的状态量,得到新的状态空间方程为:Constructing control increments within each control cycle , and the discrete state quantity and control increment , combined into a new state quantity , the new state space equation is:

;

其中,in, , , ;

令Np为预测时域步长,Nc为控制时域步长,且NcNp,构建得到目标成本函数为: Let Np be the prediction time domain step size, Nc be the control time domain step size, and Nc Np, the target cost function is constructed as:

;

其中,是k时刻下预测的k+i时刻的参考值; 是k时刻下输出的k+i时刻的实际值;是k时刻下计算的k+i时刻的控制增量;为松弛因子的权重系数,取值为1;in, It is the reference value at time k+i predicted at time k; is the actual value of the output at time k+i at time k; is the control increment at time k+i calculated at time k; is the weight coefficient of the relaxation factor, which takes a value of 1;

其中,in, ;

;

为预设的松弛因子;其中,Q、R均为权重矩阵,以及均为权重矩阵中的系数,数值均为1; ; is the preset relaxation factor; where Q and R are weight matrices, , , , , as well as They are all coefficients in the weight matrix, and their values are all 1;

基于目标成本函数和如下两个约束条件:Based on the target cost function and the following two constraints:

,以及,构建得到牵引滑行控制器; ,as well as , a traction and sliding controller is constructed;

通过所述牵引滑行控制器,基于所述两个约束条件,在每个控制周期内对目标成本函数求解,得到如下最优控制增量序列:Through the traction sliding controller, based on the two constraints, the target cost function is solved in each control cycle to obtain the following optimal control increment sequence:

;

通过所述牵引滑行控制器,将该最优控制增量序列中的第一项控制增量与上一时刻的控制量相加作为当前时刻输入的控制量,在下一控制周期中重复上述过程,进行在线滚动优化,得出每个时刻的实际控制量,最终实现对该系统的轨迹跟踪控制。Through the traction sliding controller, the first control increment in the optimal control increment sequence is added to the control amount at the previous moment as the control amount input at the current moment. The above process is repeated in the next control cycle, and online rolling optimization is performed to obtain the actual control amount at each moment, and finally the trajectory tracking control of the system is realized.

S290、在牵引滑行过程中,如果检测到滑行路径前方出现障碍物,则检测是否能够以减速慢行的方式避让该障碍物。S290: During the traction sliding process, if an obstacle is detected in front of the sliding path, it is detected whether the obstacle can be avoided by slowing down.

在本实施例中,在基于最优全局路径规划控制牵引车和目标飞机按照全局规划路径规划行驶过程中,实时感知障碍物,以对局部路径实时调整生成平滑路径。In this embodiment, when the tractor and the target aircraft are controlled to travel according to the global planned path based on the optimal global path planning, obstacles are sensed in real time to adjust the local path in real time to generate a smooth path.

具体的,可以首先根据定位模块确定飞机和牵引车在机场中的位置,通过存储模块中的飞机参数以及牵引车参数并结合传感模块中测量得到的铰接角信息构建飞机牵引系统的轮廓。Specifically, the positions of the aircraft and the tractor in the airport can be first determined using the positioning module, and the profile of the aircraft traction system can be constructed by storing the aircraft parameters and the tractor parameters in the module and combining the articulation angle information measured in the sensor module.

之后,可以根据传感模块实时检测飞机牵引系统滑行路径上是否存在障碍物,当存在障碍物时,处理判断模块结合障碍物的速度、尺寸以及飞机牵引系统的速度尺寸判断安全风险,因飞机牵引系统的转弯危险系数高的特点,优先选用缓慢减速的方式避让;当减速无法避让时需要重新规划滑行路径,也即,当处理判断模块得出飞机无法通过减速避让时,就需以当前节点为初始节点,并将该障碍物的信息增加到机场地图中,并重新规划新的滑行路径。Afterwards, the sensor module can be used to detect in real time whether there are obstacles on the taxiing path of the aircraft traction system. When there are obstacles, the processing and judgment module determines the safety risk based on the speed and size of the obstacle and the speed and size of the aircraft traction system. Due to the high turning risk factor of the aircraft traction system, slow deceleration is preferred to avoid it. When deceleration cannot avoid it, the taxiing path needs to be replanned. That is, when the processing and judgment module concludes that the aircraft cannot avoid it by decelerating, it is necessary to use the current node as the initial node, add the information of the obstacle to the airport map, and replan a new taxiing path.

在本实施例的一个可选的实施方式中,检测是否能够以减速慢行的方式避让该障碍物,可以包括:In an optional implementation of this embodiment, detecting whether the obstacle can be avoided by slowing down may include:

获取所述障碍物的移动速度以及当前的牵引滑行速度,并计算所述移动速度与所述牵引滑行速度的速度和值;如果所述速度和值未超过预设的速度门限阈值,则确定能够以减速慢行的方式避让该障碍物;否则,确定不能以减速慢行的方式避让该障碍物。The moving speed of the obstacle and the current traction and sliding speed are obtained, and the sum of the moving speed and the traction and sliding speed is calculated; if the sum of the speeds does not exceed a preset speed threshold, it is determined that the obstacle can be avoided by slowing down; otherwise, it is determined that the obstacle cannot be avoided by slowing down.

在一个具体的例子中,,当障碍物的移动速度和当前的牵引滑行速度之和小于50km/h时,可以优先选用缓慢减速的方式避让;当障碍物的移动速度和当前的牵引滑行速度之和大于50km/h时,减速可能无法避让,此时,需要将障碍物的位置坐标以及速度更新到机场地图中。In a specific example, when the sum of the obstacle's moving speed and the current traction taxiing speed is less than 50km/h, slow deceleration can be used as a preferred method for avoidance; when the sum of the obstacle's moving speed and the current traction taxiing speed is greater than 50km/h, deceleration may not be able to avoid it. At this time, the obstacle's position coordinates and speed need to be updated to the airport map.

S2100、若否,则根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程。S2100, if not, then re-plan a new global planning path according to the current sliding position point, obstacle information and sliding target point, and then return to execute the operation of using the pre-established traction sliding controller to perform trajectory tracking control on the global planning path until the entire traction process is completed.

本发明实施例的技术方案,通过控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径;采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行;在牵引滑行过程中,如果检测到滑行路径前方出现障碍物,则检测是否能够以减速慢行的方式避让该障碍物;若否,则根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程的技术手段,实现在牵引车上的抱轮机构准确对接目标飞机的前起落架后,由牵引车平稳的牵引目标飞机滑行至滑行终点的技术效果,在保证牵引车和目标飞机自动对接的精确性、快速性及安全性的同时,提高了牵引车和飞机在组合滑行过程中的安全性及可靠性。The technical solution of the embodiment of the present invention controls the wheel holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft in a first fast and then slow manner, and after the docking is completed, plans a global planning path from the taxiing start point to the taxiing end point; adopts a pre-established traction taxiing controller to track the global planning path so that the tractor can smoothly tow the target aircraft for taxiing; during the traction taxiing process, if an obstacle is detected in front of the taxiing path, it is detected whether the obstacle can be avoided by slowing down; if not, according to the current taxiing position point, obstacle information and taxiing target point, a new global planning path is re-planned, and then returns to execute the operation of using the pre-established traction taxiing controller to track the global planning path until the entire traction process is completed. The technical means achieves the technical effect that after the wheel holding mechanism on the tractor accurately docks with the front landing gear of the target aircraft, the tractor smoothly tows the target aircraft to the taxiing end point, while ensuring the accuracy, rapidity and safety of the automatic docking of the tractor and the target aircraft, the safety and reliability of the tractor and the aircraft in the combined taxiing process are improved.

实施例三Embodiment 3

图7为本发明实施例三提供的一种民航飞机的牵引环境控制装置的结构示意图。如图7所示,该装置包括:全局规划路径规划模块710、轨迹跟踪控制模块720、避让检测模块730以及路径重规划模块740,其中:FIG7 is a schematic diagram of the structure of a traction environment control device for a civil aircraft provided in Embodiment 3 of the present invention. As shown in FIG7 , the device includes: a global planning path planning module 710, a trajectory tracking control module 720, an avoidance detection module 730, and a path re-planning module 740, wherein:

全局规划路径规划模块710,用于控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径;The global planning path planning module 710 is used to control the wheel holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft in a first fast and then slow manner, and after the docking is completed, plan a global planning path from the taxiing start point to the taxiing end point;

轨迹跟踪控制模块720,用于采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行;The trajectory tracking control module 720 is used to use a pre-established traction and taxiing controller to perform trajectory tracking control on the global planning path so that the tractor can stably tow the target aircraft for taxiing;

避让检测模块730,用于在牵引滑行过程中,如果检测到滑行路径前方出现障碍物,则检测是否能够以减速慢行的方式避让该障碍物;The avoidance detection module 730 is used to detect whether the obstacle can be avoided by slowing down if an obstacle is detected in front of the sliding path during the traction sliding process;

路径重规划模块740,用于若否,则根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程。The path replanning module 740 is used to, if not, replan a new global planning path based on the current sliding position point, obstacle information and sliding target point, and then return to execute the operation of using the pre-established traction sliding controller to perform trajectory tracking control on the global planning path until the entire traction process is completed.

本发明实施例的技术方案,通过控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径;采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行;在牵引滑行过程中,如果检测到滑行路径前方出现障碍物,则检测是否能够以减速慢行的方式避让该障碍物;若否,则根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程的技术手段,实现在牵引车上的抱轮机构准确对接目标飞机的前起落架后,由牵引车平稳的牵引目标飞机滑行至滑行终点的技术效果,在保证牵引车和目标飞机自动对接的精确性、快速性及安全性的同时,提高了牵引车和飞机在组合滑行过程中的安全性及可靠性。The technical solution of the embodiment of the present invention controls the wheel holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft in a first fast and then slow manner, and after the docking is completed, plans a global planning path from the taxiing start point to the taxiing end point; adopts a pre-established traction taxiing controller to track the global planning path so that the tractor can stably tow the target aircraft for taxiing; during the traction taxiing process, if an obstacle is detected in front of the taxiing path, it is detected whether the obstacle can be avoided by slowing down; if not, according to the current taxiing position point, obstacle information and taxiing target point, a new global planning path is re-planned, and then returns to execute the operation of using the pre-established traction taxiing controller to track the global planning path until the entire traction process is completed. The technical means achieves the technical effect that after the wheel holding mechanism on the tractor accurately docks with the front landing gear of the target aircraft, the tractor stably tows the target aircraft to the taxiing end point, while ensuring the accuracy, speed and safety of the automatic docking of the tractor and the target aircraft, the safety and reliability of the tractor and the aircraft in the combined taxiing process are improved.

在上述各实施例的基础上,全局规划路径规划模块710,可以具体包括:Based on the above embodiments, the global planning path planning module 710 may specifically include:

第一图像识别单元,用于通过牵引车上设置的远距离视觉相机实时采集目标飞机的第一前起落架图像,并根据第一前起落架图像,获取牵引车与前起落架间的第一实时距离和相对位置关系;A first image recognition unit is used to collect a first front landing gear image of the target aircraft in real time through a long-distance visual camera arranged on the tractor, and obtain a first real-time distance and relative position relationship between the tractor and the front landing gear according to the first front landing gear image;

第一速度移动单元,用于如果第一实时距离大于距离阈值,则根据相对位置关系,控制牵引车上的抱轮机构以第一速度朝向该前起落架进行移动;A first speed moving unit, configured to control the wheel holding mechanism on the tractor to move toward the front landing gear at a first speed according to the relative position relationship if the first real-time distance is greater than a distance threshold;

第二图像识别单元,用于如果第一实时距离小于或者等于距离阈值,则通过牵引车上设置的近距离视觉相机实时采集目标飞机的第二前起落架图像,并根据第二前起落架图像,计算牵引车相对于前起落架的目标偏角;a second image recognition unit, configured to collect a second front landing gear image of the target aircraft in real time through a close-range visual camera provided on the tractor if the first real-time distance is less than or equal to the distance threshold, and calculate a target deflection angle of the tractor relative to the front landing gear according to the second front landing gear image;

第二速度移动单元,用于控制牵引车上的抱轮机构按照所述目标偏角,以第二速度靠近并准确对接目标飞机的前起落架,其中,第一速度大于第二速度。The second speed moving unit is used to control the wheel holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft at a second speed according to the target deflection angle, wherein the first speed is greater than the second speed.

在上述各实施例的基础上,第二图像识别单元,具体用于:On the basis of the above embodiments, the second image recognition unit is specifically used for:

在第二前起落架图像中识别前起落架轮廓,并根据所述前起落架轮廓的特征,识别牵引车相对于前起落架的偏转类型为左偏或者右偏;recognizing a front landing gear profile in the second front landing gear image, and recognizing, based on features of the front landing gear profile, whether the deflection type of the tractor relative to the front landing gear is left deflection or right deflection;

根据所述前起落架轮廓,获取飞机前轮的横向最大尺寸w’、纵向最大尺寸d以及前轮宽度b;According to the front landing gear profile, obtain the maximum lateral dimension w', the maximum longitudinal dimension d and the width b of the front wheel of the aircraft;

根据目标飞机的机轮轮胎型号,确定飞机前轮的轮胎直径d1、轮胎宽度b1以及轮胎圆弧半径R1之间的固定比例关系;According to the wheel and tire model of the target aircraft, a fixed proportional relationship between the tire diameter d1, the tire width b1 and the tire arc radius R1 of the front wheel of the aircraft is determined;

根据飞机前轮的横向最大尺寸w’、纵向最大尺寸d、前轮宽度b以及所述固定比例关系,计算牵引车相对于前起落架的偏转角度;Calculate the deflection angle of the tractor relative to the front landing gear according to the maximum lateral dimension w', the maximum longitudinal dimension d, the width b of the front wheel of the aircraft and the fixed proportional relationship;

将所述偏转类型和所述偏转角度的组合,作为牵引车相对于前起落架的目标偏角。A combination of the deflection type and the deflection angle is used as a target deflection angle of the tractor relative to the front landing gear.

在上述各实施例的基础上,第二图像识别单元,进一步具体用于:On the basis of the above embodiments, the second image recognition unit is further specifically used for:

根据所述固定比例关系,获取第一比例因子,以及第二比例因子According to the fixed proportional relationship, a first proportional factor is obtained. , and the second scaling factor ;

根据第一比例因子和第二比例因子,计算得到偏转调整因子According to the first scale factor and the second scale factor , calculate the deflection adjustment factor ;

其中,in, ;

根据飞机前轮的横向最大尺寸w’、纵向最大尺寸d、前轮宽度b、第一比例因子、第二比例因子以及偏转调整因子,计算牵引车相对于前起落架的偏转角度According to the maximum lateral dimension w', maximum longitudinal dimension d, width b, and first proportional factor of the aircraft's front wheel , Second scale factor and the deflection adjustment factor , calculate the deflection angle of the tractor relative to the front landing gear ;

其中,in, .

在上述各实施例的基础上,全局规划路径规划模块710,可以进一步具体用于:Based on the above embodiments, the global planning path planning module 710 can be further specifically used for:

通过牵引车上的定位模块确定滑行起点,并在接收的空管指令中识别滑行终点;Determine the taxiing start point through the positioning module on the tractor, and identify the taxiing end point in the received air traffic control instructions;

使用作为启发函数,结合滑行起点、滑行终点以及机场地图,规划出由滑行起点至滑行终点的全局最优路径,作为全局规划路径;use As a heuristic function, the global optimal path from the taxi start point to the taxi end point is planned in combination with the taxi start point, the taxi end point and the airport map as the global planning path;

其中,为启发因子,的取值由机场地图的大小确定;为当前节点与起点构成的矢量跟终点和当前节点构成的矢量之间的夹角;是前一个节点与当前节点构成的矢量跟下一个节点和当前节点构成的矢量之间的夹角;为安全因子,的取值由的大小确定,均为调整参数,的取值由的大小确定,的取值由的大小确定。in, As the inspiration factor, The value of is determined by the size of the airport map; The angle between the vector formed by the current node and the starting point and the vector formed by the end point and the current node; It is the angle between the vector formed by the previous node and the current node and the vector formed by the next node and the current node; is the safety factor, The value of The size is determined by , are adjustment parameters, The value of The size is determined by The value of The size is determined.

在上述各实施例的基础上,轨迹跟踪控制模块720,可以具体用于:Based on the above embodiments, the trajectory tracking control module 720 can be specifically used for:

在大地坐标系XOY中,定义牵引车前轴中心为A点,后轴中心为B点,牵引车前后轮距为L1,牵引车与目标飞机的铰接点为H点,牵引车的前轮转角为,目标飞机两个主起落架连线的中点为C点,C点到铰接点的距离为L2,牵引车后轴中心B点到铰接点H点的距离为La,牵引车的横摆角为,目标飞机的横摆角为,牵引车和目标飞机铰接角为In the geodetic coordinate system XOY, the center of the front axle of the tractor is defined as point A, the center of the rear axle is defined as point B, the front and rear wheelbase of the tractor is defined as L1, the hinge point between the tractor and the target aircraft is defined as point H, and the front wheel turning angle of the tractor is defined as The midpoint of the line connecting the two main landing gears of the target aircraft is point C, the distance from point C to the hinge point is L2, the distance from the rear axle center point B to the hinge point H is La, and the yaw angle of the tractor is , the yaw angle of the target aircraft is , the articulation angle between the tractor and the target aircraft is ;

为状态量,为控制量建立飞机牵引模型:by is the state quantity, Model the aircraft traction for the control quantity:

;其中,代表对Z取导数; ;in, represents the derivative with respect to Z;

根据所述飞机牵引模型,构建得到四自由度线性误差模型的状态空间表达式:;其中,According to the aircraft traction model, the state space expression of the four-degree-of-freedom linear error model is constructed: ;in, ;

; ;

; ;

;

;

对所述四自由度线性误差模型的状态空间表达式进行离散化处理,在采样周期T下得到离散化模型为:The state space expression of the four-degree-of-freedom linear error model is discretized, and the discretized model is obtained under the sampling period T:

;

其中,in, , , ;

构建每一个控制周期内的控制增量,并将离散的状态量和控制增量,组合成新的状态量,得到新的状态空间方程为:Constructing control increments within each control cycle , and the discrete state quantity and control increment , combined into a new state quantity , the new state space equation is:

;

其中,in, , , ;

令Np为预测时域步长,Nc为控制时域步长,且NcNp,构建得到目标成本函数为: Let Np be the prediction time domain step size, Nc be the control time domain step size, and Nc Np, the target cost function is constructed as:

;

其中,是k时刻下预测的k+i时刻的参考值; 是k时刻下输出的k+i时刻的实际值;是k时刻下计算的k+i时刻的控制增量;为松弛因子的权重系数,取值为1;in, It is the reference value at time k+i predicted at time k; is the actual value of the output at time k+i at time k; is the control increment at time k+i calculated at time k; is the weight coefficient of the relaxation factor, which takes a value of 1;

其中,in, ;

;

为预设的松弛因子;其中,Q、R均为权重矩阵,以及均为权重矩阵中的系数,数值均为1; ; is the preset relaxation factor; where Q and R are weight matrices, , , , , as well as They are all coefficients in the weight matrix, and their values are all 1;

基于目标成本函数和如下两个约束条件:Based on the target cost function and the following two constraints:

,以及,构建得到牵引滑行控制器; ,as well as , a traction and sliding controller is constructed;

通过所述牵引滑行控制器,基于所述两个约束条件,在每个控制周期内对目标成本函数求解,得到如下最优控制增量序列:Through the traction sliding controller, based on the two constraints, the target cost function is solved in each control cycle to obtain the following optimal control increment sequence:

;

通过所述牵引滑行控制器,将该最优控制增量序列中的第一项控制增量与上一时刻的控制量相加作为当前时刻输入的控制量,在下一控制周期中重复上述过程,进行在线滚动优化,得出每个时刻的实际控制量,最终实现对该系统的轨迹跟踪控制。Through the traction sliding controller, the first control increment in the optimal control increment sequence is added to the control amount at the previous moment as the control amount input at the current moment. The above process is repeated in the next control cycle, and online rolling optimization is performed to obtain the actual control amount at each moment, and finally the trajectory tracking control of the system is realized.

在上述各实施例的基础上,避让检测模块730,可以具体用于:Based on the above embodiments, the avoidance detection module 730 can be specifically used for:

获取所述障碍物的移动速度以及当前的牵引滑行速度,并计算所述移动速度与所述牵引滑行速度的速度和值;Obtaining the moving speed of the obstacle and the current traction sliding speed, and calculating the speed sum of the moving speed and the traction sliding speed;

如果所述速度和值未超过预设的速度门限阈值,则确定能够以减速慢行的方式避让该障碍物;否则,确定不能以减速慢行的方式避让该障碍物。If the speed sum value does not exceed the preset speed threshold, it is determined that the obstacle can be avoided by slowing down; otherwise, it is determined that the obstacle cannot be avoided by slowing down.

本发明实施例所提供的民航飞机的牵引滑行控制装置可执行本发明任意实施例所提供的民航飞机的牵引滑行控制方法,具备执行方法相应的功能模块和有益效果。The traction taxiing control device for a civil aircraft provided in an embodiment of the present invention can execute the traction taxiing control method for a civil aircraft provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.

实施例四Embodiment 4

在图8示出了本发明实施例四所适用的一种牵引车的外形示意图。如图8所示,1-抱轮机构、2-近距离视觉相机、3-加速度计陀螺仪、4-控制器、5,6-激光雷达测距传感、7-角度传感器、8-远距离视觉相机。FIG8 shows a schematic diagram of the appearance of a tractor applicable to the fourth embodiment of the present invention. As shown in FIG8, 1-wheel holding mechanism, 2-close-range visual camera, 3-accelerometer gyroscope, 4-controller, 5, 6-laser radar ranging sensor, 7-angle sensor, 8-long-range visual camera.

在本实施例中,牵引车主要包含抱轮机构、控制器、两个视觉相机及其他传感器;所述抱轮机构位于无杆牵引车近车辆中心位置,用于夹抱并托举飞机前轮。In this embodiment, the tractor mainly includes a wheel-holding mechanism, a controller, two visual cameras and other sensors; the wheel-holding mechanism is located near the center of the rodless tractor and is used to clamp and lift the front wheel of the aircraft.

所述控制器包括定位模块、存储模块、至少一个处理器以及运动控制器;定位模块用于确定飞机和牵引车在机场中的位置,存储模块用于存放飞机参数以及牵引车参数,至少一个处理器用于执行如本发明任一实施例所述的方法,也即:The controller includes a positioning module, a storage module, at least one processor and a motion controller; the positioning module is used to determine the positions of the aircraft and the tractor at the airport, the storage module is used to store aircraft parameters and tractor parameters, and the at least one processor is used to execute the method according to any embodiment of the present invention, that is:

控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径;采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行;在牵引滑行过程中,如果检测到滑行路径前方出现障碍物,则检测是否能够以减速慢行的方式避让该障碍物;若否,则根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程。The wheel holding mechanism on the tractor is controlled to approach and accurately dock with the front landing gear of the target aircraft in a fast-first-then-slow manner, and after the docking is completed, a global planning path from the taxiing start point to the taxiing end point is planned; a pre-established traction taxiing controller is used to perform trajectory tracking control on the global planning path, so that the tractor can stably tow the target aircraft for taxiing; during the traction taxiing process, if an obstacle is detected in front of the taxiing path, it is detected whether the obstacle can be avoided by slowing down; if not, a new global planning path is re-planned according to the current taxiing position point, obstacle information and taxiing target point, and then the operation of using the pre-established traction taxiing controller to perform trajectory tracking control on the global planning path is returned to execute until the entire traction process is completed.

运动控制器用于控制抱轮机构先快后慢地靠近前起落架以及牵引滑行过程中对牵引车的方向及油门控制。The motion controller is used to control the wheel holding mechanism to approach the front landing gear quickly and then slowly, as well as to control the direction and throttle of the tractor during the towing taxiing process.

在本发明的上下文中,计算机可读存储介质可以是有形的介质,其可以包含或存储以供指令执行系统、装置或设备使用或与指令执行系统、装置或设备结合地使用的计算机程序。计算机可读存储介质可以包括但不限于电子的、磁性的、光学的、电磁的、红外的、或半导体系统、装置或设备,或者上述内容的任何合适组合。备选地,计算机可读存储介质可以是机器可读信号介质。机器可读存储介质的更具体示例会包括基于一个或多个线的电气连接、便携式计算机盘、硬盘、随机存取存储器(RAM)、只读存储器(ROM)、可擦除可编程只读存储器(EPROM或快闪存储器)、光纤、便捷式紧凑盘只读存储器(CD-ROM)、光学储存设备、磁储存设备、或上述内容的任何合适组合。In the context of the present invention, a computer-readable storage medium may be a tangible medium that may contain or store a computer program for use by or in conjunction with an instruction execution system, device, or equipment. A computer-readable storage medium may include, but is not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices, or equipment, or any suitable combination of the foregoing. Alternatively, a computer-readable storage medium may be a machine-readable signal medium. A more specific example of a machine-readable storage medium may include an electrical connection based on one or more lines, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.

上述具体实施方式,并不构成对本发明保护范围的限制。本领域技术人员应该明白的是,根据设计要求和其他因素,可以进行各种修改、组合、子组合和替代。任何在本发明的精神和原则之内所作的修改、等同替换和改进等,均应包含在本发明保护范围之内。The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims (10)

1.一种民航飞机的牵引滑行控制方法,其特征在于,包括:1. A method for controlling the traction taxiing of a civil aircraft, characterized by comprising: 控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径;Control the wheel-holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft in a fast-first-and-slow-later manner, and after docking, plan a global planning path from the taxiing start point to the taxiing end point; 采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行;Using a pre-established traction and taxiing controller, the global planning path is tracked and controlled so that the tractor can smoothly tow the target aircraft for taxiing; 在牵引滑行过程中,如果检测到滑行路径前方出现障碍物,则检测是否能够以减速慢行的方式避让该障碍物;During the traction sliding process, if an obstacle is detected in front of the sliding path, it is detected whether the obstacle can be avoided by slowing down; 若否,则根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程;If not, after replanning a new global planning path according to the current sliding position point, obstacle information and sliding target point, return to execute the operation of using the pre-established traction sliding controller to perform trajectory tracking control on the global planning path until the entire traction process is completed; 若是,则执行减速避让策略后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程,其中,所述减速避让策略包括该牵引车需要在何时以何种减速方式进行减速处理,所述减速方式包括刹车时间或者油门量设置值;If yes, after executing the deceleration avoidance strategy, the process returns to executing the operation of using the pre-established traction sliding controller to perform trajectory tracking control on the global planning path until the entire traction process is completed, wherein the deceleration avoidance strategy includes when and in what deceleration mode the tractor needs to decelerate, and the deceleration mode includes the braking time or the throttle setting value; 其中,检测是否能够以减速慢行的方式避让该障碍物包括:Among them, detecting whether the obstacle can be avoided by slowing down includes: 将所述障碍物的当前位置点、运动速度和运动方向,牵引滑行系统的运动速度、当前位置点、减速性能参数以及全局规划路线输入至预先训练的神经网络模型中,由所述神经网络模型输出是否能够以减速慢行的方式避让该障碍物的识别结果;The current position, speed and direction of the obstacle, the speed, current position, deceleration performance parameters and global planning route of the traction sliding system are input into a pre-trained neural network model, and the neural network model outputs an identification result of whether the obstacle can be avoided by slowing down; 所述方法还包括:The method further comprises: 如果所述识别结果为不能以减速慢行的方式避让该障碍物,则计算该障碍物避让该牵引滑行系统的第一避让成本,以及该牵引滑行系统避让该障碍物的第二避让成本,如果该第二避让成本远大于第一避让成本,则请求空管中心提示该障碍物进行避让,并同时执行减速避让策略。If the recognition result is that the obstacle cannot be avoided by slowing down, the first avoidance cost of the traction taxiing system to avoid the obstacle and the second avoidance cost of the traction taxiing system to avoid the obstacle are calculated. If the second avoidance cost is much greater than the first avoidance cost, the air traffic control center is requested to prompt the obstacle to be avoided and at the same time execute the deceleration avoidance strategy. 2.根据权利要求1所述的方法,其特征在于,控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,包括:2. The method according to claim 1 is characterized in that controlling the wheel holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft in a manner of first fast and then slow, comprises: 通过牵引车上设置的远距离视觉相机实时采集目标飞机的第一前起落架图像,并根据第一前起落架图像,获取牵引车与前起落架间的第一实时距离和相对位置关系;The first front landing gear image of the target aircraft is collected in real time by a long-distance visual camera arranged on the tractor, and the first real-time distance and relative position relationship between the tractor and the front landing gear are obtained according to the first front landing gear image; 如果第一实时距离大于距离阈值,则根据相对位置关系,控制牵引车上的抱轮机构以第一速度朝向该前起落架进行移动;If the first real-time distance is greater than the distance threshold, controlling the wheel holding mechanism on the tractor to move toward the front landing gear at a first speed according to the relative position relationship; 如果第一实时距离小于或者等于距离阈值,则通过牵引车上设置的近距离视觉相机实时采集目标飞机的第二前起落架图像,并根据第二前起落架图像,计算牵引车相对于前起落架的目标偏角;If the first real-time distance is less than or equal to the distance threshold, a close-range visual camera provided on the tractor is used to collect a second front landing gear image of the target aircraft in real time, and a target deflection angle of the tractor relative to the front landing gear is calculated based on the second front landing gear image; 控制牵引车上的抱轮机构按照所述目标偏角,以第二速度靠近并准确对接目标飞机的前起落架,其中,第一速度大于第二速度。The wheel-holding mechanism on the tractor is controlled to approach and accurately dock with the front landing gear of the target aircraft at a second speed according to the target deflection angle, wherein the first speed is greater than the second speed. 3.根据权利要求2所述的方法,其特征在于,根据第二前起落架图像,计算牵引车相对于前起落架的目标偏角,包括:3. The method according to claim 2, characterized in that calculating the target deflection angle of the tractor relative to the front landing gear according to the second front landing gear image comprises: 在第二前起落架图像中识别前起落架轮廓,并根据所述前起落架轮廓的特征,识别牵引车相对于前起落架的偏转类型为左偏或者右偏;recognizing a front landing gear profile in the second front landing gear image, and recognizing, based on features of the front landing gear profile, whether the deflection type of the tractor relative to the front landing gear is left deflection or right deflection; 根据所述前起落架轮廓,获取飞机前轮的横向最大尺寸w’、纵向最大尺寸d以及前轮宽度b;According to the front landing gear profile, obtain the maximum lateral dimension w', the maximum longitudinal dimension d and the width b of the front wheel of the aircraft; 根据目标飞机的机轮轮胎型号,确定飞机前轮的轮胎直径d1、轮胎宽度b1以及轮胎圆弧半径R1之间的固定比例关系;According to the wheel and tire model of the target aircraft, a fixed proportional relationship between the tire diameter d1, the tire width b1 and the tire arc radius R1 of the front wheel of the aircraft is determined; 根据飞机前轮的横向最大尺寸w’、纵向最大尺寸d、前轮宽度b以及所述固定比例关系,计算牵引车相对于前起落架的偏转角度;Calculate the deflection angle of the tractor relative to the front landing gear according to the maximum lateral dimension w', the maximum longitudinal dimension d, the width b of the front wheel of the aircraft and the fixed proportional relationship; 将所述偏转类型和所述偏转角度的组合,作为牵引车相对于前起落架的目标偏角。A combination of the deflection type and the deflection angle is used as a target deflection angle of the tractor relative to the front landing gear. 4.根据权利要求3所述的方法,其特征在于,根据飞机前轮的横向最大尺寸w’、纵向最大尺寸d、前轮宽度b以及所述固定比例关系,计算牵引车相对于前起落架的偏转角度,包括:4. The method according to claim 3, characterized in that the deflection angle of the tractor relative to the front landing gear is calculated according to the maximum lateral dimension w', the maximum longitudinal dimension d, the front wheel width b and the fixed proportional relationship of the front wheel of the aircraft, comprising: 根据所述固定比例关系,获取第一比例因子,以及第二比例因子According to the fixed proportional relationship, a first proportional factor is obtained. , and the second scaling factor ; 根据第一比例因子和第二比例因子,计算得到偏转调整因子According to the first scale factor and the second scale factor , calculate the deflection adjustment factor ; 其中,in, ; 根据飞机前轮的横向最大尺寸w’、纵向最大尺寸d、前轮宽度b、第一比例因子、第二比例因子以及偏转调整因子,计算牵引车相对于前起落架的偏转角度According to the maximum lateral dimension w', maximum longitudinal dimension d, width b, and first proportional factor of the aircraft's front wheel , Second scale factor and the deflection adjustment factor , calculate the deflection angle of the tractor relative to the front landing gear ; 其中,in, . 5.根据权利要求1所述的方法,其特征在于,规划由滑行起点至滑行终点的全局规划路径,包括:5. The method according to claim 1, wherein planning a global planning path from a taxiing start point to a taxiing end point comprises: 通过牵引车上的定位模块确定滑行起点,并在接收的空管指令中识别滑行终点;Determine the taxiing start point through the positioning module on the tractor, and identify the taxiing end point in the received air traffic control instructions; 使用作为启发函数,结合滑行起点、滑行终点以及机场地图,规划出由滑行起点至滑行终点的全局最优路径,作为全局规划路径;use As a heuristic function, the global optimal path from the taxi start point to the taxi end point is planned in combination with the taxi start point, the taxi end point and the airport map as the global planning path; 其中,为启发因子,的取值由机场地图的大小确定;当前节点与起点构成的矢量跟终点和当前节点构成的矢量之间的夹角;是前一个节点与当前节点构成的矢量跟下一个节点和当前节点构成的矢量之间的夹角;为安全因子,的取值由的大小确定,均为调整参数,的取值由的大小确定,的取值由的大小确定。in, As the inspiration factor, The value of is determined by the size of the airport map; The angle between the vector formed by the current node and the starting point and the vector formed by the end point and the current node; It is the angle between the vector formed by the previous node and the current node and the vector formed by the next node and the current node; is the safety factor, The value of The size is determined by , are adjustment parameters, The value of The size is determined by The value of The size is determined. 6.根据权利要求1所述的方法,其特征在于,采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,包括:6. The method according to claim 1, characterized in that the pre-established traction sliding controller is used to perform trajectory tracking control on the global planning path, comprising: 在大地坐标系XOY中,定义牵引车前轴中心为A点,后轴中心为B点,牵引车前后轮距为L1,牵引车与目标飞机的铰接点为H点,牵引车的前轮转角为,目标飞机两个主起落架连线的中点为C点,C点到铰接点的距离为L2,牵引车后轴中心B点到铰接点H点的距离为La,牵引车的横摆角为,目标飞机的横摆角为,牵引车和目标飞机铰接角为In the geodetic coordinate system XOY, the center of the front axle of the tractor is defined as point A, the center of the rear axle is defined as point B, the front and rear wheelbase of the tractor is defined as L1, the hinge point between the tractor and the target aircraft is defined as point H, and the front wheel turning angle of the tractor is defined as The midpoint of the line connecting the two main landing gears of the target aircraft is point C, the distance from point C to the hinge point is L2, the distance from the rear axle center point B to the hinge point H is La, and the yaw angle of the tractor is , the yaw angle of the target aircraft is , the articulation angle between the tractor and the target aircraft is ; 为状态量,为控制量建立飞机牵引模型:by is the state quantity, Model the aircraft traction for the control quantity: ;其中,表对Z取导数; ;in, The table takes the derivative with respect to Z; 根据所述飞机牵引模型,构建得到四自由度线性误差模型的状态空间表达式:;其中,According to the aircraft traction model, the state space expression of the four-degree-of-freedom linear error model is constructed: ;in, ; ; ; ; ; ; ; 对所述四自由度线性误差模型的状态空间表达式进行离散化处理,在采样周期T下得到离散化模型为:The state space expression of the four-degree-of-freedom linear error model is discretized, and the discretized model is obtained under the sampling period T: ; 其中,in, , , ; 构建每一个控制周期内的控制增量,并将离散的状态量和控制增量,组合成新的状态量,得到新的状态空间方程为:Constructing control increments within each control cycle , and the discrete state quantity and control increment , combined into a new state quantity , the new state space equation is: ; 其中,in, , , ; 令Np为预测时域步长,Nc为控制时域步长,且NcNp,构建得到目标成本函数为:Let Np be the prediction time domain step size, Nc be the control time domain step size, and Nc Np, the target cost function is constructed as: ; 其中,是k时刻下预测的k+i时刻的参考值;是k时刻下输出的k+i时刻的实际值;是k时刻下计算的k+i时刻的控制增量;为松弛因子的权重系数,取值为1;in, It is the reference value at time k+i predicted at time k; is the actual value of the output at time k+i at time k; is the control increment at time k+i calculated at time k; is the weight coefficient of the relaxation factor, which takes a value of 1; 其中,in, ; ; 为预设的松弛因子;其中,Q、R均为权重矩阵,以及均为权重矩阵中的系数,数值均为1; ; is the preset relaxation factor; where Q and R are weight matrices, , , , , as well as They are all coefficients in the weight matrix, and their values are all 1; 基于目标成本函数和如下两个约束条件:Based on the target cost function and the following two constraints: ,以及,构建得到牵引滑行控制器; ,as well as , a traction and sliding controller is constructed; 通过所述牵引滑行控制器,基于所述两个约束条件,在每个控制周期内对目标成本函数求解,得到如下最优控制增量序列:Through the traction sliding controller, based on the two constraints, the target cost function is solved in each control cycle to obtain the following optimal control increment sequence: ; 通过所述牵引滑行控制器,将该最优控制增量序列中的第一项控制增量与上一时刻的控制量相加作为当前时刻输入的控制量,在下一控制周期中重复上述过程,进行在线滚动优化,得出每个时刻的实际控制量,最终实现对该系统的轨迹跟踪控制。Through the traction sliding controller, the first control increment in the optimal control increment sequence is added to the control amount at the previous moment as the control amount input at the current moment. The above process is repeated in the next control cycle, and online rolling optimization is performed to obtain the actual control amount at each moment, and finally the trajectory tracking control of the system is realized. 7.根据权利要求1所述的方法,其特征在于,检测是否能够以减速慢行的方式避让该障碍物,包括:7. The method according to claim 1, characterized in that detecting whether the obstacle can be avoided by slowing down comprises: 获取所述障碍物的移动速度以及当前的牵引滑行速度,并计算所述移动速度与所述牵引滑行速度的速度和值;Obtaining the moving speed of the obstacle and the current traction sliding speed, and calculating the speed sum of the moving speed and the traction sliding speed; 如果所述速度和值未超过预设的速度门限阈值,则确定能够以减速慢行的方式避让该障碍物;否则,确定不能以减速慢行的方式避让该障碍物。If the speed sum value does not exceed the preset speed threshold, it is determined that the obstacle can be avoided by slowing down; otherwise, it is determined that the obstacle cannot be avoided by slowing down. 8.一种民航飞机的牵引滑行控制装置,其特征在于,包括:8. A traction taxiing control device for a civil aircraft, characterized by comprising: 全局规划路径规划模块,用于控制牵引车上的抱轮机构以先快后慢的方式,靠近并准确对接目标飞机的前起落架,并在对接完成后,规划由滑行起点至滑行终点的全局规划路径;The global planning path planning module is used to control the wheel holding mechanism on the tractor to approach and accurately dock with the front landing gear of the target aircraft in a fast-first-then-slow manner, and after the docking is completed, plan the global planning path from the taxiing start point to the taxiing end point; 轨迹跟踪控制模块,用于采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制,以使牵引车平稳的牵引目标飞机进行滑行;A trajectory tracking control module is used to use a pre-established traction and taxiing controller to perform trajectory tracking control on the global planning path so that the tractor can stably tow the target aircraft for taxiing; 避让检测模块,用于在牵引滑行过程中,如果检测到滑行路径前方出现障碍物,则检测是否能够以减速慢行的方式避让该障碍物;The avoidance detection module is used to detect whether the obstacle can be avoided by slowing down if an obstacle is detected in front of the sliding path during the traction sliding process; 路径重规划模块,用于若否,则根据当前滑行位置点、障碍物信息和滑行目标点,重新规划新的全局规划路径后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程;A path re-planning module, which is used to, if not, re-plan a new global planning path according to the current sliding position point, obstacle information and sliding target point, and then return to execute the operation of using the pre-established traction sliding controller to perform trajectory tracking control on the global planning path until the entire traction process is completed; 减速避让模块,用于若是,则执行减速避让策略后,返回执行采用预先建立的牵引滑行控制器,对所述全局规划路径进行轨迹跟踪控制的操作,直至完成整个牵引过程,其中,所述减速避让策略包括该牵引车需要在何时以何种减速方式进行减速处理,所述减速方式包括刹车时间或者油门量设置值;a deceleration avoidance module, for returning to the operation of using a pre-established traction and sliding controller to perform trajectory tracking control on the global planning path after executing the deceleration avoidance strategy, until the entire traction process is completed, wherein the deceleration avoidance strategy includes when and in what deceleration mode the tractor needs to decelerate, and the deceleration mode includes a braking time or a throttle setting value; 其中,避让检测模块具体用于:将所述障碍物的当前位置点、运动速度和运动方向,牵引滑行系统的运动速度、当前位置点、减速性能参数以及全局规划路线输入至预先训练的神经网络模型中,由所述神经网络模型输出是否能够以减速慢行的方式避让该障碍物的识别结果;The avoidance detection module is specifically used to: input the current position point, movement speed and movement direction of the obstacle, the movement speed, current position point, deceleration performance parameters and global planning route of the traction sliding system into a pre-trained neural network model, and the neural network model outputs the recognition result of whether the obstacle can be avoided by slowing down; 所述装置还包括:障碍物避让模块,用于:如果所述识别结果为不能以减速慢行的方式避让该障碍物,则计算该障碍物避让该牵引滑行系统的第一避让成本,以及该牵引滑行系统避让该障碍物的第二避让成本,如果该第二避让成本远大于第一避让成本,则请求空管中心提示该障碍物进行避让,并同时执行减速避让策略。The device also includes: an obstacle avoidance module, which is used to: if the recognition result is that the obstacle cannot be avoided by slowing down, calculate the first avoidance cost of the traction taxiing system for avoiding the obstacle, and the second avoidance cost of the traction taxiing system for avoiding the obstacle; if the second avoidance cost is much greater than the first avoidance cost, request the air traffic control center to prompt the obstacle to be avoided, and simultaneously execute the deceleration avoidance strategy. 9. 一种牵引车,其特征在于,所述牵引车包括:9. A tractor, characterized in that the tractor comprises: 至少一个处理器;以及at least one processor; and 与所述至少一个处理器通信连接的存储器;其中,a memory communicatively connected to the at least one processor; wherein, 所述存储器存储有可被所述至少一个处理器执行的计算机程序,所述计算机程序被所述至少一个处理器执行,以使所述至少一个处理器能够执行权利要求1-7中任一项所述的民航飞机的牵引滑行控制方法。The memory stores a computer program executable by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the traction taxiing control method for a civil aircraft according to any one of claims 1 to 7. 10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使处理器执行时实现权利要求1-7中任一项所述的民航飞机的牵引滑行控制方法。10. A computer-readable storage medium, characterized in that the computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the traction taxiing control method for a civil aircraft according to any one of claims 1 to 7 when executed.
CN202310552995.1A 2023-05-17 2023-05-17 Traction sliding control method and device for civil aircraft, tractor and storage medium Active CN116300971B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310552995.1A CN116300971B (en) 2023-05-17 2023-05-17 Traction sliding control method and device for civil aircraft, tractor and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310552995.1A CN116300971B (en) 2023-05-17 2023-05-17 Traction sliding control method and device for civil aircraft, tractor and storage medium

Publications (2)

Publication Number Publication Date
CN116300971A CN116300971A (en) 2023-06-23
CN116300971B true CN116300971B (en) 2023-09-01

Family

ID=86789117

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310552995.1A Active CN116300971B (en) 2023-05-17 2023-05-17 Traction sliding control method and device for civil aircraft, tractor and storage medium

Country Status (1)

Country Link
CN (1) CN116300971B (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116576865B (en) * 2023-07-07 2023-10-17 民航成都电子技术有限责任公司 Flight area path planning method, device, equipment and medium
CN117894213B (en) * 2024-01-16 2024-07-05 上海明晖航空科技有限公司 Aircraft towing anti-collision warning communication system and method based on virtual protection network

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016015546A1 (en) * 2014-08-01 2016-02-04 深圳中集天达空港设备有限公司 System and method for aircraft docking guidance and aircraft type identification
CN109292107A (en) * 2018-09-05 2019-02-01 庆安集团有限公司 A kind of intelligent trailer system and traction method for airport
CN109960880A (en) * 2019-03-26 2019-07-02 上海交通大学 An obstacle avoidance path planning method for industrial robots based on machine learning
CN111409630A (en) * 2020-04-13 2020-07-14 新石器慧通(北京)科技有限公司 Vehicle obstacle avoidance method, system and device
CN113791621A (en) * 2021-09-15 2021-12-14 北京航空航天大学 Method and system for docking automatic driving tractor and airplane
CN115309169A (en) * 2022-10-11 2022-11-08 天地科技股份有限公司 Underground unmanned vehicle control method and device

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016015546A1 (en) * 2014-08-01 2016-02-04 深圳中集天达空港设备有限公司 System and method for aircraft docking guidance and aircraft type identification
CN109292107A (en) * 2018-09-05 2019-02-01 庆安集团有限公司 A kind of intelligent trailer system and traction method for airport
CN109960880A (en) * 2019-03-26 2019-07-02 上海交通大学 An obstacle avoidance path planning method for industrial robots based on machine learning
CN111409630A (en) * 2020-04-13 2020-07-14 新石器慧通(北京)科技有限公司 Vehicle obstacle avoidance method, system and device
CN113791621A (en) * 2021-09-15 2021-12-14 北京航空航天大学 Method and system for docking automatic driving tractor and airplane
CN115309169A (en) * 2022-10-11 2022-11-08 天地科技股份有限公司 Underground unmanned vehicle control method and device

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
Obstacle avoidance of redundant manipulators using neural networks based reinforcement learning;Mihai Duguleana;Robotics and computer-integrated manufacturing;第132-146页 *

Also Published As

Publication number Publication date
CN116300971A (en) 2023-06-23

Similar Documents

Publication Publication Date Title
CN116300971B (en) Traction sliding control method and device for civil aircraft, tractor and storage medium
JP6969962B2 (en) Map information providing system for vehicle driving support and / or driving control
RU2737874C1 (en) Method of storing information of vehicle, method of controlling movement of vehicle and device for storing information of vehicle
US10928827B2 (en) Systems and methods for generating a path for a vehicle
CN105292116B (en) The lane changing path planning algorithm of automatic driving vehicle
US9499197B2 (en) System and method for vehicle steering control
RU2692097C1 (en) Device and method for setting a position for stopping a vehicle
CN109426261B (en) Automatic driving device
CN113494923B (en) Path track planning method and system based on differential dynamic planning
CN110361013A (en) A kind of path planning system and method for auto model
KR102178992B1 (en) Method and Apparatus for Planning Car Motion
CN105752154B (en) Vehicle steering control system and method
EP4222035A1 (en) Methods and systems for performing outlet inference by an autonomous vehicle to determine feasible paths through an intersection
US20210200231A1 (en) Speed planning guidance line for mild slow down
US20230415739A1 (en) Systems and methods for controlling longitudinal acceleration based on lateral objects
US20230415736A1 (en) Systems and methods for controlling longitudinal acceleration based on lateral objects
CN116135639A (en) Vehicle path adjustment
CN118192617B (en) Obstacle avoidance planning control method and system for unmanned vehicle
CN211427151U (en) Automatic guide system applied to unmanned freight vehicle in closed field
US20230415781A1 (en) Systems and methods for controlling longitudinal acceleration based on lateral objects
CN115344049B (en) Automatic path planning and vehicle control method and device for passenger boarding vehicle
US20240192369A1 (en) Systems and methods for infant track association with radar detections for velocity transfer
JP7552918B2 (en) Vehicle control method and vehicle control device
JP7571642B2 (en) Travel route estimation method and travel route estimation device
CN115743183A (en) Automatic driving control method, device, equipment, medium and vehicle

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20230623

Assignee: Beijing Qiwei Digital Technology Co.,Ltd.

Assignor: CIVIL AVIATION University OF CHINA

Contract record no.: X2024980009538

Denomination of invention: Traction and taxiing control methods, devices, towing vehicles, and storage media for civil aviation aircraft

Granted publication date: 20230901

License type: Common License

Record date: 20240711

EE01 Entry into force of recordation of patent licensing contract