一种用于机载并联平台的位姿观测器设计方法
【专利摘要】本发明提供了一种用于机载并联平台的位姿观测器设计方法。1)以六自由度并联机器平台作为机载平台，平台的固定端的位姿是随机体呈动态变化的，而由六个并联的伸缩杆以及万向铰链控制工作台的位姿始终处于水平状态。2)伸缩杆的实际长度由传感器测量，而平台的位姿通过非线性观测器进行估计。3)伸缩杆长度的测量误差作为状态观测器进行位姿估计的输入信号。4)利用微分同胚将非线性观测器变换转化为带有非线性扰动的线性观测器形式求取，5)同时采用自动微分技术实现增益矩阵的估计，大大提高了增益矩阵的求解速度。
【专利说明】一种用于机载并联平台的位姿观测器设计方法
【技术领域】
[0001]本发明属于机器人控制【技术领域】，涉及一种机载并联机器人平台的位姿观测器的设计方法。
【背景技术】
[0002]并联机器人是由多条独立的运动链连接末端执行器和固定系统而形成的多闭环机构。它具有刚度大、承载能力强、误差小、精度高、自重负荷比小、动力性能好等一系列优点，已经成功地用于加工中心、操作机器人、运动训练装置、微动器、微型机器人以及多维传感器等众多领域，并以其特有的并联机器人多运动链构成的闭环机构方式，成为一个潜在的高速高精度的运动平台。目前关于并联机器人的研究开发和应用正日益广泛，应用的领域也在不断的扩展，这些重要应用弥补了串联机器人的不足，扩大了机器人的应用范围。
[0003]从系统的总体出发，针对期望位姿直接设计控制器，该方法控制精度高，并且在分析机构末端输出误差及实际运动轨迹等方面都具有重要的实际意义。但是，任务空间控制需要计算并联机器人的正运动学，而并联机器人的运动学正解非常复杂，一般不存在解析解，且解不唯一；而数值计算计算量很大，实时性差，且对初值依赖明显。因此，如何提高求解效率以增加其实用性便成为并联机器人研究的一个难点和热点。目前，通常采用在并联机构适当位置增加传感器，获得机构冗余信息，则可以降低机构运动学和动力学求解的复杂程度，实现关节位置和机构位姿之间的线性解耦，但是传感器价格昂贵，而且如何安装传感器本身也存在一定的问题。随着非线性技术的不断发展，以非线性状态观测器代替传感器，获得对位姿的估计信息，有效降低正解维数及求解过程，是提高运算速度，增加其实用性的一种非常好的解决方案。
[0004]因此设计一种合理的用于机载并联平台的位姿观测器设计方法具有重要的应用价值。
【发明内容】
[0005]本发明所要解决的技术问题是，设计一种用于机载并联平台的位姿观测器设计方法，实现对平台姿态的快速观测及估计。
[0006]本发明主要包括以下内容:
[0007](I)考虑实际系统的特点，建立机载平台的动力学模型；
[0008](2)建立基于观测器的控制系统的设计方案；
[0009](3)设计全维非线性状态观测器的设计；
[0010](4)准确地估计出平台的位姿信息。
【专利附图】
【附图说明】
[0011]图1机载并联平台示意图。
[0012]图中①铰链②伸缩杆③工作台④固定平台[0013]图2带有位姿观测器的平台控制系统结构图。
【具体实施方式】
[0014]下面结合附图对本发明作进一步详细说明。
[0015]本发明以机(车)载六自由度并联平台为研究对象(如图1所示)，其固定平台④固定在机(车)体。由于机体在运动过程中有一定的位姿，不能始终保持水平，因而区别于以往静止的并联平台，机(车)载并联平台的固定平台的位姿是动态变化的。由六个并联的伸缩杆②以及万向铰链①控制工作台的位置，以保证工作平台③始终处于水平状态，使负载位姿在运行中保持平稳。
[0016](I)考虑实际系统的特点，建立机载平台的动力学模型
[0017]a.首先充分考虑机身的扰动以及对各支路进行分解时，存在单支路负载变化和耦合干扰等不确定性因素，并考虑相互作用的影响，合理建立系统的无模型动态，将整体问题转化为各支路的问题考虑。
[0018]b.用并联机器人各个部件的雅可比矩阵描述动平台在任务空间的速度、加速度以及两岸和滑块的速度、加速度之间的关系。最终得到综合系统的雅可比矩阵为
【权利要求】
1.一种用于机载并联平台的位姿观测器设计方法，其特征在于以六自由度并联机器平台作为机载平台，以非线性观测器作为估计、测量平台位姿的主要手段，以实现对平台位姿状态的快速、准确的跟踪。
2.根据权利I所述的用于机载并联平台的位姿观测器设计方法，其特征在于选取的平台为六自由度的并联平台，并由六个并联的伸缩杆以及万向铰链控制工作台的位姿，平台的固定端的位姿是随机体呈动态变化的，而工作平台始终处于水平状态。
3.根据权利I所述的用于机载机载并联平台的位姿观测器设计方法，其特征在于必须利用坐标变化将位置控制问题转化为轨迹跟踪控制问题。其动力学模型为如下形式:
4.根据权利I所述的用于机载并联平台的位姿观测器设计方法，其特征在于伸缩杆的实际长度由传感器测量，其测量误差作为状态观测器进行位姿估计的输入信号，状态观测器的模型为如下形式:
5.根据权利I所述的用于机载并联平台的位姿观测器设计方法，其特征在于利用微分同胚将非线性观测器变换转化为带有非线性扰动的线性观测器形式求取，简化了结构，采用自动微分技术，大大提高了增益矩阵的求解速度。
【文档编号】B25J9/00GK103862459SQ201210533221
【公开日】2014年6月18日 申请日期:2012年12月11日 优先权日:2012年12月11日
【发明者】陈奕梅 申请人:天津工业大学