1.一种双足机器人行走实时步态的AZR调节方法,其特征在于,所述方法包括:步骤1:利用机器人离线系统测算数据构建在线数据库,所述在线数据库包括机器人步长集合S、AZR集合H、行走步态集合G及能耗集合E;
步骤2:给定机器人目标行程距离d和期望AZR位置rAZR,规划能耗最低的步长序列步骤3:取出机器人每步长 和AZR变量ηi,查询在线数据库,得到步态控制的电机角度序列gi;
步骤4:按照机器人行走中脚步压力集合Fi,计算实时ZMP轨迹rZMP(n),基于rZMP(n)和rAZR(n),获得Y轴方向的偏差值ei;
步骤5:利用所述Y轴方向的偏差值ei,采用PI校正方法获得AZR变量ηi的修正值ηi+1,并根据所述修正值ηi+1以及步长si+1查询在线数据库,在线优化双足机器人的步态轨迹。
2.根据权利要求1所述的一种双足机器人行走实时步态的AZR调节方法,其特征在于,步骤2具体包括:
步骤2.1:所述步长序列包括起始步、停止步和多个循环步sm,多个所述循环步sm步长相等,根据机器人运动规则,定义所述起始步包括s1和s2,所述停止步包括sc‑1和sc,令s1=sc、s2=sc‑1,且起始步与停止步的总长度取1~2倍循环步sm的步长;
步骤2.2:给定机器人目标行程距离d,已知循环步sm的步长,通过公式(1)计算所述起始步s1和s2步长:
其中,db为起始步与停止步的总长度;c为总步数;
步骤2.3:给定期望AZR位置rAZR,从步长集合S中取循环步长sm,形成步长序列Sm,所述步长序列Sm的能耗函数如公式(2)表示;
其中,η为AZR位置rAZR对应面积AZR变量值, 表示循环步sm的能耗, 表示起始步s1的能耗, 表示停止步sc的能耗, 和 是表示机器人行走起始和停止过程中,摆动脚在身前和身后运动距离不相等时的等效循环步长为s1和s2的能耗;
步骤2.4:结合公式(2),取最优循环步长 所述最优循环步长 对应形成能耗最低的步长序列 所述能耗最低的步长序列 满足公式(3)所示约束条件;
其中, 友示sm取步长集合S中第k个值时计算的能耗值,k=1,2,…,L,L是步长集合S的元素数目。
3.根据权利要求1所述的一种双足机器人行走实时步态的AZR调节方法,其特征在于,步骤4具体包括:
步骤4.1所述实时ZMP轨迹rZMP(n)表示为:T
rZMP(n)=[xZMP(n) yZMP(n) 0] (4);
其中,x、y分别表示机器人前、侧方向;
结合公式(4),机器人行走第i步,由采样点n时刻的机器人脚底压力传感器取值集合Fi(n),计算实时ZMP轨迹rZMP(n),如公式(5)表示:其中, 和 分别为第j个传感器在x轴方向和y轴方向的位置和压力,cn是传感器的数量。
4.根据权利要求3所述的一种双足机器人行走实时步态的AZR调节方法,其特征在于,所述步骤4还包括:
步骤4.2:取双足机器人每步时间TS为控制周期,所述双足机器人每步时间TS表示为:TS=N·ts (6);
其中,N为双足机器人步态周期;
步骤4.3:定义机器人运动的占空比为σ≡2N1/N,根据采样点n的取值,判断机器人的运动状态;
若N1<n≤N2,双足机器人处于单支撑阶段SSP;
若1≤n≤N1,N2<n≤N,双足机器人处于双支撑阶段DSP;
其中,N1=σN/2,N2=N‑N1,n=1,2,…,N;
步骤4.4:当双足机器人处于双支撑阶段DSP时,rZMP(n)位于期望AZR区域;
当双足机器人处于单支撑阶段SSP时,要求运动X轴方向xZMP(n)单调增,且xZMP(N1+1)≥xAZR(N1+1)、xZMP(N2)≤xAZR(N2)。
5.根据权利要求4所述的一种双足机器人行走实时步态的AZR调节方法,其特征在于,结合公式(5),步骤4所述Y轴方向的偏差值ei表示为:其中,yAZR(n)≥0时,co=1;yAZR(n)<0时,co=‑1,lfw为机器人足宽。
6.根据权利要求1所述的一种双足机器人行走实时步态的AZR调节方法,其特征在于,所述步骤5具体包括:
步骤5.1:建立传递函数为增量式的PI模型,所述AZR变量ηi的修正值ηi+1如公式(8)表示:
ηi+1=ηi+Δηi+1 (8);
其中,增量Δηi+1如公式(9)表示:其中,kP是比例系数,TI是积分时间常数,TS是控制周期;
步骤5.2:根据所述修正值ηi+1以及步长si+1查询在线数据库,得到控制双足机器人行走第i+1步的步态轨迹gi+1,gi+1如公式(10)表示:其中,q为机器人关节电机的角度,m是关节电机的数目,N是步态周期。
7.根据权利要求6所述的一种双足机器人行走实时步态的AZR调节方法,其特征在于,所述步骤5还包括:
在计算Δηi+1时,引入时间常数为TL的一阶惯性环节 加以平滑:Δηi+1=KαΔηi+K1ei+K2ei‑1 (11);
其中,