实现双绳双瓣抓斗无人天车精准抓料的方法

权利要求

1.实现双绳双瓣抓斗无人天车精准抓料的方法，其特征在于包含以下步骤：(1)通过3D扫描对料型建立网格化模型，将料型数据化；(2)抓斗开口度和抓取重量关系对应，观察抓取重量和抓斗开口度的关系，建立对应关系图，量化抓斗开度；(3)抓取料面选取，通过测量抓斗设定开度下的张开宽度和抓斗一侧长度，量化抓取面，再根据抓取面内的网格化数据获取抓取面的三个重要分析指标，分别为总平均高度、X方向倾斜偏差和Y方向倾斜偏差，再通过遍历出所有可抓取料面及料面的三个分析指标，先后利用总平均高度和偏差总和进行排序和筛选，获取最优的抓取料面；(4)抓取深度计算，先依据抓取料面的总平均高度设定一个初始抓取高度，通过抓取体积精确计算初始抓取重量，再通过计算初始抓取高度下抓取的重量与计划重量的偏差获取二次修正高度，得出抓取高度，实现精准抓料。2.根据权利要求1所述的实现双绳双瓣抓斗无人天车精准抓料的方法，其特征在于：所述步骤(1)中，包含以下步骤： 步骤S01：大车前进方向为X轴正向，小车前进方向为Y轴正向，主钩起升方向为Z轴正向，大小车后退极限对应料区拐角地面为原点，建立料区三维坐标系； 步骤S02：利用3D扫描仪扫描料区，获取料型在扫描仪坐标系下的三维数据； 步骤S03：标定3D扫描仪设备的扫描头在料区三维坐标系下的三维坐标； 步骤S04：根据3D扫描仪的扫描头在料区三维坐标系下的三维坐标，将扫描获取的扫描仪坐标系下的三维数据转换为料区坐标系的三维数据； 步骤S05：以原点为基准，X方向200mm，Y方向100mm为单位长度建立料区网格式三维模型，其中X方向转换后从小到大依次定义为X 0、X 1、X 1......X max-1、X max，Y方向转换后从小到大依次定义为Y 0、Y 1、Y 1......Y max-1、Y max； 所述步骤(2)中，包含以下步骤： 步骤S06：测量将抓斗完全张开时的角度θ max，此时的开口度定义为1.0，完全闭合时的开口度定义为0，开口度与角度比例成线性； 步骤S07：抓斗额定最大抓取重量定义为W max； 步骤S08：根据实际的抓取作业经验，建立抓取重量区间和抓斗开口度的对应关系图 抓取重量为0到0.05W max，设置开口度为0.1，张开角度为0.1*θ max； 抓取重量为0.05W max到0.1W max时，设置开口度为0.2，张开角度为0.2*θ max； 抓取重量为0.1W max到0.2W max时，设置开口度为0.25，张开角度为0.25*θ max； 抓取重量为0.2W max到0.3W max时，设置开口度为0.35，张开角度为0.35*θ max； 抓取重量为0.3W max到0.4W max时，设置开口度为0.45，张开角度为0.45*θ max； 抓取重量为0.4W max到0.5W max时，设置开口度为0.6，张开角度为0.6*θ max； 抓取重量为0.5W max到0.6W max时，设置开口度为0.7，张开角度为0.7*θ max； 抓取重量为0.6W max到0.7W max时，设置开口度为0.8，张开角度为0.8*θ max； 抓取重量大于0.7W max时，为防止提升电机过载，禁止抓取； 步骤S09：测量不同张开角度下开闭钢丝绳对应的下降量和抓斗的张开宽度； 所述步骤(3)中，包含以下步骤： 步骤S10：根据抓取重量W plan所在抓取重量区间选择对应抓斗开口度及对应角度θ、开闭钢丝绳的下降量L down、抓斗张开宽度L width； 步骤S11：抓斗张开宽度L width方向与X方向平行，以200mm为单位长度进行转换，得出网格式三维模型下的宽度值NumX； 步骤S12：测量出抓斗张开宽度方向垂直的抓斗一侧的长度L length，长度方向与Y方向平行，以100mm为单位长度进行转换，得出网格式三维模型下的长度值NumY； 步骤S13：抓取料面的横截面是以宽为抓斗张开宽度L width、长为抓斗一侧长度L length的矩形，获取以料区坐标系原点为基准的抓取料面四条边所有网格式三维坐标点的数据，分别为(X 0,Y 0)到(X 0,Y NumY)、(X NumX,Y 0)到(X NumX,Y NumY)、(X 0,Y 0)到(X NumX,Y 0)、(X 0,Y NumY)到(X NumX,Y NumY)； 步骤S14：获取抓取料面上的所有网格式三维坐标点的高度值，计算抓取料面的总平均高度，定位为H ave； 步骤S15：分别计算当前抓取料面四条边的平均高度，(X 0,Y 0)到(X 0,Y NumY)的边高度定义为H X0、(X NumX,Y 0)到(X NumX,Y NumY)的边高度定义为H NumX、(X 0,Y 0)到(X NumX,Y 0)的边高度定义为H Y0、(X 0,Y NumY)到(X NumX,Y NumY)的边高度定义为H NumY； 步骤S16：计算H NumX-H X0的绝对值X Dif0，将其定义为当前抓取料面X方向的倾斜偏差； 步骤S17：计算H NumY-H Y0的绝对值Y Dif0，将其定义为当前抓取料面Y方向的倾斜偏差； 步骤S18：嵌套循环遍历所有可抓取料面的数据，并计算对应料面总平均高度、X方向的倾斜偏差、Y方向的倾斜偏差； 步骤S19：按总平均高度由大到小的原则对所有可抓取料面进行排序，取前四分之一的料面数据； 步骤S20：去除X方向的倾斜偏差大于300mm的抓料料面数据； 步骤S21：去除Y方向的倾斜偏差大于300mm的抓料料面数据； 步骤S22：计算剩余抓取料面的X方向的倾斜偏差与去除Y方向的倾斜偏差的和，并按从小到大进行排序，取第一条料面数据作为最终抓取料面； 所述步骤(4)中，包含以下步骤： 步骤S23：抓斗张开到设定角度，保持开闭钢丝绳不动，支持钢丝绳开始下降，接触到料面后，下降至料面四条边的总平均高度后继续下降150mm，此时结束下降动作，下沉高度为H ave-150mm，定义为H ini； 步骤S24：测量抓斗臂长L arm，计算抓斗在高度H ini闭合时在该高度截面下方所抓物料体积为 定义为V sur， 为扇形柱体， 为三棱柱； 步骤S25：获取抓取料面内所有点的坐标及高度值，计算单位长度为1的网格四个顶点的高度总平均值H unit，将该高度定义为该单位网格的料面高度； 步骤S26：计算单位网格内抓斗在高度H ini之上可抓物料体积100×200×(H unit-H ini)，定义为V unit； 步骤S27：将抓取料面内所有单位网格的体积进行累加，获得在高度H ini之上可抓物料体积总和V sum； 步骤S28：在高度H ini抓斗可抓物料的总重量为(V sur+V sum)×ρ，定义为W ini，其中ρ为物料的密度； 步骤S29：在高度H ini抓斗可抓物料的总重量与计划重量偏差为W ini-W plan，定义为W offset，转换为体积 定义为V offset，其中ρ为物料的密度； 步骤S30：抓斗需要二次下沉或上升的高度为 定义为H offset，其中L wdith×L length为抓斗抓取面的面积，由此得出抓斗抓取高度为H ini-H offset。

