作业机械的控制方法和装置制造方法及图纸

本申请公开了一种作业机械的控制方法和装置，属于作业机械领域。所述作业机械的控制方法包括：基于作业机械和目标对象对应的图像信息，确定作业机械对应的第一参考点的第一位置信息，以及目标对象对应的第二参考点的第二位置信息；基于第一位置信息、第二位置信息、目标对象对应的第三参考点的第三位置信息和作业机械的运动角，确定作业机械和目标对象之间的目标路径；基于目标路径，控制作业机械的运行姿态；目标路径包括至少两段子曲线段和至少两段子直线段。本申请的作业机械的控制方法，作业机械可以自行调整位置来托举或叉取目标对象，无需作业机械多次调整之后再托举或叉取目标对象，简化了作业机械的运动，提升了作业机械的作业效率。机械的作业效率。机械的作业效率。

【技术实现步骤摘要】
作业机械的控制方法和装置


[0001]本申请属于作业机械领域，尤其涉及一种作业机械的控制方法和装置。

技术介绍

[0002]在作业机械对目标对象进行托举或叉取的过程中，需要设计作业机械的运动路径以精准地托举或叉取目标对象。相关技术中，主要基于作业机械的当前位姿信息规划下一段运行路线，待作业机械到达下一段运行路线终点后再基于当前位姿信息规划下一段运行路线，需多次规划作业机械的运行路径，以托举或叉取目标对象，常用的作业机械的控制方法过程复杂，需要多次调整作业机械的位姿进行对齐，作业机械的作业效率较低。

技术实现思路

