多点支撑平台的上装姿态控制方法技术

本发明专利技术公开了一种多点支撑平台的上装姿态控制方法。分别测量平台的承载交互作用矩阵和变形交互作用矩阵，构建承载与变形耦合控制矩阵；测量各支腿的当前载荷，并计算其最优载荷；基于操作员的档杆指令生成升降、侧倾和俯仰基准参量，连同当前载荷、最优载荷、承载与变形耦合控制矩阵，构建平台几何与支腿载荷耦合控制方程；计算并修正得到对应指令下的支腿总作动量，并执行同步作动；循环检测操作员指令直至全部置零，结束姿态控制。该方法具有同步实现平台姿态控制和保持支腿均匀承载的效果，能够显著提升多点支撑平台的上装姿态控制速度、几何精度、过程稳定性、支腿承载稳定性和控制鲁棒性。制鲁棒性。制鲁棒性。

【技术实现步骤摘要】
多点支撑平台的上装姿态控制方法


[0001]本专利技术属于姿态控制领域，具体涉及一种多点支撑平台的上装姿态控制方法

技术介绍

[0002]多点支撑平台的上装姿态控制需求十分广泛。例如多轴独立悬架车辆、军民用特种车辆的多支腿调平、多点支撑大尺寸构件的精密加工与装配、机床基础的支撑安装调试等。仅以多轴独立悬架车辆为例，车辆涉水、铁路、航空运输等需要预先实施车身高升低降，以提高通过能力；上下纵、侧向斜坡前可预先高升低降、俯仰侧倾，以提高通过性和驾驶员视野。在姿态控制的同时若能同步实现各车轮载荷的分配控制，能够显著提高车辆的通过性、机动性和姿态稳定性。
[0003]多于三点支撑的上装姿态控制属于典型的超静定问题，承载中各支腿和平台的弹性变形以及支撑载荷相互影响。传统的姿态控制方法均将上装简化为刚体，基于点追逐法和角度误差法，通过反复迭代测试和作动实现调平功能，存在速度慢、精度低、反复振荡、支腿载荷不受控，甚至出现虚腿和过载等问题。例如 CN202010002450.X的中国专利公开了一种调平控制系统及方法，其方法是首先调节支腿高度使第一倾角满足精度要求，再使第二倾角满足精度要求，重复整个流程，直到第一、第二倾角均小于极限倾角，则调平结束。该专利通过反复迭代测试和作动实现调平功能，并不能很好地保证调平精度、速度，更不能同时实现对支腿载荷的完全控制。而在车辆姿态控制领域，目前多采用的互联方案，即通过悬架气压或液压管路的互联实现将多点支撑超静定降阶为静定问题。例如CN105539060A的中国专利公开了一种液压互联悬架，通过将后悬液压缸反向串联，平衡两侧车轮承受的载荷，实现防侧倾效果。然而这种互联方案难以实现高升低降、俯仰侧倾等不同姿态控制的灵活切换需求，而且也不能实现对各车轮承载的同步控制。
[0004]要解决上述不足，必需从解决超静定系统的变形和承载耦合关系出发，实施平台几何与支腿载荷的耦合控制。因此，本专利充分考虑支腿、平台的变形交互作用以及支腿和平台之间的承载交互作用，提出一种高速且同步的实现平台几何与支腿载荷耦合控制的方法，能够根据操作员给出的升降、侧倾、俯仰及三者任意组合的档杆指令，精确计算各支腿作动量，达到精确、快速实现姿态控制的同时，各支腿载荷达到最优载荷的目的。

技术实现思路

