一种基于参考信息的码垛机器人轨迹规划方法技术

该发明专利技术公开了一种基于参考信息的码垛机器人轨迹规划方法,涉及码垛机器人关节角空间轨迹规划领域.该方法首先确定最优化目标和优化目标之间的权重比例；之后根据轨迹点插值信息，采用高次B样条曲线进行插值之后建立最优解初始种群并采用多目标求解算法和决策算法，根据之前的权重比例选取最优结果；最后根据前一步的规划结果，将其作为参考信息输入，采用基于参考信息的多目标求解算法进行求解得出当前步的最优结果。本方法对于码垛机器人轨迹规划中同垛同层前后步的规划结果进行了有效的利用，加速了轨迹规划算法的进程。

【技术实现步骤摘要】

本专利技术涉及码垛机器人关节角空间轨迹规划领域，具体是一种考虑到参考信息的关节角空间轨迹规划方法。
技术介绍
在传统的码垛机器人轨迹规划算法中，主要存在着以下的不足：根据码垛机器人作业轨迹的特点，其同一层前后步之间的轨迹呈现着一定的相关性。因此前一步的轨迹规划结果，可以被下一步的轨迹规划所采用。而传统的轨迹规划算法中，并没有对此进行考虑，导致轨迹规划计算的过程中需要大量的重复计算。
技术实现思路
本专利技术针对现有技术存在的不足，提出了一种基于参考信息的码垛机器人轨迹规划方法。本方法针对于当前轨迹规划方法中，对于码垛机器人轨迹的作业特点在轨迹规划算法中考虑不足的问题做出了改进。本专利技术的技术方案是一种基于参考信息的码垛机器人轨迹规划方法，该方法包括：步骤1：根据用户意愿，确定最优轨迹的优化目标和目标之间的权重值；步骤2：根据码垛机器人作业轨迹中的必经点，获取码垛时搬运第一包货物的最优轨迹曲线；步骤2.1：根据码垛机器人作业轨迹中必须经过的定点，采用高次样条曲线进行插值，获取码垛时搬运第一包货物的多个轨迹曲线；步骤2.2：根据步骤1确定的优化目标，以步骤2.1获得的多个轨迹曲线为初始总群，采用遗传进化算法将初始总群进化M代，M的大小根据实际情况决定；步骤2.3：根据步骤1确定的各优化目标在轨迹规划过程中所占的权重，采用决策算法从步骤2.2获得的轨迹曲线中选出码垛时搬运第一包货物时最优的轨迹曲线；步骤3：若码垛机器人搬运的不是第一包货物，则根据码垛机器人搬运上一包货物的轨迹来确定该次搬运货物的轨迹；步骤3.1：判断码垛机器人该次搬运的货物非第一包货物，根据该次搬运中的必经定点采用高次样条曲线进行插值，获取该次搬运货物的多个轨迹曲线；步骤3.2：根据步骤1确定的优化目标，以步骤3.1获得的多个轨迹曲线为初始总群，采用遗传进化算法对初始总群每进化N代获得的各轨迹曲线与搬运前一包获得的最优轨迹曲线进行相似度计算，其中N的大小根据实际情况决定，且N＜M；若获得轨迹中超过比例P的轨迹与搬运上一包最优轨迹相似，则停止进化，否则直至进化M代，所述P的大小根据实际情况决定；步骤3.3：根据步骤1确定的各优化目标在轨迹规划过程中所占的权重，采用决策算法从当前获得轨迹曲线中选出搬运该包货物时最优的轨迹曲线。进一步的，所述步骤1中的优化目标包括：作业时间最短、平滑性指数最低、耗能最低；进一步的，所述步骤2.2的具体方法为：步骤2.2.1：计算步骤2.1获得初始种群中各个体的对应的各优化目标的数值；步骤2.2.2：根据获得各优化目标数值进行归一化处理，选取优化目标最优秀的A个个体，A的大小根据实际情况决定；步骤2.2.3：采用选取的A个个体根据遗传算法进行进化，获得新的种群；步骤2.2.4：采用步骤2.2.2和步骤2.2.3的方法对该种群进化M代。进一步的，所述步骤2.3的具体方法为：步骤2.3.1：计算进化M代后种群中各个体的优化目标数值；步骤2.3.2：根据步骤1确定的各优化目标权重对各个体的优化目标数值进行加权；步骤2.3.3：计算加权后各优化目标数值与理想优化目标数值的欧式距离；步骤2.3.4：选出距离理想优化目标数值欧式距离最近的个体为最优个体。进一步的，所述步骤3.2的具体方法为：步骤3.2.1：根据步骤1获得权重信息计算每进化N代后种群中各个体的优化目标数值；步骤3.2.2：计算搬运上一包货物获得最优轨迹曲线的优化目标数值与步骤3.2.1获得的优化目标数值的欧式距离，该欧式距离表示相似度；步骤3.2.3：相似度大于阈值S的个体为相似个体，阈值S根据实际情况确定，统计相似个体所占总个体比例；步骤3.2.4：相似个体比例大于等于P则停止进化，再选出此时种群中最优的个体。本专利技术为一种基于参考信息的码垛机器人轨迹规划方法，该方法首先确定最优化目标和优化目标之间的权重比例；之后根据轨迹点插值信息，采用高次B样条曲线进行插值之后建立最优解初始种群并采用多目标求解算法和决策算法，根据之前的权重比例选取最优结果；最后根据前一步的规划结果，将其作为参考信息输入，采用基于参考信息的多目标求解算法进行求解得出当前步的最优结果。本方法对于码垛机器人轨迹规划中同垛同层前后步的规划结果进行了有效的利用，加速了轨迹规划算法的进程。附图说明图1为本专利技术方法的具体实施方式流程图；图2为本专利技术缩略框图。具体实施方式下面对本专利技术的实施例程作详细说明，本实施例程在以本专利技术技术方案为前提下进行实施，给出了详细的实施方式和具体的操作过程，但本专利技术的保护范围不限于下述的实施例程。实施例程主要可以分为以下的几个步骤：步骤1：确定最优轨迹的优化目标和目标之间的权重值；一般而言，机器人在执行规划的轨迹的过程中，都期望机器人执行轨迹的时间最短，轨迹最为平滑保证对机器人的机械结构本体的冲击最小，执行轨迹的过程中能耗最小，关机驱动的力矩变换最小的目标。本实施例程定义机器人的最优化目标如下：其意义分别为：S1:为码垛机器人完成一定的作业轨迹所用的时间最小值S2:为码垛机器人关节的平均加速度最小值，即用来衡量机器人的能耗指标S3:为码垛机器人关节脉动程度最小值，即用来衡量机器人的轨迹的平滑程度在求解上述目标的过程中，必须满足一定的约束条件：max|vi(t)|≤vmaxii＝1,2,3...,n(2)max|ji(t)|≤jmaxii＝1,2,3...,n(3)max|ai(t)|≤amaxii＝1,2,3...,n(4)max|τi(t)|≤τmaxii＝1,2,3...,n(5)max|qi(t)|≤qmaxii＝1,2,3...,n(6)其意义分别为：式(2):第i个关节的角速度最大值小于规定最大值式(3):第i个关节的冲击值小于规定最大值式(4):第i个关节的角加速度最大值小于规定最大值式(5):第i个关节的力矩最大值小于规定最大值式(6):第i个关节的关节位移小于规定最大值同时三个最优目标之间的权重为：(1)最小化时间权重值：0.65(2)最优能量权重值：0.165(3)最平滑轨迹权重值：0.185步骤2：基于非支配排序遗传算法的轨迹规划:对于工作轨迹中的第一包作业轨迹，将采用传统的基于非支配排序遗传算法的轨迹规划算法进行求解，为了完成求解任务，需要进行以下的几个步骤：步骤2.1：建立初始化进化种群：为了能够采用非支配排序遗传算法进行求解，需要先建立初始进化种群。建立初始进化种群主要需要进行以下几个步骤：1)采用7次B样条曲线对码垛机器人的关节角空间轨迹进行插值2)根据插值的结果，在解空间中，随机生成一定个数的个体，建立初始化种群。步骤2.2采用非支配排序遗传算法进化求解：采用非支配排序遗传算法，进化M代。步骤2.3根据步骤(2)的结果，采用优劣距离法，根据各个目标之间的权重，求取结果：。1)建立初始化判断矩阵；2)决策矩阵归一化；3)建立加权判断矩阵；4)得出进化结果；5)计算各目标值与理想值之间的欧氏距离；6)计算各个目标的相对贴近度并选择最合适解步骤3：基于R支配的最优目标轨迹规划求解；对于同一层中除了第一步以外的作业轨迹，本实施用例采用基于R支配的最优目标轨迹规划算法进行求解。对于基于R支配的非支配排序而言，其本质是重新定义本文档来自技高网...

