1.一种基于滑模控制的水下多足机器人的姿态控制方法，包括以下步骤：步骤1、建立机器人的运动学模型①首先建立机器人的D‑H模型：该机器人包括机体以及多条机械足，每条机械足包括依次连接的第一关节、第二关节、大腿、第三关节、小腿；建立世界坐标系，建立机器人坐标系，建立机械足坐标系；

②建立关节角速度和姿态角速度之间的关系：式中， 为机器人坐标系相对于世界坐标系旋转矩阵，B B o

PF＝Po+PF

B B

为反对称矩阵；PF表示机械足末端在机器人坐标系中的位置，Po表示第一关节在o

机器人坐标系中的位置，PF表示机械足末端在机械足坐标系中的位置；

l2、l3分别是大腿和小腿的长度；

γ、β、α分别为机器人当前姿态中机体的俯仰角、横滚角、航向角； 分别为机器人当前姿态中机体的俯仰角速度、横滚角速度、航向角速度；

θ1、θ2、θ3分别为机器人当前姿态中机械足的第一关节角度、第二关节角度、第三关节角度； 分别为机器人当前姿态中机械足的第一关节角速度、第二关节角速度、第三关节角速度；

步骤2、选择滑模变量

以时间t为控制周期，机器人的姿态误差定义为：e＝η‑ηd，滑动模态定义为：s＝e+a|eb/c| ；

T T

式中，η＝[γ β α]，ηd＝[γd βd αd] ，a、b、c为滑动模态参数，γd、βd、αd分别为经过时间t后机器人到达目标姿态时机体的俯仰角、横滚角、航向角；

步骤3、通过带负指数的双幂次趋近律设计滑模控制率设计双幂次滑模趋近律：

式中，为滑模面s的微分，sgn()为符号函数，k1、k2、k3、m、n、p、q为趋近律的参数；

步骤4、姿态控制

计算姿态角速度

计算关节角速度

得到机器人目标姿态的关节角度： 将机械足的关节转到指定角度qt；式中，qt‑1为机器人当前姿态中机械足的关节角度。

2.根据权利要求1所述的一种基于滑模控制的水下多足机器人的姿态控制方法，其特+征在于：所述步骤2中，a∈R，b、c均为正奇数且b/c＞1。

3.根据权利要求2所述的一种基于滑模控制的水下多足机器人的姿态控制方法，其特征在于：所述步骤3中，k1＞0、k2＞0、k3＞0、0＜m＜1、n＞1、p与q均为正奇数，p/q＞1。