CN113442915B - 一种自动避障天线 - Google Patents

一种自动避障天线 Download PDF

Info

Publication number
CN113442915B
CN113442915B CN202110943451.9A CN202110943451A CN113442915B CN 113442915 B CN113442915 B CN 113442915B CN 202110943451 A CN202110943451 A CN 202110943451A CN 113442915 B CN113442915 B CN 113442915B
Authority
CN
China
Prior art keywords
distance
obstacle
antenna
module
radar signal
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
CN202110943451.9A
Other languages
English (en)
Other versions
CN113442915A (zh
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.)
Shenzhen Automotive Research Institute of Beijing University of Technology
Original Assignee
Shenzhen Automotive Research Institute of Beijing University of Technology
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 Automotive Research Institute of Beijing University of Technology filed Critical Shenzhen Automotive Research Institute of Beijing University of Technology
Priority to CN202110943451.9A priority Critical patent/CN113442915B/zh
Publication of CN113442915A publication Critical patent/CN113442915A/zh
Application granted granted Critical
Publication of CN113442915B publication Critical patent/CN113442915B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/09—Taking automatic action to avoid collision, e.g. braking and steering
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
    • B60R11/00—Arrangements for holding or mounting articles, not otherwise provided for
    • B60R11/02—Arrangements for holding or mounting articles, not otherwise provided for for radio sets, television sets, telephones, or the like; Arrangement of controls thereof
    • B60R11/0258—Arrangements for holding or mounting articles, not otherwise provided for for radio sets, television sets, telephones, or the like; Arrangement of controls thereof for navigation systems
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095—Predicting travel path or likelihood of collision
    • B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00—Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001—Planning or execution of driving tasks
    • B60W60/0015—Planning or execution of driving tasks specially adapted for safety
    • B60W2420/408—
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/54—Audio sensitive means, e.g. ultrasound
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/80—Spatial relation or speed relative to objects

Abstract

本发明涉及智能天线技术领域，具体涉及一种自动避障天线。其包括：激光雷达模块、毫米波雷达模块、超声波雷达模块、数据处理模块和显示报警模块。其中，激光雷达模块、毫米波雷达模块、超声波雷达模块分别用于在车辆行驶中检测路径上的障碍物信息以得到激光雷达信号、毫米波雷达信号和超声波雷达信号；数据处理模块同于对所述激光雷达信号、毫米波雷达信号和超声波雷达信号进行处理得到当前车辆和/或天线与障碍物的距离，自动避障模块用于根据当前车辆和/或天线与障碍物的距离控制天线和/或车辆运动以避开障碍物。通过本申请的自动避障天线成本低、可靠性高且避障效果的天线。

Description

