三维存取机构轴向平移防卡阻自适应控制方法及系统

摘要: 本技术涉及电数字数据处理领域,具体而言,涉及一种三维存取机构轴向平移防卡阻自适应控制方法及系统。背景技术:1、在矿山地质勘查、地下空间掘进、隧道超前预报、以及深...
三维存取机构轴向平移防卡阻自适应控制方法及系统

本技术涉及电数字数据处理领域,具体而言,涉及一种三维存取机构轴向平移防卡阻自适应控制方法及系统。

背景技术:

1、在矿山地质勘查、地下空间掘进、隧道超前预报、以及深部绳索取芯钻探工程中,频繁且大密度的加接钻杆与反向拆卸回收钻杆构成了整孔施工作业中劳动强度最高、耗费辅助工时最多、安全机械伤害事故最为密集的关键生产环节。为了解决上述问题,行业内开发出了全自动钻杆排放与转运装备(无人管柱仓)。通过在钻杆存储框架顶部设置三维存取机构驱动夹爪沿水平方向平移和沿高度方向升降实现钻杆从钻杆存储框架到转运对接单元之间的自动化调配移送。

2、但是,现有的三维存取机构在使用中暴露出以下一系列难以克服的缺陷:

3、在持续大强度的破岩钻进中,由于孔口返水冲刷及大回拖动作,孔口会源源不断地向外部喷淋、抛洒出大量的硬质岩屑粉尘颗粒、高尖硬度的硬质合金矿渣碎屑以及具有强碱和强粘滞特性的高浓度残渣粘土泥浆流。这些散落在空气和轨道表面的硬质颗粒浆液极易附着并侵入在裸露的传动齿条齿谷内或者导轨横梁光滑的滑动面上。传统的平移小车控制多采用恒定速度或恒定流量油路控制,三维存取机构平移时,如果齿轮与齿条的配合缝隙内突发性地卡入一颗或数颗高硬度岩屑粉尘颗粒,会由于“零柔性死点咬合”在啮合界面瞬间爆发出巨大的阻力弯矩和尖锐的机械应力集中,在现有的驱动回路控制下,三维存取机构如果遭遇此类硬质障碍,传统驱动电网由于缺乏自适应抗卡阻调速和电流扭矩前馈补偿能力,会使三维存取机构被直接卡死在轨道中间产生严重越程颤动,这不仅会在齿轮齿条接触面产生不可逆的啃咬、刮伤剥落缺陷,甚至会强行将驱动齿轮的金属轮齿生生扭断崩脱报废,导致整个装置陷入瘫痪死机状态。

4、更为严重的是,若侵入的属于无法碾碎的重型钢件硬质杂物(如脱落的螺栓、断裂卡瓦牙块),三维存取机构在卡死瞬间,如果伺服驱动电网未能在一时刻执行前馈诊断和能量阻断,定子绕组内部的电流会在百万分之一秒内由于反电动势归零而发生断崖式的过载暴增(俗称马达堵转)。高额的短路过热能量会瞬间将发电机、变压整流模块及伺服驱动器的逆变桥晶体管直接烧毁击穿,甚至由于强大的侧向冲击动能,强行将长达12米的钻架导轨横梁顶弯、拉伤发生严重弹塑性弯曲变形,引发钻杆管柱在高空发生倾倒脱落砸毁阀块管路的恶性工伤灾难。而现有的控制手势和系统完全缺乏应对这种安全事故的预警和处理手段。

技术实现思路

1、本技术的目的在于提供一种三维存取机构轴向平移防卡阻自适应控制方法及系统,其通过采集数据参数计算出三维存取机构的阻力矩变动差分矩阵判断是否齿条是否卡阻以控制电机运行状态进行处理,能够避免齿条卡阻造成设备损伤并危及作业人员安全。

2、本技术是这样实现的:

3、本技术提供一种三维存取机构轴向平移防卡阻自适应控制方法,包括以下步骤:

4、控制三维存取机构的电机驱动齿轮旋转,使齿轮带动所述三维存取机构沿钻杆存储框架顶部设置的齿条移动;

5、使用所述齿条啮合的编码器齿轮对应的编码器输出脉冲电信号,构建出所述三维存取机构全时域的实时移动物理轨迹坐标信息与动态滑差速度;

6、在所述三维存取机构移动的全时域内,使用所述三维存取机构内的传感器实时采集所述电机的定子绕组内部瞬时电流、输出轴瞬时角速度及电机动态输出回转扭矩参数;

7、根据所述传感器采集数据和预存的理论平滑运行扭矩基准曲线计算出阻力矩变动差分矩阵;

8、根据阻力矩变动差分矩阵判断是否齿条是否卡阻以控制电机运行状态;

9、当定子绕组内部瞬时电流超过预设的极限过载安全阈值时,判定为刚性卡死,控制电机关闭。

10、在一些可选的实施方案中,所述传感器以不低于5000hz的特征采样频率实时采集所述电机的定子绕组内部瞬时电流、输出轴瞬时角速度及动态输出回转扭矩参数。

