CN108513644A - 无人机避障方法及无人机 - Google Patents

无人机避障方法及无人机 Download PDF

Info

Publication number
CN108513644A
CN108513644A CN201780005013.XA CN201780005013A CN108513644A CN 108513644 A CN108513644 A CN 108513644A CN 201780005013 A CN201780005013 A CN 201780005013A CN 108513644 A CN108513644 A CN 108513644A
Authority
CN
China
Prior art keywords
flight path
barrier
metric data
flight
unmanned plane
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.)
Pending
Application number
CN201780005013.XA
Other languages
English (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.)
SZ DJI Technology Co Ltd
Shenzhen Dajiang Innovations Technology Co Ltd
Original Assignee
Shenzhen Dajiang Innovations Technology Co Ltd
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 Shenzhen Dajiang Innovations Technology Co Ltd filed Critical Shenzhen Dajiang Innovations Technology Co Ltd
Publication of CN108513644A publication Critical patent/CN108513644A/zh
Pending legal-status Critical Current

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/933—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of aircraft or spacecraft
    • G01S13/935—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of aircraft or spacecraft for terrain-avoidance
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10—Simultaneous control of position or course in three dimensions
    • G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/106—Change initiated in response to external conditions, e.g. avoidance of elevated terrain or of no-fly zones
    • G05D1/1064—Change initiated in response to external conditions, e.g. avoidance of elevated terrain or of no-fly zones specially adapted for avoiding collisions with other aircraft
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10—Simultaneous control of position or course in three dimensions
    • G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64C—AEROPLANES; HELICOPTERS
    • B64C1/00—Fuselages; Constructional features common to fuselages, wings, stabilising surfaces or the like
    • B64C1/36—Fuselages; Constructional features common to fuselages, wings, stabilising surfaces or the like adapted to receive antennas or radomes
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64C—AEROPLANES; HELICOPTERS
    • B64C39/00—Aircraft not otherwise provided for
    • B64C39/02—Aircraft not otherwise provided for characterised by special use
    • B64C39/024—Aircraft not otherwise provided for characterised by special use of the remote controlled vehicle type, i.e. RPV
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/35—Details of non-pulse systems
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0055—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots with safety arrangements
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10—Simultaneous control of position or course in three dimensions
    • G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/102—Simultaneous control of position or course in three dimensions specially adapted for aircraft specially adapted for vertical take-off of aircraft
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U10/00—Type of UAV
    • B64U10/10—Rotorcrafts
    • B64U10/13—Flying platforms
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U10/00—Type of UAV
    • B64U10/10—Rotorcrafts
    • B64U10/13—Flying platforms
    • B64U10/16—Flying platforms with five or more distinct rotor axes, e.g. octocopters
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U2201/00—UAVs characterised by their flight controls
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U2201/00—UAVs characterised by their flight controls
    • B64U2201/10—UAVs characterised by their flight controls autonomous, i.e. by navigating independently from ground or air stations, e.g. by using inertial navigation systems [INS]
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/06—Systems determining position data of a target
    • G01S13/08—Systems for measuring distance only
    • G01S13/32—Systems for measuring distance only using transmission of continuous waves, whether amplitude-, frequency-, or phase-modulated, or unmodulated
    • G01S13/34—Systems for measuring distance only using transmission of continuous waves, whether amplitude-, frequency-, or phase-modulated, or unmodulated using transmission of continuous, frequency-modulated waves while heterodyning the received signal, or a signal derived therefrom, with a locally-generated signal related to the contemporaneously transmitted signal
    • G01S13/343—Systems for measuring distance only using transmission of continuous waves, whether amplitude-, frequency-, or phase-modulated, or unmodulated using transmission of continuous, frequency-modulated waves while heterodyning the received signal, or a signal derived therefrom, with a locally-generated signal related to the contemporaneously transmitted signal using sawtooth modulation
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/933—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of aircraft or spacecraft
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/03—Details of HF subsystems specially adapted therefor, e.g. common to transmitter and receiver

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Mechanical Engineering (AREA)
  • Traffic Control Systems (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

一种无人机避障方法及无人机。该方法包括：根据雷达输出的量测数据，确定障碍物相对无人机的飞行航迹；根据所述飞行航迹，对所述障碍物进行避障处理。本发明解决了障碍物误判的问题。

Description

无人机避障方法及无人机
技术领域
本发明涉及飞行技术领域，尤其涉及一种无人机避障方法及无人机。
背景技术
通常，无人机在作业的过程中，飞行走廊上的山丘、树木等自然物体及电力线、电线杆、建筑物等都会对无人机的安全飞行带来极大隐患。
现有技术中，主要采用超声波、双目视觉、激光等光学镜头对外部环境进行感知，来实现无人机的避障。但是，光学镜头对光照、气候条件等外部条件比较敏感，而雷达具有对外部条件不太明感，即使在雨、雾、尘等恶劣气候下雷达仍然有效以及全天候性等特点，因此也可以使用雷达进行障碍物感知，根据雷达感知到的障碍物，实现无人机的避障。
但是，现有技术中，在使用雷达进行障碍物感知的无人机作业的过程中，存在障碍物误判的问题。
发明内容
本发明提供一种无人机避障方法及无人机，用于解决现有技术中在使用雷达进行障碍物感知的无人机作业的过程中，存在的障碍物误判的问题。
第一方面，本发明提供一种无人机避障方法，包括：
根据雷达输出的量测数据，确定障碍物相对无人机的飞行航迹；
根据所述飞行航迹，对所述障碍物进行避障处理。
第二方面，本发明提供一种无人机，其包括机架，设置于所述机架的控制器，所述农业无人机还包括：安装于所述机架上或所述机架的负载上的雷达；
所述雷达，用于获取量测数据；
所述控制器，与所述雷达通信连接，用于根据所述雷达输出的量测数据，确定障碍物相对无人机的飞行航迹，并根据所述飞行航迹，对所述障碍物进行避障处理。
本发明提供的无人机避障方法及无人机，通过根据雷达输出的量测数据，确定障碍物相对无人机的飞行航迹，根据所述飞行航迹，对所述障碍物进行避障处理，使得即使雷达基于杂波输出了量测数据，但是由于杂波并不存在对应的障碍物，因此根据雷达基于杂波输出的量测数据，并不能确定出障碍物相对无人机的飞行航迹，从而在根据所述飞行航迹，对所述障碍物进行避障处理时，避免了根据雷达基于杂波输出了量测数据进行障碍物避障，解决了障碍物误判的问题。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍，显而易见地，下面描述中的附图是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为本发明无人机避障方法实施例一的流程图
图2为本发明雷达的结构示意图；
图3为本发明无人机避障方法实施例二的流程图；
图4为本发明回波与第一关联波门的关系示意图；
图5为本发明雷达、障碍物以及笛卡尔坐标系的关系示意图；
图6为本发明无人机避障方法实施例三的流程图；
图7为本发明生成候选航迹的示意图；
图8为本发明无人机避障方法实施例四的流程图；
图9为本发明确定满足预设条件的量测数据的示意图；
图10为本发明无人机的结构示意图；
图11为本发明无人机的实体结构图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
本发明应用于无人机，所述无人机上安装有雷达，所述雷达可以对障碍物进行探测，输出基于对障碍物的探测所获得的量测数据。其中，所述量测数据可能是雷达在探测到障碍物后输出的量测数据，或者，也可能雷达检测到杂波，例如地杂波等，而并非探测到障碍物所输出的量测数据。本发明，用于解决现有技术中，在使用雷达进行障碍物感知的无人机作业的过程中，存在障碍物误判的问题。
图1为本发明无人机避障方法实施例一的流程图，本实施例的执行主体可以为所述无人机的控制器。如图1所示，本实施例的方法可以包括：
步骤101、根据雷达输出的量测数据，确定障碍物相对无人机的飞行航迹。
本步骤中，所述量测数据具体可以包括障碍物的速度、距离、方位角中的一个或多个。可选的，根据雷达的天线进行划分，所述雷达具体可以指其天线为定向天线的雷达，或者也可以是指其天线为旋转天线的雷达。若所述雷达具体指其天线为定向天线的雷达，则所述雷达的个数可以为多个，该多个雷达分别用于探测所述无人机不同方位的障碍物。例如6个雷达，分别朝向所述无人机的正前方、前下方、正下方、正后方、后下方、正上方发射雷达波。若所述雷达具体指其天线为旋转天线的雷达，则所述雷达可以连续转动，本实施例的方法还可以包括：控制所述雷达连续转动，获取所述雷达在连续转动时的量测数据。可选的，在所述雷达连续转动时，所述雷达至少朝向所述无人机的正前方、前下方、正下方、正后方、后下方、正上方发射雷达波。进一步可选的，所述雷达的转轴方向可以平行于所述无人机的俯仰轴。
需要说明的是，对于所述雷达在所述无人机上安装的位置，可以根据需求灵活设计，本发明对此并不作限定。所述雷达波的发射方向，可以根据需求灵活设计，本发明对此并不作限定。
可选的，按照所述雷达的探测原理进行划分，所述雷达可以为连续波雷达或者脉冲雷达。如图2所示，以所述雷达为调频连续波(FMCW，Frequency Modulated ContinuousWave)雷达为例，其主要包括信号处理模块和射频前端。其中，信号处理模块包括控制器(例如，数字信号处理(DSP，Digital Signal Process)芯片等)，信号处理模块主要用于产生调制信号，并根据A/D采集的差频信号确定距离。信号处理模块还可以包括例如闪存(FLASH)、随机存取存储器(RAM，Random-Access Memory)、只读存储器(ROM，read-only memory)等用于存储数据的存储器。射频前端采用一发双收，即包括一个发射通路和两个接收通路。对于发射通路，通过压控振荡器(VCO，Voltage Controlled Oscillator)对信号处理模块产生的调制波形进行调压以产生线性调频信号(线性调频信号的发射频率可以在24GHz)，并在对线性调频信号通过功率放大器(PA，Power Amplifier)进行放大后，通过发射天线TX发出(这里，发射天线TX发出的即为雷达波)。发射天线发出的雷达波经目标反射后的回波被接收通路通过接收天线RX1和RX2接收，对接收到的信号通过低噪声放大器(LNA，Low NoiseAmplifier)进行低噪声放大，并对进行低噪声放大后的信号进行混频(其中，混频具体是将雷达波对应的信号与回波对应的信号进行混频)来得到差频信号。进一步的，该差频信号经过A/D采集进入信号处理模块后，由信号处理模块根据该差频信号确定上述量测数据。其中，上述接收通路和发射通路还分别可以包括功率分配器(简称功分)。上述接收天线和发射天线具体可以采用微带天线。
需要说明是，对于运动状态为运动的障碍物或者运动状态为静止的障碍物，以飞行的无人机为参考，相对于无人机均存在飞行航迹。因此，即使雷达基于杂波输出了量测数据，但是由于杂波并不存在对应的障碍物，因此根据雷达基于地杂波输出的量测数据，并不能确定出障碍物相对无人机的飞行航迹。
需要说明的是，对于确定障碍物相对无人机的飞行航迹的具体实现方式，本发明并不作限定。例如，当雷达两次探测输出的两个测量数据之间的关系满足预设关系时，可以这两个测量数据分别作为航点，并将这两个航点组成的航线，确定为障碍物相对于无人机的飞行航线。其中，所述飞行航迹可以包括至少两个航点，每个航点的信息可以包括：位置、速度、角度等中的一个或多个。
步骤102、根据所述飞行航迹，对所述障碍物进行避障处理。
本步骤中，具体可以根据所述障碍物相对无人机的飞行航迹，调整所述无人机的飞行航线或者飞行高度，以对所述障碍物进行避障处理。可选的，可以根据所述障碍物相对于无人机的飞行航迹，控制所述无人机的飞行姿态，以对所述障碍物进行避障处理。所述飞行姿态可以包括俯冲、爬升、加速、减速、横滚等。需要说明的是，对于根据所述飞行航迹对所述障碍物进行避障处理的具体实现方式，本发明并不作限定，本领域技术人员可以根据实际需要设计相应的避障策略进行避障。
本实施例中，通过根据雷达输出的量测数据，确定障碍物相对无人机的飞行航迹，根据所述飞行航迹，对所述障碍物进行避障处理，使得即使雷达基于杂波输出了量测数据，但是由于杂波并不存在对应的障碍物，因此根据雷达基于杂波输出的量测数据，并不能确定出障碍物相对无人机的飞行航迹，从而在根据所述飞行航迹，对所述障碍物进行避障处理时，避免了根据雷达基于杂波输出的量测数据进行障碍物避障，解决了障碍物误判的问题。
图3为本发明无人机避障方法实施例二的流程图。本实施例在图1所示实施例的基础上主要描述了根据雷达输出的量测数据，确定障碍物相对无人机的飞行航迹一种具体的实现方式。如图3所示，本实施例的方法可以包括：
步骤301、根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物当前时刻的第一预测航点。
本步骤中，所述障碍物当前时刻的预测航点，即第一预测航点，是基于之前时刻所述障碍物相对于无人机的飞行航迹确定的。由于之前时刻所述障碍物相对于所述无人机的飞行航迹，可以体现出所述障碍物相对于所述无人机的飞行规律，因此基于之前时刻所述障碍物相对于无人机的飞行航迹可以确定出所述第一预测航点。需要说明的是，对于根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物当前时刻的第一预测航点的具体实现方式，本发明并不作限定。例如，可以根据之前时刻所述障碍物相对于无人机的飞行航迹，确定所述障碍物的运动规律(例如，匀速直线运动规律，匀加速直线运动规律等)，并根据所述障碍物的运动规律确定所述第一预测航点。
可选的，步骤301具体可以包括：根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物的运动模型；根据所述运动模型，确定当前时刻所述障碍物的第一预测航点。其中，所述运动模型可以将当前时刻所述障碍物的第一预测航点表示为之前时刻(例如，前一时刻)航点的函数。在选择运动模型时，可以根据所述障碍物的运动状态以及所述雷达的实时性来综合考虑。例如，当所述障碍物的运动状态为静止时，运动模型具体可以为常速模型，该常速模型可以实时获取无人机的飞行速度信息。具体的，可以将之前时刻所述障碍物相对于所述无人机的飞行航迹中航点的位置、速度、角度等中的一个或多个作为状态变量，确定所述障碍物的运动模型。在航点的位置、速度、角度等中选择状态变量时，可以依据维数最少且能全面反映动态特性的一组变量的原则，防止计算量随状态变量数目的增加而增加。可选的，所述状态变量可以包括速度。
可选的，所述根据所述运动模型，确定当前时刻所述障碍物的第一预测航点，具体可以包括：根据所述运动模型确定当前时刻所述障碍物的估计航点；根据前一时刻的航点以及所述估计航点，基于卡尔曼算法，确定当前时刻所述障碍物的第一预测航点。具体的，可以将所述前一时刻的航点作为卡尔曼滤波算法中的测量值，将所述估计航点作为卡尔曼滤波算法中的预测值，采用卡尔曼滤波算法计算出来的估计值即为所述第一预测航点。
需要说明的是，对于根据所述运动模型，确定当前时刻所述障碍物的第一预测航点的具体实现方式，本发明并不作限定。例如，可以将根据所述运动模型确定的当前时刻所述障碍物的所述估计航点作为所述第一预测航点，或者，可以通过对所述第一估计航点和所述飞行航迹前一时刻的航点进行加权，确定所述第一预测航点。
步骤302、根据所述第一预测航点，确定第一关联波门。
本步骤中，所述第一关联波门可以是指以所述第一预测航点为中心的一个空间区域，所述第一关联波门具体可以为矩形波门、环形波门、圆形波门、球形波门或扇形波门等。在确定所述第一关联波门的形状和尺寸时，可以基于如下两方面进行考虑：一方面，要使落入第一关联波门内的有关回波有很高的概率；另一方面，不允许第一关联波门内有过多无关回波。这里，有关回波可以理解为对应的量测数据与上述飞行航迹有关的量测数据，无关回波可以理解为对应的量测数据与上述飞行航迹无关的量测数据。
步骤303、若当前时刻所述雷达的回波落入所述第一关联波门内，则根据所述回波对应的量测数据确定所述飞行航迹的当前航点。
本步骤中，以第一关联波门为球形波门，坐标系为笛卡尔坐标系为例，第一关联波门的范围可以为如下公式(1)。
其中，(x0，y0)可以表示笛卡尔坐标系下第一预测航点对应的坐标，(xk，yk)可以表示笛卡尔坐标系下回波对应的量测数据的坐标，K可以表示球形波门的半径。
例如，图4中(xi,yi)对应的回波落入第一关联波门内，(xn,yn)对应的回波未落入第一关联波门内，即落入第一关联波门之外。
需要说明的是，通常雷达输出的量测数据为极坐标系下的数据，而控制器处理的是笛卡尔坐标系下的数据，因此对于雷达输出的极坐标系下的量测数据可以进行坐标系转换，转换为笛卡尔坐标系下的量测数据。例如，假设雷达、障碍物以及笛卡尔坐标系之间的关系如图5所示，则障碍物的距离R、方位角与笛卡尔坐标系下的坐标x之间的关系可以如公式(2)所示，R、与笛卡尔坐标系下的坐标y之间的关系可以如公式(3)所示。
需要说明的是，图5中X和Y为笛卡尔坐标系的两条坐标轴。
可选的，当落入所述第一关联波门内的回波的个数为一个时，所述根据所述回波对应的量测数据确定所述障碍物的当前航点，包括：将所述回波对应的量测数据作为所述飞行航迹的当前航点。
可选的，当落入所述关联波门内的回波的个数为多个时，所述根据所述回波对应的量测数据确定所述障碍物的当前航点，包括：
在多个回波中选择一个回波，并将所选择的回波对应的量测数据作为所述飞行航迹的当前航点。可选的，所述在多个回波中选择一个回波，包括：基于最近邻法，在多个回波中选择一个回波。
具体的，首先可以根据第k+1时刻的第i个回波zi(k+1)，采用如下公式(4)确定第k+1时刻的第i个回波的更新向量vi(k+1)。
vi(k+1)＝zi(k+1)-zi(k) 公式(4)
其中，zi(k)表示第k时刻的回波对应的量测数据。
其次，根据vi(k+1)，采用如下公式(5)确定距离gi(k+1)。
其中，表示vi(k+1)的转置，S-1(k+1)表示新息协方差矩阵。
最后，选择多个回波中使得gi(k+1)最小的回波。
需要说明的是，对于基于最近邻法，在多个回波中选择一个回波的具体实现方式，本发明并不作限定，例如，也可以选择多个回波中与第一预测航点对应的回波距离最近的回波。
可选的，在无人机飞行的过程中，障碍物并不是固定不变的，因此除了确定上述飞行航迹之外，还可以确定区别于上述飞行航迹的新的飞行航迹。因此，当当前时刻所述雷达的回波未落入所述第一关联波门内时，进一步的，可以根据量测数据确定新的飞行航迹。这里，关于根据量测数据确定新的飞行航迹的处理方式与图6所示实施例中生成候选航迹的处理方式可以类似，在此不再赘述。
本实施例中，通过根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物当前时刻的第一预测航点，根据所述第一预测航点，确定第一关联波门，若当前时刻所述雷达的回波落入所述第一关联波门内，则根据所述回波对应的量测数据确定所述飞行航迹的当前航点，实现了根据雷达输出的量测数据，确定障碍物相对无人机的飞行航迹。
图6为本发明无人机避障方法实施例三的流程图。本实施例在图3所示实施例的基础上主要描述了若当前时刻所述雷达的回波未落入所述第一关联波门内时的一种可选的实现方式。如图6所示，本实施例的方法可以包括：
步骤601、若当前时刻所述雷达的回波未落入所述第一关联波门内，则判断所述回波是否落入第二关联波门内；所述第二关联波门为根据第二预测航点确定的关联波门，所述第二预测航点为根据候选航迹确定的预测航点。
本步骤中，在无人机飞行的过程中，障碍物并不是固定不变的。为了提高障碍物的飞行航迹的准确率，除了上述飞行航迹之外，还可以确定出一些可能成为障碍物的飞行航迹的候选航迹，当当前时刻所述雷达的回波未落入所述第一关联波门内时，可以进一步的判断是否落入基于候选航迹确定的第二关联波门内。其中，所述候选航迹的个数可以为一个或多个，本发明对此并不作限定。
需要说明的是，关于所述第二关联波门的相关内容，与上述第一相关波门类似，在此不再赘述。
步骤602、若所述回波落入所述第二关联波门内，则根据所述回波对应的量测数据确定所述候选航迹的当前航点。
需要说明的是，步骤602与步骤303类似，在此不再赘述。
步骤603、若所述回波未落入所述第二关联波门内，则根据所述回波对应的量测数据生成候选航迹。
本步骤中，在无人机飞行的过程中，障碍物并不是固定不变的，因此除了上述飞行航迹和候选航迹之外，还可以确定区别于上述飞行航迹和候选航迹的新的候选航迹。可选的，在尽快针对障碍物建立航迹以及尽量避免虚假航迹两方面的基础上，生成航迹时需要基于这两方面进行考虑。
可选的，可以采用如下方式生成候选航迹。
当雷达连续M个时刻分别输出的各第一量测数据中，第二量测数据的个数大于或等于K个时，确定生成所述候选航迹。
其中，所述第二量测数据包括第一量测数据与所述第一量测数据前一时刻的量测数据之间的差异程度小于或等于预设差异程度的第一量测数据，所述候选航迹包括根据各第一量测数据确定的航点信息，M为大于或等于2的正整数，K为小于或等于M的正整数。
具体的，假设当第i个时刻的第一量测数据与其前一时刻的量测数据之间的差异程度小于或等于预设差异程度时，Zi＝1，当第i个时刻的第一量测数据与其前一时刻的量测数据之间的差异程度大于预设差异程度时Zi＝0，则如图7所示，可以先判断Z0至ZM-1连续的M个Zi之和K是否大于或等于M，此时Z0至ZM-1可以认为是位于滑动窗口内，当K大于或等于M时，生成候选航迹，当K小于M时，进一步判断Z1至ZM连续的M个Zi之和K是否大于或等于M，即将滑动窗口向右移一次，当K大于或等于M时，生成候选航迹，当K小于M时，进一步判断Z2至ZM+1连续的M个Zi之和K是否大于或等于M，……。需要说明的是，Z0可以默认等于1或者0。
需要说明的是，在无人机飞行的过程中，障碍物并不是固定不变的，为了能够确定航迹(例如，飞行航迹以及候选航迹)的准确性，进一步的，可以对航迹的质量进行管理，航迹的质量越高可以表示航迹的准确性越高，航迹的质量越低可以表示航迹的准确性越低。
可选的，可以采用如下方式对航迹的质量进行管理：
根据所述当前航点与所述第一预测航点之间的差异程度，对所述飞行航迹的航迹质量进行更新；根据所述当前航点与所述第二预测航点之间的差异程度，对所述候选航迹的航迹质量进行更新；其中，差异程度越小，航迹质量越好；差异程度越大，航迹质量越差。需要说明的是，所述当前航点可以为上述候选航迹或上述飞行航迹的当前航点。
需要说明的是，在无人机飞行的过程中，上述候选航迹可能能够成为障碍物的飞行航迹，也可能不能成为障碍物的飞行轨迹，所述飞行航迹在一段时间之后也可能成为候选航迹。因此，可选的，在对航迹的质量进行管理的基础上，进一步的，还可以根据航迹的质量对航迹进行管理。具体的，根据所述航迹质量对候选航迹和飞行航迹进行管理。
可选的，所述根据所述航迹质量对候选航迹和飞行航迹进行管理，包括：当所述飞行航迹的航迹质量小于或等于第一预设航迹质量时，将所述飞行航机作为候选航迹；当所述候选航迹的航迹质量大于或等于第二预设航迹质量时，将所述候选航迹作为飞行航迹。
需要说明的是，所述第一预设航迹质量以及所述第二预设航迹质量，可以根据需求灵活设计，本发明对此并不作限定。
可选的，为了减小所维护的航迹的数目，还可以对航迹进行删除，这里“删除”可以理解为与上述“生成”相反的操作。具体的，所述根据所述航迹质量对候选航迹和飞行航迹进行管理，还可以包括：当所述候选航迹的航迹质量小于或等于第三预设航迹质量时，将所述候选航迹删除，所述第三预设航迹质量小于所述第一预设航迹质量。
本实施例中，通过若当前时刻所述雷达的回波未落入所述第一关联波门内，则判断所述回波是否落入第二关联波门内，若所述回波落入所述第二关联波门内，则根据所述回波对应的量测数据确定所述候选航迹的当前航点，若所述回波未落入所述第二关联波门内，则根据所述回波对应的量测数据生成候选航迹，在障碍物的飞行航迹的基础上，实现了候选航迹生成以及更新，提高了障碍物的飞行航迹的准确率。
图8为本发明无人机避障方法实施例四的流程图。本实施例在上述实施例的基础上主要描述了在使用雷达输出的量测数据之间的一种可选的实现方式。如图8所示，本实施例的方法可以包括：
步骤801、确定所述雷达输出的量测数据中满足预设条件的量测数据。
本步骤中，雷达通常具有较大的探测范围，而无人机需要考虑的障碍物的范围可以仅为探测范围的部分，因此可以根据预设条件从雷达输出的量测数据中确定出与避障相关的量测数据。这里，雷达输出的量测数据中满足预设条件的量测数据可以认为是能够使用的可靠数据，雷达输出的量测数据中不满足预设条件的量测数据可以认为是不能使用的无用数据。可选的，所述预设条件包括：距离门限条件和/或角度门限条件。其中，所述距离门限条件可以由一个或者多个预设距离限定，例如，当由一个预设距离限定时，所述距离门限条件可以为大于或等于该预设距离，或者小于或等于该预设距离；当由两个预设距离，预设距离1和预设距离2限定时，所述距离门限条件可以为大于或等于预设距离1且小于或等于预设距离2。其中，所述角度门限条件可以由一个或多个预设角度限定，例如，当由一个预设角度限定时，所述角度门限条件可以为大于或等于该预设角度，或者小于或等于该预设角度；当由两个预设角度，预设角度1和预设角度2限定时，所述角度门限条件可以为大于或等于预设角度1且小于或等于预设角度2。
当所述预设条件包括距离门限条件和角度门限条件，步骤801具体的，可以例如图9所示。
步骤802、根据所述雷达输出的满足所述预设条件的量测数据，确定障碍物相对无人机的飞行航迹。
需要说明的是，关于根据量测数据确定障碍物相对于无人机的飞行航迹的具体方式可以参见上述实施例，在此不再赘述。
步骤803、根据所述飞行航迹，对所述障碍物进行避障处理。
需要说明的是，步骤803与步骤102类似，在此不再赘述。
本实施例中，确定所述雷达输出的量测数据中满足预设条件的量测数据，根据所述雷达输出的满足所述预设条件的量测数据，确定障碍物相对无人机的飞行航迹，可以减小数据的计算量，从而减轻控制器的负担，提高了处理的速度，同时，也可以降低虚假航迹形成的可能性。
图10为本发明无人机的结构示意图，图11为本发明无人机的实体结构图。如图9和图10所示，本实施例的无人机1000可以包括机架1001，设置于机架1001的控制器1002，安装于机架1001上或机架1001的负载1003上的雷达1004。其中，雷达1004，用于获取量测数据；控制器1002，与所述雷达1004通信连接，用于根据雷达输出的量测数据，确定障碍物相对无人机的飞行航迹，并根据所述飞行航迹，对所述障碍物进行避障处理。
可选的，控制器1002根据雷达输出的量测数据，确定障碍物相对于无人机的飞行航迹，具体包括：
根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物当前时刻的第一预测航点；
根据所述第一预测航点，确定第一关联波门；
若当前时刻所述雷达的回波落入所述第一关联波门内，则根据所述回波对应的量测数据确定所述飞行航迹的当前航点。
可选的，当落入所述第一关联波门内的回波的个数为一个时，控制器1002根据所述回波对应的量测数据确定所述障碍物的当前航点，具体包括：
将所述回波对应的量测数据作为所述飞行航迹的当前航点。
可选的，当落入所述关联波门内的回波的个数为多个时，控制器1002根据所述回波对应的量测数据确定所述障碍物的当前航点，具体包括：
在多个回波中选择一个回波，并将所选择的回波对应的量测数据作为所述飞行航迹的当前航点。
可选的，控制器1002在多个回波中选择一个回波，具体包括：
基于最近邻法，在多个回波中选择一个回波。
可选的，控制器1002还用于：
若当前时刻所述雷达的回波未落入所述第一关联波门内，则判断所述回波是否落入第二关联波门内；所述第二关联波门为根据第二预测航点确定的关联波门，所述第二预测航点为根据候选航迹确定的预测航点；
若所述回波落入所述第二关联波门内，则根据所述回波对应的量测数据确定所述候选航迹的当前航点；
若所述回波未落入所述第二关联波门内，则根据所述回波对应的量测数据生成候选航迹。
可选的，控制器1002根据所述回波对应的量测数据生成候选航迹，具体包括：
当雷达连续M个时刻分别输出的各第一量测数据中，第二量测数据的个数大于或等于K个时，确定生成所述候选航迹；所述第二量测数据包括第一量测数据与所述第一量测数据前一时刻的量测数据之间的差异程度小于或等于预设差异程度的第一量测数据，所述候选航迹包括根据各第一量测数据确定的航点信息，M为大于或等于2的正整数，K为小于或等于M的正整数。
可选的，控制器1002，还用于：
根据所述当前航点与所述第一预测航点之间的差异程度，对所述飞行航迹的航迹质量进行更新；
根据所述当前航点与所述第二预测航点之间的差异程度，对所述候选航迹的航迹质量进行更新；
其中，差异程度越小，航迹质量越好；差异程度越大，航迹质量越差。
可选的，控制器1002，还用于根据所述航迹质量对候选航迹和飞行航迹进行管理。
可选的，控制器1002根据所述航迹质量对候选航迹和飞行航迹进行管理，具体包括：
当所述飞行航迹的航迹质量小于或等于第一预设航迹质量时，将所述飞行航机作为候选航迹；
当所述候选航迹的航迹质量大于或等于第二预设航迹质量时，将所述候选航迹作为飞行航迹。
可选的，控制器1002根据所述航迹质量对候选航迹和飞行航迹进行管理，还包括：
当所述候选航迹的航迹质量小于或等于第三预设航迹质量时，将所述候选航迹删除，所述第三预设航迹质量小于所述第一预设航迹质量。
可选的，控制器1002根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物当前时刻的第一预测航点，具体包括：
根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物的运动模型；
根据所述运动模型，确定当前时刻所述障碍物的第一预测航点。
可选的，控制器1002根据所述运动模型，确定当前时刻所述障碍物的第一预测航点，具体包括：
根据所述运动模型确定当前时刻所述障碍物的估计航点；
根据前一时刻的航点以及所述估计航点，基于卡尔曼算法，确定当前时刻所述障碍物的第一预测航点。
可选的，控制器1002，还用于在使用雷达输出的量测数据之前，确定所述雷达输出的量测数据中满足预设条件的量测数据；
控制器1002根据所述雷达输出的量测数据，确定障碍物相对无人机的飞行航迹，具体包括：根据所述雷达输出的满足所述预设条件的量测数据，确定障碍物相对无人机的飞行航迹。
可选的，所述预设条件包括：距离门限条件，和/或角度门限条件。
可选的，控制器1002根据所述飞行航迹，对所述障碍物进行避障处理，具体包括：
根据所述飞行航迹，控制所述无人机的飞行姿态，以对所述障碍物进行避障处理。
可选的，控制器1002还用于：
控制所述雷达连续转动；
获取所述雷达在连续转动时的量测数据。
可选的，在所述雷达连续转动时，所述雷达至少朝向所述无人机的正前方、前下方、正下方、正后方、后下方、正上方发射雷达波。
可选的，所述雷达的转轴方向平行于所述无人机的俯仰轴。
可选的，本发明中上述无人机具体可以为多旋翼无人机，例如四旋翼无人机。
需要说明的是，图11中以雷达1004为其天线为旋转天线的雷达为例，且雷达1004在无人机1000上的安装位置仅为举例。图11只是以示例的形式示意出一种无人机的实体结构图，并不是对无人机结构的限定，本发明对无人机的结构不作具体限定。
本实施例的无人机中的控制器，可以用于执行图1、图3、图6或图8所示方法实施例的技术方案，其实现原理和技术效果类似，此处不再赘述。
本领域普通技术人员可以理解：实现上述各方法实施例的全部或部分步骤可以通过程序指令相关的硬件来完成。前述的程序可以存储于一计算机可读取存储介质中。该程序在执行时，执行包括上述各方法实施例的步骤；而前述的存储介质包括：ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质。
最后应说明的是：以上各实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述各实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分或者全部技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。

Claims (38)

1.一种无人机避障方法，其特征在于，包括：
根据雷达输出的量测数据，确定障碍物相对无人机的飞行航迹；
根据所述飞行航迹，对所述障碍物进行避障处理。
2.根据权利要求1所述的方法，其特征在于，所述根据雷达输出的量测数据，确定障碍物相对于无人机的飞行航迹，包括：
根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物当前时刻的第一预测航点；
根据所述第一预测航点，确定第一关联波门；
若当前时刻所述雷达的回波落入所述第一关联波门内，则根据所述回波对应的量测数据确定所述飞行航迹的当前航点。
3.根据权利要求2所述的方法，其特征在于，当落入所述第一关联波门内的回波的个数为一个时，所述根据所述回波对应的量测数据确定所述障碍物的当前航点，包括：
将所述回波对应的量测数据作为所述飞行航迹的当前航点。
4.根据权利要求2所述的方法，其特征在于，当落入所述关联波门内的回波的个数为多个时，所述根据所述回波对应的量测数据确定所述障碍物的当前航点，包括：
在多个回波中选择一个回波，并将所选择的回波对应的量测数据作为所述飞行航迹的当前航点。
5.根据权利要求4所述的方法，其特征在于，所述在多个回波中选择一个回波，包括：
基于最近邻法，在多个回波中选择一个回波。
6.根据权利要求2-5任一项所述的方法，其特征在于，所述方法还包括：
若当前时刻所述雷达的回波未落入所述第一关联波门内，则判断所述回波是否落入第二关联波门内；所述第二关联波门为根据第二预测航点确定的关联波门，所述第二预测航点为根据候选航迹确定的预测航点；
若所述回波落入所述第二关联波门内，则根据所述回波对应的量测数据确定所述候选航迹的当前航点；
若所述回波未落入所述第二关联波门内，则根据所述回波对应的量测数据生成候选航迹。
7.根据权利要求6所述的方法，其特征在于，所述根据所述回波对应的量测数据生成候选航迹，包括：
当雷达连续M个时刻分别输出的各第一量测数据中，第二量测数据的个数大于或等于K个时，确定生成所述候选航迹；所述第二量测数据包括第一量测数据与所述第一量测数据前一时刻的量测数据之间的差异程度小于或等于预设差异程度的第一量测数据，所述候选航迹包括根据各第一量测数据确定的航点信息，M为大于或等于2的正整数，K为小于或等于M的正整数。
8.根据权利要求6或7所述的方法，其特征在于，所述方法还包括：
根据所述当前航点与所述第一预测航点之间的差异程度，对所述飞行航迹的航迹质量进行更新；
根据所述当前航点与所述第二预测航点之间的差异程度，对所述候选航迹的航迹质量进行更新；
其中，差异程度越小，航迹质量越好；差异程度越大，航迹质量越差。
9.根据权利要求8所述的方法，其特征在于，所述方法还包括：根据所述航迹质量对候选航迹和飞行航迹进行管理。
10.根据权利要求9所述的方法，其特征在于，所述根据所述航迹质量对候选航迹和飞行航迹进行管理，包括：
当所述飞行航迹的航迹质量小于或等于第一预设航迹质量时，将所述飞行航机作为候选航迹；
当所述候选航迹的航迹质量大于或等于第二预设航迹质量时，将所述候选航迹作为飞行航迹。
11.根据权利要求10所述的方法，其特征在于，所述根据所述航迹质量对候选航迹和飞行航迹进行管理，还包括：
当所述候选航迹的航迹质量小于或等于第三预设航迹质量时，将所述候选航迹删除，所述第三预设航迹质量小于所述第一预设航迹质量。
12.根据权利要求2-11任一项所述的方法，其特征在于，所述根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物当前时刻的第一预测航点，包括：
根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物的运动模型；
根据所述运动模型，确定当前时刻所述障碍物的第一预测航点。
13.根据权利要求12所述的方法，其特征在于，所述根据所述运动模型，确定当前时刻所述障碍物的第一预测航点，包括：
根据所述运动模型确定当前时刻所述障碍物的估计航点；
根据前一时刻的航点以及所述估计航点，基于卡尔曼算法，确定当前时刻所述障碍物的第一预测航点。
14.根据权利要求1-13任一项所述的方法，其特征在于，在使用雷达输出的量测数据之前，还包括：
确定所述雷达输出的量测数据中满足预设条件的量测数据；
所述根据所述雷达输出的量测数据，确定障碍物相对无人机的飞行航迹，包括：根据所述雷达输出的满足所述预设条件的量测数据，确定障碍物相对无人机的飞行航迹。
15.根据权利要求14所述的方法，其特征在于，所述预设条件包括：距离门限条件，和/或角度门限条件。
16.根据权利要求1-15任一项所述的方法，其特征在于，所述根据所述飞行航迹，对所述障碍物进行避障处理，包括：
根据所述飞行航迹，控制所述无人机的飞行姿态，以对所述障碍物进行避障处理。
17.根据权利要求1-16任一项所述的方法，其特征在于，所述方法还包括：
控制所述雷达连续转动；
获取所述雷达在连续转动时的量测数据。
18.根据权利要求17所述的方法，其特征在于，在所述雷达连续转动时，所述雷达至少朝向所述无人机的正前方、前下方、正下方、正后方、后下方、正上方发射雷达波。
19.根据权利要求1-18任一项所述的方法，其特征在于，所述雷达的转轴方向平行于所述无人机的俯仰轴。
20.一种无人机，其包括机架，设置于所述机架的控制器，其特征在于，所述农业无人机还包括：安装于所述机架上或所述机架的负载上的雷达；
所述雷达，用于获取量测数据；
所述控制器，与所述雷达通信连接，用于根据所述雷达输出的量测数据，确定障碍物相对无人机的飞行航迹，并根据所述飞行航迹，对所述障碍物进行避障处理。
21.根据权利要求20所述的无人机，其特征在于，所述控制器根据雷达输出的量测数据，确定障碍物相对于无人机的飞行航迹，具体包括：
根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物当前时刻的第一预测航点；
根据所述第一预测航点，确定第一关联波门；
若当前时刻所述雷达的回波落入所述第一关联波门内，则根据所述回波对应的量测数据确定所述飞行航迹的当前航点。
22.根据权利要求21所述的无人机，其特征在于，当落入所述第一关联波门内的回波的个数为一个时，所述控制器根据所述回波对应的量测数据确定所述障碍物的当前航点，具体包括：
将所述回波对应的量测数据作为所述飞行航迹的当前航点。
23.根据权利要求21所述的无人机，其特征在于，当落入所述关联波门内的回波的个数为多个时，所述控制器根据所述回波对应的量测数据确定所述障碍物的当前航点，具体包括：
在多个回波中选择一个回波，并将所选择的回波对应的量测数据作为所述飞行航迹的当前航点。
24.根据权利要求23所述的无人机，其特征在于，所述控制器在多个回波中选择一个回波，具体包括：
基于最近邻法，在多个回波中选择一个回波。
25.根据权利要求21-24任一项所述的无人机，其特征在于，所述控制器还用于：
若当前时刻所述雷达的回波未落入所述第一关联波门内，则判断所述回波是否落入第二关联波门内；所述第二关联波门为根据第二预测航点确定的关联波门，所述第二预测航点为根据候选航迹确定的预测航点；
若所述回波落入所述第二关联波门内，则根据所述回波对应的量测数据确定所述候选航迹的当前航点；
若所述回波未落入所述第二关联波门内，则根据所述回波对应的量测数据生成候选航迹。
26.根据权利要求25所述的无人机，其特征在于，所述控制器根据所述回波对应的量测数据生成候选航迹，具体包括：
当雷达连续M个时刻分别输出的各第一量测数据中，第二量测数据的个数大于或等于K个时，确定生成所述候选航迹；所述第二量测数据包括第一量测数据与所述第一量测数据前一时刻的量测数据之间的差异程度小于或等于预设差异程度的第一量测数据，所述候选航迹包括根据各第一量测数据确定的航点信息，M为大于或等于2的正整数，K为小于或等于M的正整数。
27.根据权利要求25或26所述的无人机，其特征在于，所述控制器，还用于：
根据所述当前航点与所述第一预测航点之间的差异程度，对所述飞行航迹的航迹质量进行更新；
根据所述当前航点与所述第二预测航点之间的差异程度，对所述候选航迹的航迹质量进行更新；
其中，差异程度越小，航迹质量越好；差异程度越大，航迹质量越差。
28.根据权利要求27所述的无人机，其特征在于，所述控制器，还用于根据所述航迹质量对候选航迹和飞行航迹进行管理。
29.根据权利要求28所述的无人机，其特征在于，所述控制器根据所述航迹质量对候选航迹和飞行航迹进行管理，具体包括：
当所述飞行航迹的航迹质量小于或等于第一预设航迹质量时，将所述飞行航机作为候选航迹；
当所述候选航迹的航迹质量大于或等于第二预设航迹质量时，将所述候选航迹作为飞行航迹。
30.根据权利要求29所述的无人机，其特征在于，所述控制器根据所述航迹质量对候选航迹和飞行航迹进行管理，还包括：
当所述候选航迹的航迹质量小于或等于第三预设航迹质量时，将所述候选航迹删除，所述第三预设航迹质量小于所述第一预设航迹质量。
31.根据权利要求21-30任一项所述的无人机，其特征在于，所述控制器根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物当前时刻的第一预测航点，具体包括：
根据之前时刻所述障碍物相对于所述无人机的飞行航迹，确定所述障碍物的运动模型；
根据所述运动模型，确定当前时刻所述障碍物的第一预测航点。
32.根据权利要求31所述的无人机，其特征在于，所述控制器根据所述运动模型，确定当前时刻所述障碍物的第一预测航点，具体包括：
根据所述运动模型确定当前时刻所述障碍物的估计航点；
根据前一时刻的航点以及所述估计航点，基于卡尔曼算法，确定当前时刻所述障碍物的第一预测航点。
33.根据权利要求30-32任一项所述的无人机，其特征在于，所述控制器，还用于在使用雷达输出的量测数据之前，确定所述雷达输出的量测数据中满足预设条件的量测数据；
所述控制器根据所述雷达输出的量测数据，确定障碍物相对无人机的飞行航迹，具体包括：根据所述雷达输出的满足所述预设条件的量测数据，确定障碍物相对无人机的飞行航迹。
34.根据权利要求33所述的无人机，其特征在于，所述预设条件包括：距离门限条件，和/或角度门限条件。
35.根据权利要求30-34任一项所述的无人机，其特征在于，所述控制器根据所述飞行航迹，对所述障碍物进行避障处理，具体包括：
根据所述飞行航迹，控制所述无人机的飞行姿态，以对所述障碍物进行避障处理。
36.根据权利要求20-35任一项所述的无人机，其特征在于，所述控制器还用于：
控制所述雷达连续转动；
获取所述雷达在连续转动时的量测数据。
37.根据权利要求36所述的无人机，其特征在于，在所述雷达连续转动时，所述雷达至少朝向所述无人机的正前方、前下方、正下方、正后方、后下方、正上方发射雷达波。
38.根据权利要求20-37任一项所述的无人机，其特征在于，所述雷达的转轴方向平行于所述无人机的俯仰轴。
CN201780005013.XA 2017-12-18 2017-12-18 无人机避障方法及无人机 Pending CN108513644A (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2017/117043 WO2019119243A1 (zh) 2017-12-18 2017-12-18 无人机避障方法及无人机

Publications (1)

Publication Number Publication Date
CN108513644A true CN108513644A (zh) 2018-09-07

Family

ID=63375751

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201780005013.XA Pending CN108513644A (zh) 2017-12-18 2017-12-18 无人机避障方法及无人机

Country Status (3)

Country Link
US (1) US20200285254A1 (zh)
CN (1) CN108513644A (zh)
WO (1) WO2019119243A1 (zh)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109270519A (zh) * 2018-09-14 2019-01-25 吉林大学 基于毫米波雷达的车载旋翼无人机回收引导***及方法
CN109633620A (zh) * 2018-12-13 2019-04-16 广州极飞科技有限公司 目标物体的识别方法和装置、作业设备
CN109947123A (zh) * 2019-02-27 2019-06-28 南京航空航天大学 一种基于视线导引律的无人机路径跟踪与自主避障方法
CN110770597A (zh) * 2018-11-21 2020-02-07 深圳市大疆创新科技有限公司 旋转微波雷达的地形预测方法、装置、***和无人机
CN112424635A (zh) * 2019-11-05 2021-02-26 深圳市大疆创新科技有限公司 障碍物检测方法、***、地面端设备及自主移动平台
CN112506222A (zh) * 2020-12-10 2021-03-16 中国南方电网有限责任公司超高压输电公司天生桥局 一种无人机智能化避障方法及装置
WO2022141048A1 (zh) * 2020-12-29 2022-07-07 深圳市大疆创新科技有限公司 获取点云聚类波门的方法、雷达、可移动平台和存储介质
CN114967751A (zh) * 2022-06-21 2022-08-30 深圳华创电科技术有限公司 飞行器航迹追踪方法、装置、设备及存储介质

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113371217B (zh) * 2021-08-11 2021-11-02 深圳市华芯机器人技术有限责任公司 一种基于远程巡视具有防雾功能的无人机
CN113885554B (zh) * 2021-09-13 2023-07-25 汕头大学 一种无人机集群的分布式围捕控制方法及***
CN113628257B (zh) * 2021-10-11 2021-12-28 中大检测(湖南)股份有限公司 基于雷达与双目视觉结合的无人监测***
CN113867402B (zh) * 2021-10-29 2022-12-20 仲恺农业工程学院 一种基于基准面的农田无人机避障作业方法和装置
CN114020029B (zh) * 2021-11-09 2022-06-10 深圳大漠大智控技术有限公司 一种针对集群的航拍航线自动生成方法、装置及相关组件

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101655561A (zh) * 2009-09-14 2010-02-24 南京莱斯信息技术股份有限公司 基于联合卡尔曼滤波的多点定位数据与雷达数据融合方法
CN102566580A (zh) * 2011-12-27 2012-07-11 中国直升机设计研究所 一种无人直升机飞行航迹规划方法
CN104808682A (zh) * 2015-03-10 2015-07-29 成都市优艾维机器人科技有限公司 小型旋翼无人机自主避障飞行控制***及控制方法
CN104991235A (zh) * 2015-06-15 2015-10-21 南京航空航天大学 一种基于雷达点迹的快速跟踪目标的方法
CN105929848A (zh) * 2016-06-28 2016-09-07 南京邮电大学 一种三维环境中的多无人机***的航迹规划方法
CN106774392A (zh) * 2016-12-13 2017-05-31 中国南方电网有限责任公司超高压输电公司检修试验中心 一种电力线路巡检过程中飞行路径的动态规划方法
CN106872955A (zh) * 2017-01-24 2017-06-20 西安电子科技大学 基于联合概率数据关联算法的雷达多目标跟踪优化方法
CN106908066A (zh) * 2017-04-25 2017-06-30 西安电子科技大学 基于遗传算法的无人机监视覆盖单步寻优的航迹规划方法
CN106959441A (zh) * 2017-02-28 2017-07-18 中国电子科技集团公司第二十八研究所 一种机场场面监视雷达多径虚假目标航迹抑制方法
CN107063259A (zh) * 2017-03-08 2017-08-18 四川九洲电器集团有限责任公司 一种航迹关联方法及电子设备

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102707724B (zh) * 2012-06-05 2015-01-14 清华大学 一种无人机的视觉定位与避障方法及***
CN105759829A (zh) * 2016-04-12 2016-07-13 深圳市龙云创新航空科技有限公司 基于激光雷达的微型无人机操控方法及***
CN106197426A (zh) * 2016-06-28 2016-12-07 桂林电子科技大学 一种无人机应急通信路径规划方法及***
CN105955303A (zh) * 2016-07-05 2016-09-21 北京奇虎科技有限公司 无人机自主避障方法、装置
CN106647800A (zh) * 2016-10-19 2017-05-10 广东容祺智能科技有限公司 一种无人机自动避障导航***
CN106527468A (zh) * 2016-12-26 2017-03-22 德阳科蚁科技有限责任公司 一种无人机避障控制方法、***及无人机
CN106950978B (zh) * 2017-03-28 2019-08-27 西安电子科技大学 固定翼无人机避障***及其避障方法以及固定翼无人机

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101655561A (zh) * 2009-09-14 2010-02-24 南京莱斯信息技术股份有限公司 基于联合卡尔曼滤波的多点定位数据与雷达数据融合方法
CN102566580A (zh) * 2011-12-27 2012-07-11 中国直升机设计研究所 一种无人直升机飞行航迹规划方法
CN104808682A (zh) * 2015-03-10 2015-07-29 成都市优艾维机器人科技有限公司 小型旋翼无人机自主避障飞行控制***及控制方法
CN104991235A (zh) * 2015-06-15 2015-10-21 南京航空航天大学 一种基于雷达点迹的快速跟踪目标的方法
CN105929848A (zh) * 2016-06-28 2016-09-07 南京邮电大学 一种三维环境中的多无人机***的航迹规划方法
CN106774392A (zh) * 2016-12-13 2017-05-31 中国南方电网有限责任公司超高压输电公司检修试验中心 一种电力线路巡检过程中飞行路径的动态规划方法
CN106872955A (zh) * 2017-01-24 2017-06-20 西安电子科技大学 基于联合概率数据关联算法的雷达多目标跟踪优化方法
CN106959441A (zh) * 2017-02-28 2017-07-18 中国电子科技集团公司第二十八研究所 一种机场场面监视雷达多径虚假目标航迹抑制方法
CN107063259A (zh) * 2017-03-08 2017-08-18 四川九洲电器集团有限责任公司 一种航迹关联方法及电子设备
CN106908066A (zh) * 2017-04-25 2017-06-30 西安电子科技大学 基于遗传算法的无人机监视覆盖单步寻优的航迹规划方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
李小毛 等: "《基于3D 激光雷达的无人水面艇海上目标检测》", 《上海大学学报》 *
熊超 等: "《基于概率多假设跟踪技术的数目可变航拍视频多目标跟踪》", 《中国体视学与图像分析》 *

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109270519A (zh) * 2018-09-14 2019-01-25 吉林大学 基于毫米波雷达的车载旋翼无人机回收引导***及方法
CN110770597A (zh) * 2018-11-21 2020-02-07 深圳市大疆创新科技有限公司 旋转微波雷达的地形预测方法、装置、***和无人机
WO2020103049A1 (zh) * 2018-11-21 2020-05-28 深圳市大疆创新科技有限公司 旋转微波雷达的地形预测方法、装置、***和无人机
CN109633620A (zh) * 2018-12-13 2019-04-16 广州极飞科技有限公司 目标物体的识别方法和装置、作业设备
CN109633620B (zh) * 2018-12-13 2021-02-19 广州极飞科技有限公司 目标物体的识别方法和装置、作业设备
CN109947123A (zh) * 2019-02-27 2019-06-28 南京航空航天大学 一种基于视线导引律的无人机路径跟踪与自主避障方法
CN112424635A (zh) * 2019-11-05 2021-02-26 深圳市大疆创新科技有限公司 障碍物检测方法、***、地面端设备及自主移动平台
CN112506222A (zh) * 2020-12-10 2021-03-16 中国南方电网有限责任公司超高压输电公司天生桥局 一种无人机智能化避障方法及装置
WO2022141048A1 (zh) * 2020-12-29 2022-07-07 深圳市大疆创新科技有限公司 获取点云聚类波门的方法、雷达、可移动平台和存储介质
CN114967751A (zh) * 2022-06-21 2022-08-30 深圳华创电科技术有限公司 飞行器航迹追踪方法、装置、设备及存储介质

Also Published As

Publication number Publication date
US20200285254A1 (en) 2020-09-10
WO2019119243A1 (zh) 2019-06-27

Similar Documents

Publication Publication Date Title
CN108513644A (zh) 无人机避障方法及无人机
Smith et al. Experiments with cognitive radar
CN107278282B (zh) 路径规划的方法、装置、飞行控制***、全方位避障***与无人机
Kirubarajan et al. IMMPDA solution to benchmark for radar resource allocation and tracking in the presence of ECM
CN103852763B (zh) 雷达设备和信号处理方法
CN108521792A (zh) 微波雷达的测距方法、微波雷达、计算机存储介质、无人飞行器及其控制方法
EP3642645B1 (en) Methods and apparatus for distributed, multi-node, low-frequency radar systems for degraded visual environments
Kwag et al. UAV based collision avoidance radar sensor
US11921233B2 (en) Adaptive radar for near-far target identification
WO2021138187A1 (en) Dynamic sparse radar array for scenarios
US20210199787A1 (en) Sequential doppler focusing
WO2021133837A1 (en) Sequential clustering
Benavoli et al. Knowledge-based system for multi-target tracking in a littoral environment
Ruan et al. Multiple model PMHT and its application to the benchmark radar tracking problem
CN110167124A (zh) 一种自适应传输功率的水下无线传感器网络目标跟踪方法
JP7486355B2 (ja) 船舶用物標検出システム、船舶用物標検出方法、信頼度推定装置、及びプログラム
CN107783114A (zh) 旋翼无人机远距离复杂环境防撞毫米波雷达信号处理***及方法
KR101981624B1 (ko) 빅데이터 기반 인공지능 기술을 이용한 저피탐 표적 탐지 장치 및 그 방법
Qin et al. Research on information fusion structure of radar and AIS
CN112731321B (zh) 基于mimo认知雷达的移动机器人避障及地图绘制方法
Bykova et al. Safe navigation algorithm for autonomous underwater vehicles
JP6856964B1 (ja) 飛来物衝突回避システムおよび飛来物衝突回避制御装置
CN110133608B (zh) 合作外辐射源双基雷达协同路径规划多步优化方法
CN114355324A (zh) 一种航迹生成方法
Hutchins et al. Evaluation of a probabilistic multihypothesis tracking algorithm in cluttered environments

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
RJ01 Rejection of invention patent application after publication

Application publication date: 20180907

RJ01 Rejection of invention patent application after publication