【技术保护点】
一种基于参考信息的码垛机器人轨迹规划方法，该方法包括：步骤1：根据用户意愿，确定最优轨迹的优化目标和目标之间的权重值；步骤2：根据码垛机器人作业轨迹中的必经点，获取码垛时搬运第一包货物的最优轨迹曲线；步骤2.1：根据码垛机器人作业轨迹中必须经过的定点，采用高次样条曲线进行插值，获取码垛时搬运第一包货物的多个轨迹曲线；步骤2.2：根据步骤1确定的优化目标，以步骤2.1获得的多个轨迹曲线为初始总群，采用遗传进化算法将初始总群进化M代，M的大小根据实际情况决定；步骤2.3：根据步骤1确定的各优化目标在轨迹规划过程中所占的权重，采用决策算法从步骤2.2获得的轨迹曲线中选出码垛时搬运第一包货物时最优的轨迹曲线。步骤3：若码垛机器人搬运的不是第一包货物，则根据码垛机器人搬运上一包货物的轨迹来确定该次搬运货物的轨迹：步骤3.1：判断码垛机器人该次搬运的货物非第一包货物，根据该次搬运中的必经定点采用高次B样条曲线进行插值，获取该次搬运货物的多个轨迹曲线；步骤3.2：根据步骤1确定的优化目标，以步骤3.1获得的多个轨迹曲线为初始总群，采用遗传进化算法对初始总群每进化N代获得的各轨迹曲线与搬运前一包获得的最优轨迹曲线进行相似度计算，其中N的大小根据实际情况决定，且N＜M；若获得轨迹中超过比例P的轨迹与搬运上一包最优轨迹相似，则停止进化；步骤3.3：根据步骤1确定的各优化目标在轨迹规划过程中所占的权重，采用决策算法从当前获得轨迹曲线中选出搬运该包货物时最优的轨迹曲线。...

