基于小区育种的电驱播种施肥控制系统及控制方法
本发明涉及机械控制,具体为基于小区育种的电驱播种施肥控制系统及控制方法。
背景技术:
1、小区育种是农业科研中培育、筛选、评估作物品种的核心环节。与大田作物的连续规模化播种不同,小区育种具有极高的空间局限性和特异性,对边界隔离要求极其严苛。为了在同一块试验田内有效对比不同品种的性状,需要在紧邻的各个小区间精确留出隔离带,并确保各小区的作业完全独立。在小区边界衔接处,系统需要具备瞬时切断与精准开播的能力,以防造成混种、重播或交叉污染,这直接关系到育种试验的成败。随着农机装备机电一体化程度的提高,基于微控制器的电控排种系统正逐步取代存在滑移累积误差的传统纯机械地轮传动结构,以适应智能育种的高精度需求。
2、现有技术中,例如公开号为cn106444507a公开了一种基于可编程的免耕旋播机控制系统及其方法。该方案通过霍尔传感器检测地轮转速,在播种电机轴上安装旋转编码器检测实际转速,并在排种器下方的分流装置内设置红外对管以检测实际落种量。其控制系统采用双闭环结构,通过比例积分计算自动调节电机驱动电压,实现播种速度对行走速度的自适应跟随。这种反馈调节机制在一定程度上提高了常规连续作业状态下播种株距的均匀性,摆脱了部分传统机械长传动链的限制。
3、尽管上述现有技术引入了电子反馈调节提升了稳态作业的精度,但在面对具有空间边界约束的离散化控制任务时,仍存在明显的技术不足。现有控制系统多依赖实时速度或位置反馈进行事后跟随调节,控制系统下达断料指令到执行机构完成动作之间存在固有的机械响应滞后,同时物料下落也存在不可避免的物理延迟。由于缺乏对机电滞后与物理延迟的前馈补偿,系统在实际作业下难以实现真正的边界瞬时启停,容易导致机器驶入隔离带时仍在工作,产生拖尾越界现象,破坏隔离带的纯净度。因此,如何克服系统固有的机械响应滞后与物料落体延迟,实现设备在物理边界处的停止与启动以避免拖尾越界,是本领域待解决的技术问题。
4、在所述背景技术部分公开的上述信息仅用于加强对本公开的背景的理解,因此它可以包括不构成对本领域普通技术人员已知的现有技术的信息。
技术实现思路
1、本发明的目的在于提供基于小区育种的电驱播种施肥控制系统及控制方法,以解决上述背景技术中提出的问题。
2、为实现上述目的,本发明提供如下技术方案:
3、基于小区育种的电驱播种施肥控制系统,具体包括:
4、数据获取模块,用于获取作业段规划参数、第一执行电机和第二执行电机的基础工作参数,以及移动作业平台运动数据;
5、目标转速计算模块,用于根据移动作业平台运动数据计算实际水平运行速度,并根据实际水平运行速度、作业段规划参数及两个执行电机的基础工作参数,分别确定第一执行电机目标转速和第二执行电机目标转速;
6、动作控制模块,用于根据基础工作参数确定对应的目标反向转动角度和安全制动角加速度,并计算第一执行电机由运行状态减速至停止及完成反向转动所需的动作耗时;
7、位置控制模块,用于根据地理位置信息确定移动作业平台在当前作业段内的剩余距离,并根据实际水平运行速度、动作耗时及基础工作参数,分别确定第一临界控制距离和第二临界控制距离;
8、换向控制模块,用于将剩余距离分别与第一临界控制距离和第二临界控制距离进行比较,当剩余距离小于或等于第一临界控制距离时,控制第一执行电机按照对应的安全制动角加速度减速至停止,并按照对应的目标反向转动角度执行反向转动,剩余距离小于或等于第二临界控制距离时,控制第二执行电机停止运行;
9、启动控制模块,用于根据下一作业段的规划参数、两个执行电机的基础工作参数及实际水平运行速度,分别确定第一启动空间阈值和第二启动空间阈值,并在作业段转换区域的剩余距离小于或等于相应启动空间阈值时,分别提前启动第一执行电机和第二执行电机。
10、进一步地,作业段规划参数包括:预设的各作业段长度、各隔离带长度、第一物料单粒平均质量、第一物料投放间隔及第二物料投放量;
11、第一执行电机和第二执行电机的基础工作参数包括:预设的第一作业平台每转孔数、第一作业平台吸料半径、第一物料延迟时间、第二物料延迟时间、第一物料气压吸附力、余料清理结构夹角及柔性加加速度系数;
12、其中,第一物料延迟时间为第一执行电机的响应延迟时间与第一物料从脱落口到落入沟底的时间之和,第二物料延迟时间为第二执行电机的响应延迟时间与第二物料从脱落口到落入沟底的时间之和;
13、移动作业平台运动数据包括:移动作业平台绝对地速、移动作业平台俯仰角及移动作业平台地理坐标。
14、进一步地,根据移动作业平台绝对地速及移动作业平台俯仰角,将移动作业平台绝对地速与移动作业平台俯仰角的余弦值进行乘积运算,得到实际水平运行速度;
15、计算第一执行电机目标转速,所依据逻辑如下:
16、将第一作业平台每转孔数与第一物料投放间隔进行乘积运算,并计算实际水平运行速度与该乘积运算结果的比值,得到第一作业平台目标转速,将第一作业平台目标转速与预设的第一执行电机传动比进行乘积运算,得到第一执行电机目标转速;
17、计算第二执行电机目标转速,所依据逻辑如下:
18、将预设的目标第二物料投放量与实际水平运行速度进行乘积运算,得到单位时间内需要的第二物料投放量,计算单位时间内需要的第二物料投放量预设的第二执行电机单圈物料投放量的比值,得到第二作业平台目标转速,将第二作业平台目标转速与预设的第二执行电机传动比进行乘积运算,得到第二执行电机目标转速。
19、进一步地,在进行工作前,根据基础工作参数,计算截断第一物料所需的目标反转角度及安全制动角加速度;
20、其中,计算目标反转角度,所依据逻辑如下:
21、计算周角360°与第一作业平台每转孔数的比值,将该比值与预设的安全拉回系数进行乘积运算,并将该乘积运算结果与余料清理结构夹角进行加和运算,得到第一作业平台回转角度,将第一作业平台回转角度与第一执行电机传动比进行乘积运算,得到第一执行电机的目标反转角度;
22、其中,计算防止第一物料洒落的安全制动角加速度,所依据逻辑如下:
23、计算第一物料单粒平均质量、预设的重力加速度及预设的防脱落临界相角的正弦值的乘积,得到第一物料重力切向分力,将第一物料气压吸附力与第一物料重力切向分力和预设的第一物料摩擦阻力之和,进行差值运算,将差值运算结果与第一物料单粒平均质量和第一作业平台吸料半径之积进行比值运算,得到第一作业平台极限角加速度,将第一作业平台极限角加速度与第一执行电机传动比进行乘积运算,得到第一执行电机的安全制动角加速度。
24、进一步地,根据安全制动角加速度与目标反转角度,结合第一执行电机目标转速,计算第一执行电机从第一执行电机目标转速减速至0的减速耗时,及从第一执行电机转速0开始加速后减速,完成目标反转角度的反转耗时,将减速耗时与反转耗时进行加和运算,得到第一执行电机反转至目标反转角度所需的动作耗时;
25、其中,计算减速耗时,所依据逻辑如下:
26、根据转速与角速度换算关系,将第一执行电机目标转速转化为第一执行电机目标角速度,将第一执行电机目标角速度与安全制动角加速度进行比值运算,得到刚性减速时间;
27、将安全制动角加速度与柔性加加速度进行比值计算,得到柔性过渡时间;
28、将刚性减速时间与柔性过渡时间进行加和运算,得到减速耗时;
29、其中,计算反转耗时,所依据逻辑如下:
30、将目标反转角度与安全制动角加速度进行比值运算,并将比值运算结果进行开方处理后乘以常数2,得到反转耗时。
31、进一步地,其中,当前作业段内的剩余距离通过计算当前移动作业平台地理坐标与起始移动作业平台地理坐标变化,得到移动作业平台水平运动距离,使用预设的当前作业段长度与移动作业平台水平运动距离进行差值运算,得到当前作业段内的剩余距离;
32、根据基础工作参数及第一执行电机反转所需的动作耗时,分别得到第一临界控制距离与第二临界控制距离;
33、其中,计算第一临界控制距离,所依据逻辑如下:
34、将第一物料延迟时间与动作总耗时进行加和运算,得到反转总时间,将实际水平运行速度与反转总时间进行乘积运算,得到第一临界控制距离;
35、其中,计算第二临界控制距离,所依据逻辑如下:
36、将实际水平运行速度与第二物料延迟时间进行乘积运算,得到第二临界控制距离。
37、进一步的,根据第一临界控制距离与第二临界控制距离,分别与当前作业段内的剩余距离进行对比,根据对比结果分别执行第一执行电机及第二执行电机控制动作;
38、若当前作业段内的剩余距离小于等于第一临界控制距离,则控制第一执行电机的角速度以安全制动角加速度进行减速至0,然后根据目标反转角度及安全制动角加速度执行反转操作;
39、若当前作业段内的剩余距离大于第一临界控制距离,则控制第一执行电机继续工作;
40、若当前作业段内的剩余距离小于等于第二临界控制距离,则控制第二执行电机停止工作;
41、若当前作业段内的剩余距离大于第二临界控制距离,则控制第二执行电机继续工作。
42、进一步的,根据作业段规划参数、基础工作参数及实际水平运行速度,进行提前启动第一执行电机控制逻辑如下:
43、根据位置控制模块中,移动作业平台与当前作业段内的剩余距离计算逻辑,计算移动作业平台与当前隔离带剩余距离;
44、根据作业段规划参数及基础工作参数,调用转速控制模块,得到下一工作段的第一执行电机目标转速,根据转速与角速度换算关系,将下一工作段的第一执行电机目标转速转化为下一小区的第一执行电机目标角速度;
45、将安全制动角加速度与目标反转角度进行乘积运算,并将乘积运算结果乘以常数2后进行开方处理,得到第一执行电机以安全制动角加速度从静止状态持续加速,在目标反转角度内能达到的最高终点角速度;
46、将下一工作段的第一执行电机目标角速度与最高终点角速度进行对比,取二者最小值为角速度限幅值;
47、将目标反转角度与角速度限幅值进行比值运算,将角速度限幅值与2倍的安全制动角加速度进行比值运算,将两次比值运算进行加和运算,并将该加和运算结果与第一物料延迟时间进行相加,得到第一物料前馈耗时;
48、将实际水平运行速度与第一物料前馈耗时进行乘积运算,得到第一执行电机的启动空间阈值;
49、若当前隔离带剩余距离小于等于第一执行电机的启动空间阈值时,则提前启动第一执行电机;
50、若当前隔离带剩余距离大于第一执行电机的启动空间阈值时,则不提前启动第一执行电机。
51、进一步的,根据基础工作参数及实际水平运行速度,进行提前启动第二执行电机控制逻辑如下:
52、将实际水平运行速度与第二物料延迟时间进行乘积运算,得到第二执行电机的启动空间阈值;
53、若移动作业平台与当前隔离带剩余距离小于等于第二执行电机的启动空间阈值时,则提前启动第二执行电机;
54、若移动作业平台与当前隔离带剩余距离大于第二执行电机的启动空间阈值时,则不提前启动第二执行电机。
55、为实现上述目的,本发明还提供如下技术方案:
56、基于小区育种的电驱播种施肥控制方法,所述方法由上述任一项所述的基于小区育种的电驱播种施肥控制系统执行,包括:
57、步骤1:获取作业段规划参数、第一执行电机和第二执行电机的基础工作参数,以及移动作业平台运动数据;
58、步骤2:根据绝对运行速度和俯仰角计算实际水平运行速度,并根据实际水平运行速度、作业段规划参数及两个执行电机的基础工作参数,分别确定第一执行电机目标转速和第二执行电机目标转速;
59、步骤3:根据基础工作参数确定对应的目标反向转动角度和安全制动角加速度,并计算第一执行电机由运行状态减速至停止及完成反向转动所需的动作耗时;
60、步骤4:根据地理位置信息确定移动作业平台在当前作业段内的剩余距离,并根据实际水平运行速度、动作耗时及基础工作参数,分别确定第一临界控制距离和第二临界控制距离;
61、步骤5:将剩余距离分别与第一临界控制距离和第二临界控制距离进行比较,当剩余距离小于或等于第一临界控制距离时,控制第一执行电机按照对应的安全制动角加速度减速至停止,并按照对应的目标反向转动角度执行反向转动,剩余距离小于或等于第二临界控制距离时,控制第二执行电机停止运行;
62、步骤6:根据下一作业段的规划参数、两个执行电机的基础工作参数及实际水平运行速度,分别确定第一启动空间阈值和第二启动空间阈值,并在作业段转换区域的剩余距离小于或等于相应启动空间阈值时,分别提前启动第一执行电机和第二执行电机。
63、与现有技术相比,本发明的有益效果是:
64、本发明根据移动作业平台绝对地速及移动作业平台俯仰角计算得到的实际水平运行速度,结合基础工作参数与第一执行电机完成反转所需的动作耗时,分别获取第一临界控制距离及第二临界控制距离;并在移动作业平台在当前作业段内剩余距离小于等于第一临界控制距离或第二临界控制距离时,触发相应的第一执行电机及第二执行电机控制动作。本方案将排料流程中的动作时间耗费转换为空间维度的距离临界值,通过对距离参数的持续比对来下达动作指令,在空间位移上补偿了机械动作的执行耗时。这一设计减弱了地速波动及机电延迟造成的空间位置偏移,使断料动作的作用范围合理贴合小区的预设边界,改善了设备惯性引起的越界落料现象;
65、本发明还通过根据基础工作参数计算第一执行电机的目标反转角度以及安全制动角加速度,为断料控制动作设定了运动参数限制,降低了第一执行电机急停时引发物料意外脱落的风险;同时,结合作业段规划参数、基础工作参数及实际水平运行速度,分别生成第一启动空间阈值和第二启动空间阈值,当隔离带剩余距离小于等于第一启动空间阈值或第二启动空间阈值时,提前启动第一执行电机或第二执行电机。在跨越隔离带的开播阶段,本方案将开播准备的物理耗时转化为基于地理坐标的空间距离参数,使电机的起步加速过程得以在隔离带内预先展开。该设计缩减了机构起转初期的空转行程,保障了设备驶离隔离带后第一物料与第二物料的投放动作在目标作业段内及时发生,满足了育种作业对各作业段间交接连贯性的工程需求。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com