说明书

技术领域

本发明涉及实现双绳双瓣抓斗无人天车精准抓料的方法，属于冶金自动控制方法技术领域。

背景技术

无人抓斗天车已广泛应用于矿厂、钢厂的各个领域，由于矿粉多为散料，因此双绳双瓣抓斗在这些领域应用较多。双绳双瓣抓斗在天车上配有两个电机卷筒，每个卷筒引出一根钢丝绳，其中一根钢丝绳系于抓斗顶部平衡架的两端，负责抓斗的起升和下降，起支持作用，定义为支持钢丝绳，另一根钢丝绳经过抓斗上横梁的滑轮与下横梁的滑轮，组成滑轮组，负责抓斗的开闭，定义为开闭钢丝绳。需要开闭抓斗时，支持钢丝绳保持不动，放下开闭钢丝绳，抓斗打开，收起开闭钢丝绳，抓斗闭合。

目前无人抓斗天车能实现点对点的准确吊运，但每次作业的实际抓取重量无法得到准确控制，而部分料场的发货车辆要求最终的实际装车重量与计划装车重量误差在2％以内，如果车辆出厂效验重量时，重量发生超差，车辆必须返回料区进行二次装车或卸车，轻者影响发货效率，严重时可能造成料场堆料，从而影响生产。