【技术特征摘要】
1.一种基于参考信息的码垛机器人轨迹规划方法，该方法包括：步骤1：根据用户意愿，确定最优轨迹的优化目标和目标之间的权重值；步骤2：根据码垛机器人作业轨迹中的必经点，获取码垛时搬运第一包货物的最优轨迹曲线；步骤2.1：根据码垛机器人作业轨迹中必须经过的定点，采用高次样条曲线进行插值，获取码垛时搬运第一包货物的多个轨迹曲线；步骤2.2：根据步骤1确定的优化目标，以步骤2.1获得的多个轨迹曲线为初始总群，采用遗传进化算法将初始总群进化M代，M的大小根据实际情况决定；步骤2.3：根据步骤1确定的各优化目标在轨迹规划过程中所占的权重，采用决策算法从步骤2.2获得的轨迹曲线中选出码垛时搬运第一包货物时最优的轨迹曲线。步骤3：若码垛机器人搬运的不是第一包货物，则根据码垛机器人搬运上一包货物的轨迹来确定该次搬运货物的轨迹：步骤3.1：判断码垛机器人该次搬运的货物非第一包货物，根据该次搬运中的必经定点采用高次B样条曲线进行插值，获取该次搬运货物的多个轨迹曲线；步骤3.2：根据步骤1确定的优化目标，以步骤3.1获得的多个轨迹曲线为初始总群，采用遗传进化算法对初始总群每进化N代获得的各轨迹曲线与搬运前一包获得的最优轨迹曲线进行相似度计算，其中N的大小根据实际情况决定，且N＜M；若获得轨迹中超过比例P的轨迹与搬运上一包最优轨迹相似，则停止进化；步骤3.3：根据步骤1确定的各优化目标在轨迹规划过程中所占的权重，采用决策算法从当前获得轨迹曲线中选出搬运该包货物时最优的轨迹曲线。2.如权利要求1所述的一种基于参考信息的码垛机器人轨迹规划方法，其特征在于所述步骤1中的优化目标...

【专利技术属性】
技术研发人员：李波，戴骏贤，
申请(专利权)人：电子科技大学，
类型：发明
国别省市：四川;51