一种仿人机器人行走轨迹的优化控制方法
一种仿人机器人行走轨迹的优化控制方法
【技术领域】
[0001] 本发明涉及仿人机器人的控制方法，属于机器人控制技术领域。
【背景技术】
[0002] 仿人机器人的运动规划与轨迹跟踪问题一直是仿人机器人研宄的热点与前沿。仿 人机器人的轨迹规划大都依据线性倒立摆的运动规律进行规划，而在实际运动中采用跟踪 规划位置的方式进行运动。这种控制方式缺乏灵活性，尤其当误差出现时跟踪规划位置的 方式极易造成误差的积累与传递，对仿人机器人的稳定运动造成很大的影响。
[0003] -种有效的解决方式是采用离线规划，在线调整的方式对机器人的运动进行调 节。通过建立仿人机器人对轨迹跟踪情况的评价函数，同时通过步行周期内的评价函数的 累积值对机器人的步行参数进行调节，实现稳定控制。
[0004] 现有技术的两种技术方案如下：
[0005] 现有技术 1:EnglsbergerJ,OttC,RoaMA,etal.Bipedalwalkingcontrol basedoncapturepointdynamics[C]//IntelligentRobotsand Systems(IR0S), 2011IEEE/RSJInternationalConferenceon.IEEE,2011:4420-4427.
[0006] 现有技术2 :基于闭环控制的仿人机器人全向行走方法。
[0007] 现有技术1公开了一种仿人机器人的行走控制方法。该方法提供了一种仿人机器 人的行走运动方法。该方法通过机器人在每个步行周期开始时的瞬时状态，控制机器人选 定落脚点，并进行行走与姿态的调节。该控制方法根据机器人的瞬时状态对控制量做出调 节，没有考虑机器人在运动过程中的状态。
[0008] 现有技术2公开了一种仿人机器人闭环控制全向行走方法，通过测定机器人的 ZMP和机器人的位姿状态，利用预观控制方法，调节仿人机器人的步行参数，控制机器人的 行走。该方法通过预观控制调节机器人的行走，预观控制无法实时修正当前机器人对给定 轨迹的跟踪情况。
[0009] 现有技术中的仿人机器人的控制方法，依赖于离线轨迹的生成。但是用于仿人机 器人离线轨迹生成的数学模型都是采用简化的倒立摆模型，倒立摆模型的结构与仿人机器 人有较大的不同，因此仿人机器人的运动与基于倒立摆模型生成的运动轨迹相比会产生较 大的误差，如若不进行调节，随着误差的积累，极易出现仿人机器人失稳摔倒的情况。
[0010] 为了防止仿人机器人在运动过程中误差的积累，需要一种仿人机器人的行走轨迹 优化控制方法，可以有效减小仿人机器人在行走过程中误差的积累并对给定轨迹的轨迹进 行优化修正，提高仿人机器人行走的稳定性。
【发明内容】
[0011] 本发明的目的在于针对仿人机器人行走运动，提出了一种仿人机器人运动轨迹的 实时优化控制跟踪方法。并且通过对完整步行周期优化效果的累计生成轨迹修正量，在每 个步行周期结束时，修正仿人机器人的步行参数，提高仿人机器人行走的稳定性。
[0012] 本发明的技术方案是，
[0013] 一种仿人机器人行走轨迹的优化控制方法，包括以下步骤：
[0014] 步骤1 :在运动过程中，建立评价函数；
[0015] 步骤2:实时生成机器人的关节控制量，使机器人实时最优跟踪生成的轨迹，尽可 能减小实际运动轨迹与给定运动轨迹之间的误差；
[0016] 步骤3:依据在支撑相内每一步控制周期内的评价函数的累计值进行步行参数的 修正。
[0017] 优选地，所述步骤1进一步包括：
[0018] 根据拉格朗日定理，系统的动力学方程为
[0021] 其中D(q)为系统的惯性矩阵，c(qj)为科氏力和向心力矩阵，G(q)为重力矩阵， q为机器人各个关节的关节角度，u为各个关节的驱动力矩；
[0022] 机器人的质心位置c与机器人关节角度q的关系为：
[0023]c=c(q) (2)
[0024] 设定仿人机器人的步行周期为tb，则建立位姿跟踪情况评价函数J，J中建立了机 器人对给定轨迹的跟踪情况，J如式（3)所示，第一项描述了机器人对给定质心轨迹的跟踪 情况，第二项描述了机器人关节的输出力矩，第三项描述了机器人关节角度对给定的关节 角度的跟踪情况；
[0026] 其中的Q，R，W为可以调节的权重系数，分别代表了仿人机器人系统在质心轨迹， 关节输出力矩和关节跟踪的权重系数，对应的权重系数越大表示系统在控制过程中在该项 上的容差越小。
[0027] 优选地，所述步骤2进一步包括：采用基于线性倒立摆模型的运动轨迹生成器，根 据预先设定的机器人的第n步行走参数，通过运动轨迹生成器生成机器人的质心的运动轨 迹c_d和利用逆运动学求解的关节轨迹q_d;轨迹生成器在每个支撑相开始时计算以上运 动参数并生成下一步的运动轨迹。
[0028] 优选地，所述行走参数包括步长S_(x,n)、步宽S_(y,n)。
[0029] 优选地，所述步骤2进一步包括：通过控制变量u的作用使评价函数J在有限的时 间内最小；评价函数J越小，表示机器人对给定轨迹的跟踪越理想；
[0030] 选定时间步长At
[0031] 第i个运算步长时，系统的状态为
[0035] 对评价函数进行离散化
[0037]为了减小Jd的值，在第i个控制周期内，使.L取极小值，因为输入的关节角度力矩 u只能影响关节的角加速度，因此第i个控制周期的控制量^影响的是i+2时刻系统状态， 将⑷带入（5)得到
[0039] 采用最速下降法求解控制量Ui，搜索步长为X，求解利用的表达式为
[0041] 优选地，所述步骤3进一步包括：将在每个支撑相内累计得到的误差sum=Eli进 行步行参数的计算。
[0042]优选地，第n+1步的行走参数为
[0044] 其中a，b为可调节的参数，根据机器人系统选择。
[0045]优选地，选择aG(〇, 〇?2) ;bG(〇, 〇?1)。
[0046] 通过以上技术方案，本发明能够取得以下的技术效果。
[0047] 1.本发明通过建立评价函数，在每个控制周期内实时求解关节控制力矩U保证机 器人对给定运动轨迹的跟踪。同时根据在一个步行周期内评价函数的累积值，调节仿人机 器人的 步行参数，保证仿人机器人运动的稳定性。
[0048] 2.本发明采用迭代的方法进行控制量的求解，求解速度快，适合机器人系统的应 用。
【附图说明】
[0049] 图1是本发明的机器人行走轨迹的控制方法流程图。
【具体实施方式】
[0050] 下面结合附图和具体实施方案对本发明作进一步说明。
[0051] 在运动过程中，通过建立的优化评价函数，实时生成机器人的关节控制量u，使机 器人实时最优跟踪生成的轨迹，尽可能减小实际运动轨迹与给定运动轨迹之间的误差。同 时，依据在支撑相内每一步控制周期内的评价函数的累计值进行步行参数的修正。
[0052] 机器人采用基于线性倒立摆模型的运动轨迹生成器，机器人的第n步行走参数步 长Sx，n、步宽Sy，n，是预先设定的。通过运动轨迹生成器生成机器人的质心的运动轨迹4和 利用逆运动学求解的关节轨迹qd。轨迹生成器在每个支撑相开始时计算以上运动参数并生 成下一步的运动轨迹。
[0053] 根据拉格朗日定理，系统的动力学方程为
[0056] 其中D(q)为系统的惯性矩阵，C(q,d〇为科氏力和向心力矩阵，G(q)为重力矩阵， q为机器人各个关节的关节角度，u为各个关节的驱动力矩。
[0057] 机器人的质心位置c与机器人关节角度q的关系为：
[0058]c=c(q) (2)
[0059] 设定仿人机器人的步行周期为tb，则建立位姿跟踪情况评价函数J，J中建立了机 器人对给定轨迹的跟踪情况，J如式（3)所示，第一项描述了机器人对给定质心轨迹的跟踪 情况，第二项描述了机器人关节的输出力矩，第三项描述了机器人关节角度对给定的关节 角度的跟踪情况。
[0061] 其中的Q，R，W为可以调节的权重系数，分别代表了仿人机器人系统在质心轨迹， 关节输出力矩和关节跟踪的权重系数，对应的权重系数越大表示系统在控制过程中在该项 上的容差越小。通过控制变量u的作用使评价函数J在有限的时间内最小。评价函数J越 小，表示机器人对给定轨迹的跟踪越理想。
[0062] 选定时间步长At
[0063] 第i个运算步长时，系统的状态为
[0067] 对评价函数进行离散化
[0069] 为了减小Jd的值，在第i个控制周期内，使取极小值，因为输入的关节角度力矩 u只能影响关节的角加速度，因此第i个控制周期的控制量^影响的是i+2时刻系统状态， 将⑷带入（5)得到
[0071] 为了快速性的需要，每个控制周期内采用迭代的方式求解控制量Ui，以达到对实 时性的要求。采用最速下降法求解较有的控制量^，搜索步长为X，求解利用的表达式为
[0073] 将在每个支撑相内累计得到的误差sum=EL进行步行参数的计算。第n+1步的 行走参数为
[0075] 其中a，b为可调节的参数，根据机器人系统选择，一般选择ae(0, 0.2);bG(〇, 〇? 1)。
【主权项】
1. 一种仿人机器人行走轨迹的优化控制方法，包括以下步骤： 步骤1 :在运动过程中，建立评价函数； 步骤2 :实时生成机器人的关节控制量，使机器人实时最优跟踪生成的轨迹，尽可能减 小实际运动轨迹与给定运动轨迹之间的误差； 步骤3 :依据在支撑相内每一步控制周期内的评价函数的累计值进行步行参数的修 正。2. 根据权利要求1所述的方法，其特征在于，所述步骤1进一步包括： 根据拉格朗日定理，系统的动力学方程为其中D(q)为系统的惯性矩阵，C(q, ?)为科氏力和向心力矩阵，G(q)为重力矩阵，q为 机器人各个关节的关节角度，u为各个关节的驱动力矩； 机器人的质心位置c与机器人关节角度q的关系为： c = c (q) (2) 设定仿人机器人的步行周期为tb，则建立位姿跟踪情况评价函数J，J中建立了机器 人对给定轨迹的跟踪情况，J如式（3)所示，第一项描述了机器人对给定质心轨迹的跟踪情 况，第二项描述了机器人关节的输出力矩，第三项描述了机器人关节角度对给定的关节角 度的跟踪情况；其中的Q，R，W为可以调节的权重系数，分别代表了仿人机器人系统在质心轨迹，关节 输出力矩和关节跟踪的权重系数，对应的权重系数越大表示系统在控制过程中在该项上的 容差越小。3. 根据权利要求2所述的方法，其特征在于，所述步骤2进一步包括：采用基于线性倒 立摆模型的运动轨迹生成器，根据预先设定的机器人的第n步行走参数，通过运动轨迹生 成器生成机器人的质心的运动轨迹Cd和利用逆运动学求解的关节轨迹qd;轨迹生成器在每 个支撑相开始时计算以上运动参数并生成下一步的运动轨迹。4. 根据权利要求3所述的方法，其特征在于，所述行走参数包括机器人在行走方向上 的步长Sx，n、步宽Sy，n。5. 根据权利要求2所述的方法，其特征在于，所述步骤2进一步包括：通过控制变量u 的作用使评价函数J在步行周期内最小；评价函数J的值越小，表示机器人对给定轨迹的跟 踪越理想； 选定时间步长At 第i个运算步长时，系统的状态为对评价函数进行离散化为了减小Jd的值，在第i个控制周期内，使评价函数的离散量ii取极小值，因为输入的 关节角度力矩U只能影响关节的角加速度，因此第i个控制周期的控制量^影响的是i+2 时刻系统状态，将（4)带入（5)得到采用最速下降法求解控制量Ui,搜索步长为λ，求解利用的表达式为(7)。6. 根据权利要求5所述的方法，其特征在于，所述步骤3进一步包括：将在每个支撑相 内累计得到的误差sum = Σ??进行步行参数的计算。7. 根据权利要求6所述的方法，其特征在于，第η+1步的行走参数为(8) 其中a，b为可调节的参数，根据机器人系统选择。8. 根据权利要求7所述的方法，其特征在于，选择a e (〇, 〇. 2) ;b e (〇, 〇. 1)。
【专利摘要】本发明提供了一种仿人机器人行走轨迹的优化控制跟踪方法。该方法通过对完整步行周期优化效果的累计生成轨迹修正量，在每个步行周期结束时，修正仿人机器人的步行参数，提高仿人机器人行走的稳定性。
【IPC分类】G05D1/02
【公开号】CN104898672
【申请号】CN201510239280
【发明人】黄强, 孙文涛, 余张国, 陈学超, 张伟民, 张思, 孟立波
【申请人】北京理工大学
【公开日】2015年9月9日
【申请日】2015年5月12日
【技术领域】
[0001] 本发明涉及仿人机器人的控制方法，属于机器人控制技术领域。
【背景技术】
[0002] 仿人机器人的运动规划与轨迹跟踪问题一直是仿人机器人研宄的热点与前沿。仿 人机器人的轨迹规划大都依据线性倒立摆的运动规律进行规划，而在实际运动中采用跟踪 规划位置的方式进行运动。这种控制方式缺乏灵活性，尤其当误差出现时跟踪规划位置的 方式极易造成误差的积累与传递，对仿人机器人的稳定运动造成很大的影响。
[0003] -种有效的解决方式是采用离线规划，在线调整的方式对机器人的运动进行调 节。通过建立仿人机器人对轨迹跟踪情况的评价函数，同时通过步行周期内的评价函数的 累积值对机器人的步行参数进行调节，实现稳定控制。
[0004] 现有技术的两种技术方案如下：
[0005] 现有技术 1:EnglsbergerJ,OttC,RoaMA,etal.Bipedalwalkingcontrol basedoncapturepointdynamics[C]//IntelligentRobotsand Systems(IR0S), 2011IEEE/RSJInternationalConferenceon.IEEE,2011:4420-4427.
[0006] 现有技术2 :基于闭环控制的仿人机器人全向行走方法。
[0007] 现有技术1公开了一种仿人机器人的行走控制方法。该方法提供了一种仿人机器 人的行走运动方法。该方法通过机器人在每个步行周期开始时的瞬时状态，控制机器人选 定落脚点，并进行行走与姿态的调节。该控制方法根据机器人的瞬时状态对控制量做出调 节，没有考虑机器人在运动过程中的状态。
[0008] 现有技术2公开了一种仿人机器人闭环控制全向行走方法，通过测定机器人的 ZMP和机器人的位姿状态，利用预观控制方法，调节仿人机器人的步行参数，控制机器人的 行走。该方法通过预观控制调节机器人的行走，预观控制无法实时修正当前机器人对给定 轨迹的跟踪情况。
[0009] 现有技术中的仿人机器人的控制方法，依赖于离线轨迹的生成。但是用于仿人机 器人离线轨迹生成的数学模型都是采用简化的倒立摆模型，倒立摆模型的结构与仿人机器 人有较大的不同，因此仿人机器人的运动与基于倒立摆模型生成的运动轨迹相比会产生较 大的误差，如若不进行调节，随着误差的积累，极易出现仿人机器人失稳摔倒的情况。
[0010] 为了防止仿人机器人在运动过程中误差的积累，需要一种仿人机器人的行走轨迹 优化控制方法，可以有效减小仿人机器人在行走过程中误差的积累并对给定轨迹的轨迹进 行优化修正，提高仿人机器人行走的稳定性。
【发明内容】
[0011] 本发明的目的在于针对仿人机器人行走运动，提出了一种仿人机器人运动轨迹的 实时优化控制跟踪方法。并且通过对完整步行周期优化效果的累计生成轨迹修正量，在每 个步行周期结束时，修正仿人机器人的步行参数，提高仿人机器人行走的稳定性。
[0012] 本发明的技术方案是，
[0013] 一种仿人机器人行走轨迹的优化控制方法，包括以下步骤：
[0014] 步骤1 :在运动过程中，建立评价函数；
[0015] 步骤2:实时生成机器人的关节控制量，使机器人实时最优跟踪生成的轨迹，尽可 能减小实际运动轨迹与给定运动轨迹之间的误差；
[0016] 步骤3:依据在支撑相内每一步控制周期内的评价函数的累计值进行步行参数的 修正。
[0017] 优选地，所述步骤1进一步包括：
[0018] 根据拉格朗日定理，系统的动力学方程为
[0021] 其中D(q)为系统的惯性矩阵，c(qj)为科氏力和向心力矩阵，G(q)为重力矩阵， q为机器人各个关节的关节角度，u为各个关节的驱动力矩；
[0022] 机器人的质心位置c与机器人关节角度q的关系为：
[0023]c=c(q) (2)
[0024] 设定仿人机器人的步行周期为tb，则建立位姿跟踪情况评价函数J，J中建立了机 器人对给定轨迹的跟踪情况，J如式（3)所示，第一项描述了机器人对给定质心轨迹的跟踪 情况，第二项描述了机器人关节的输出力矩，第三项描述了机器人关节角度对给定的关节 角度的跟踪情况；
[0026] 其中的Q，R，W为可以调节的权重系数，分别代表了仿人机器人系统在质心轨迹， 关节输出力矩和关节跟踪的权重系数，对应的权重系数越大表示系统在控制过程中在该项 上的容差越小。
[0027] 优选地，所述步骤2进一步包括：采用基于线性倒立摆模型的运动轨迹生成器，根 据预先设定的机器人的第n步行走参数，通过运动轨迹生成器生成机器人的质心的运动轨 迹c_d和利用逆运动学求解的关节轨迹q_d;轨迹生成器在每个支撑相开始时计算以上运 动参数并生成下一步的运动轨迹。
[0028] 优选地，所述行走参数包括步长S_(x,n)、步宽S_(y,n)。
[0029] 优选地，所述步骤2进一步包括：通过控制变量u的作用使评价函数J在有限的时 间内最小；评价函数J越小，表示机器人对给定轨迹的跟踪越理想；
[0030] 选定时间步长At
[0031] 第i个运算步长时，系统的状态为
[0035] 对评价函数进行离散化
[0037]为了减小Jd的值，在第i个控制周期内，使.L取极小值，因为输入的关节角度力矩 u只能影响关节的角加速度，因此第i个控制周期的控制量^影响的是i+2时刻系统状态， 将⑷带入（5)得到
[0039] 采用最速下降法求解控制量Ui，搜索步长为X，求解利用的表达式为
[0041] 优选地，所述步骤3进一步包括：将在每个支撑相内累计得到的误差sum=Eli进 行步行参数的计算。
[0042]优选地，第n+1步的行走参数为
[0044] 其中a，b为可调节的参数，根据机器人系统选择。
[0045]优选地，选择aG(〇, 〇?2) ;bG(〇, 〇?1)。
[0046] 通过以上技术方案，本发明能够取得以下的技术效果。
[0047] 1.本发明通过建立评价函数，在每个控制周期内实时求解关节控制力矩U保证机 器人对给定运动轨迹的跟踪。同时根据在一个步行周期内评价函数的累积值，调节仿人机 器人的 步行参数，保证仿人机器人运动的稳定性。
[0048] 2.本发明采用迭代的方法进行控制量的求解，求解速度快，适合机器人系统的应 用。
【附图说明】
[0049] 图1是本发明的机器人行走轨迹的控制方法流程图。
【具体实施方式】
[0050] 下面结合附图和具体实施方案对本发明作进一步说明。
[0051] 在运动过程中，通过建立的优化评价函数，实时生成机器人的关节控制量u，使机 器人实时最优跟踪生成的轨迹，尽可能减小实际运动轨迹与给定运动轨迹之间的误差。同 时，依据在支撑相内每一步控制周期内的评价函数的累计值进行步行参数的修正。
[0052] 机器人采用基于线性倒立摆模型的运动轨迹生成器，机器人的第n步行走参数步 长Sx，n、步宽Sy，n，是预先设定的。通过运动轨迹生成器生成机器人的质心的运动轨迹4和 利用逆运动学求解的关节轨迹qd。轨迹生成器在每个支撑相开始时计算以上运动参数并生 成下一步的运动轨迹。
[0053] 根据拉格朗日定理，系统的动力学方程为
[0056] 其中D(q)为系统的惯性矩阵，C(q,d〇为科氏力和向心力矩阵，G(q)为重力矩阵， q为机器人各个关节的关节角度，u为各个关节的驱动力矩。
[0057] 机器人的质心位置c与机器人关节角度q的关系为：
[0058]c=c(q) (2)
[0059] 设定仿人机器人的步行周期为tb，则建立位姿跟踪情况评价函数J，J中建立了机 器人对给定轨迹的跟踪情况，J如式（3)所示，第一项描述了机器人对给定质心轨迹的跟踪 情况，第二项描述了机器人关节的输出力矩，第三项描述了机器人关节角度对给定的关节 角度的跟踪情况。
[0061] 其中的Q，R，W为可以调节的权重系数，分别代表了仿人机器人系统在质心轨迹， 关节输出力矩和关节跟踪的权重系数，对应的权重系数越大表示系统在控制过程中在该项 上的容差越小。通过控制变量u的作用使评价函数J在有限的时间内最小。评价函数J越 小，表示机器人对给定轨迹的跟踪越理想。
[0062] 选定时间步长At
[0063] 第i个运算步长时，系统的状态为
[0067] 对评价函数进行离散化
[0069] 为了减小Jd的值，在第i个控制周期内，使取极小值，因为输入的关节角度力矩 u只能影响关节的角加速度，因此第i个控制周期的控制量^影响的是i+2时刻系统状态， 将⑷带入（5)得到
[0071] 为了快速性的需要，每个控制周期内采用迭代的方式求解控制量Ui，以达到对实 时性的要求。采用最速下降法求解较有的控制量^，搜索步长为X，求解利用的表达式为
[0073] 将在每个支撑相内累计得到的误差sum=EL进行步行参数的计算。第n+1步的 行走参数为
[0075] 其中a，b为可调节的参数，根据机器人系统选择，一般选择ae(0, 0.2);bG(〇, 〇? 1)。
【主权项】
1. 一种仿人机器人行走轨迹的优化控制方法，包括以下步骤： 步骤1 :在运动过程中，建立评价函数； 步骤2 :实时生成机器人的关节控制量，使机器人实时最优跟踪生成的轨迹，尽可能减 小实际运动轨迹与给定运动轨迹之间的误差； 步骤3 :依据在支撑相内每一步控制周期内的评价函数的累计值进行步行参数的修 正。2. 根据权利要求1所述的方法，其特征在于，所述步骤1进一步包括： 根据拉格朗日定理，系统的动力学方程为其中D(q)为系统的惯性矩阵，C(q, ?)为科氏力和向心力矩阵，G(q)为重力矩阵，q为 机器人各个关节的关节角度，u为各个关节的驱动力矩； 机器人的质心位置c与机器人关节角度q的关系为： c = c (q) (2) 设定仿人机器人的步行周期为tb，则建立位姿跟踪情况评价函数J，J中建立了机器 人对给定轨迹的跟踪情况，J如式（3)所示，第一项描述了机器人对给定质心轨迹的跟踪情 况，第二项描述了机器人关节的输出力矩，第三项描述了机器人关节角度对给定的关节角 度的跟踪情况；其中的Q，R，W为可以调节的权重系数，分别代表了仿人机器人系统在质心轨迹，关节 输出力矩和关节跟踪的权重系数，对应的权重系数越大表示系统在控制过程中在该项上的 容差越小。3. 根据权利要求2所述的方法，其特征在于，所述步骤2进一步包括：采用基于线性倒 立摆模型的运动轨迹生成器，根据预先设定的机器人的第n步行走参数，通过运动轨迹生 成器生成机器人的质心的运动轨迹Cd和利用逆运动学求解的关节轨迹qd;轨迹生成器在每 个支撑相开始时计算以上运动参数并生成下一步的运动轨迹。4. 根据权利要求3所述的方法，其特征在于，所述行走参数包括机器人在行走方向上 的步长Sx，n、步宽Sy，n。5. 根据权利要求2所述的方法，其特征在于，所述步骤2进一步包括：通过控制变量u 的作用使评价函数J在步行周期内最小；评价函数J的值越小，表示机器人对给定轨迹的跟 踪越理想； 选定时间步长At 第i个运算步长时，系统的状态为对评价函数进行离散化为了减小Jd的值，在第i个控制周期内，使评价函数的离散量ii取极小值，因为输入的 关节角度力矩U只能影响关节的角加速度，因此第i个控制周期的控制量^影响的是i+2 时刻系统状态，将（4)带入（5)得到采用最速下降法求解控制量Ui,搜索步长为λ，求解利用的表达式为(7)。6. 根据权利要求5所述的方法，其特征在于，所述步骤3进一步包括：将在每个支撑相 内累计得到的误差sum = Σ??进行步行参数的计算。7. 根据权利要求6所述的方法，其特征在于，第η+1步的行走参数为(8) 其中a，b为可调节的参数，根据机器人系统选择。8. 根据权利要求7所述的方法，其特征在于，选择a e (〇, 〇. 2) ;b e (〇, 〇. 1)。
【专利摘要】本发明提供了一种仿人机器人行走轨迹的优化控制跟踪方法。该方法通过对完整步行周期优化效果的累计生成轨迹修正量，在每个步行周期结束时，修正仿人机器人的步行参数，提高仿人机器人行走的稳定性。
【IPC分类】G05D1/02
【公开号】CN104898672
【申请号】CN201510239280
【发明人】黄强, 孙文涛, 余张国, 陈学超, 张伟民, 张思, 孟立波
【申请人】北京理工大学
【公开日】2015年9月9日
【申请日】2015年5月12日
最新回复(0)