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

CN108082181B - 基于农田环境感知的农机导航控制方法 - Google Patents

基于农田环境感知的农机导航控制方法 Download PDF

Info

Publication number
CN108082181B
CN108082181B CN201711267862.0A CN201711267862A CN108082181B CN 108082181 B CN108082181 B CN 108082181B CN 201711267862 A CN201711267862 A CN 201711267862A CN 108082181 B CN108082181 B CN 108082181B
Authority
CN
China
Prior art keywords
radar
target
agricultural machine
camera
distance
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
CN201711267862.0A
Other languages
English (en)
Other versions
CN108082181A (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.)
Nanjing Woyang Machinery Technology Co ltd
Original Assignee
Nanjing Woyang Machinery 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 Nanjing Woyang Machinery Technology Co ltd filed Critical Nanjing Woyang Machinery Technology Co ltd
Publication of CN108082181A publication Critical patent/CN108082181A/zh
Application granted granted Critical
Publication of CN108082181B publication Critical patent/CN108082181B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/10—Terrestrial scenes
    • G06V20/188—Vegetation
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60Q—ARRANGEMENT OF SIGNALLING OR LIGHTING DEVICES, THE MOUNTING OR SUPPORTING THEREOF OR CIRCUITS THEREFOR, FOR VEHICLES IN GENERAL
    • B60Q9/00—Arrangement or adaptation of signal devices not provided for in one of main groups B60Q1/00 - B60Q7/00, e.g. haptic signalling
    • B60Q9/008—Arrangement or adaptation of signal devices not provided for in one of main groups B60Q1/00 - B60Q7/00, e.g. haptic signalling for anti-collision purposes
    • 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
    • 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
    • B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • 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
    • B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • 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/882—Radar or analogous systems specially adapted for specific applications for altimeters
    • 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/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223—Control 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
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V10/00—Arrangements for image or video recognition or understanding
    • G06V10/20—Image preprocessing
    • G06V10/25—Determination of region of interest [ROI] or a volume of interest [VOI]
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V10/00—Arrangements for image or video recognition or understanding
    • G06V10/20—Image preprocessing
    • G06V10/30—Noise filtering
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/50—Context or environment of the image
    • G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/50—Context or environment of the image
    • G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/588—Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
    • 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
    • B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0001—Details of the control system
    • B60W2050/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
    • 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
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00—Indexing scheme for image analysis or image enhancement
    • G06T2207/10—Image acquisition modality
    • G06T2207/10032—Satellite or aerial image; Remote sensing
    • G06T2207/10044—Radar image
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00—Indexing scheme for image analysis or image enhancement
    • G06T2207/30—Subject of image; Context of image processing
    • G06T2207/30248—Vehicle exterior or interior
    • G06T2207/30252—Vehicle exterior; Vicinity of vehicle
    • G06T2207/30256—Lane; Road marking
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00—Indexing scheme for image analysis or image enhancement
    • G06T2207/30—Subject of image; Context of image processing
    • G06T2207/30248—Vehicle exterior or interior
    • G06T2207/30252—Vehicle exterior; Vicinity of vehicle
    • G06T2207/30261—Obstacle

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Mathematical Physics (AREA)
  • Health & Medical Sciences (AREA)
  • Electromagnetism (AREA)
  • General Health & Medical Sciences (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Human Computer Interaction (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Traffic Control Systems (AREA)
  • Measuring Magnetic Variables (AREA)
  • Guiding Agricultural Machines (AREA)

Abstract

本发明提供了农机控制技术领域内的一种基于农田环境感知的农机导航控制方法，具体包括以下步骤，步骤1：农机作业前，对摄像机进行标定，将雷达和视觉信息在空间上融合；步骤2：农机作业时，距离检测装置一检测雷达与地面间的高度变化，距离检测装置二检测摄像机与地面间的高度变化，实时调整雷达与摄像机坐标的转换，使雷达与摄像机在空间上同步；步骤3：工控机解算接收的毫米波雷达数据，确定有效目标，确定最危险目标，同步采集摄像机图像；步骤4：工控机根据雷达信息判断最危险目标状态并规划行走路径，根据雷达与摄像机采集到的图像数据，判断最危险目标的类型，导航箱控制农机动作；本发明中数据融合精度高，提高识别障碍物的准确度。

Description

基于农田环境感知的农机导航控制方法
技术领域
本发明涉及一种导航方法，特别涉及一种农机无人驾驶中使用的导航方法。
背景技术
精准农业技术被认为是21世纪农业科技发展的前沿，是科技含最高、集成综合性最强的现代农业生产管理技术之一。精准农业技术根据空间变异，定位、定时、定量的实施一套现代化农事操作技术与管理的系统，是信息技术与农业生产全面结合的一种新型农业技术。
精准农业的应用于快速发展，能够充分挖掘农田最大的生产潜力、合理利用水肥资源、减少环境污染，大幅度提高农产品产量和品质。
发展精准农业技术是解决我国农业由传统农业向现代化农业发展过程中所面临的确保农产品总量、调整农业产业结构、改善农产品品质和质量、资源严重不足且利用率低、环境污染等问题的有效解决方式，也是中国农业现代化发展与转型升级的必经之路。
卫星导航技术是精准农业技术的基本组成之一，使农机实现自动行驶，农机作业前只需要设定好参数后，导航系统便引导农机进入自动作业模式，开始进行直线耕作。在农机自动导航的过程中，农田的环境恶劣且复杂，大型的农田里可能会存在电线杆、田埂、土丘、牲畜以及随时出现的劳作人员等，这些因素都为无人驾驶农机的实现提出了新的挑战。现有技术中，使用卫星导航技术可以实现农机在农田里自动行走，但是农机无法准确识别农机前方的障碍物，即农机无法感应农田环境，更不用说根据感知到的农田环境自动做停车等待还是继续行驶等处理，农机作业时必须得有驾驶员辅助操控农机的动作，一不注意，农机就会与前方障碍物碰撞；因此迫切需要研究出一套基于农田环境感知的导航控制方法使无人驾驶的农机具备对周边环境进行感知的能力，一旦遇到上述农田中存在电线杆、田埂、土丘、牲畜以及随时出现的劳作人员等情况，能够及时采取停车等待、避障等应急处理。
发明内容
针对现有技术中的缺陷，本发明的目的在于克服上述现有技术中的不足之处，解决现有技术中无人驾驶的农机无法感知农田环境的技术问题，提供一种用于农机无人驾驶的农田环境感知方法，本发明实现了农田环境的感知，感知精度高，识别农机前方障碍物的准确度高，提高农机无人驾驶时的可靠性。
本发明的目的是这样实现的：一种基于农田环境感知的农机导航控制方法，具体包括以下步骤，
步骤1：农机作业前，对摄像机进行标定，摄像机空间坐标变换，再对雷达视觉联合标定，使得雷达和视觉信息在空间上融合；
步骤2：农机作业时，距离检测装置一实时检测雷达与地面间的高度变化△hst，距离检测装置二实时检测摄像机与地面间的高度变化△hct，工控机进行数据处理实时调整雷达与摄像机坐标的转换关系，使雷达与摄像机在作业条件下实现在空间上的同步；
步骤3：工控机解算接收到的毫米波雷达数据，确定有效目标，选出农机作业前方雷达感兴趣的区域，确定最危险目标，同步进行摄像机图像的采集；
步骤4：根据雷达的信息判断出最危险目标的运动状态，工控机根据最危险目标的运动状态规划农机行走路径，根据雷达与相机采集到的最危险目标的图像数据，判断出最危险目标的类型，工控机将解析出来的动作指令传输给导航箱，导航箱控制农机做相应的动作；
其中，农机作业时，农机的行驶速度匀速；
所述距离检测装置一和距离检测装置二的结构相同，距离检测装置一安装在农机前侧且设置在雷达正下方，距离检测装置二安装在农机下侧且设置在摄像机正下方位置；所述距离检测装置一包括具有容纳腔且可开合的壳体，容纳腔为圆柱体状，所述壳体内设有可沿着壳体内壁做上下直线运动的滑块，壳体内设有检测滑块顶部与壳体内壁上侧距离变化的距离传感器，所述滑块和壳体内壁顶部之间连接有2个连接件，连接件关于滑块在宽度方向上的中心对称设置；所述连接件包括导向套，所述导向套内设有可沿着导向套内壁滑动的导向杆，滑块的前后两侧与壳体内壁之间留有可容纳导向杆的间隙，所述导向套的底部开有导向孔并设有限制导向杆远离导向套的限位阶，所述导向杆穿过导向孔与滑块外侧连接，所述导向套的容纳腔正上方对应的壳体上开有至少一个透气孔，所述滑块的底部安装有可在地面上滚动的万向滚轮；
工控机接收所述距离传感器发送过来的数据信号并进行数据处理。
为了实现雷达和摄像机在空间上的初步同步，所述步骤1中的将车辆坐标转换成图像像素坐标具体包括以下步骤，
步骤1.1：农机作业前，地面默认为水平，将毫米波雷达固定安装在农机的前侧且位于农机纵向中轴，雷达发射面向外，使雷达发射面与地面垂直；安装摄像机时使摄像机的光轴与地面平行；
步骤1.2：以雷达的中心为原点建立雷达坐标系00-X0Y0Z0，毫米波雷达所在平面由X0轴和Y0轴确定并与Z0轴相垂直，Z0轴与地面平行且与农机中心轴线重合；建立摄像机坐标系Oc-XcYcZc，以摄像机的中心为原点Oc，平面XcOcYc平行于摄像机的成像平面，Zc轴是摄像机的取景光轴且垂直于成像平面；建立车辆坐标系Ow-XwYwZw，Ow为农机后轴的中心与车辆的中心轴线的交点，Xw轴水平向右并垂直于农机的纵向中轴线，Zw水平向前且与农机中心轴线重合，Yw轴垂直于水面地面向上，雷达坐标系的X0O0Z0平面与车辆坐标系的XwOwZw平面平行；
步骤1.3：光轴与成像平面相交的点是图像主点O’，车辆坐标通过旋转矩阵R和平移向量sc转换后得到摄像机坐标(xc，yc，zc，1)T，任意点P的车辆坐标为(xw，yw，zw，1)T，将车辆坐标转换为摄像机坐标，具体的转换关系如下，
Figure BDA0001494892550000041
式(1-1)中，R为一个三行三列的正交单位矩阵，sc(xc0，yc0，zc0)为初始条件下车辆坐标系到摄像机坐标系的1*3平移矩阵，xc0为摄像机所在的中心轴与车辆中心轴线两直线的距离，yc0为初始条件下摄像机距离地面的高度，zc0为摄像机距离农机后轴的距离；
步骤1.4：将摄像机坐标(xc，yc，zc，1)T转换到图像物理坐标(x1，y1)T，具体的转换关系如下，
Figure BDA0001494892550000042
式(1-2)中，f为摄像机的焦距，焦距单位为mm；
步骤1.5：将图像物理坐标(x1，y1)T转换到图像像素坐标(u,v)，具体的转换关系如下：
Figure BDA0001494892550000043
其中，dx,dy分别表示每个像素在横轴和纵轴上单位大小，u0、v0分别为图像像素坐标系下摄像机光轴和成像平面交点的横纵坐标，坐标单位为pixel；
步骤1.6：根据以上公式(1-1)～(1-3)得到图像像素坐标系到车辆坐标系的转换公式，具体的为，
Figure BDA0001494892550000051
步骤1.7：为了使雷达和视觉信息在空间上融合，将步骤1.6中的坐标转换关系更新为，
Figure BDA0001494892550000052
其中，s＝sc+s0，s0的坐标设为(xs0,ys0,zs0)，xs0＝0，ys0为初始条件下雷达距离地面的高度，zs0为雷达与农机后轴的距离。
为了提高农机作业过程中雷达和摄像机的融合精度，所述步骤2中的工控机进行数据处理实时调整雷达与摄像机坐标的转换关系，具体的为，根据农机的实际路况实时调整平移向量s，扫描周期t下调整后的平移向量st＝sc+s0+△st，实时的车辆坐标与图像像素坐标的转换关系，具体的为，
Figure BDA0001494892550000053
Figure BDA0001494892550000054
其中，△hct为扫描周期t下摄像机与地面高度的变化值，△hst为扫描周期t下雷达与地面高度的变化值，j为扫描周期数，(ut,vt)为农机作业过程中扫描周期t下实时更新计算得到的图像像素坐标。
为了进一步提高环境感知精度，所述步骤2中自适应调整后的平移向量中获得△ht的步骤如下，
所述步骤2中实时调整后的平移向量中获得△ht的步骤如下，
步骤2.1：实时计算雷达与地面间的高度变化量以及摄像机与地面间的高度变化量，具体的为，
扫描周期t中i时刻与i-1时刻雷达与地面高度距离变化值为△hsti，采用平均法计算扫描周期t中雷达相对地面的高度变化量△hst，
Figure BDA0001494892550000061
假设扫描周期t中采样时刻i与采样时刻i-1下摄像机与地面高度变化值为△hcti，采用平均法计算扫描周期t中摄像机与地面的高度变化量△hct，
Figure BDA0001494892550000062
步骤2.2：实时计算出扫描周期t下自适应调整后的平移向量s，具体的为，
Figure BDA0001494892550000063
其中，k为一个扫描周期中的采样点的总数；
此设计中，通过实时检测雷达距离地面的高度变化以及摄像机距离地面的高度变化，实时更新平移向量s，提高摄像机和雷达空间同步的精度。
为了进一步提高解算雷达数据的准确性，所述步骤3中的解算雷达数据确定有效目标，具体包括以下步骤，
步骤3.1：对雷达接收到的数据按照毫米波雷达协议进行解算，得到前方物体相对雷达的角度α、距离r、相对速度v、前方物体的反射强度并为每个目标分配唯一一个ID；
步骤3.2：对随机噪声信号进行滤波，保证雷达数据的连续有效性，具体的为，定义z＝[r,α,v]T为雷达的测量值，z(k)为毫米波雷达第k次输出的测量值，
d2＝S(z(k)-z(k-1))(z(k)-z(k-1))T＜rs 2 (3-1)
过滤掉不符合式(3-1)的数据信号；其中，d为相邻量测向量z(k)、z(k-1)之间的加权欧氏距离，S为加权矩阵，rs为设定的阈值；
步骤3.3：判定目标是否在农机行驶的车道内，当雷达前方物体满足di≤ds时，目标在农机行驶车道内，否则，目标不在农机行驶车道内，农机行驶车道内的目标初选为有效目标，并对其按照由近及远的准则进行排序编号；在农机行驶车道外的目标为非危险目标，将其排除；其中，ds为安全距离阈值，ds＝L/2+ks，di为i采样点下测得的目标与Z0轴之间的距离，L为农机上悬挂的犁具宽度，ks为设定的安全余量；
步骤3.4：对初选的有效目标进行有效性检验，最终确定有效目标；
步骤3.5：根据确定好的有效目标，通过毫米波雷达获取的最近距离障碍物确定为候选的最危险目标，若dj≤dmin,dj为毫米波雷达获取的农机与ID是j的有效目标之间的距离，dmin为在毫米波雷达一个扫描周期内所获取的农机与最近有效目标的距离，则ID是j的有效目标为最危险目标；
此设计中，先对干扰和噪声信号产生的随机噪声信号进行滤除，提高雷达数据解算的准确性；通过对农机行驶车道的判别，排除农机行驶车道外的障碍物目标，初步选定同车道内的障碍物为有效目标，对初选有效目标进行检验以进一步确定有效目标，提高有效目标识别的精确度；对有效目标按照距离由近到远的顺序为规则，确定最危险目标；
所述步骤3.4中对初选的有效目标进行有效性检验具体包括以下步骤，
步骤3.4.1：对初选的有效目标进行预测，选取状态Sn＝[dn,vn,an],初选有效目标的状态预测方程为，
Figure BDA0001494892550000081
其中，d(n+1,n)、v(n+1,n)、a(n+1,n)是上一个扫描周期预测的有效障碍物目标的状态信息，dn,vn,an分别表示毫米波雷达第n探测周期内测得的有效障碍物目标的相对距离、相对速度、相对加速度，t是毫米波雷达的扫描周期；
步骤3.4.2：通过比较预测的第n+1周期有效目标的状态信息和雷达实际测得的第n+1周期有效目标的状态信息，具体如下，
Figure BDA0001494892550000082
其中，d0、v0、a0是设定的有效障碍物目标测量值与预测值之间的误差阈值；
步骤3.4.3：有效障碍物目标在雷达的扫描周期中被连续探测到m次以上，同时，满足步骤3.4.2中公式(3-3)的有效目标与初选有效目标一致，则更新目标的相对距离、相对速度、相对角度、编号信息；否则，初选的有效目标不处于毫米波雷达探测目标中，使用有效目标预测信息对初选的有效目标进行跟踪，若初选的有效目标在雷达的下一个扫描周期中仍然没有被探测到，则停止使用对应的初选有效目标信息，更新有效目标信息，并返回步骤3.4.1循环执行；
此设计中，通过上一个扫描预测的有效目标的状态信息与测试出来的进行对比，判断有效目标信息是否一致，以此来进一步排除虚假目标，使有效目标的确定得到进一步保障。
作为本发明的进一步改进，所述步骤4中判断最危险目标的动静状态具体包括以下步骤，
所述步骤4中判断最危险目标的动静状态，工控机根据最危险目标的运动状态规划农机行走路径具体包括以下步骤，
步骤4.1：根据步骤3.5中确定的最危险目标，不断更新最危险目标的相对速度和相对距离信息，判断最危险目标与雷达的距离是否在停车距离范围内，即zd>zmin(4-1)，zd为毫米波雷达探测到的雷达与最危险目标的相对距离，zmin为设定的停车距离阈值，最危险目标满足公式(4-1)时，农机继续行驶；
步骤4.2：根据相对速度大小判定最危险目标的动静状态，具体如下，
v≠v车 (4-2)
在连续的扫描周期内，(4-2)式始终成立时，判定目标的状态为动态，此时，工控机发出声光报警，zd≤zmin时，工控机将停车等待指令发送给导航箱，导航箱控制农机做停车等待处理；否则，农机继续行驶，并返回至步骤3.1循环执行，其中，v为雷达相对目标的速度大小，v车为农机的行驶速度；(4-2)式始终不成立时，判定目标为静态，则工控机做出避障处理，具体的为，摄像机扫描出障碍物的边缘轮廓，工控机根据农机的犁具宽度和农机最小转弯半径设定一条避障路径；工控机按照设定好的避障路径解析出农机的前轮转角，并将动作指令发送给导航箱，导航箱控制农机的前轮转角使农机按照设定的避障路径行走；
农机的左右两侧中心位置分别安装有雷达一和雷达二；农机在避障过程中，雷达一和雷达二不断扫描农机左右两侧是否有障碍物，设定雷达一与障碍物的相对距离为d1，设定雷达二与障碍物的相对距离为d2，根据以下公式判断农机是否继续按照避障路径行走，
d1<ds0 (4-3)
d2<ds0 (4-4)
(4-3)或(4-4)任意一个式子成立时，工控机做出停车等待决策，导航箱控制农机停下；否则，农机继续按照避障路径行走；
其中，ds0为设定的转弯安全距离，农机上安装有角度传感器，前轮转向角由角度传感器测得，角度传感器将检测到的转向角信号传输给工控机；
此设计中，判定最危险目标的动静态原理简单，提高响应速度；根据最危险目标的动静态情况做出农机进一步的行走决策，若农机为静态，则农机按照设定的避障路径行走。
为了进一步提高提高获得理论避障路径的可靠性，所述步骤4.2中的避障路径具体的为，
以障碍物的中心为圆心做特征圆，特征圆的半径为rmin+w/2，避障路径由圆弧段一、直线段一、圆弧段二、直线段二和圆弧段三组成，圆弧段一的一端与农机原始的直线路径相切，圆弧段一的另一端与直线段一的一端相切，直线段一的另一端和直线段二的一端分别与圆弧段二相切，直线段二的另一端与圆弧段三相切，圆弧段二为特征圆上的一段，圆弧段一和圆弧段三关于圆弧段二的中心线对称设置，农机依次经过圆弧段一、直线段一、圆弧段二、直线段二和圆弧段三绕过障碍物，其中，rmin为农机的最小转弯半径，w为农机的作业宽度，障碍物的外接圆半径小于最小转弯半径rmin；圆弧段一的半径为rmin，所述圆弧段三的半径为rmin，圆弧段一的起点记为H点，圆弧段一的圆心记为O1点，直线段一与农机原始的直线路径的相交点记为J，直线段一与圆弧段二的相切点记为D，农机原始路径与特征圆的相交点分别记为K和K’，JK＝w/2，圆弧段二的圆心记为O点，O的坐标设为(a，b)，圆弧段二的中心点记为B点，J点的坐标记为(x1，y1)，JD的方程可以写成：
y＝k(x-x1)+y1 (4-5)；
特征圆的方程可以写成：
(x-a)2+(y-b)2＝r2
Figure BDA0001494892550000112
r＝rmin+w/2 (4-6)
通过(4-5)和(4-6)可以求出k，D点为JD和特征圆的相交点，以此解出D点坐标；
设点O1的坐标为(x2,y2)，则点O1到直线JD的距离为：
Figure BDA0001494892550000113
根据公式(4-7)和(4-8)求出O1的坐标；则H点的坐标为(x2，y1)，B点的坐标为(a，b+r)。
作为本发明的进一步改进，所述步骤4中根据雷达与相机采集到的最危险目标的图像数据，判断出最危险目标的类型，导航箱控制农机做相应的动作，具体包括以下步骤，
步骤4.1a：最危险目标为动态的情形下，摄像机对最危险目标进行识别，摄像机获取最危险目标的图像，将图像与训练好的人体样本训练库进行匹配比较，输出目标识别结果；
步骤4.2a：导航箱根据输出的目标识别结果控制农机动作，若为非人体，则导航箱发出声光报警，并控制农机做停车等待处理；若目标识别结果为人体，则导航箱发出声光报警，判断人体是否偏离农机行驶车道或者人体向远离农机方向运动，用以下公式判断，
zwn+1>zwn (4-3)
di>ds (4-4)
若雷达探测到的人体目标满足(4-3)或(4-4)，则农机继续向前行驶，否则导航箱控制农机做停车等待处理；zwn为第n探测扫描周期雷达相对最危险目标的距离，zw(n+1)为下一个扫描周期雷达相对最危险目标的距离；
此设计中，先判断最危险目标的动静状态，若最危险目标始终为静态，则认为最危险目标为电线杆、树木等非生命体，否则，认为最危险目标为农作人员或者牲畜，通过摄像机采集最危险目标的图像并识别出最危险目标是否为人体，输出目标识别结果，若为人体，则导航箱发出声光报警，因为劳作人员自身有避险意识，劳作人员在听到农机的报警声后可能会走出农机行驶车道或者往远离农机运动方向行走，利用劳作人员的习惯性反应设置判断程序，适应性好，农机自动避开电线杆、牲畜等非人体的同时还可提醒农机前方的农作人员自觉避让，并根据农作人员的行为做继续行驶或停车等待处理。
作为本发明的进一步改进，所述距离传感器安装在滑块顶部的中心，距离传感器正对壳体内壁顶部。
作为本发明的进一步改进，所述距离传感器安装在壳体内壁顶部的中心，距离传感器正对滑块顶部的中心。
农机作业前，摄像机与雷达的标定是在水平地面的条件下进行的；而农机作业时，农田地面凹凸不平，由于雷达和摄像机并非安装于农机的同一位置，雷达和摄像机相对地面的高度不同且随着地形发生变化；距离检测装置一的工作过程具体的为，万向滚轮沿着凹凸不平的地面滚动，当地面凸出时，凸出地面给万向滚轮向上的作用力，滑块沿着壳体内壁向上滑动，滑块推动导向杆向上滑动，距离传感器检测滑块的上升距离，即雷达与地面间的高度变化量；向上凸的地面逐渐水平时，滑块逐渐向下滑动；当地面向下凹进时，滑块在自重的作用下，滑块向下滑动，直至万向滚轮与地面接触，距离传感器检测滑块与壳体内壁间的高度变化，距离传感器实时将检测到的雷达与当前地面间的高度变化值发送给工控机；距离检测装置二的工作原理跟距离检测装置一的工作原理相同，距离检测装置二实时将检测到的摄像机与当前地面间的高度变化值发送给工控机；
本发明与现有技术相比，本发明将毫米波雷达和摄像机结合起来感知农田环境，实时检测雷达和摄像机距离地面的高度变化，将高度变化量加入到雷达和摄像机坐标转换的平移向量中，农机作业时，使摄像机和雷达在空间上实现真正的同步，提高摄像机和雷达的融合精度；对噪声和干扰信号产生的随机噪声信号进行滤除，提高雷达探测信号的准确性；根据设定好的农机航向确定为农机行驶车道，将农机行驶车道内的障碍物目标初选为有效目标，再对初选的有效目标进行进一步检验，以进一步确定有效目标，提高雷达感知同车道内障碍物目标的有效性和准确性；选取最危险目标并跟踪最危险目标，摄像机以最危险目标的动静态为基础进行目标识别，若最危险目标为动态，只需要识别出动态目标是否为人体即可，不需要识别出具体类型，减小运算量，提高响应速度，导航箱根据图像识别结果控制农机动作，避免农机在无人驾驶时与障碍物碰撞；若识别结果为人体时，导航箱声光报警提醒劳作人员避开农机，利用人的习惯思维这一特性，不断检测人体是否偏离农机行驶车道或者人体向远离农机方向运动，导航箱根据检测结果控制农机是否做停车等待处理，适应性好；若最危险目标为静态，摄像机扫描出障碍物的轮廓，获取避障路径，控制农机的前轮转向角使农机按照设定的避障路径行走，同时，雷达一和雷达二检测农机避障过程中是否有新的障碍物存在，若有，农机停车等待，以确保农机的安全作业；本发明可应用于农机无人驾驶时农田环境自动感知的导航工作中。
附图说明
图1为本发明基于毫米波雷达和摄像机的感知农田环境方法的流程图。
图2为本发明中摄像机坐标系和车辆坐标系的关系示意图。
图3为本发明中摄像机坐标系与图像物理坐标系的关系示意图。
图4为本发明中图像物理坐标系与图像像素坐标系的关系示意图。
图5为本发明中农机行驶过程中农田环境示意图。
图6为本发明中农机行驶过程中车道判别示意图。
图7为本发明中对初选有效目标进行检验以进一步确定有效目标的流程图。
图8为本发明中的避障路径轨迹图。
图9为本发明中距离检测装置一的一个结构示意图。
图10为本发明中距离检测装置一的一个A-A向视图。
图11为本发明中距离检测装置的另一个结构示意图。
其中，1滑块，2壳体，3透气孔，4导向套，5导向杆，6限位阶，7容纳腔，8距离传感器，9万向滚轮。
具体实施方式
下面结合附图对本发明作进一步的说明。
实施例1
如图1～10所示的一种基于农田环境感知的农机导航控制方法，具体包括以下步骤：
步骤1：农机作业前，对摄像机进行标定，摄像机空间坐标变换，再对雷达视觉联合标定，使得雷达和视觉信息在空间上融合；
步骤2：农机作业时，距离检测装置一实时检测雷达与地面间的高度变化△hst，距离检测装置二实时检测摄像机与地面间的高度变化△hct，工控机进行数据处理实时调整雷达与摄像机坐标的转换关系，使雷达与摄像机在作业条件下实现在空间上的同步；
步骤3：工控机解算接收到的毫米波雷达数据，确定有效目标，选出农机作业前方雷达感兴趣的区域，确定最危险目标，同步进行摄像机图像的采集；
步骤4：根据雷达的信息判断出最危险目标的运动状态，工控机根据最危险目标的运动状态规划农机行走路径，根据雷达与相机采集到的最危险目标的图像数据，判断出最危险目标的类型，工控机将解析出来的动作指令传输给导航箱，导航箱控制农机做相应的动作；
其中，农机作业时，农机的行驶速度匀速；
距离检测装置一和距离检测装置二的结构相同，距离检测装置一安装在农机前侧且设置在雷达正下方，距离检测装置二安装在农机下侧且设置在摄像机正下方位置；如图9和图10所示，距离检测装置一包括具有容纳腔7且可开合的壳体2，容纳腔7为圆柱体状，壳体2内设有可沿着壳体2内壁做上下直线运动的滑块1，滑块1呈长方体状，滑块1顶部的中心安装有距离传感器8，距离传感器8正对壳体2内壁顶部；滑块1和壳体2内壁顶部之间连接有2个连接件，连接件关于滑块1在宽度方向上的中心对称设置；连接件包括导向套4，导向套4内设有可沿着导向套4内壁滑动的导向杆，滑块1的前后两侧与壳体2内壁之间留有可容纳导向杆的间隙，导向套4的底部开有导向孔并设有限制导向杆远离导向套4的限位阶6，导向杆穿过导向孔与滑块1外侧连接，导向套4的容纳腔7正上方对应的壳体2上开有至少一个透气孔3，滑块1的底部安装有可在地面上滚动的万向滚轮9；
工控机接收距离传感器8发送过来的数据信号并进行数据处理；
为了实现摄像机和毫米波雷达在空间上的初步同步，如图2～4所示，步骤1中的将车辆坐标转换成图像像素坐标具体包括以下步骤，
步骤1中的将车辆坐标转换成图像像素坐标具体包括以下步骤，
步骤1.1：农机作业前，地面默认为水平，将毫米波雷达固定安装在农机的前侧且位于农机纵向中轴，雷达发射面向外，使雷达发射面与地面垂直；安装摄像机时使摄像机的光轴与地面平行；
步骤1.2：以雷达的中心为原点建立雷达坐标系00-X0Y0Z0，毫米波雷达所在平面由X0轴和Y0轴确定并与Z0轴相垂直，Z0轴与地面平行且与农机中心轴线重合；建立摄像机坐标系Oc-XcYcZc，以摄像机的中心为原点Oc，平面XcOcYc平行于摄像机的成像平面，Zc轴是摄像机的取景光轴且垂直于成像平面；建立车辆坐标系Ow-XwYwZw，Ow为农机后轴的中心与车辆的中心轴线的交点，Xw轴水平向右并垂直于农机的纵向中轴线，Zw水平向前且与农机中心轴线重合，Yw轴垂直于水面地面向上，雷达坐标系的X0O0Z0平面与车辆坐标系的XwOwZw平面平行；
步骤1.3：光轴与成像平面相交的点是图像主点O’，车辆坐标通过旋转矩阵R和平移向量sc转换后得到摄像机坐标(xc，yc，zc，1)T，任意点P的车辆坐标为(xw，yw，zw，1)T，将车辆坐标转换为摄像机坐标，具体的转换关系如下，
Figure BDA0001494892550000161
式(1-1)中，R为一个三行三列的正交单位矩阵，sc(xc0，yc0，zc0)为初始条件下车辆坐标系到摄像机坐标系的1*3平移矩阵，xc0为摄像机所在的中心轴与车辆中心轴线两直线的距离，yc0为初始条件下摄像机距离地面的高度，zc0为摄像机距离农机后轴的距离；
步骤1.4：将摄像机坐标(xc，yc，zc，1)T转换到图像物理坐标(x1，y1)T，具体的转换关系如下，
Figure BDA0001494892550000162
式(1-2)中，f为摄像机的焦距，焦距单位为mm；
步骤1.5：将图像物理坐标(x1，y1)T转换到图像像素坐标(u,v)，具体的转换关系如下：
Figure BDA0001494892550000171
其中，dx,dy分别表示每个像素在横轴和纵轴上单位大小，u0、v0分别为图像像素坐标系下摄像机光轴和成像平面交点的横纵坐标，坐标单位为pixel；
步骤1.6：根据以上公式(1-1)～(1-3)得到图像像素坐标系到车辆坐标系的转换公式，具体的为，
Figure BDA0001494892550000172
步骤1.7：为了使雷达和视觉信息在空间上融合，将步骤1.6中的坐标转换关系更新为，
Figure BDA0001494892550000173
其中，s＝sc+s0，s0的坐标设为(xs0,ys0,zs0)，xs0＝0，ys0为初始条件下雷达距离地面的高度，zs0为雷达与农机后轴的距离；
将雷达坐标借助共用的车辆坐标系转化为图像坐标，雷达数据经三维坐标逆变换，完成目标信息匹配至视觉信息，雷达与摄像头空间的相对位置借助车辆坐标系求取即可；步骤2中的实时调整图像像素坐标与车辆坐标的转换关系，具体的为，根据农机的实际路况实时调整平移向量s，扫描周期t下调整后的平移向量st＝sc+s0+△st，实时的车辆坐标与图像像素坐标的转换关系，具体的为，
Figure BDA0001494892550000181
Figure BDA0001494892550000182
其中，△hct为扫描周期t下摄像机与地面高度的变化值，△hst为扫描周期t下雷达与地面高度的变化值，j为扫描周期数；
步骤2中实时调整后的平移向量中获得△ht的步骤如下，
步骤2.1：实时计算雷达与地面间的高度变化量以及摄像机与地面间的高度变化量，具体的为，
扫描周期t中i时刻与i-1时刻雷达与地面高度距离变化值为△hsti，采用平均法计算扫描周期t中雷达相对地面的高度变化量△hst，
Figure BDA0001494892550000183
假设扫描周期t中采样时刻i与采样时刻i-1下摄像机与地面高度变化值为△hcti，采用平均法计算扫描周期t中摄像机与地面的高度变化量△hct，
Figure BDA0001494892550000184
步骤2.2：实时计算出扫描周期t下自适应调整后的平移向量s，具体的为，
Figure BDA0001494892550000185
其中，k为一个扫描周期中的采样点的总数。
步骤3中的解算雷达数据确定有效目标，具体包括以下步骤，
步骤3.1：对雷达接收到的数据按照毫米波雷达协议进行解算，得到前方物体相对雷达的角度α、距离r、相对速度v、前方物体的反射强度并为每个目标分配唯一一个ID；
步骤3.2：对随机噪声信号进行滤波，保证雷达数据的连续有效性，具体的为，定义z＝[r,α,v]T为雷达的测量值，z(k)为毫米波雷达第k次输出的测量值，
d2＝S(z(k)-z(k-1))(z(k)-z(k-1))T＜rs 2 (3-1)
过滤掉不符合式(3-1)的数据信号；其中，d为相邻量测向量z(k)、z(k-1)之间的加权欧氏距离，S为加权矩阵，rs为设定的阈值；
步骤3.3：判定目标是否在农机行驶的车道内，当雷达前方物体满足di≤ds时，目标在农机行驶车道内，否则，目标不在农机行驶车道内，农机行驶车道内的目标初选为有效目标，并对其按照由近及远的准则进行排序编号；在农机行驶车道外的目标为非危险目标，将其排除；其中，ds为安全距离阈值，ds＝L/2+ks，di为i采样点下测得的目标与Z0轴之间的距离，L为农机上悬挂的犁具宽度，ks为设定的安全余量；
下面举例说明，从图5中可以看出，B、C这2个障碍物距离农机中心的纵向距离大于ds，在农机行驶车道外；A、D这2个障碍物距离农机中心的纵向距离小于ds，在农机行驶车道内，则A和D初选为有效目标；
图6中为障碍物在行驶车道内时的显示，障碍物E距离农机中心O农机的距离小于L/2+ks，E在农机行驶车道内；
步骤3.4：对初选的有效目标进行有效性检验，最终确定有效目标；
步骤3.5：根据确定好的有效目标，通过毫米波雷达获取的最近距离障碍物确定为候选的最危险目标，若dj≤dmin,dj为毫米波雷达获取的农机与ID是j的有效目标之间的距离，dmin为在毫米波雷达一个扫描周期内所获取的农机与最近有效目标的距离，则ID是j的有效目标为最危险目标；
步骤3.4中对初选的有效目标进行有效性检验具体包括以下步骤，
步骤3.4.1：对初选的有效目标进行预测，选取状态Sn＝[dn,vn,an],初选有效目标的状态预测方程为，
Figure BDA0001494892550000201
其中，d(n+1,n)、v(n+1,n)、a(n+1,n)是上一个扫描周期预测的有效障碍物目标的状态信息，dn,vn,an分别表示毫米波雷达第n探测周期内测得的有效障碍物目标的相对距离、相对速度、相对加速度，t是毫米波雷达的扫描周期；
步骤3.4.2：通过比较预测的第n+1周期有效目标的状态信息和雷达实际测得的第n+1周期有效目标的状态信息，具体如下，
Figure BDA0001494892550000202
其中，d0、v0、a0是设定的有效障碍物目标测量值与预测值之间的误差阈值；
步骤3.4.3：有效障碍物目标在雷达的扫描周期中被连续探测到m次以上，同时，满足步骤3.4.2中公式(3-3)的有效目标与初选有效目标一致，则更新目标的相对距离、相对速度、相对角度、编号信息；否则，初选的有效目标不处于毫米波雷达探测目标中，使用有效目标预测信息对初选的有效目标进行跟踪，若初选的有效目标在雷达的下一个扫描周期中仍然没有被探测到，则停止使用对应的初选有效目标信息，更新有效目标信息，并返回步骤3.4.1循环执行；
步骤4中判断最危险目标的动静状态，工控机根据最危险目标的运动状态规划农机行走路径具体包括以下步骤，
步骤4.1：根据步骤2.5中确定的最危险目标，不断更新最危险目标的相对速度和相对距离信息，判断最危险目标与雷达的距离是否在停车距离范围内，即zd>zmin(4-1)，zd为毫米波雷达探测到的雷达与最危险目标的相对距离，zmin为设定的停车距离阈值，最危险目标满足公式(4-1)时，农机继续行驶；
步骤4.2：根据相对速度大小判定最危险目标的动静状态，具体如下，
v≠v车 (4-2)
在连续的扫描周期内，(4-2)式始终成立时，判定目标的状态为动态，此时，工控机发出声光报警，zd≤zmin时，工控机将停车等待指令发送给导航箱，导航箱控制农机做停车等待处理；否则，农机继续行驶，并返回至步骤3.1循环执行，其中，v为雷达相对目标的速度大小，v车为农机的行驶速度；(4-2)式始终不成立时，判定目标为静态，则工控机做出避障处理，具体的为，摄像机扫描出障碍物的边缘轮廓，工控机根据农机的犁具宽度和农机最小转弯半径设定一条避障路径；工控机按照设定好的避障路径解析出农机的前轮转角，并将动作指令发送给导航箱，导航箱控制农机的前轮转角使农机按照设定的避障路径行走；
农机的左右两侧中心位置分别安装有雷达一和雷达二；农机在避障过程中，雷达一和雷达二不断扫描农机左右两侧是否有障碍物，设定雷达一与障碍物的相对距离为d1，设定雷达二与障碍物的相对距离为d2，根据以下公式判断农机是否继续按照避障路径行走，
d1<ds0 (4-3)
d2<ds0 (4-4)
(4-3)或(4-4)任意一个式子成立时，工控机做出停车等待决策，导航箱控制农机停下；否则，农机继续按照避障路径行走；
其中，ds0为设定的转弯安全距离，农机上安装有角度传感器，前轮转向角由角度传感器测得，角度传感器将检测到的转向角信号传输给工控机；
步骤4中根据雷达与相机采集到的最危险目标的图像数据，判断出最危险目标的类型具体包括以下步骤，
步骤4.1a：若最危险目标始终为静态，则导航箱控制农机做停车等待处理；否则，摄像机对最危险目标进行识别；
步骤4.2a：摄像机获取最危险目标的图像，将图像与训练好的人体样本训练库进行匹配比较，输出目标识别结果；
步骤4.3a：导航箱根据输出的目标识别结果控制农机动作，若为非人体，则导航箱发出声光报警，并控制农机做停车等待处理；若目标识别结果为人体，则导航箱发出声光报警，判断人体是否偏离农机行驶车道或者人体向远离农机方向运动，用以下公式判断，
zwn+1>zwn (4-3)
di>ds (4-4)
若雷达探测到的人体目标满足(4-3)或(4-4)，则农机继续向前行驶，否则导航箱控制农机做停车等待处理；zwn为第n探测扫描周期雷达相对最危险目标的距离，zw(n+1)为下一个扫描周期雷达相对最危险目标的距离；
如图8所示，步骤4.2中的避障路径具体的为，
以障碍物的中心为圆心O做特征圆，特征圆的半径为rmin+w/2，避障路径由圆弧段一、直线段一、圆弧段二、直线段二和圆弧段三组成，圆弧段一的一端与农机原始的直线路径相切，圆弧段一的另一端与直线段一的一端相切，直线段一的另一端和直线段二的一端分别与圆弧段二相切，直线段二的另一端与圆弧段三相切，圆弧段二为特征圆上的一段，圆弧段一和圆弧段三关于圆弧段二的中心线对称设置，农机依次经过圆弧段一、直线段一、圆弧段二、直线段二和圆弧段三绕过障碍物；其中，rmin为农机的最小转弯半径，w为农机的作业宽度，障碍物的外接圆半径小于最小转弯半径rmin；圆弧段一的半径为rmin，圆弧段三的半径为rmin，圆弧段一的起点记为H点，圆弧段一的圆心记为O1点，直线段一与农机原始的直线路径的相交点记为J，直线段一与圆弧段二的相切点记为D，农机原始路径与特征圆的相交点分别记为K和K’，JK＝w/2，圆弧段二的圆心记为O点，O的坐标设为(a，b)，圆弧段二的中心点记为B点，J点的坐标记为(x1，y1)，JD的方程可以写成：
y＝k(x-x1)+y1 (4-5)；
特征圆的方程可以写成：
(x-a)2+(y-b)2＝r2
Figure BDA0001494892550000231
r＝rmin+w/2 (4-6)
通过(4-5)和(4-6)可以求出k，D点为JD和特征圆的相交点，以此解出D点坐标；
设点O1的坐标为(x2,y2)，则点O1到直线JD的距离为：
Figure BDA0001494892550000232
根据公式(4-7)和(4-8)求出O1的坐标；则H点的坐标为(x2，y1)，B点的坐标为(a，b+r)；
步骤4中根据雷达与相机采集到的最危险目标的图像数据，判断出最危险目标的类型，导航箱控制农机做相应的动作，具体包括以下步骤，
步骤4.1a：最危险目标为动态的情形下，摄像机对最危险目标进行识别，摄像机获取最危险目标的图像，将图像与训练好的人体样本训练库进行匹配比较，输出目标识别结果；
步骤4.2a：导航箱根据输出的目标识别结果控制农机动作，若为非人体，则导航箱发出声光报警，并控制农机做停车等待处理；若目标识别结果为人体，则导航箱发出声光报警，判断人体是否偏离农机行驶车道或者人体向远离农机方向运动，用以下公式判断，
zwn+1>zwn (4-3)
di>ds (4-4)
若雷达探测到的人体目标满足(4-3)或(4-4)，则农机继续向前行驶，否则导航箱控制农机做停车等待处理；zwn为第n探测扫描周期雷达相对最危险目标的距离，zw(n+1)为下一个扫描周期雷达相对最危险目标的距离；
农机作业前，摄像机与雷达的标定是在水平地面的条件下进行的；而农机作业时，农田地面凹凸不平，由于雷达和摄像机并非安装于农机的同一位置，雷达和摄像机相对地面的高度不同且随着地形发生变化；距离检测装置一的工作过程具体的为，万向滚轮9沿着凹凸不平的地面滚动，当地面凸出时，凸出地面给万向滚轮9向上的作用力，滑块1沿着壳体2内壁向上滑动，滑块1推动导向杆向上滑动，距离传感器8检测滑块1的上升距离，即雷达与地面间的高度变化量；向上凸的地面逐渐水平时，滑块1逐渐向下滑动；当地面向下凹进时，滑块1在自重的作用下，滑块1向下滑动，直至万向滚轮9与地面接触，距离传感器8检测滑块1与壳体2内壁间的高度变化，距离传感器8实时将检测到的雷达与当前地面间的高度变化值发送给工控机；距离检测装置二的工作原理跟距离检测装置一的工作原理相同，距离检测装置二实时将检测到的摄像机与当前地面间的高度变化值发送给工控机；
本发明与现有技术相比，本发明将毫米波雷达和摄像机结合起来感知农田环境，通过距离检测装置一和距离检测装置二的设置分别实时检测雷达和摄像机距离地面的高度变化，将高度变化量加入到雷达和摄像机坐标转换的平移向量中；距离检测装置一和距离检测装置二的结构设计巧妙，检测精度高；农机作业时，使摄像机和雷达在空间上实现真正的同步，提高摄像机和雷达的融合精度；对噪声和干扰信号产生的随机噪声信号进行滤除，提高雷达探测信号的准确性；根据设定好的农机航向确定为农机行驶车道，将农机行驶车道内的障碍物目标初选为有效目标，再对初选的有效目标进行进一步检验，以进一步确定有效目标，提高雷达感知同车道内障碍物目标的有效性和准确性；选取最危险目标并跟踪最危险目标，摄像机以最危险目标的动静态为基础进行目标识别，若最危险目标为动态，只需要识别出动态目标是否为人体即可，不需要识别出具体类型，减小运算量，提高响应速度，导航箱根据图像识别结果控制农机动作，避免农机在无人驾驶时与障碍物碰撞；若识别结果为人体时，导航箱声光报警提醒劳作人员避开农机，利用人的习惯思维这一特性，不断检测人体是否偏离农机行驶车道或者人体向远离农机方向运动，导航箱根据检测结果控制农机是否做停车等待处理，适应性好；若最危险目标为静态，摄像机扫描出障碍物的轮廓，获取避障路径，控制农机的前轮转向角使农机按照设定的避障路径行走，同时，雷达一和雷达二检测农机避障过程中是否有新的障碍物存在，若有，农机停车等待，以确保农机的安全作业；本发明可应用于农机无人驾驶时农田环境自动感知的导航工作中。
实施例2
与实施例1的不同之处在于，如图11所示，距离传感器8安装在壳体22内壁顶部的中心，距离传感器8正对滑块1顶部的中心。
本发明并不局限于上述实施例，在本发明公开的技术方案的基础上，本领域的技术人员根据所公开的技术内容，不需要创造性的劳动就可以对其中的一些技术特征作出一些替换和变形，这些替换和变形均在本发明保护范围内。

Claims (8)

1.一种基于农田环境感知的农机导航控制方法，其特征在于，具体包括以下步骤，
步骤1：农机作业前，对摄像机进行标定，摄像机空间坐标变换，再对雷达视觉联合标定，使得雷达和视觉信息在空间上融合；
步骤2：农机作业时，距离检测装置一实时检测雷达与地面间的高度变化△hst，距离检测装置二实时检测摄像机与地面间的高度变化△hct，工控机进行数据处理实时调整雷达与摄像机坐标的转换关系，使雷达与摄像机在作业条件下实现在空间上的同步；
步骤3：工控机解算接收到的毫米波雷达数据，确定有效目标，选出农机作业前方雷达感兴趣的区域，确定最危险目标，同步进行摄像机图像的采集；
步骤4：根据雷达的信息判断出最危险目标的运动状态，工控机根据最危险目标的运动状态规划农机行走路径，根据雷达与相机采集到的最危险目标的图像数据，判断出最危险目标的类型，工控机将解析出来的动作指令传输给导航箱，导航箱控制农机做相应的动作；
其中，农机作业时，农机的行驶速度匀速；
所述距离检测装置一和距离检测装置二的结构相同，距离检测装置一安装在农机前侧且设置在雷达正下方，距离检测装置二安装在农机下侧且设置在摄像机正下方位置；所述距离检测装置一包括具有容纳腔且可开合的壳体，容纳腔为圆柱体状，所述壳体内设有可沿着壳体内壁做上下直线运动的滑块，壳体内设有检测滑块顶部与壳体内壁上侧距离变化的距离传感器，所述滑块和壳体内壁顶部之间连接有2个连接件，连接件关于滑块在宽度方向上的中心对称设置；所述连接件包括导向套，所述导向套内设有可沿着导向套内壁滑动的导向杆，滑块的前后两侧与壳体内壁之间留有可容纳导向杆的间隙，所述导向套的底部开有导向孔并设有限制导向杆远离导向套的限位阶，所述导向杆穿过导向孔与滑块外侧连接，所述导向套的容纳腔正上方对应的壳体上开有至少一个透气孔，所述滑块的底部安装有可在地面上滚动的万向滚轮；
工控机接收所述距离传感器发送过来的数据信号并进行数据处理；
所述步骤1中的将雷达坐标转换成图像像素坐标具体包括以下步骤，
步骤1.1：农机作业前，地面默认为水平，将毫米波雷达固定安装在农机的前侧且位于农机纵向中轴，雷达发射面向外，使雷达发射面与地面垂直；安装摄像机时使摄像机的光轴与地面平行；
步骤1.2：以雷达的中心为原点建立雷达坐标系00-X0Y0Z0，毫米波雷达所在平面由X0轴和Y0轴确定并与Z0轴相垂直，Z0轴与地面平行且与农机中心轴线重合；建立摄像机坐标系Oc-XcYcZc，以摄像机的中心为原点Oc，平面XcOcYc平行于摄像机的成像平面，Zc轴是摄像机的取景光轴且垂直于成像平面；建立车辆坐标系Ow-XwYwZw，Ow为农机后轴的中心与车辆的中心轴线的交点，Xw轴水平向右并垂直于农机的纵向中轴线，Zw水平向前且与农机中心轴线重合，Yw轴垂直于水面地面向上，雷达坐标系的X0O0Z0平面与车辆坐标系的XwOwZw平面平行；
步骤1.3：光轴与成像平面相交的点是图像主点O’，车辆坐标通过旋转矩阵R和平移向量sc转换后得到摄像机坐标(xc，yc，zc，1)T，任意点P的车辆坐标为(xw，yw，zw，1)T，将车辆坐标转换为摄像机坐标，具体的转换关系如下，
Figure FDA0002447910720000021
式(1-1)中，R为一个三行三列的正交单位矩阵，sc(xc0，yc0，zc0)为初始条件下车辆坐标系到摄像机坐标系的1*3平移矩阵，xc0为摄像机所在的中心轴与车辆中心轴线两直线的距离，yc0为初始条件下摄像机距离地面的高度，zc0为摄像机距离农机后轴的距离；
步骤1.4：将摄像机坐标(xc，yc，zc，1)T转换到图像物理坐标(x1，y1)T，具体的转换关系如下，
Figure FDA0002447910720000022
式(1-2)中，f为摄像机的焦距，焦距单位为mm；
步骤1.5：将图像物理坐标(x1，y1)T转换到图像像素坐标(u,v)，具体的转换关系如下：
Figure FDA0002447910720000023
其中，dx,dy分别表示每个像素在横轴和纵轴上单位大小，u0、v0分别为图像像素坐标系下摄像机光轴和成像平面交点的横纵坐标，坐标单位为pixel；
步骤1.6：根据以上公式(1-1)～(1-3)得到图像像素坐标系到车辆坐标系的转换公式，具体的为，
Figure FDA0002447910720000031
步骤1.7：为了使雷达和视觉信息在空间上融合，将步骤1.6中的坐标转换关系更新为，
Figure FDA0002447910720000032
其中，s＝sc+s0，s0的坐标设为(xs0,ys0,zs0)，xs0＝0，ys0为初始条件下雷达距离地面的高度，zs0为雷达与农机后轴的距离；
所述步骤2中的工控机进行数据处理实时调整雷达与摄像机坐标的转换关系，具体的为，根据农机的实际路况实时调整平移向量s，扫描周期t下调整后的平移向量st＝sc+s0+△st，实时的车辆坐标与图像像素坐标的转换关系，具体的为，
Figure FDA0002447910720000033
Figure FDA0002447910720000034
其中，△hct为扫描周期t下摄像机与地面高度的变化值，△hst为扫描周期t下雷达与地面高度的变化值，j为扫描周期数，(ut,vt)为农机作业过程中扫描周期t下实时更新计算得到的图像像素坐标；
农机行驶车道内的目标初选为有效目标，距离农机最近的障碍物为候选的最危险目标。
2.根据权利要求1所述的基于农田环境感知的农机导航控制方法，其特征在于，
所述步骤2中实时调整后的平移向量中获得△ht的步骤如下，
步骤2.1：实时计算雷达与地面间的高度变化量以及摄像机与地面间的高度变化量，具体的为，
扫描周期t中i时刻与i-1时刻雷达与地面高度距离变化值为△hsti，采用平均法计算扫描周期t中雷达相对地面的高度变化量△hst，
Figure FDA0002447910720000041
假设扫描周期t中采样时刻i与采样时刻i-1下摄像机与地面高度变化值为△hcti，采用平均法计算扫描周期t中摄像机与地面的高度变化量△hct，
Figure FDA0002447910720000042
步骤2.2：实时计算出扫描周期t下自适应调整后的平移向量s，具体的为，
Figure FDA0002447910720000043
其中，k为一个扫描周期中的采样点的总数。
3.根据权利要求2所述的基于农田环境感知的农机导航控制方法，其特征在于，所述步骤3中的解算雷达数据确定有效目标，具体包括以下步骤，
步骤3.1：对雷达接收到的数据按照毫米波雷达协议进行解算，得到前方物体相对雷达的角度α、距离r、相对速度v相对、前方物体的反射强度并为每个目标分配唯一一个ID；
步骤3.2：对随机噪声信号进行滤波，保证雷达数据的连续有效性，具体的为，定义z＝[r,α,v相对]T为雷达的测量值，z(k)为毫米波雷达第k次输出的测量值，
d2＝S(z(k)-z(k-1))(z(k)-z(k-1))T＜rs 2 (3-1)
过滤掉不符合式(3-1)的数据信号；其中，d为相邻量测向量z(k)、z(k-1)之间的加权欧氏距离，S为加权矩阵，rs为设定的阈值；
步骤3.3：判定目标是否在农机行驶的车道内，当雷达前方物体满足di≤ds时，目标在农机行驶车道内，否则，目标不在农机行驶车道内，农机行驶车道内的目标初选为有效目标，并对其按照由近及远的准则进行排序编号；在农机行驶车道外的目标为非危险目标，将其排除；其中，ds为安全距离阈值，ds＝L/2+ks，di为i采样点下测得的目标与Z0轴之间的距离，L为农机上悬挂的犁具宽度，ks为设定的安全余量；
步骤3.4：对初选的有效目标进行有效性检验，最终确定有效目标；
步骤3.5：根据确定好的有效目标，通过毫米波雷达获取的最近距离障碍物确定为候选的最危险目标，若dj≤dmin,dj为毫米波雷达获取的农机与ID是j的有效目标之间的距离，dmin为在毫米波雷达个扫描周期内所获取的农机与最近有效目标的距离，则ID是j的有效目标为最危险目标；
其中，所述步骤3.4中对初选的有效目标进行有效性检验具体包括以下步骤，
步骤3.4.1：对初选的有效目标进行预测，选取状态Sn＝[dn,vn,an],初选有效目标的状态预测方程为，
Figure FDA0002447910720000051
其中，d(n+1，n)、v(n+1，n)、a(n+1，n)是上一个扫描周期预测的有效障碍物目标的状态信息，dn，vn，an分别表示毫米波雷达第n探测周期内测得的有效障碍物目标的相对距离、相对速度、相对加速度，t是毫米波雷达的扫描周期；
步骤3.4.2：通过比较预测的第n+1周期有效目标的状态信息和雷达实际测得的第n+1周期有效目标的状态信息，具体如下，
Figure FDA0002447910720000052
其中，d0、v0、a0是设定的有效障碍物目标测量值与预测值之间的误差阈值；
步骤3.4.3：有效障碍物目标在雷达的扫描周期中被连续探测到m次以上，同时，满足步骤3.4.2中公式(3-3)的有效目标与初选有效目标一致，则更新目标的相对距离、相对速度、相对角度、编号信息；否则，初选的有效目标不处于毫米波雷达探测目标中，使用有效目标预测信息对初选的有效目标进行跟踪，若初选的有效目标在雷达的下一个扫描周期中仍然没有被探测到，则停止使用对应的初选有效目标信息，更新有效目标信息，并返回步骤3.4.1循环执行。
4.根据权利要求3所述的基于农田环境感知的农机导航控制方法，其特征在于，所述步骤4中判断最危险目标的动静状态具体包括以下步骤，
步骤4.1：根据步骤3.5中确定的最危险目标，不断更新最危险目标的相对速度和相对距离信息，判断最危险目标与雷达的距离是否在停车距离范围内，即zd>zmin(4-1)，zd为毫米波雷达探测到的雷达与最危险目标的相对距离，zmin为设定的停车距离阈值，最危险目标满足公式(4-1)时，农机继续行驶；
步骤4.2：根据相对速度大小判定最危险目标的动静状态，具体如下，v≠v车 (4-2)
在连续的扫描周期内，(4-2)式始终成立时，判定目标的状态为动态，此时，工控机发出声光报警，zd≤zmin时，工控机将停车等待指令发送给导航箱，导航箱控制农机做停车等待处理；否则，农机继续行驶，并返回至步骤3.1循环执行，其中，v为雷达相对目标的速度大小，v车为农机的行驶速度；(4-2)式始终不成立时，判定目标为静态，则工控机做出避障处理，具体的为，摄像机扫描出障碍物的边缘轮廓，工控机根据农机的犁具宽度和农机最小转弯半径设定一条避障路径；工控机按照设定好的避障路径解析出农机的前轮转角，并将动作指令发送给导航箱，导航箱控制农机按照设定的避障路径行走；
农机的左右两侧中心位置分别安装有雷达一和雷达二；农机在避障过程中，雷达一和雷达二不断扫描农机左右两侧是否有障碍物，设定雷达一与障碍物的相对距离为d1’，设定雷达二与障碍物的相对距离为d2’，根据以下公式判断农机是否继续按照避障路径行走，
d1’<ds0 (4-3)
d2’<ds0 (4-4)
(4-3)或(4-4)任意一个式子成立时，工控机做出停车等待决策，导航箱控制农机停下；
否则，农机继续按照避障路径行走；
其中，ds0为设定的转弯安全距离。
5.根据权利要求4所述的基于农田环境感知的农机导航控制方法，其特征在于，所述步骤4.2中的避障路径具体的为，
以障碍物的中心为圆心做特征圆，特征圆的半径为rmin+w/2，避障路径由圆弧段一、直线段一、圆弧段二、直线段二和圆弧段三组成，圆弧段一的一端与农机原始的直线路径相切，圆弧段一的另一端与直线段一的一端相切，直线段一的另一端和直线段二的一端分别与圆弧段二相切，直线段二的另一端与圆弧段三相切，圆弧段二为特征圆上的一段，圆弧段一和圆弧段三关于圆弧段二的中心线对称设置，农机依次经过圆弧段一、直线段一、圆弧段二、直线段二和圆弧段三绕过障碍物，其中，rmin为农机的最小转弯半径，w为农机的作业宽度，障碍物的外接圆半径小于最小转弯半径rmin；圆弧段一的半径为rmin，所述圆弧段三的半径为rmin，圆弧段一的起点记为H点，圆弧段一的圆心记为O1点，直线段一与农机原始的直线路径的相交点记为J，直线段一与圆弧段二的相切点记为D，农机原始路径与特征圆的相交点分别记为K和K’，JK＝w/2，圆弧段二的圆心记为O点，O的坐标设为(a，b)，圆弧段二的中心点记为B点，J点的坐标记为(x1’，y1’)，JD的方程可以写成：
y＝k(x-x1)+y1 (4-5)；
特征圆的方程可以写成：
(x-a)2+(y-b)2＝r2
Figure FDA0002447910720000071
r＝rmin+w/2 (4-6)
通过(4-5)和(4-6)可以求出k，D点为JD和特征圆的相交点，以此解出D点坐标；
设点O1的坐标为(x2,y2)，则点O1到直线JD的距离为：
Figure FDA0002447910720000072
y2′＝y1′+rmin (4-8)
根据公式(4-7)和(4-8)求出O1的坐标；则H点的坐标为(x2，y1)，B点的坐标为(a，b+r)。
6.根据权利要求5所述的基于农田环境感知的农机导航控制方法，其特征在于，所述步骤4中根据雷达与相机采集到的最危险目标的图像数据，判断出最危险目标的类型，导航箱控制农机做相应的动作，具体包括以下步骤，
步骤4.1a：最危险目标为动态的情形下，摄像机对最危险目标进行识别，摄像机获取最危险目标的图像，将图像与训练好的人体样本训练库进行匹配比较，输出目标识别结果；
步骤4.2a：导航箱根据输出的目标识别结果控制农机动作，若为非人体，则导航箱发出声光报警，并控制农机做停车等待处理；若目标识别结果为人体，则导航箱发出声光报警，判断人体是否偏离农机行驶车道或者人体向远离农机方向运动，用以下公式判断，
zw(n+1)>zwn (4-3)
di>ds (4-4)
若雷达探测到的人体目标满足(4-3)或(4-4)，则农机继续向前行驶，否则导航箱控制农机做停车等待处理；zwn为第n探测扫描周期雷达相对最危险目标的距离，zw(n+1)为下一个扫描周期雷达相对最危险目标的距离。
7.根据权利要求1～6任一项所述的基于农田环境感知的农机导航控制方法，其特征在于，所述距离传感器安装在滑块顶部的中心，距离传感器正对壳体内壁顶部。
8.根据权利要求1～6任一项所述的基于农田环境感知的农机导航控制方法，其特征在于，所述距离传感器安装在壳体内壁顶部的中心，距离传感器正对滑块顶部的中心。
CN201711267862.0A 2017-03-10 2017-12-05 基于农田环境感知的农机导航控制方法 Active CN108082181B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN2017101418102 2017-03-10
CN201710141810.2A CN106874887A (zh) 2017-03-10 2017-03-10 基于农田环境感知的农机导航控制方法

Publications (2)

Publication Number Publication Date
CN108082181A CN108082181A (zh) 2018-05-29
CN108082181B true CN108082181B (zh) 2020-06-09

Family

ID=59170304

Family Applications (2)

Application Number Title Priority Date Filing Date
CN201710141810.2A Pending CN106874887A (zh) 2017-03-10 2017-03-10 基于农田环境感知的农机导航控制方法
CN201711267862.0A Active CN108082181B (zh) 2017-03-10 2017-12-05 基于农田环境感知的农机导航控制方法

Family Applications Before (1)

Application Number Title Priority Date Filing Date
CN201710141810.2A Pending CN106874887A (zh) 2017-03-10 2017-03-10 基于农田环境感知的农机导航控制方法

Country Status (1)

Country Link
CN (2) CN106874887A (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109471432B (zh) * 2018-11-08 2021-09-28 南京农业大学 一种自主导航农用车最短避障路径规划方法
CN111157996B (zh) * 2020-01-06 2022-06-14 珠海丽亭智能科技有限公司 一种停车机器人行驶安全检测方法
CN113465590B (zh) * 2021-06-29 2024-03-15 三一专用汽车有限责任公司 路径规划方法和装置、自动驾驶方法和装置及作业机械
CN113778081B (zh) * 2021-08-19 2022-07-22 中国农业科学院农业资源与农业区划研究所 一种基于激光雷达和视觉的果园路径识别方法和机器人
CN115067012B (zh) * 2022-07-22 2022-12-20 安徽理工大学 一种基于农田环境感知的农机导向装置
CN116338608B (zh) * 2023-05-22 2023-07-28 亿慧云智能科技（深圳）股份有限公司 微波雷达探测角度调整方法、装置、设备及存储介质
CN117671622B (zh) * 2023-10-23 2024-06-07 天津大学 一种用于无人驾驶采棉机的离线规划触视融合生长式棉垄自标注方法
CN117784264B (zh) * 2024-02-28 2024-05-24 山东大学 基于探地雷达数据的输电塔间地下病害定位方法及系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102508246A (zh) * 2011-10-13 2012-06-20 吉林大学 车辆前方障碍物检测跟踪方法
CN104965202A (zh) * 2015-06-18 2015-10-07 奇瑞汽车股份有限公司 障碍物探测方法和装置
CN105574542A (zh) * 2015-12-15 2016-05-11 中国北方车辆研究所 基于多传感器融合的多视觉特征车辆检测方法
CN105799776A (zh) * 2016-04-22 2016-07-27 扬州大学 基于北斗导航的农业机械自动驾驶耕作控制系统及方法
CN205843680U (zh) * 2016-07-07 2016-12-28 西北农林科技大学 一种果园机器人的视觉导航系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102508246A (zh) * 2011-10-13 2012-06-20 吉林大学 车辆前方障碍物检测跟踪方法
CN104965202A (zh) * 2015-06-18 2015-10-07 奇瑞汽车股份有限公司 障碍物探测方法和装置
CN105574542A (zh) * 2015-12-15 2016-05-11 中国北方车辆研究所 基于多传感器融合的多视觉特征车辆检测方法
CN105799776A (zh) * 2016-04-22 2016-07-27 扬州大学 基于北斗导航的农业机械自动驾驶耕作控制系统及方法
CN205843680U (zh) * 2016-07-07 2016-12-28 西北农林科技大学 一种果园机器人的视觉导航系统

Also Published As

Publication number Publication date
CN108082181A (zh) 2018-05-29
CN106874887A (zh) 2017-06-20

Similar Documents

Publication Publication Date Title
CN108089185B (zh) 基于农田环境感知的农机无人驾驶导航方法
CN108154084B (zh) 用于农机无人驾驶的多传感器融合的农田环境感知方法
CN108082181B (zh) 基于农田环境感知的农机导航控制方法
CN108107887B (zh) 农机导航用农田环境感知方法
CN106950952B (zh) 用于农机无人驾驶的农田环境感知方法
CN108169743B (zh) 农机无人驾驶用农田环境感知方法
CN113156421A (zh) 基于毫米波雷达和摄像头信息融合的障碍物检测方法
CN113424079A (zh) 障碍物检测方法、装置、计算机设备和存储介质
US20200090366A1 (en) Device and method for detection and localization of vehicles
EP3825903A1 (en) Method, apparatus and storage medium for detecting small obstacles
US10101448B2 (en) On-board radar apparatus and region detection method
CN113850102B (zh) 基于毫米波雷达辅助的车载视觉检测方法及系统
CN105700525B (zh) 基于Kinect传感器深度图机器人工作环境不确定性地图构建法
CN113378741B (zh) 一种基于多源传感器的飞机牵引车辅助感知方法及其系统
CN111178295A (zh) 车位检测和模型训练方法、装置、车辆、设备及存储介质
CN111123262B (zh) 自动驾驶3d建模方法、装置及系统
CN110136186B (zh) 一种用于移动机器人目标测距的检测目标匹配方法
CN117058236A (zh) 一种基于多目视觉系统自切换的目标识别定位方法
CN115877347A (zh) 一种矿区障碍检测方法、系统、电子设备及可读存储介质
CN115151836A (zh) 用于探测车辆周围环境中的移动对象的方法和机动车辆
CN111126363B (zh) 自动驾驶车辆的物体识别方法及装置
Abdo et al. Mobile robot localization evaluations with visual odometry in varying environments using Festo-Robotino
CN116380110B (zh) 一种基于大数据无人驾驶车辆实时路径规划方法
CN113971699A (zh) 目标物识别方法、装置、电子设备和存储介质
CN115035359A (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