1.一种挖掘机最优作业轨迹规划方法, 其特征在于,包括:获取由配置在挖掘机上的激光雷达所采集到的坡面角度信息、以及挖掘机铲斗齿尖的初始位姿信息,并根据所述坡面角度信息和所述初始位姿信息确定所述挖掘机在挖掘阶段的六个路径点;
采用运动学逆解算法对所述六个路径点进行转换处理,生成与所述六个路径点相对应的各关节角度值;
利用4‑3‑3‑3‑4多项式对所述六个路径点和所述各关节角度值进行求导、求解预处理,生成与所述六个路径点相对应的五段轨迹、角速度和角加速度;
获取由配置在挖掘机上的感知模块所采集到的挖掘体积、挖掘时间和挖掘能耗,根据满斗率、所述挖掘时间和单位体积能耗确定优化目标函数,并根据所述优化目标函数、预设的优化变量以及约束条件,确定优化问题,具体为:获取由配置在挖掘机上的感知模块所采集到的满斗率、挖掘时间和单位体积能耗,并分别确定所述满斗率、所述挖掘时间和所述单位体积能耗的目标函数,公式为:其中, 为所述满斗率的目标函数, 为单次挖掘的体积, 为铲斗的宽度, 为挖掘对象的表面函数, 为挖掘轨迹, 为挖掘出铲点的横坐标;
所述挖掘时间为每段轨迹的时间总和,其目标函数公式为:
其中, 为所述挖掘时间的目标函数,为每段轨迹的时间总和, 为每段轨迹的时间;
所述单位体积能耗的目标函数为关节的平均角加速度,其表达式为:其中, 为第 个关节的角加速度,其通过轨迹表达式求二阶导得到,为关节数;
对所述满斗率的目标函数、所述挖掘时间的目标函数和所述单位体积能耗的目标函数进行多目标归一化处理,生成优化目标函数,公式为:其中, 、 、 为权重系数, , 、 、 为归一化系数,分别是铲斗容积的倒数、挖掘的平均时间和挖掘的平均能耗;
获取预设的优化变量,所述优化变量为每个关节五段轨迹的时间,公式为:获取预设的约束条件,所述约束条件为各关节的角速度和角加速度不能超过其最大值,表达式为:其中, 为第 个关节在第 段轨迹的角速度, 为角速度最大值, 为第 个关节在第 段轨迹的角加速度, 为角加速度最大值;
结合所述优化目标函数、所述优化变量、以及所述约束条件,确定优化问题,优化问题的表达式为:;
采用粒子群算法对所述优化问题进行求解,对所述五段轨迹进行调整,生成最终的规划轨迹,具体为:初始化粒子种群,对每个关节的五段时间进行优化处理,随机生成M个五维粒子,得到M×5的粒子种群,并初始化M×5的粒子种群的速度和位置;
随机生成插值时间 、 、 、 、 ,并将所述插值时间 、 、 、 、 代入所述轨迹表达式中,求解所述轨迹表达式中每一段的系数,得到确定系数的轨迹表达式,其中,;
对所述确定系数的轨迹表达式进行一次求导和二次求导处理,得到角速度和角加速度的值,判断得到的值是否满足预设约束条件;
计 算每 个 粒 子 的 优化 目 标 函 数 值,对 满 足 约 束的 粒 子 采 用 公 式计算其优化目标函数值;
对于不满足约束的粒子,将其优化目标函数值设为较大的常数,通过优化迭代使其不断靠近最优粒子,直到其满足约束为止,并计算出每个粒子的优化目标函数值,不断迭代优化至最小;
根据粒子的位置和速度的表达式,更新粒子的速度和位置,当到达迭代次数时,停止算法;
选择每个关节插值时间最大的一段,作为最后的最优值;
其中,所述粒子群算法的公式为:
其中,为惯性因子, 和 均为学习因子, 和 均为[0,1]区间内的随机数, 为在迭代过程中粒子目前为止经历过的最佳值,为在当前迭代过程中相对整个群组中的最佳值, 为第 次迭代粒子的速度, 为第 次迭代粒子的位置, 为第 次迭代粒子的速度, 为第 次迭代粒子的位置。
2.根据权利要求1所述的一种挖掘机最优作业轨迹规划方法, 其特征在于,所述六个路径点分别为入铲点、出铲点和挖掘路径中间的四个路径点,其中,所述六个路径点的信息包括坐标 、以及铲斗末端姿态角 。
3.根据权利要求2所述的一种挖掘机最优作业轨迹规划方法, 其特征在于,采用运动学逆解算法对所述六个路径点进行转换处理,生成与所述六个路径点相对应的各关节角度值,具体为:采用运动学逆解算法对所述六个路径点进行运动学求解处理,根据所述六个路径点的坐标和铲斗末端姿态角生成各关节角度值,运动学逆解求解公式为:其中, 、 、 和 分别为回转、动臂、斗杆和铲斗的角度值, 和 分别为挖掘机D‑H坐标系中点 的横坐标和纵坐标,、、是角度值 根据几何关系分解形成的, 、 、分别为动臂、斗杆和铲斗的长度值, 为挖掘机D‑H坐标系中点 到点 的距离,为挖掘机D‑H坐标系中点 到点 的距离, 和 为 点坐标值。
4.根据权利要求3所述的一种挖掘机最优作业轨迹规划方法, 其特征在于,利用4‑3‑
3‑3‑4多项式对所述六个路径点和所述各关节角度值进行求导、求解预处理,生成与所述六个路径点相对应的五段轨迹、角速度和角加速度,具体为:根据4‑3‑3‑3‑4多项式,设与所述六个路径点相对应的五段轨迹的轨迹表达式为:其中, 、 、 、 、 分别为各关节在第一段、第二段、第三段、第四段和第五段轨迹的轨迹表达式, 、 、 、 、 、 、 、 、 、 、 、、 、 、 、 、 、 、 、 、 、 为五段轨迹表达式的未知系数,为无量纲时间, ,为挖掘轨迹实际时间, 为第 段轨迹开始时间,为第 段轨迹结束时间, 为第 段轨迹所用时间;
对所述轨迹表达式进行求导,得到对应的角速度变化函数,公式为:其中, 为角速度变化函数, 各关节在第 段轨迹的轨迹表达式, 为轨迹表达式的一阶导数, , ;
再次对所述角速度变化函数进行求导,得到对应的角加速度变化函数,公式为:其中, 为角加速度变化函数, 为轨迹表达式的二阶导数;
将所述六个路径点相对应的各关节角度值和预设的轨迹连续要求代入所述轨迹表达式中,求解所述五段轨迹表达式的未知系数 、 、 、 、 、 、 、 、 、、 、 、 、 、 、 、 、 、 、 、 、 的值,得到确定系数的轨迹表达式,求解公式为:
其中, 为第 个插值点的关节角度值。
5.一种挖掘机最优作业轨迹规划装置,其特征在于,包括:路径点生成单元,用于获取由配置在挖掘机上的激光雷达所采集到的坡面角度信息、以及挖掘机铲斗齿尖的初始位姿信息,并根据所述坡面角度信息和所述初始位姿信息确定所述挖掘机在挖掘阶段的六个路径点;
关节角度值计算单元,用于采用运动学逆解算法对所述六个路径点进行转换处理,生成与所述六个路径点相对应的各关节角度值;
轨迹表达式计算单元,用于利用4‑3‑3‑3‑4多项式对所述六个路径点和所述各关节角度值进行求导、求解预处理,生成与所述六个路径点相对应的五段轨迹、角速度和角加速度;
优化问题确定单元,用于获取由配置在挖掘机上的感知模块所采集到的挖掘体积、挖掘时间和挖掘能耗,根据满斗率、所述挖掘时间和单位体积能耗确定优化目标函数,并根据所述优化目标函数、预设的优化变量以及约束条件,确定优化问题,具体为:获取由配置在挖掘机上的感知模块所采集到的满斗率、挖掘时间和单位体积能耗,并分别确定所述满斗率、所述挖掘时间和所述单位体积能耗的目标函数,公式为:其中, 为所述满斗率的目标函数, 为单次挖掘的体积, 为铲斗的宽度, 为挖掘对象的表面函数, 为挖掘轨迹, 为挖掘出铲点的横坐标;
所述挖掘时间为每段轨迹的时间总和,其目标函数公式为:
其中, 为所述挖掘时间的目标函数,为每段轨迹的时间总和, 为每段轨迹的时间;
所述单位体积能耗的目标函数为关节的平均角加速度,其表达式为:其中, 为第 个关节的角加速度,其通过轨迹表达式求二阶导得到,为关节数;
对所述满斗率的目标函数、所述挖掘时间的目标函数和所述单位体积能耗的目标函数进行多目标归一化处理,生成优化目标函数,公式为:其中, 、 、 为权重系数, , 、 、 为归一化系数,分别是铲斗容积的倒数、挖掘的平均时间和挖掘的平均能耗;
获取预设的优化变量,所述优化变量为每个关节五段轨迹的时间,公式为:获取预设的约束条件,所述约束条件为各关节的角速度和角加速度不能超过其最大值,表达式为:其中, 为第 个关节在第 段轨迹的角速度, 为角速度最大值, 为第 个关节在第 段轨迹的角加速度, 为角加速度最大值;
结合所述优化目标函数、所述优化变量、以及所述约束条件,确定优化问题,优化问题的表达式为:;
轨迹规划单元,用于采用粒子群算法对所述优化问题进行求解,对所述五段轨迹进行调整,生成最终的规划轨迹,具体为:初始化粒子种群,对每个关节的五段时间进行优化处理,随机生成M个五维粒子,得到M×5的粒子种群,并初始化M×5的粒子种群的速度和位置;
随机生成插值时间 、 、 、 、 ,并将所述插值时间 、 、 、 、 代入所述轨迹表达式中,求解所述轨迹表达式中每一段的系数,得到确定系数的轨迹表达式,其中,;
对所述确定系数的轨迹表达式进行一次求导和二次求导处理,得到角速度和角加速度的值,判断得到的值是否满足预设约束条件;
计 算每 个 粒 子 的 优化 目 标 函 数 值,对 满 足 约 束的 粒 子 采 用 公 式计算其优化目标函数值;
对于不满足约束的粒子,将其优化目标函数值设为较大的常数,通过优化迭代使其不断靠近最优粒子,直到其满足约束为止,并计算出每个粒子的优化目标函数值,不断迭代优化至最小;
根据粒子的位置和速度的表达式,更新粒子的速度和位置,当到达迭代次数时,停止算法;
选择每个关节插值时间最大的一段,作为最后的最优值;
其中,所述粒子群算法的公式为:
其中,为惯性因子, 和 均为学习因子, 和 均为[0,1]区间内的随机数, 为在迭代过程中粒子目前为止经历过的最佳值,为在当前迭代过程中相对整个群组中的最佳值, 为第 次迭代粒子的速度, 为第 次迭代粒子的位置, 为第 次迭代粒子的速度, 为第 次迭代粒子的位置。
6.一种挖掘机最优作业轨迹规划设备,其特征在于,包括存储器以及处理器,所述存储器内存储有计算机程序,所述计算机程序能够被所述处理器执行,以实现如权利要求1至4任意一项所述的一种挖掘机最优作业轨迹规划方法。
7.一种计算机可读存储介质,其特征在于,存储有计算机程序,所述计算机程序能够被所述计算机可读存储介质所在设备的处理器执行,以实现如权利要求1至4任意一项所述的一种挖掘机最优作业轨迹规划方法。