一种标准果蔬菜园用多源传感器表型采集装备及方法与流程
本发明属于农业机器人及多源传感器采集,具体为一种标准果蔬菜园用多源传感器表型采集装备及方法。
背景技术:
1、现有基于四足机器人的田间表型采集系统,通常在四足机器人本体背部通过防振支撑框架安装云台,云台上搭载激光雷达与工业相机,出厂标定后沿巡检路径采集数据。
2、该系统在果蔬菜园垄沟起伏地形下进行多源传感器同步采集时存在特有缺陷:地面感知、云台稳定、植株采集与避障保护四个环节彼此独立运行——地面感知仅用于导航,云台仅响应已发生的晃动,植株采集与避障由各自独立传感器执行且信号互不通联。该缺陷的物理机理在于:激光雷达在采集植株外形点云时,其输出的同一帧点云中天然包含地面点云与障碍物点云,但现有架构将点云数据仅用于植株三维重建,地面点云被作为"无用数据"过滤丢弃,障碍物检测另行由独立传感器完成——同一数据源的不同分量被割裂分配至互不通联的功能模块。由于缺乏对前方地形的预先感知,云台只能在机身已发生俯仰晃动后执行反馈补偿,无法在姿态恶化前主动调整。常规手段难以解决该矛盾:增加被动减振厚度会抬高重心降低稳定性;提高imu反馈控制带宽仅能缩小响应延迟,无法实现地形预判;增设专用地形传感器则增加系统复杂度和成本。上述缺陷仅在果蔬菜园非结构化垄沟地面与多源传感器高精度同步采集需求同时存在时产生——在平坦路面或单一传感器采集场景下,该问题并不显著。
3、为此,本发明提出了一种标准果蔬菜园用多源传感器表型采集装备及方法来解决上述问题。
技术实现思路
1、针对上述情况,为克服现有技术的缺陷,本发明提供一种标准果蔬菜园用多源传感器表型采集装备及方法,有效的解决了上述背景技术中提出的问题。
2、为实现上述目的,本发明提供如下技术方案:一种标准果蔬菜园用多源传感器表型采集装备,包括四足机器人本体,四足机器人本体顶部自下而上依次设有支撑防护机构、旋转机构、云台和采集机构;
3、支撑防护机构包括防振支撑框架,防振支撑框架内部嵌有高弹复合硅胶减震垫,构成第一层保护;
4、旋转机构包括旋转电机,旋转电机的输出轴外部固定有旋转台,旋转台的输出轴顶部与云台固定连接;
5、云台内设三轴伺服电机并接入机身内置的imu惯性测量单元,云台顶部设有俯仰双头电机,构成第二层保护;
6、采集机构包括激光雷达,激光雷达侧部设有工业相机;
7、还包括边缘计算模块,边缘计算模块分别与激光雷达、工业相机、云台电连接,构成第三层保护;
8、通过激光雷达接收环境点云信号并提取地面点云,生成云台预补偿控制量后输出至俯仰双头电机执行反向俯仰、旋转电机执行水平旋转;
9、云台稳定后触发激光雷达和工业相机同步采集三维点云和rgb图像,并通过激光雷达持续接收地面点云回传信号更新地形起伏指标;
10、通过激光雷达接收同一帧激光点云信号提取障碍物距离,当小于安全阈值且imu倾角信号超过阈值时生成自锁信号,驱动云台带动激光雷达和工业相机缩回安全仓并关断电源。
11、优选的,四足机器人本体末端设有四个机器人大腿,每个机器人大腿底部铰接有小腿;
12、四足机器人本体侧壁固定有电池,四足机器人本体顶部固定有雷达,四足机器人本体头部固定有移动相机,四足机器人本体头部底端固定有超声传感器。
13、优选的,防振支撑框架底部固定有连接板,螺栓穿过连接板上的若干个连接孔与四足机器人本体可拆卸连接,防振支撑框架顶部可拆卸连接有顶部框架;
14、旋转电机与顶部框架固定连接,云台顶部固定有俯仰铰接块,俯仰铰接块外部通过转轴铰接有俯仰铰接板,转轴与俯仰铰接板固定连接,转轴与俯仰双头电机的输出轴固定连接。
15、优选的,俯仰铰接板顶部可拆卸连接有激光雷达支架,激光雷达支架与激光雷达固定连接,激光雷达支架侧壁固定有工业相机,工业相机与其内部的工业相机支架固定连接,工业相机支架末端可拆卸连接有镜头。
16、本发明还提供了一种标准果蔬菜园用多源传感器表型采集方法,基于如上述所述的一种标准果蔬菜园用多源传感器表型采集装备,采集方法由边缘计算模块执行,包括以下步骤:
17、步骤一:通过边缘计算模块激光雷达提取的远距离地面点云信号并提取远距离地形起伏指标,通过雷达接收中距离环境回波信号并提取中距离地形趋势信号,通过超声传感器接收近距离地面回波信号并提取近距离地形高程信号,将三者加权融合生成融合地形预判信号;通过imu接收三轴角速度与加速度信号经融合解算生成机身姿态扰动矢量;将融合地形预判信号与机身姿态扰动矢量联合前馈融合生成云台预补偿控制量,输出至俯仰双头电机执行反向俯仰、输出至旋转电机执行水平旋转;
18、步骤二:云台稳定后,通过同步触发单元触发激光雷达、工业相机、雷达、移动相机和超声传感器同步采集多源数据,并将地面点云和超声距离信号回传以更新融合地形预判信号;
19、步骤三:通过激光雷达接收远距离障碍物信号并提取远距离障碍物距离数据,通过雷达接收中距离障碍物信号并提取中距离障碍物距离数据,通过超声传感器接收近距离障碍物信号并提取近距离障碍物距离数据,通过边缘计算模块将、、加权融合生成;
20、步骤四:通过边缘计算模块将与imu倾角信号联合判断,当小于安全阈值且imu倾角超过阈值时生成自锁信号,驱动俯仰双头电机和旋转电机带动激光雷达和工业相机缩回安全仓,并输出断电信号至全部传感器电源端。
21、优选的,通过激光雷达接收远距离地面点云信号并计算前方0.5-2.0m范围内地面点云的高度方差与坡度角生成远距离地形起伏指标,通过雷达101接收中距离环境回波信号经点云粗分割生成中距离地形趋势信号,通过超声传感器接收近距离地面回波信号经距离解算生成近距离地形高程信号,三者按0.5:0.3:0.2权重融合生成融合地形预判信号;
22、将融合地形预判信号与机身姿态扰动矢量按0.5:0.5权重合成云台预补偿控制量。
23、优选的,将、、按0.5:0.3:0.2权重加权融合生成;
24、通过同步触发单元以30hz频率触发激光雷达、工业相机、雷达、移动相机和超声传感器同步采集,并通过ros 2框架对采集数据进行时间戳同步标记与存储。
25、优选的,通过边缘计算模块的arm处理器读取由imu足端里程计积分获得的四足机器人当前行进速度v,当v<0.3m/s时超声传感器权重提高至0.4、激光雷达权重降低至0.3,当v>0.6m/s时激光雷达权重提高至0.6、超声传感器权重降低至0.1,以动态调整所述地形预判信号的融合权重。
26、优选的,通过标定板图像序列与激光点云帧数据,经奇异值分解法求解初始刚体变换矩阵外参后,代入最小重投影误差非线性优化目标函数迭代优化,其中为标定板特征点在工业相机图像中的像素坐标,为该特征点在激光雷达坐标系下的三维空间点坐标,k为工业相机的内参矩阵,r为旋转矩阵,t为平移向量;采用列文伯格-马夸尔特算法迭代,当重投影误差小于0.5像素时停止迭代,输出优化后的刚体变换矩阵外参。
27、优选的,安全阈值为0.5m,倾角阈值为45°,且二者须同时满足时边缘计算模块才生成自锁信号。
28、与现有技术相比,本发明的有益效果是:
29、(1) 本装置通过激光雷达、雷达与超声传感器按0.5:0.3:0.2权重提取远中近距离地形信号,并与imu姿态扰动矢量按0.5:0.5权重前馈融合,使云台在机身姿态变化前执行反向补偿,将垄沟地形中俯仰角标准差从±1.8°降至±0.6°、图像重投影误差从2.1像素降至0.7像素;同时将障碍物距离、、按同权重融合并与倾角信号联动自锁,使避障误触发率从22%降至3%,解决了背景技术所述各环节独立运行无法形成因果闭环的缺陷。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com