双绳双瓣抓斗无人天车作业抓取重量无法得到准确控制主要是由于抓取物料的料面高低不平、抓斗的张开角度和抓斗在料面的下沉深度无法量化，从而影响实际抓取重量。料面的高低不平同样易导致抓斗接触料面时发生倾倒，无法进行有效抓取。如何有效结合抓取点的料型、抓斗张开角度、抓斗下沉深度，给出可行策略从而有实现抓取重量的精准控制，成为了双绳双瓣抓斗无人天车精准抓料急待解决的难题。

发明内容

本发明目的是提供一种实现双绳双瓣抓斗无人天车精准抓料的方法，通过3D扫描对料型建立网格化模型，将料型数据化；优先选择高点抓取的原则能避免料堆个别区域过高或过低，起到优化料型的作用，防止料型高低不平；选取抓取点料面倾斜偏差较小的原则可防止抓斗接触料面时发生倾斜，提高抓取成功率；精确的料面选择和抓取深度计算大大减小了抓取重量误差，实现抓斗对抓取重量的精确控制，可有效将误差控制在2％以内，同时避免抓斗倾倒，提高天车抓料效率，减小装车时天车作业次数，降低车辆二次装车或卸车的概率，有效地解决了背景技术中存在的上述问题。

本发明的技术方案是：一种实现双绳双瓣抓斗无人天车精准抓料的方法，包含以下步骤：(1)通过3D扫描对料型建立网格化模型，将料型数据化；(2)抓斗开口度和抓取重量关系对应，观察抓取重量和抓斗开口度的关系，建立对应关系图，量化抓斗开度；(3)抓取料面选取，通过测量抓斗设定开度下的张开宽度和抓斗一侧长度，量化抓取面，再根据抓取面内的网格化数据获取抓取面的三个重要分析指标，分别为总平均高度、X方向倾斜偏差和Y方向倾斜偏差，再通过遍历出所有可抓取料面及料面的三个分析指标，先后利用总平均高度和偏差总和进行排序和筛选，获取最优的抓取料面；(4)抓取深度计算，先依据抓取料面的总平均高度设定一个初始抓取高度，通过抓取体积精确计算初始抓取重量，再通过计算初始抓取高度下抓取的重量与计划重量的偏差获取二次修正高度，得出抓取高度，实现精准抓料。

所述步骤(1)中，包含以下步骤：

步骤S01：大车前进方向为X轴正向，小车前进方向为Y轴正向，主钩起升方向为Z轴正向，大小车后退极限对应料区拐角地面为原点，建立料区三维坐标系；

步骤S02：利用3D扫描仪扫描料区，获取料型在扫描仪坐标系下的三维数据；

步骤S03：标定3D扫描仪设备的扫描头在料区三维坐标系下的三维坐标；

步骤S04：根据3D扫描仪的扫描头在料区三维坐标系下的三维坐标，将扫描获取的扫描仪坐标系下的三维数据转换为料区坐标系的三维数据；

步骤S05：以原点为基准，X方向200mm，Y方向100mm为单位长度建立料区网格式三维模型，其中X方向转换后从小到大依次定义为X 0、X 1、X 1......X max-1、X max，Y方向转换后从小到大依次定义为Y 0、Y 1、Y 1......Y max-1、Y max；

所述步骤(2)中，包含以下步骤：

步骤S06：测量将抓斗完全张开时的角度θ max，此时的开口度定义为1.0，完全闭合时的开口度定义为0，开口度与角度比例成线性；

步骤S07：抓斗额定最大抓取重量定义为W max；

步骤S08：根据实际的抓取作业经验，建立抓取重量区间和抓斗开口度的对应关系图

抓取重量为0到0.05W max，设置开口度为0.1，张开角度为0.1*θ max；

抓取重量为0.05W max到0.1W max时，设置开口度为0.2，张开角度为0.2*θ max；

抓取重量为0.1W max到0.2W max时，设置开口度为0.25，张开角度为0.25*θ max；

抓取重量为0.2W max到0.3W max时，设置开口度为0.35，张开角度为0.35*θ max；

抓取重量为0.3W max到0.4W max时，设置开口度为0.45，张开角度为0.45*θ max；

抓取重量为0.4W max到0.5W max时，设置开口度为0.6，张开角度为0.6*θ max；

