[发明专利]多点支撑平台的上装姿态控制方法

权利要求书

1.本发明公开了一种多点支撑平台的上装姿态控制方法，该平台的上装为纵向对称平面结构，由4条以上支腿垂向支撑，支腿沿上装的纵向对称面对称分布；支腿的上端与上装固定连接，下端固定支撑在地面上，支腿的液压缸可进行垂直方向的伸缩运动，每条支腿的结构尺寸、与上装的连接结构完全相同；每条支腿上安装有两个液压敏感元件构成的测量垂向载荷的力传感器和测量支腿作动量的位移传感器，上装上表面有主轴沿平台纵向的二维倾角传感器；操作员通过控制升降档杆、侧倾档杆和俯仰档杆给与指令输入，通过控制器解析计算，得到各液压支腿的作动量，以此来对平台进行姿态调整，其特征在于包括以下步骤：

步骤1，将n条支腿分别赋予序号1～n；以上装的几何中心为坐标系原点，按右手定则将平台的纵、横、垂向分别设为x、y、z轴，各支腿与上装连结点的坐标记为(x_i，y_i，z_i)，i＝1～n，倾角和力矩的正方向判定由右手螺旋定则确定；

步骤2，驱动第i条支腿垂向作动伸长，同时保持其他的支腿不动，由所述的位移传感器实时测量直至产生一个设定位移，按照从1到n的次序分别由所述的力传感器测量每条支腿的载荷增量，将各载荷增量除以所述设定位移并依次放入一个n×n维矩阵第i列的第1到n行中；循环驱动各支腿执行上述操作，直至构造出n×n维的承载交互作用矩阵

步骤3，在步骤2驱动第i条支腿产生所述设定位移的同时，由二维倾角传感器分别测量平台绕x轴和y轴的倾角增量，将各倾角增量除以所述设定位移，并依次放入一个2×n维矩阵的第i列的第1、2行，构造出2×n维的变形交互作用矩阵

步骤4，将承载交互作用矩阵依次输入到(n+2)×n维矩阵的第1行到第n行，将变形交互作用矩阵依次输入到(n+2)×n维矩阵的最后两行，构造出承载与变形耦合控制矩阵

步骤5，利用力传感器测量各支腿的当前载荷

步骤6，将上装总重记为G，将各支腿均摊上装总重作为理想载荷，以各支腿载荷与理想载荷G/n的均方差最小为目标，以平台绕x、y轴的力矩平衡和沿z轴的力平衡为约束，各支腿的理论最优载荷为

步骤7，监测操作员的档杆指令，并生成相应的作动基准值，包括：

当操作员的档杆指令仅为升降动作中的上升或下降时，分别设定升降作动基准值为△z和-△z；

当操作员的档杆指令仅为侧倾动作中的左倾或右倾时，分别设定侧倾作动基准值为△θ_x^t和-△θ_x^t，同时将俯仰作动基准值置零；

当操作员的档杆指令仅为俯仰动作中的前俯或后仰时，分别设定俯仰作动基准值为△θ_y^t和-△θ_y^t，同时将侧倾作动基准值置零；

当操作员的档杆指令为侧倾和俯仰的组合时，按照上述基准值的正、负号规则，分别设定侧倾作动基准值和俯仰作动基准值；

当操作员的档杆指令为升降和侧倾的组合，或升降和俯仰的组合时，按照上述基准值的正、负号规则，分别设定升降作动基准值和侧倾作动基准值的组合，或升降作动基准值和俯仰作动基准值的组合；

当操作员的档杆指令为升降、侧倾和俯仰的组合时，按照上述基准值的正、负号规则，分别设定升降作动基准值、侧倾作动基准值和俯仰作动基准值；

步骤8，结合步骤4所述的承载与变形耦合控制矩阵，步骤5所述的各支腿的当前载荷，步骤6所述的各支腿的最优载荷，以及步骤7确定的作动基准值，构造出平台几何与支腿载荷耦合控制方程：

公式5中F_i^t为各支腿的当前载荷，F_i^*为各支腿的最优载荷，{F_i^t-F_i^*}是n条支腿的n×1维载荷偏差列向量，{△θ^t}_2×1自上而下分别为侧倾作动基准值和俯仰作动基准值构成的2×1维列向量；求解公式5即可得到侧倾、俯仰及涉及二者组合的档杆指令下，上装作动对应方向单位倾角的同时支腿载荷达到理论最优载荷需要的各支腿作动量△e_i；

步骤9，在步骤8所述各支腿作动量上，按照步骤7所述基准值的正、负号规则，叠加步骤7设定的升降作动基准值，得到总支腿作动量；

步骤10，根据步骤9得到的总支腿作动量，控制各支腿进行同步作动；

步骤11，循环检测并识别操作员对档杆的操纵指令是否全部置零，若是则支腿锁死，作动结束；若否，则回到步骤5，直至步骤11的支腿锁死条件满足。