11、在一些可选的实施方案中,根据所述传感器采集数据和预存的理论平滑运行扭矩基准曲线采用公式计算出阻力矩变动差分矩阵:

12、;

13、式中,k代表当前采样周期,为电机的动态输出回转扭矩参数;为所述三维存取机构的实时移动物理轨迹坐标;为预存的理论平滑运行扭矩基准曲线;为系统折算至马达轴端的动态转动惯量,为瞬时角加速度,为系统库伦摩擦力矩修正系数,为电机的输出轴瞬时角速度。

14、在一些可选的实施方案中,计算出阻力矩变动差分矩阵后,提取摩擦突变的阶跃变动率参数:

15、;

16、式中,δt为控制周期常数;k代表当前采样周期;所述阶跃变动率参数用于表征阻力矩在单位时间内的突变剧烈程度。

17、在一些可选的实施方案中,根据所述阻力矩变动差分矩阵判断是否齿条是否卡阻以控制所述电机运行状态时:

18、当阻力矩变动差分矩阵大于第一预设安全阈值,且所述阶跃变动率参数超过预设的冲击载荷斜率阈值,判定齿条的齿谷内侵入硬质异物并发生突发性冲击卡阻,根据阻力矩变动差分矩阵控制所述电机降低输出轴转速降低所述三维存取机构移动速度,并控制向所述电机的定子绕组施加额外驱动电流实施转矩补偿强行通过齿条卡阻区域;

19、若大于第一预设安全阈值,但所述阶跃变动率参数未超过预设的冲击载荷斜率阈值,则判定为持续性粘滞摩擦,控制所述电机维持当前转速并发出预警提示。

20、在一些可选的实施方案中,计算出阻力矩变动差分矩阵后使用基于自回归积分滑动平均模型计算阻力矩变动的m步外推预测值:

21、;

22、式中,为自回归特征参数系数,为滑动平均移动参数权重,为离散过程中的高斯预测白噪声偏差;

23、当计算的阻力矩变动的m步外推预测值超过预设的极限危险包络面阈值时,判断刚性卡死,控制电机关闭。

24、在一些可选的实施方案中,使用以下公式计算向所述电机的定子绕组施加额外驱动电流:

25、;

26、式中,为比例电流增益系数;为积分时间常数增益;为微分前馈补偿阻尼系数;为控制周期常数。

27、在一些可选的实施方案中,控制向所述电机的定子绕组施加额外驱动电流实施转矩补偿强行通过齿条卡阻区域后,所述编码器反馈线速度衰减趋于零且位移停滞,同时电机的定子绕组内部瞬时电流暴增并超过预设的极限过载安全阈值时,判定系刚性卡死,控制电机关闭。

28、本技术还提供了一种三维存取机构轴向平移防卡阻自适应控制系统,用于实现上述的三维存取机构轴向平移防卡阻自适应控制方法,包括:

29、钻杆存储框架,顶部至少一端连接有沿水平方向延伸的齿条;

30、三维存取机构,可沿齿条移动地连接于钻杆存储框架顶部,包括与齿条一一对应的电机和编码器,电机的输出轴和编码器分别连接有与对应齿条啮合的齿轮和编码器齿轮;

31、控制器,分别与电机和编码器电连接。

32、在一些可选的实施方案中,三维存取机构分别通过调节螺钉连接有与齿条一一对应滑动抵压的耐磨板,调节螺钉旋转时调节耐磨板和对应齿条之间的间隙。

33、本技术的有益效果是:本技术提供的三维存取机构轴向平移防卡阻自适应控制方法包括以下步骤:控制三维存取机构的电机驱动齿轮旋转,使齿轮带动三维存取机构沿钻杆存储框架顶部设置的齿条移动;使用齿条啮合的编码器齿轮对应的编码器输出脉冲电信号,构建出三维存取机构全时域的实时移动物理轨迹坐标信息与动态滑差速度;在三维存取机构移动的全时域内,使用三维存取机构内的传感器实时采集电机的定子绕组内部瞬时电流、输出轴瞬时角速度及电机动态输出回转扭矩参数;根据传感器采集数据和预存的理论平滑运行扭矩基准曲线计算出阻力矩变动差分矩阵;根据阻力矩变动差分矩阵判断是否齿条是否卡阻以控制电机运行状态,当定子绕组内部瞬时电流超过预设的极限过载安全阈值时,判定为刚性卡死,控制电机关闭。本技术提供的三维存取机构轴向平移防卡阻自适应控制方法及系统通过获取电机的定子绕组内部瞬时电流、输出轴瞬时角速度及电机动态输出回转扭矩参数与预存的理论平滑运行扭矩基准曲线计算出阻力矩变动差分矩阵,从而判断是否齿条是否卡阻以控制电机运行状态进行处理,能够避免齿条卡阻造成设备损伤并危及作业人员安全。