抓取重量为0.5W max到0.6W max时，设置开口度为0.7，张开角度为0.7*θ max；

抓取重量为0.6W max到0.7W max时，设置开口度为0.8，张开角度为0.8*θ max；

抓取重量大于0.7W max时，为防止提升电机过载，禁止抓取；

步骤S09：测量不同张开角度下开闭钢丝绳对应的下降量和抓斗的张开宽度；

所述步骤(3)中，包含以下步骤：

步骤S10：根据抓取重量W plan所在抓取重量区间选择对应抓斗开口度及对应角度θ、开闭钢丝绳的下降量L down、抓斗张开宽度L width；

步骤S11：抓斗张开宽度L width方向与X方向平行，以200mm为单位长度进行转换，得出网格式三维模型下的宽度值NumX；

步骤S12：测量出抓斗张开宽度方向垂直的抓斗一侧的长度L length，长度方向与Y方向平行，以100mm为单位长度进行转换，得出网格式三维模型下的长度值NumY；

步骤S13：抓取料面的横截面是以宽为抓斗张开宽度L width、长为抓斗一侧长度L length的矩形，获取以料区坐标系原点为基准的抓取料面四条边所有网格式三维坐标点的数据，分别为(X 0,Y 0)到(X 0,Y NumY)、(X NumX,Y 0)到(X NumX,Y NumY)、(X 0,Y 0)到(X NumX,Y 0)、(X 0,Y NumY)到(X NumX,Y NumY)；

步骤S14：获取抓取料面上的所有网格式三维坐标点的高度值，计算抓取料面的总平均高度，定位为H ave；

步骤S15：分别计算当前抓取料面四条边的平均高度，(X 0,Y 0)到(X 0,Y NumY)的边高度定义为H X0、(X NumX,Y 0)到(X NumX,Y NumY)的边高度定义为H NumX、(X 0,Y 0)到(X NumX,Y 0)的边高度定义为H Y0、(X 0,Y NumY)到(X NumX,Y NumY)的边高度定义为H NumY；

步骤S16：计算H NumX-H X0的绝对值X Dif0，将其定义为当前抓取料面X方向的倾斜偏差；

步骤S17：计算H NumY-H Y0的绝对值Y Dif0，将其定义为当前抓取料面Y方向的倾斜偏差；

步骤S18：嵌套循环遍历所有可抓取料面的数据，并计算对应料面总平均高度、X方向的倾斜偏差、Y方向的倾斜偏差；

步骤S19：按总平均高度由大到小的原则对所有可抓取料面进行排序，取前四分之一的料面数据；

步骤S20：去除X方向的倾斜偏差大于300mm的抓料料面数据；

步骤S21：去除Y方向的倾斜偏差大于300mm的抓料料面数据；

步骤S22：计算剩余抓取料面的X方向的倾斜偏差与去除Y方向的倾斜偏差的和，并按从小到大进行排序，取第一条料面数据作为最终抓取料面；

所述步骤(4)中，包含以下步骤：

步骤S23：抓斗张开到设定角度，保持开闭钢丝绳不动，支持钢丝绳开始下降，接触到料面后，下降至料面四条边的总平均高度后继续下降150mm，此时结束下降动作，下沉高度为H ave-150mm，定义为H ini；

步骤S24：测量抓斗臂长L arm，计算抓斗在高度H ini闭合时在该高度截面下方所抓物料体积为 定义为V sur， 为扇形柱体， 为三棱柱；

步骤S25：获取抓取料面内所有点的坐标及高度值，计算单位长度为1的网格四个顶点的高度总平均值H unit，将该高度定义为该单位网格的料面高度；

步骤S26：计算单位网格内抓斗在高度H ini之上可抓物料体积100×200×(H unit-H ini)，定义为V unit；

步骤S27：将抓取料面内所有单位网格的体积进行累加，获得在高度H ini之上可抓物料体积总和V sum；

步骤S28：在高度H ini抓斗可抓物料的总重量为(V sur+V sum)×ρ，定义为W ini，其中ρ为物料的密度；

步骤S29：在高度H ini抓斗可抓物料的总重量与计划重量偏差为W ini-W plan，定义为W offset，转换为体积 定义为V offset，其中ρ为物料的密度；

步骤S30：抓斗需要二次下沉或上升的高度为 定义为H offset，其中L wdith×L length为抓斗抓取面的面积，由此得出抓斗抓取高度为H ini-H offset。