[0003]本申请旨在至少解决现有技术中存在的技术问题之一。为此，本申请提出一种作业机械的控制方法和装置，作业机械可以自行调整位置来托举或叉取目标对象，无需作业机械多次调整之后再托举或叉取目标对象，简化了作业机械的运动，提升了作业机械的作业效率。
[0004]第一方面，本申请提供了一种作业机械的控制方法，该方法包括：
[0005]基于作业机械和目标对象对应的图像信息，确定作业机械对应的第一参考点的第一位置信息，以及目标对象对应的第二参考点的第二位置信息；第二参考点为目标对象的中轴线上的点，中轴线在作业机械与目标对象的投影面内；
[0006]基于第一位置信息、第二位置信息、目标对象对应的第三参考点的第三位置信息和作业机械的运动角，确定作业机械和目标对象之间的目标路径；运动角为作业机械沿直线向目标对象行驶过程中，作业机械的运动方向与中轴线之间的夹角；
[0007]基于目标路径，控制作业机械的运行姿态；
[0008]目标路径包括至少两段子曲线段和至少两段子直线段，第一参考点为至少两段子曲线段中第一子曲线段的端点；第二参考点和第三参考点为至少两段子直线段中第一子直线段的端点，且第二参考点为至少两段子曲线段中第二子曲线段的端点。
[0009]根据本申请实施例提供的作业机械的控制方法，通过确定作业机械运动路径上的多个参考点以将运动路径分解为至少两段子直线段和至少两段子曲线段，并控制作业机械基于分解后的运动路径运行，作业机械可以自行调整位置来托举或叉取目标对象，无需作业机械多次调整之后再托举或叉取目标对象，简化了作业机械的运动，提升了作业机械的作业效率，解决了多次堆放后目标对象的位置偏差累计。
[0010]本申请一个实施例的作业机械的控制方法，基于第一位置信息、第二位置信息、目标对象对应的第三参考点的第三位置信息和作业机械的运动角，确定作业机械和目标对象之间的目标路径，包括：
[0011]基于第一位置信息和运动角，确定第四参考点相对于第一参考点的第一位姿偏差；基于第二位置信息和运动角，确定第五参考点相对于第二参考点的第二位姿偏差；其
中，第四参考点为第一子曲线段的端点，第五参考点为第二子曲线段的端点；且第四参考点和第五参考点为至少两段子直线段中第二子直线段的端点；
[0012]基于第一位置信息、第三位置信息、第一位姿偏差、第二位姿偏差和运动角，确定第四参考点和第五参考点之间的第三位姿偏差；
[0013]基于第一位姿偏差、第二位姿偏差和第三位姿偏差，获取第一参考点和第二参考点之间的纵轴误差；
[0014]在纵轴误差不超过目标阈值的情况下，基于纵轴误差确定第四参考点的第四位置信息和第五参考点的第五位置信息；
[0015]基于第一位置信息、第二位置信息、第三位置信息、第四位置信息和第五位置信息，确定目标路径。
[0016]本申请一个实施例的作业机械的控制方法，在纵轴误差不超过目标阈值的情况下，基于纵轴误差确定第四参考点的第四位置信息和第五参考点的第五位置信息，包括：
[0017]在纵轴误差不超过目标阈值的情况下，从目标旋转半径边界范围内获取第一参考点和第四参考点之间的第一旋转半径，以及第二参考点和第五参考点之间的第二旋转半径；
[0018]基于第一旋转半径和第一位姿偏差确定第四位置信息；基于第二旋转半径和第二位姿偏差确定第五位置信息。
[0019]本申请一个实施例的作业机械的控制方法，基于第一位置信息和运动角，确定第四参考点相对于第一参考点的第一位姿偏差；基于第二位置信息和运动角，确定第五参考点相对于第二参考点的第二位姿偏差，包括：
[0020]基于第一位置信息确定作业机械对应的位姿角，并将位姿角和运动角之间的差值确定为第一参考点和第四参考点之间的第一旋转角；位姿角为作业机械延长线与X轴之间的夹角；
[0021]基于位姿角、运动角和第一旋转角，确定第一位姿偏差；
[0022]将运动角确定为第二参考点和第五参考点之间的第二旋转角；
[0023]基于第二旋转角，确定第二位姿偏差。
[0024]本申请一个实施例的作业机械的控制方法，基于第一位置信息、第二位置信息、第三位置信息、第四位置信息和第五位置信息，确定目标路径，包括：
[0025]基于第一位置信息和第四位置信息，采用插值算法，确定第一参考点和第四参考点之间的第一子曲线段；
[0026]基于第四位置信息和第五位置信息，采用插值算法，确定第四参考点和第五参考点之间的第二子直线段；
[0027]基于第二位置信息和第五位置信息，采用插值算法，确定第二参考点和第五参考点之间的第二子曲线段；
[0028]基于第二位置信息和第三位置信息，采用插值算法，确定第二参考点和第三参考点之间的第一子直线段；
[0029]基于第一子曲线段、第二子直线段、第二子曲线段和第一子直线段，确定目标路径。
[0030]本申请一个实施例的作业机械的控制方法，基于作业机械和目标对象对应的图像
信息，确定作业机械对应的第一参考点的第一位置信息，以及目标对象对应的第二参考点的第二位置信息，包括：
[0031]获取目标雷达建立的作业机械的活动区域地图，以及图像传感器采集的图像信息；
[0032]基于图像信息，获取作业机械的第一位姿和目标对象的第二位姿；
[0033]将第一位姿和第二位姿转换至活动区域地图，获取作业机械在活动区域地图上的第一参考点的第一位置信息，以及目标对象在活动区域地图上的第二参考点的第二位置信息。
[0034]第二方面，本申请提供了一种作业机械的控制装置，该装置包括：
[0035]第一处理模块，用于基于作业机械和目标对象对应的图像信息，确定作业机械对应的第一参考点的第一位置信息，以及目标对象对应的第二参考点的第二位置信息；第二参考点为目标对象的中轴线上的点，中轴线在作业机械与目标对象的投影面内；
[0036]第二处理模块，用于基于第一位置信息、第二位置信息、目标对象对应的第三参考点的第三位置信息和作业机械的运动角，确定作业机械和目标对象之间的目标路径；运动角为作业机械沿直线向目标对象行驶过程中，作业机械的运动方向与中轴线之间的夹角；
[0037]第三处理模块，用于基于目标路径，控制作业机械的运行姿态；
[0038]目标路径包括至少本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种作业机械的控制方法，其特征在于，包括：基于作业机械和目标对象对应的图像信息，确定作业机械对应的第一参考点的第一位置信息，以及目标对象对应的第二参考点的第二位置信息；第二参考点为目标对象的中轴线上的点，中轴线在作业机械与目标对象的投影面内；基于第一位置信息、第二位置信息、目标对象对应的第三参考点的第三位置信息和作业机械的运动角，确定作业机械和目标对象之间的目标路径；运动角为作业机械沿直线向目标对象行驶过程中，作业机械的运动方向与中轴线之间的夹角；基于目标路径，控制作业机械的运行姿态；目标路径包括至少两段子曲线段和至少两段子直线段，第一参考点为至少两段子曲线段中第一子曲线段的端点；第二参考点和第三参考点为至少两段子直线段中第一子直线段的端点，且第二参考点为至少两段子曲线段中第二子曲线段的端点。2.根据权利要求1所述的作业机械的控制方法，其特征在于，基于第一位置信息、第二位置信息、目标对象对应的第三参考点的第三位置信息和作业机械的运动角，确定作业机械和目标对象之间的目标路径，包括：基于第一位置信息和运动角，确定第四参考点相对于第一参考点的第一位姿偏差；基于第二位置信息和运动角，确定第五参考点相对于第二参考点的第二位姿偏差；其中，第四参考点为第一子曲线段的端点，第五参考点为第二子曲线段的端点；且第四参考点和第五参考点为至少两段子直线段中第二子直线段的端点；基于第一位置信息、第三位置信息、第一位姿偏差、第二位姿偏差和运动角，确定第四参考点和第五参考点之间的第三位姿偏差；基于第一位姿偏差、第二位姿偏差和第三位姿偏差，获取第一参考点和第二参考点之间的纵轴误差；在纵轴误差不超过目标阈值的情况下，基于纵轴误差确定第四参考点的第四位置信息和第五参考点的第五位置信息；基于第一位置信息、第二位置信息、第三位置信息、第四位置信息和第五位置信息，确定目标路径。3.根据权利要求2所述的作业机械的控制方法，其特征在于，在纵轴误差不超过目标阈值的情况下，基于纵轴误差确定第四参考点的第四位置信息和第五参考点的第五位置信息，包括：在纵轴误差不超过目标阈值的情况下，从目标旋转半径边界范围内获取第一参考点和第四参考点之间的第一旋转半径，以及第二参考点和第五参考点之间的第二旋转半径；基于第一旋转半径和第一位姿偏差确定第四位置信息；基于第二旋转半径和第二位姿偏差确定第五位置信息。4.根据权利要求2所述的作业机械的控制方法，其特征在于，基于第一位置信息和运动角，确定第四参考点相对于第一参考点的第一位姿偏差；基于第二位置信息和运动角，确定第五参考点相对于第二参考点的第二位姿偏差，包括：基于第一位置信息确定作业机械对应的位姿角，并将位姿角和运动角之间的差值确定为第一参考点和第四参考点之间的第一旋转角；位姿角为作业机械延长线与X轴之间的夹角；
基于位姿角、运动角和第一旋转角，确定第一位姿偏差；将运动角确定为第二参考点和第五参考...

【专利技术属性】
技术研发人员：朱超俊，陈健，卢浩明，
申请(专利权)人：广州广电运通金融电子股份有限公司，
类型：发明
国别省市：