1.一种四足机器人连续躯干运动轨迹规划方法，其特征是，包括以下步骤：(1)将四足机器人在躯干摆动阶段各支撑足投影至平面坐标系{PO}中；

(2)根据各支撑足在平面坐标系{PO}中的投影位置及设定的能够改变躯干侧移量的可调整参数，确定躯干运动轨迹的关键路径点；

(3)根据确定的躯干运动轨迹的关键路径点以及躯干运动的边界条件，给出躯干运动轨迹的方程。

2.根据权利要求1所述的四足机器人连续躯干运动轨迹规划方法，其特征是，所述步骤(2)中躯干运动轨迹关键路径点的确定过程如下所述：将按迈步顺序接下来要摆动的后足记为NSF，记此足的期望落足点为DF，与NSF位于躯干同侧的前足记为IFF，记与NSF位于躯干不同侧的两只足中的前足与后足分别为CFF和CHF；假设这四只足的投影在{PO}中的坐标分别为PNSF(PxNSF，PyNSF),PIFF(PxIFF，PyIFF),PCFFP P P P P P(xCFF，yCFF),PCHF(xCHF，yCHF),NSF期望落足点DF投影在坐标系{O}中的坐标为PDF( xDF，PyDF)；

三角形ΔPI PCFF PCHF为NSF与IFF相对应的双支撑三角形，为了保证机器人在摆动足运动过程中稳定性，在躯干摆动阶段中，以使躯干的重心向双支撑三角形的内心位置运动为躯干重心调整的目标；

设直线LDF-CFF为连接点PDF与点PCFF的直线，LIFF-CHF为连接点PIFF与点PCHF的直线。根据各点的坐标，得到直线LDF-CFF与LIFF-CHF的方程：其中，kDF-CFF与bDF-CFF分别为LDF-CFF的斜率和截距；kIFF-CHF与bIFF-CHF分别为LIFF-CHF的斜率和截距；

记两条直线LDF-CFF与LIFF-CHF的交点为PI(PxI,PyI),由上式得到点PI在坐标系{PO}的坐标值为：其中，kDF-CFF与bDF-CFF分别为LDF-CFF的斜率和截距；kIFF-CHF与bIFF-CHF分别为LIFF-CHF的斜率和截距；

三角形ΔPI PCFF PCHF为NSF与IFF相对应的双支撑三角形，由双支撑三角形各顶点的坐标，得到其内心PC(PxC,PyC)：其中，

记点PI与点PC的直线距离为D(PI,PC)，根据两点的坐标，得到D(PI,PC)的值为：记LI-C为连接点PI和点PC的直线，wm为第m个步态周期中，躯干运动轨迹的可调整参数，0

根据上式得到点BSPPE在坐标系{PO}中的坐标为：

记DF-CFFL⊥为过点BSPPE且垂直于LDF-CFF的直线，并记点FSPPE(FSPxE，FSPyE)为稳定区域内位于直线DF-CFFL⊥上且与直线LDF-CFF垂直距离(记为DF-CFFD⊥(FSPxE，FSPyE))为Smin的点，即点FSPPE需满足下式：根据上式得到点FSPPE在坐标系{PO}中的坐标为：

其中，

3.根据权利要求1所述的四足机器人连续躯干运动轨迹规划方法，其特征是，所述步骤(3)中给出躯干运动轨迹的方程的具体过程为：根据确定的躯干运动轨迹的关键路径点BSPPE和点FSPPE的坐标，给出单个步态周期中四足机器人躯干运动轨迹的方程；

在躯干摆动阶段中，坐标系{PO}的原点为躯干重心移动的起点，点BSPPE为终点；在足的摆动阶段中，BSPPE为躯干重心移动的起点，点FSPPE为终点，以下分别给出躯干摆动阶段和足的摆动阶段中的躯干运动轨迹方程；

A.躯干摆动阶段中躯干运动轨迹方程：

记在躯干摆动阶段中机器人躯干运动轨迹的方程为：

其中， TBSP代表机器人完成BSP的规划时

间；

在躯干摆动阶段中，坐标系{PO}的原点与躯干重心在水平地面上的投影重合，为躯干重心移动的起点；运动结束之后，躯干重心的投影将到达点BSPPE，即躯干运动轨迹的位置边界条件满足：在足的摆动阶段中机器人躯干仅沿前进方向上做匀速直线运动，而BSP相邻各有一个足的摆动阶段，因而机器人在Py方向上的躯干运动轨迹的速度和加速度边界条件为：BSP

根据躯干运动的边界条件，得到躯干运动轨迹的方程 fy(t)的系数为：其中，

将得到的系数代入躯干运动轨迹方程中，即得到四足机器人在运动过程中的躯干运动轨迹；

B.足的摆动阶段中躯干运动轨迹方程：

在足的摆动阶段中，机器人的躯干仅沿前进方向做匀速直线运动，由此得到机器人在足的摆动阶段中，沿Px方向上的躯干运动轨迹方程为：其中，t∈[TBSP,TBSP+TFSP]，TFSP代表机器人完成FSP阶段的规划时间。