本发明的有益效果是：通过3D扫描对料型建立网格化模型，将料型数据化；优先选择高点抓取的原则能避免料堆个别区域过高或过低，起到优化料型的作用，防止料型高低不平；选取抓取点料面倾斜偏差较小的原则可防止抓斗接触料面时发生倾斜，提高抓取成功率；精确的料面选择和抓取深度计算大大减小了抓取重量误差，实现抓斗对抓取重量的精确控制，可有效将误差控制在2％以内，同时避免抓斗倾倒，提高天车抓料效率，减小装车时天车作业次数，降低车辆二次装车或卸车的概率。

附图说明

图1是本发明的料区网格化模型建立流程图；

图2是本发明的抓斗开口度和抓取重量关系对应流程图；

图3是本发明抓取料面选取中可抓取料面及其三个分析指标建立流程图；

图4是本发明基于图3的最优抓取料面选取流程图；

图5是本发明的抓取深度计算流程图。

具体实施方式

为了使发明实施案例的目的、技术方案和优点更加清楚，下面将结合实施案例中的附图，对本发明实施案例中的技术方案进行清晰的、完整的描述，显然，所表述的实施案例是本发明一小部分实施案例，而不是全部的实施案例，基于本发明中的实施案例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施案例，都属于本发明保护范围。

一种实现双绳双瓣抓斗无人天车精准抓料的方法，包含以下步骤：(1)通过3D扫描对料型建立网格化模型，将料型数据化；(2)抓斗开口度和抓取重量关系对应，观察抓取重量和抓斗开口度的关系，建立对应关系图，量化抓斗开度；(3)抓取料面选取，通过测量抓斗设定开度下的张开宽度和抓斗一侧长度，量化抓取面，再根据抓取面内的网格化数据获取抓取面的三个重要分析指标，分别为总平均高度、X方向倾斜偏差和Y方向倾斜偏差，再通过遍历出所有可抓取料面及料面的三个分析指标，先后利用总平均高度和偏差总和进行排序和筛选，获取最优的抓取料面；(4)抓取深度计算，先依据抓取料面的总平均高度设定一个初始抓取高度，通过抓取体积精确计算初始抓取重量，再通过计算初始抓取高度下抓取的重量与计划重量的偏差获取二次修正高度，得出抓取高度，实现精准抓料。

所述步骤(1)中，包含以下步骤：

步骤S01：大车前进方向为X轴正向，小车前进方向为Y轴正向，主钩起升方向为Z轴正向，大小车后退极限对应料区拐角地面为原点，建立料区三维坐标系；

步骤S02：利用3D扫描仪扫描料区，获取料型在扫描仪坐标系下的三维数据；

步骤S03：标定3D扫描仪设备的扫描头在料区三维坐标系下的三维坐标；

步骤S04：根据3D扫描仪的扫描头在料区三维坐标系下的三维坐标，将扫描获取的扫描仪坐标系下的三维数据转换为料区坐标系的三维数据；

步骤S05：以原点为基准，X方向200mm，Y方向100mm为单位长度建立料区网格式三维模型，其中X方向转换后从小到大依次定义为X 0、X 1、X 1......X max-1、X max，Y方向转换后从小到大依次定义为Y 0、Y 1、Y 1......Y max-1、Y max；

所述步骤(2)中，包含以下步骤：

步骤S06：测量将抓斗完全张开时的角度θ max，此时的开口度定义为1.0，完全闭合时的开口度定义为0，开口度与角度比例成线性；

步骤S07：抓斗额定最大抓取重量定义为W max；

步骤S08：根据实际的抓取作业经验，建立抓取重量区间和抓斗开口度的对应关系图

抓取重量为0到0.05W max，设置开口度为0.1，张开角度为0.1*θ max；

抓取重量为0.05W max到0.1W max时，设置开口度为0.2，张开角度为0.2*θ max；

抓取重量为0.1W max到0.2W max时，设置开口度为0.25，张开角度为0.25*θ max；

抓取重量为0.2W max到0.3W max时，设置开口度为0.35，张开角度为0.35*θ max；

抓取重量为0.3W max到0.4W max时，设置开口度为0.45，张开角度为0.45*θ max；

抓取重量为0.4W max到0.5W max时，设置开口度为0.6，张开角度为0.6*θ max；

抓取重量为0.5W max到0.6W max时，设置开口度为0.7，张开角度为0.7*θ max；