一种自动避障天线
技术领域
本发明涉及智能天线技术领域，具体涉及一种自动避障天线。
背景技术
除常见的固定式天线外，在军用、电磁测试等领域也需要应用(车载式)可移动式天线及支架；在天线移动过程中，操作员可能会视觉偏差、遮挡导致降低、丧失对天线支架及障碍物的空间感知能力，显著增加了与障碍物相撞的风险。因此，研究自动避障天线系统的需求十分迫切。
针对天线装置的避障系统的研究较少，主要集中于小型飞行器控制领域。其采用的方案一般为：采用高精度高线束的激光雷达、毫米波雷达、高精度视觉摄像头相融合的感知方式，通过高性能计算机应用深度学习方法实现障碍物的识别、定位，进而实现车辆的避障控制。然而，对(车载式)可移动式天线而言，上述方案对传感器、控制器要求高，最终系统复杂度高、成本高，不便于布置。
发明内容
本实施例提供一种自动避障天线，其目的在于避免天线与障碍物发生碰撞。
一种自动避障天线,包括：激光雷达模块、毫米波雷达模块、超声波雷达模块、数据处理模块和自动避障模块；
其中，所述激光雷达模块、毫米波雷达模块、超声波雷达模块分别用于在车辆行驶中检测路径上的障碍物信息以得到激光雷达信号、毫米波雷达信号和超声波雷达信号；
所述数据处理模块用于对所述激光雷达信号、毫米波雷达信号和超声波雷达信号进行处理得到当前车辆和/或天线与障碍物的距离；
所述自动避障模块用于根据当前车辆和/或天线与障碍物的距离控制天线和/或车辆运动以避开障碍物。
在一种实施例中，还包括通信模块，所述通信模块与所述数据处理模块连接，用于和外部设备进行无线通信。
在一种实施例中，还包括电源管理模块，该电源管理模块包括储能电池、电压转换电路、稳压电路以及电池管理系统；所述电压转换电路用于对电压进行转换处理以输出适配的电压；所述稳压电路用于对输出电压进行稳压处理；所述电池管理系统用于对储能电池进行管理和监控储能电池的使用状态。
在一种实施例中，还包括车身机构和天线伺服调整机构，所述天线伺服调整机构设置在车身机构上，该车身机构用于带动天线运动；所述激光雷达模块、毫米波雷达模块、超声波雷达模块设置在所述车身机构上，该天线设置在天线伺服调整机构上，天线伺服调整机构用于被控制以调整天线的位置。
在一种实施例中，所述车身机构包括车轮、整车控制器、驱动电机、电机控制器、减速器、转向装置。
在一种实施例中，所述数据处理模块用于对所述激光雷达信号、毫米波雷达信号和超声波雷达信号进行处理得到当前车辆和/或天线与障碍物的距离包括：
将激光雷达信号、毫米波雷达信号和超声波雷达信号的返回强度归一化至0～1范围；
对归一化后的激光雷达信号、毫米波雷达信号和超声波雷达信号中的障碍物距离信息按照置信度由大到小进行排序，存储到待处理列表中；
选取置信度最高的障碍物距离信息作为目标障碍物距离并将其存储至输出列表中，并将其从所述待处理列表中删除；
计算其余所有障碍物距离信息与所述目标障碍物距离之间的间距值；
将间距值小于阈值的障碍物距离信息删除，将间距值大于阈值的障碍物距离信息保留，并进行下一轮循环，直至待处理列表为空。根据所述输出列表中的距离信息计算车辆和/或天线与障碍物之间的距离。
在一种实施例中，所述数据处理模块用于对所述激光雷达信号、毫米波雷达信号和超声波雷达信号进行处理得到当前车辆和/或天线与障碍物的距离包括：
将激光雷达信号、毫米波雷达信号和超声波雷达信号的返回强度归一化至0～1范围；
对归一化后的激光雷达信号、毫米波雷达信号和超声波雷达信号中的障碍物距离信息按照置信度由大到小进行排序，存储到待处理列表中；
选取距离最小的障碍物距离信息作为目标障碍物距离并将其存储至输出列表中，并将其从所述待处理列表中删除；
计算其余所有障碍物距离信息与所述目标障碍物距离之间的间距值；
将间距值小于阈值的障碍物距离信息删除，将间距值大于阈值的障碍物距离信息保留，并进行下一轮循环，直至待处理列表为空。根据所述输出列表中的距离信息计算车辆和/或天线与障碍物之间的距离。
在一种实施例中，所述数据处理模块用于对所述激光雷达信号、毫米波雷达信号和超声波雷达信号进行处理得到当前车辆和/或天线与障碍物的距离包括：
将激光雷达信号、毫米波雷达信号和超声波雷达信号返回的距离信息归一化至0～1范围；
对归一化后的激光雷达信号、毫米波雷达信号和超声波雷达信号中的障碍物距离信息按照置信度由大到小进行排序，存储到待处理列表中；
选取置信度最高的障碍物距离信息作为目标障碍物距离并将其存储至输出列表中，并将其从所述待处理列表中删除；
计算其余所有障碍物距离信息与所述目标障碍物距离之间的间距值；
将间距值小于阈值的障碍物距离信息删除，将间距值大于阈值的障碍物距离信息保留，并进行下一轮循环，直至待处理列表为空。
根据所述输出列表中的距离信息计算车辆和/或天线与障碍物之间的距离。
在一种实施例中，还包括显示报警模块，所述显示报警模块用于在触发报警机制时发出报警提示信号。
在一种实施例中，还包括：根据计算出的当前车辆和/或天线与障碍物的距离，根据距离和置信度计算碰撞风险，若碰撞风险大于风险阈值，则触发报警机制以报警。
依据上述实施例的自动避障天线,其包括：激光雷达模块、毫米波雷达模块、超声波雷达模块、数据处理模块和显示报警模块。其中，激光雷达模块、毫米波雷达模块、超声波雷达模块分别用于在车辆行驶中检测路径上的障碍物信息以得到激光雷达信号、毫米波雷达信号和超声波雷达信号；数据处理模块用于对所述激光雷达信号、毫米波雷达信号和超声波雷达信号进行处理得到当前车辆和/或天线与障碍物的距离，自动避障模块用于根据当前车辆和/或天线与障碍物的距离控制天线和/或车辆运动以避开障碍物。通过本申请的自动避障天线成本低、可靠性高且避障效果的天线。
附图说明
图1为本申请在一种实施例中传感器的设置示意图；
图2为本申请在另一种实施例中传感器的设置示意图；
图3为本申请在另一种实施例中传感器的设置示意图；
图4为本申请实施例的数据处理流程示意图；
图5为本申请实施例的置信度系数与速度关系图；
图6为本申请实施例的报警显示界面示意图。
具体实施方式
下面通过具体实施方式结合附图对本发明作进一步详细说明。其中不同实施方式中类似元件采用了相关联的类似的元件标号。在以下的实施方式中，很多细节描述是为了使得本申请能被更好的理解。然而，本领域技术人员可以毫不费力的认识到，其中部分特征在不同情况下是可以省略的，或者可以由其他元件、材料、方法所替代。在某些情况下，本申请相关的一些操作并没有在说明书中显示或者描述，这是为了避免本申请的核心部分被过多的描述所淹没，而对于本领域技术人员而言，详细描述这些相关操作并不是必要的，他们根据说明书中的描述以及本领域的一般技术知识即可完整了解相关操作。
另外，说明书中所描述的特点、操作或者特征可以以任意适当的方式结合形成各种实施方式。同时，方法描述中的各步骤或者动作也可以按照本领域技术人员所能显而易见的方式进行顺序调换或调整。因此，说明书和附图中的各种顺序只是为了清楚描述某一个实施例，并不意味着是必须的顺序，除非另有说明其中某个顺序是必须遵循的。
实施例一：
请参考图1，本实施例提供一种自动避障天线,其包括：激光雷达模块2、毫米波雷达模块6、超声波雷达模块7、数据处理模块4和自动避障模块。
其中，激光雷达模块2、毫米波雷达模块6、超声波雷达模块7分别用于在车辆行驶中检测路径上的障碍物信息以得到激光雷达信号、毫米波雷达信号和超声波雷达信号。数据处理模块4用于对激光雷达信号、毫米波雷达信号和超声波雷达信号进行处理得到当前车辆和/或天线与障碍物的距离；自动避障模块用于根据当前车辆和/或天线与障碍物的距离控制天线和/或车辆运动以避开障碍物。
其中，本实施例的激光雷达模块2包含激光雷达和支持激光雷达运行及数据传输的外围电路部分，其用于实现基于飞行时间检测(ToF)的环境扫描和建模，其原理为：激光器发射一个激光脉冲，由计时器记录下出射的时间，回返光经接收器接收，并由计时器记录下回返的时间。两个时间相减即得到了光的“飞行时间”，而光速是一定的，因此在已知速度和时间后很容易就可以计算出距离。通过向多个方向发射线束并测量距离，就可以得到物体相对于环境的位置、距离关系，其返回值的形式为[距离x，距离y，返回波强度]。
本实施例的毫米波雷达模块6包含毫米波雷达和支持毫米波雷达运行及数据传输的外围电路部分，其基本原理为：电磁信号发射过程中被其发射路径上的物体阻挡进行的反射，从而可以测得障碍物的距离，其返回值的形式为[距离x，距离y，返回波强度]。
本实施例的超声波雷达模块7包含超声波雷达和支持超声波雷达运行及数据传输的外围电路部分，其基本原理为：通过超声波发射装置向外发出超声波，通过接收器接收到发送过来超声波时的时间差来测算距离，从而可以测得障碍物的距离[距离，返回波强度]。
本实施例的数据处理模块4包含处理芯片、数据储存部分。
本实施例的天线还包括通信模块3，通信模块3与数据处理模块4连接，通信模块3用于和外部设备进行无线通信。本实施例的通信模块3可以采用蓝牙通信、4G/5G网络通信、wi fi通信等技术。
在一种实施例中，天线系统还包括电源管理模块5，该电源管理模块5包括储能电池、电压转换电路、稳压电路以及电池管理系统；电压转换电路用于对电压进行转换处理以输出适配的电压；稳压电路用于对输出电压进行稳压处理；电池管理系统用于对储能电池进行管理和监控储能电池的使用状态。
在一种实施例中，该天线还包括车身机构8和天线伺服调整机构1，天线伺服调整机构1设置在车身机构8上，该车身机构8用于带动天线运动10；激光雷达模块2、毫米波雷达模块6、超声波雷达模块7设置在车身机构8上，该天线10设置在天线伺服调整机构1上，天线伺服调整机构1用于被控制以调整天线的位置。其中，天线包括发射天线、接收天线以及用于连接天线以通信的信号线，天线伺服调整机构1包括支撑固定部分、伺服齿轮齿条、伺服卷线机构等其他可以实现升降功能与控制的部件。
本实施例中车身机构8包括车轮、整车控制器、驱动电机、电机控制器、减速器、转向装置等结构，这些机构配合以实现车辆的移动、转向控制，可以通过通信模块3实现车身状态的实时上报。
在另一种实施例中，提供另一种天线布置方式，如图2，激光雷达模块2、毫米波雷达模块6、超声波雷达模块7均固定安装于天线伺服调整机构1的顶端，可随着天线伺服调整机构1的升降而升降，激光雷达模块2、毫米波雷达模块6、超声波雷达模块7相对于天线原点的安装偏移分别为(x1,y1)、(x2,y2)、(x3,y3)；则对于远处安全距离上的某一障碍A，各传感器检测到的相对坐标分别为(x1_a,y1_a),(x2_a,y2_a),(x3_a,y3_a),通过坐标变换统一至天线支架坐标系下后三个坐标分别为：(x1_a+x1,y1_a+y1)、(x2_a+x2,y2_a+y2)、(x3_a+x3,y3_a+y3)。
在另一种实施例中，提供另一种天线布置方式，如图3，激光雷达模块2、毫米波雷达模块6、超声波雷达模块7均安装车辆的结构上，不随可随着天线支架的升降而升降，但可控制各传感器随自身转轴旋转。各传感器相对于天线原点的安装偏移分别为(x1,y1,θ1),(x2,y2,θ2),(x3,y3,θ3)；则对于远处安全距离上的某一障碍B，各传感器检测到的相对坐标分别为(x1_b,y1_b),(x2_b,y2_b),(x3_b,y3_b),通过坐标变换统一至天线支架坐标系下后三个坐标分别为：
(x1_b*cosθ1+y1_b*sinθ1+x1,y1_b*cosθ1-x1_b*sinθ1+y1),(x2_b*cosθ2+y2_b*sinθ2+x2,y2_b*cosθ2-x2_b*sinθ2+y2),(x3_b*cosθ3+y3_b*sinθ3+x3,y3_b*cosθ3-x3_b*sinθ3+y3),
传感器的布置并不限于本实施例所明确指出的3种方式，在其他实施例中，根据使用要求，可以使用组合方案，如激光雷达固定在天线支架顶端、毫米波雷达和超声波雷达固定在车体上可以旋转；也可以根据要求略去特定传感器，如只采用激光雷达和毫米波雷达；对于同一类的传感器数量也是可以变化的，如采用2个激光雷达。总之，这些传感器在数量、种类和安装方式的组合都可应用，并且都可以设定安全距离，也可以设定多程度的安全距离，实现预警、报警、紧急报警的分级检测和策略。
本实施例的数据处理流程如图4所示，获取三个传感器的信息后，对传感器信息进行融合处理得到障碍物距离，然后获取车辆当前的运行状态，结合车辆运行状态以及障碍物距离即可计算出碰撞风险，根据碰撞风险控制车辆或者天线运动，以实现避障。
其中，本实施例中数据处理模块对数据的处理方式包括以下三种，在实际处理中，技术人员可选其中任意一种。
第一种，按照各传感器信号的置信度进行信息融合处理，本实施例中重点以各传感器的信号的置信度作为重要参考量，具体包括：
步骤1.1：预先对激光雷达信号、毫米波雷达信号和超声波雷达信号在同一个环境下对同一个物体在同样的距离、大小下进行标定。然后将激光雷达信号、毫米波雷达信号和超声波雷达信号的返回强度归一化至0～1范围，称之为置信度。
步骤1.2:对归一化后的激光雷达信号、毫米波雷达信号和超声波雷达信号中的距离信息按照置信度由大到小进行排序，存储到待处理列表中。
步骤1.3：选取置信度最高的距离信息(x1，y1，a1)作为目标距离并将其存储至输出列表中，并将其从所述待处理列表中删除。其中，(x1，y1)表示距离障碍物α1的距离信息。
步骤1.4：计算其余所有距离信息与所述目标距离之间的间距值。具体的，通过公式
Figure GDA0003613978140000071
步骤1.5：将间距值小于阈值(如0.6m)的距离信息删除，将间距值大于阈值的距离信息保留。其中，与目标距离之间间距值小于阈值的点被认为是同一障碍物，因此需要删除；其中，距离阈值可根据运行工况设定，例如：若环境中实际障碍物体积均较大(如山石、建筑)，可将阈值设定为1.2m；若环境中实际障碍物体积较小(如树枝、微型飞行器)，可将阈值设定为0.2m。
步骤1.6：重复步骤1.3至步骤1.5，直至待处理列表为空或最高置信度的小于某一阈值(如0.3)或输出列表中障碍物信息已达到阈值个(如5个)。
步骤1.7：根据输出列表中的距离信息计算车辆和/或天线与障碍物之间的距离。
在一种实施例中，数据处理部分还可以采用下述第二种方法，本实施例中重点以信号中的距离信号作为参考量，具体包括：
步骤2.1：将激光雷达信号、毫米波雷达信号和超声波雷达信号的返回强度归一化至0～1范围，称之为置信度。
步骤2.2：对归一化后的激光雷达信号、毫米波雷达信号和超声波雷达信号中的距离信息由大到小进行排序，存储到待处理列表中。
步骤2.3：选取最小的距离信息作为目标距离并将其存储至输出列表中，并将其从所述待处理列表中删除。
步骤2.4：计算其余所有距离信息与所述目标距离之间的间距值。
步骤2.5：将间距值小于阈值(如0.6m)的距离信息删除，将间距值大于阈值的距离信息输出至待所述输出列表中。
步骤2.6：重复步骤2.3至步骤2.5，直至待处理列表为空或剩余最小距离大于某一阈值(如5m)或输出列表中障碍物信息已达到阈值个(如5个)。
步骤2.7：根据输出列表中的距离信息计算车辆和/或天线与障碍物之间的距离。
第三种，在另一种实施例中，重点考虑车速的影响，由于传感器自身的工作特性，激光雷达对远距离的物体检测更可靠，毫米波雷达对中距离的物体检测更可靠，超声波雷达对近距离的物体检测更可靠。第一种方法虽然对信号强度做了归一化，但并没有充分利用传感器的特性；另外，容易理解，相较于速度较高的情况下，速度低时我们更关心与中、近距离的物体。基于以上考虑，设定随车速变化的置信度调整系数，其中一种调整系数如图5所示。
本实施例的方法具体包括：
步骤3.1：将激光雷达信号、毫米波雷达信号和超声波雷达信号返回的距离信息归一化至0～1范围，称之为置信度。
步骤3.2：对归一化后的激光雷达信号、毫米波雷达信号和超声波雷达信号的距离信息分别乘以当前车速下其对应的调整系数；不同速度下对应的调整系数如图5所示，另一个简单的例子为：考虑到在车速增高的情况下超声波雷达更容易出现误报警且超声波雷达的自身检测距离较短；在车速小于3km/h时，将激光雷达信号、毫米波雷达信号和超声波雷达的调整系数均设置为1；在车速大于3km/h时，将激光雷达信号、毫米波雷达信号和超声波雷达的调整系数设置为1、1、0。
步骤3.3：按照置信度由大到小进行排序，存储到待处理列表中；
步骤3.4：选取置信度最高的距离信息作为目标距离，并将该目标距离存储到待处理列表中；
步骤3.5：计算所有距离信息与所述目标距离之间的间距值，将间距值小于阈值的距离信息删除，将间距值大于阈值的距离信息输出至待所述输出列表中；
步骤3.6：重复步骤3.3至步骤3.5，直至待处理列表为空或最高置信度的小于某一阈值(如0.3)或输出列表中障碍物信息已达到阈值个(如5个)。
步骤3.7：根据输出列表中的距离信息计算车辆和/或天线与障碍物之间的距离。
进一步的，本实施例的天线还包括显示报警模块，显示报警模块用于在触发报警机制时发出报警提示信。例如，显示报警模块的报警显示界面如图6所示，界面显示碰撞物体、碰撞可能性、碰撞方位等；警示灯转动并发出声音等提醒驾驶员。
进一步的，本实施例的天线还包括：根据计算出的当前车辆和/或天线与障碍物的距离，根据距离和置信度计算碰撞风险，若碰撞风险大于风险阈值，则触发报警机制以报警。
例如通过通讯接口和通信模块可以取得车辆的运动信息，运动信息包括当前的车速、加速度、方向盘转角、油门踏板百分比、制动踏板百分比等。可以通过这些状态预测很短时间后(例如1s后)的车辆位置和状态：对于自动驾驶车辆，该信息往往可以通过从控制策略中直接得出，对有人驾驶车辆和其他车辆，可以采取等速估计，也就是认为在较短时间内车辆的速度v、方向盘转角θ等是不变的，则这段时间的位移可表示为：
Figure GDA0003613978140000091
Figure GDA0003613978140000092
需要说明的是，本实施例只为了说明车辆状态预测而举例，并不现定于使用何种方法；本系统也可以接受来自其他方法的车辆状态预测结果，如长短时记忆(LSTM)预测、马尔可夫模型、递归神经网络等。
本实施例的碰撞风险计算包括：
采用上述输出列表中取得的障碍物信息列表[(xobs1,yobs1,aobs1),(xobs2,yobs2,aobs2),...]和取得的车辆状态获取与预测结果。
例如分别对1s后、2s后、5s后的碰撞可能性与风险进行计算。
对某一时刻t1，预测得到的车辆位置位于(xt1,yt1)，判断距离
Figure GDA0003613978140000093
的大小，取距离的倒数乘以置信度作为碰撞风险
Figure GDA0003613978140000094
如果βt1大于某一值，则认为有碰撞可能，存入输出列表；并计算与下一障碍物的碰撞风险，若碰撞风险高于风险阈值，则控制车辆转向或者天线运动以避障。例如，可以将风险阈值设置为0.2m-1,其物理意义可以理解为对5m处的置信度为1的物体(碰撞风险为1/5＝0.2)需要进行动作、对2m处置信度为0.4的物体(碰撞风险为0.4/2＝0.2)需要进行动作，但对于1m处置信度为0.1的物体(碰撞风险为0.1/1＝0.1)不进行动作。例如，可以将例如发出天线控制指令使天线下降，减少碰撞风险与碰撞损失。
以上应用了具体个例对本发明进行阐述，只是用于帮助理解本发明，并不用以限制本发明。对于本发明所属技术领域的技术人员，依据本发明的思想，还可以做出若干简单推演、变形或替换。