[0005]有鉴于此，本专利技术提供一种多点支撑平台的上装姿态控制方法，该方法充分考虑了支腿变形、平台的变形以及支腿和平台之间的承载交互作用，构建了高速且同步实现平台几何与支腿载荷耦合的方法，解决现有姿态控制方法中速度慢、精度低、反复振荡、支腿载荷不受控，甚至出现虚腿和过载等问题。
[0006]本专利技术公开了多点支撑平台的上装姿态控制方法，该装置共有大于4的n条支腿沿上装纵向对称面对称分布；支腿为液压支腿，上端与上装的下水平表面固定连接，下端垂直的支撑固定在地面上并只进行垂直于地面方向的伸缩运动，每条支腿的结构尺寸、与上装
的连接结构完全相同；各个支腿最大作动行程、伸缩速率完全相同；每条支腿上安装有两个液压敏感元件构成测量垂向载荷的力传感器和测量作动量的位移传感器，上装上表面有主轴沿平台纵向的二维倾角传感器；操作员通过控制升降档杆侧倾挡杆和俯仰挡杆给与系统命令输入，通过控制器的解析计算，得到各支腿的作动量，以此来对平台进行姿态调整，其特征在于包括以下步骤：
[0007]本专利技术实例提供了一种多点支撑平台的上装姿态控制方法，具体包括以下步骤：
[0008]步骤1，将n条支腿分别赋予序号1～n；以上装的几何中心为坐标系原点，按右手定则将平台的纵、横、垂向分别设为x、y、z轴，各支腿与上装连结点的坐标记为(x
i
，y
i
，z
i
)，i＝1～n，倾角和力矩的正方向判定由右手螺旋定则确定；
[0009]步骤2，驱动第i条支腿垂向作动伸长，同时保持其他的支腿不动，由所述的位移传感器实时测量直至产生一个设定位移，按照从1 到n的次序分别由所述的力传感器测量每条支腿的载荷增量，将各载荷增量除以所述设定位移并依次放入一个n
×
n维矩阵第i列的第1到n行中；循环驱动各支腿执行上述操作，直至构造出n
×
n 维的承载交互作用矩阵
[0010][0011]步骤3，在步骤2驱动第i条支腿产生所述设定位移的同时，由二维倾角传感器分别测量平台绕x轴和y轴的倾角增量，将各倾角增量除以所述设定位移，并依次放入一个2
×
n维矩阵的第i列的第1、2行，构造出2
×
n维的变形交互作用矩阵
[0012][0013]步骤4，将承载交互作用矩阵依次输入到(n+2)
×
n维矩阵的第1 行到第n行，将变形交互作用矩阵依次输入到(n+2)
×
n维矩阵的最后两行，构造出承载与变形耦合控制矩阵
[0014][0015]步骤5，利用力传感器测量各支腿的当前载荷F
it
；
[0016]步骤6，将上装总重记为G，将各支腿均摊上装总重作为理想载荷，以各支腿载荷F
it
与理想载荷G/n的均方差最小为目标，以平台绕x、y轴的力矩平衡和沿z轴的力平衡为约束，各支腿的理论最优载荷计算模型为
[0017][0018]将公式4利用Lagrange乘子法求解，各支腿的最优载荷F
i*
满足公式5
[0019][0020]步骤7，监测操作员的档杆指令，并生成相应的作动基准值，包括：
[0021]当操作员的档杆指令仅为升降动作中的上升或下降时，分别设定升降作动基准值为
△
z和
‑△
z；
[0022]当操作员的档杆指令仅为侧倾动作中的左倾或右倾时，分别设定侧倾作动基准值为
△
θ
xt
和
‑△
θ
xt
，同时将俯仰作动基准值置零；
[0023]当操作员的档杆指令仅为俯仰动作中的前俯或后仰时，分别设定俯仰作动基准值为
△
θ
yt
和
‑△
θ
yt
，同时将侧倾作动基准值置零；
[0024]当操作员的档杆指令为侧倾和俯仰的组合时，按照上述基准值的正、负号规则，分别设定侧倾作动基准值和俯仰作动基准值；
[0025]当操作员的档杆指令为升降和侧倾的组合，或升降和俯仰的组合时，按照上述基准值的正、负号规则，分别设定升降作动基准值和侧倾作动基准值的组合，或升降作动基准值和俯仰作动基准值的组合；
[0026]当操作员的档杆指令为升降、侧倾和俯仰的组合时，按照上述基准值的正、负号规则，分别设定升降作动基准值、侧倾作动基准值和俯仰作动基准值；
[0027]步骤8，结合步骤4所述的承载与变形耦合控制矩阵，步骤5所述的各支腿的当前载荷，步骤6所述的各支腿的最优载荷，以及步骤7确定的作动基准值，构造出平台几何与支腿载荷耦合控制方程：
...

【技术保护点】

【技术特征摘要】
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；当操作员的档杆指令仅为侧倾动作中的左倾或右倾时，分别设定侧倾作动基准值为
△
...

【专利技术属性】
技术研发人员：张帆，聂振祺，王慧恒，杨文韬，武际兴，
申请(专利权)人：山东理工大学，
类型：发明
国别省市：