抓取重量为0.6W max到0.7W max时，设置开口度为0.8，张开角度为0.8*θ max；

抓取重量大于0.7W max时，为防止提升电机过载，禁止抓取；

步骤S09：测量不同张开角度下开闭钢丝绳对应的下降量和抓斗的张开宽度；

所述步骤(3)中，包含以下步骤：

步骤S10：根据抓取重量W plan所在抓取重量区间选择对应抓斗开口度及对应角度θ、开闭钢丝绳的下降量L down、抓斗张开宽度L width；

步骤S11：抓斗张开宽度L width方向与X方向平行，以200mm为单位长度进行转换，得出网格式三维模型下的宽度值NumX；

步骤S12：测量出抓斗张开宽度方向垂直的抓斗一侧的长度L length，长度方向与Y方向平行，以100mm为单位长度进行转换，得出网格式三维模型下的长度值NumY；

步骤S13：抓取料面的横截面是以宽为抓斗张开宽度L width、长为抓斗一侧长度L length的矩形，获取以料区坐标系原点为基准的抓取料面四条边所有网格式三维坐标点的数据，分别为(X 0,Y 0)到(X 0,Y NumY)、(X NumX,Y 0)到(X NumX,Y NumY)、(X 0,Y 0)到(X NumX,Y 0)、(X 0,Y NumY)到(X NumX,Y NumY)；

步骤S14：获取抓取料面上的所有网格式三维坐标点的高度值，计算抓取料面的总平均高度，定位为H ave；

步骤S15：分别计算当前抓取料面四条边的平均高度，(X 0,Y 0)到(X 0,Y NumY)的边高度定义为H X0、(X NumX,Y 0)到(X NumX,Y NumY)的边高度定义为H NumX、(X 0,Y 0)到(X NumX,Y 0)的边高度定义为H Y0、(X 0,Y NumY)到(X NumX,Y NumY)的边高度定义为H NumY；

步骤S16：计算H NumX-H X0的绝对值X Dif0，将其定义为当前抓取料面X方向的倾斜偏差；

步骤S17：计算H NumY-H Y0的绝对值Y Dif0，将其定义为当前抓取料面Y方向的倾斜偏差；

步骤S18：嵌套循环遍历所有可抓取料面的数据，并计算对应料面总平均高度、X方向的倾斜偏差、Y方向的倾斜偏差；

步骤S19：按总平均高度由大到小的原则对所有可抓取料面进行排序，取前四分之一的料面数据；

步骤S20：去除X方向的倾斜偏差大于300mm的抓料料面数据；

步骤S21：去除Y方向的倾斜偏差大于300mm的抓料料面数据；

步骤S22：计算剩余抓取料面的X方向的倾斜偏差与去除Y方向的倾斜偏差的和，并按从小到大进行排序，取第一条料面数据作为最终抓取料面；

所述步骤(4)中，包含以下步骤：

步骤S23：抓斗张开到设定角度，保持开闭钢丝绳不动，支持钢丝绳开始下降，接触到料面后，下降至料面四条边的总平均高度后继续下降150mm，此时结束下降动作，下沉高度为H ave-150mm，定义为H ini；

步骤S24：测量抓斗臂长L arm，计算抓斗在高度H ini闭合时在该高度截面下方所抓物料体积为 定义为V sur， 为扇形柱体， 为三棱柱；

步骤S25：获取抓取料面内所有点的坐标及高度值，计算单位长度为1的网格四个顶点的高度总平均值H unit，将该高度定义为该单位网格的料面高度；

步骤S26：计算单位网格内抓斗在高度H ini之上可抓物料体积100×200×(H unit-H ini)，定义为V unit；

步骤S27：将抓取料面内所有单位网格的体积进行累加，获得在高度H ini之上可抓物料体积总和V sum；

步骤S28：在高度H ini抓斗可抓物料的总重量为(V sur+V sum)×ρ，定义为W ini，其中ρ为物料的密度；

步骤S29：在高度H ini抓斗可抓物料的总重量与计划重量偏差为W ini-W plan，定义为W offset，转换为体积 定义为V offset，其中ρ为物料的密度；

步骤S30：抓斗需要二次下沉或上升的高度为 定义为H offset，其中L wdith×L length为抓斗抓取面的面积，由此得出抓斗抓取高度为H ini-H offset。

实现双绳双瓣抓斗无人天车精准抓料的方法.pdf