Claims (9)

1.一种自动避障天线,其特征在于，包括：激光雷达模块、毫米波雷达模块、超声波雷达模块、数据处理模块和自动避障模块；
其中，所述激光雷达模块、毫米波雷达模块、超声波雷达模块分别用于在车辆行驶中检测路径上的障碍物信息以得到激光雷达信号、毫米波雷达信号和超声波雷达信号；
所述数据处理模块用于对所述激光雷达信号、毫米波雷达信号和超声波雷达信号进行处理得到当前车辆和/或天线与障碍物的距离；
所述自动避障模块用于根据当前车辆和/或天线与障碍物的距离控制天线和/或车辆运动以避开障碍物；
其中，所述数据处理模块用于对所述激光雷达信号、毫米波雷达信号和超声波雷达信号进行处理得到当前车辆和/或天线与障碍物的距离包括：
将激光雷达信号、毫米波雷达信号和超声波雷达信号的返回强度归一化至0～1范围；
对归一化后的激光雷达信号、毫米波雷达信号和超声波雷达信号中的障碍物距离信息按照置信度由大到小进行排序，存储到待处理列表中；
选取置信度最高的障碍物距离信息作为目标障碍物距离并将其存储至输出列表中，并将其从所述待处理列表中删除；
计算其余所有障碍物距离信息与所述目标障碍物距离之间的间距值；
将间距值小于阈值的障碍物距离信息删除，将间距值大于阈值的障碍物距离信息保留，并进行下一轮循环，直至待处理列表为空；
根据所述输出列表中的距离信息计算车辆和/或天线与障碍物之间的距离。
2.如权利要求1所述的自动避障天线,其特征在于，还包括通信模块，所述通信模块与所述数据处理模块连接，用于和外部设备进行无线通信。
3.如权利要求1所述的自动避障天线,其特征在于，还包括电源管理模块，该电源管理模块包括储能电池、电压转换电路、稳压电路以及电池管理系统；所述电压转换电路用于对电压进行转换处理以输出适配的电压；所述稳压电路用于对输出电压进行稳压处理；所述电池管理系统用于对储能电池进行管理和监控储能电池的使用状态。
4.如权利要求1所述的自动避障天线,其特征在于，还包括车身机构和天线伺服调整机构，所述天线伺服调整机构设置在车身机构上，该车身机构用于带动天线运动；所述激光雷达模块、毫米波雷达模块、超声波雷达模块设置在所述车身机构上，该天线设置在天线伺服调整机构上，天线伺服调整机构用于被控制以调整天线的位置。
5.如权利要求4所述的自动避障天线,其特征在于，所述车身机构包括车轮、整车控制器、驱动电机、电机控制器、减速器、转向装置。
6.如权利要求1所述的自动避障天线,其特征在于，所述数据处理模块用于对所述激光雷达信号、毫米波雷达信号和超声波雷达信号进行处理得到当前车辆和/或天线与障碍物的距离包括：
将激光雷达信号、毫米波雷达信号和超声波雷达信号的返回强度归一化至0～1范围；
对归一化后的激光雷达信号、毫米波雷达信号和超声波雷达信号中的距离信息由大到小进行排序，存储到待处理列表中；
选取最小的距离信息作为目标障碍物距离并将其存储至输出列表中，并将其从所述待处理列表中删除；
计算其余所有障碍物距离信息与所述目标障碍物距离之间的间距值；
将间距值小于阈值的障碍物距离信息删除，将间距值大于阈值的障碍物距离信息保留，并进行下一轮循环，直至待处理列表为空；
根据所述输出列表中的距离信息计算车辆和/或天线与障碍物之间的距离。
7.如权利要求1所述的自动避障天线,其特征在于，所述数据处理模块用于对所述激光雷达信号、毫米波雷达信号和超声波雷达信号进行处理得到当前车辆和/或天线与障碍物的距离包括：
将激光雷达信号、毫米波雷达信号和超声波雷达信号返回的距离信息归一化至0～1范围；
对归一化后的激光雷达信号、毫米波雷达信号和超声波雷达信号中的障碍物距离信息按照置信度由大到小进行排序，存储到待处理列表中；
选取置信度最高的障碍物距离信息作为目标障碍物距离并将其存储至输出列表中，并将其从所述待处理列表中删除；
计算其余所有障碍物距离信息与所述目标障碍物距离之间的间距值；
将间距值小于阈值的障碍物距离信息删除，将间距值大于阈值的障碍物距离信息保留，并进行下一轮循环，直至待处理列表为空；
根据所述输出列表中的距离信息计算车辆和/或天线与障碍物之间的距离。
8.如权利要求1所述的自动避障天线,其特征在于，还包括显示报警模块，所述显示报警模块用于在触发报警机制时发出报警提示信。
9.如权利要求1所述的自动避障天线,其特征在于，还包括：根据计算出的当前车辆和/或天线与障碍物的距离，根据距离和置信度计算碰撞风险，若碰撞风险大于风险阈值，则触发报警机制以报警。
CN202110943451.9A 2021-08-17 2021-08-17 一种自动避障天线 Active CN113442915B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110943451.9A CN113442915B (zh) 2021-08-17 2021-08-17 一种自动避障天线

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110943451.9A CN113442915B (zh) 2021-08-17 2021-08-17 一种自动避障天线

Publications (2)

Publication Number Publication Date
CN113442915A CN113442915A (zh) 2021-09-28
CN113442915B true CN113442915B (zh) 2022-07-15

Family

ID=77818531

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110943451.9A Active CN113442915B (zh) 2021-08-17 2021-08-17 一种自动避障天线

Country Status (1)

Country Link
CN (1) CN113442915B (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106909152A (zh) * 2017-03-17 2017-06-30 奇瑞汽车股份有限公司 一种车用环境感知系统及汽车
CN109634282A (zh) * 2018-12-25 2019-04-16 奇瑞汽车股份有限公司 自动驾驶车辆、方法和装置
CN109814112A (zh) * 2019-01-15 2019-05-28 北京百度网讯科技有限公司 一种超声波雷达与激光雷达信息融合方法和系统
CN110596731A (zh) * 2019-09-12 2019-12-20 天津市市政工程设计研究院 一种地铁车辆主动障碍物检测系统及方法
CN111026118A (zh) * 2019-12-18 2020-04-17 三一重工股份有限公司 一种矿用宽体车及其自动驾驶系统
CN211765500U (zh) * 2019-11-27 2020-10-27 北京新能源汽车技术创新中心有限公司 一种用于封闭场景下的智能驾驶环境感知系统及汽车
CN112285714A (zh) * 2020-09-08 2021-01-29 苏州挚途科技有限公司 一种基于多传感器的障碍物速度融合方法和装置

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106909152A (zh) * 2017-03-17 2017-06-30 奇瑞汽车股份有限公司 一种车用环境感知系统及汽车
CN109634282A (zh) * 2018-12-25 2019-04-16 奇瑞汽车股份有限公司 自动驾驶车辆、方法和装置
CN109814112A (zh) * 2019-01-15 2019-05-28 北京百度网讯科技有限公司 一种超声波雷达与激光雷达信息融合方法和系统
WO2020147485A1 (zh) * 2019-01-15 2020-07-23 北京百度网讯科技有限公司 一种信息处理方法、系统、设备和计算机存储介质
CN110596731A (zh) * 2019-09-12 2019-12-20 天津市市政工程设计研究院 一种地铁车辆主动障碍物检测系统及方法
CN211765500U (zh) * 2019-11-27 2020-10-27 北京新能源汽车技术创新中心有限公司 一种用于封闭场景下的智能驾驶环境感知系统及汽车
CN111026118A (zh) * 2019-12-18 2020-04-17 三一重工股份有限公司 一种矿用宽体车及其自动驾驶系统
CN112285714A (zh) * 2020-09-08 2021-01-29 苏州挚途科技有限公司 一种基于多传感器的障碍物速度融合方法和装置

Also Published As

Publication number Publication date
CN113442915A (zh) 2021-09-28

Similar Documents

Publication Publication Date Title
EP3812793B1 (en) Information processing method, system and equipment, and computer storage medium
RU2735340C1 (ru) Способ управления парковкой и устройство управления парковкой
WO2018112013A2 (en) Power modulation for a rotary light detection and ranging (lidar) device
US20210118303A1 (en) Method of controlling vehicle considering adjacent pedestrian's behavior
CN107505940A (zh) 自动引导车辆上的双激光雷达控制方法、系统及定位方法
CN105022039A (zh) 基于驾驶历史检测雷达阻塞
CN205034349U (zh) 一种防撞无人飞行器系统
CN103661097A (zh) 一种车载突现行人信息共享装置及其共享方法
US20200361452A1 (en) Vehicles and methods for performing tasks based on confidence in accuracy of module output
CN209852236U (zh) 无人驾驶卡车环境感知装置
CN202305803U (zh) 车载四线激光雷达系统及其电路
KR20220136430A (ko) 검출 방법 및 장치
CN113442915B (zh) 一种自动避障天线
CN114630774A (zh) 车辆远程控制方法及车辆远程控制装置
US11198437B2 (en) Method and apparatus for threat zone assessment
CN112446466A (zh) 在深度神经网络中测量置信度
KR100875564B1 (ko) 근거리 물체 감지 시스템
EP3663250A1 (en) A system and method for alignment of a terminal truck relative to a crane
WO2023015251A1 (en) Assisted parking of electrical vehicle at charging station
CN115902845A (zh) 激光雷达的外参标定方法及相关装置
CN112740075B (zh) 一种基于探测信号的测距方法及装置
CN104943605B (zh) 用于交通工具的警示系统及警示方法
CN213338017U (zh) 雷达装置、智能行驶装置、以及智能交通系统
CN117671648B (zh) 障碍点的检测方法、设备及存储介质
CN109270932A (zh) 自动驾驶定位系统及自动驾驶系统

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