【技术实现步骤摘要】
本专利技术涉及计算机控制，尤其涉及一种基于观测器和可达性分析的区间估计方法及系统。
技术介绍
1、自动导引车(automatic guided vehicle，简称agv)是一种具备安全保护以及各种移载功能的无人移动平台，通过装备电磁、视觉或激光等自动导引装置，实现沿预定轨迹行驶。agv作为一种智能化移动平台，凭借灵活高效的运行方式以及高度智能化、柔性化的特点，被广泛应用于各种行业领域。
2、如今市场上的agv大多都是基于非全向移动平台，而随着应用行业不断拓展和智能化水平不断提高，对agv的性能和应用范围提出了更高要求，具有完整性约束的全向移动平台agv应运而生。基于麦克纳姆轮移动平台的agv相比于普通的轮式agv，摆脱了转弯半径的限制，能够实现在一定空间内原地旋转和全向移动，在面对障碍物时也能够及时有效地调整姿态，在复杂的室内环境、狭窄的通道或者车间中，拥有更强的运动能力和适应性。近年来，研究人员为agv引入了各种状态估计方法，以提高其导航和控制性能，为了更好的处理不确定性、干扰、噪声和攻击等。
3、而目前的相关研究中，仍存在一些问题，在建模方法上，由于麦克纳姆轮agv在运动过程中会存滑移，摩擦，载荷变化和外部扰动等各种情况，所以需要合适的建模方法来贴合实际，而且线性或非线性的连续系统并不适用于实际，实际生活中的全向agv的数据是离散的，而且线性的建模又忽略了其摩擦力、载荷变化、外部扰动和测量噪声等因素的影响，建模也不可避免的是存在模型不确定性，故需要提高建模的准确性。而现有技术中大多数建模只考虑某一方
技术实现思路
1、为此，本专利技术所要解决的技术问题在于克服现有技术中建模不贴合实际，存在模型不准确性，观测器很难确保可以保持理想的估计精度和鲁棒性的问题。为解决上述技术问题，本专利技术提供了一种基于观测器和可达性分析的区间估计方法及系统，考虑载荷变化，滑动摩擦力，粘性摩擦力，滑移和外部扰动因素对全向麦克纳姆轮自动导引车进行了建模，克服模型不贴合实际的缺点，并且提出的区间估计方法对于处理存在扰动、不确定性、测量噪声的系统有着独特的优势，比传统的估计方法更具有鲁棒性，不仅提高了全向麦克纳姆轮自动导引车位移和速度区间估计的精度，而且降低了观测器设计的保守性。
2、为了达到上述目的，本专利技术采用的主要技术方案包括：
3、第一方面，本专利技术提供一种基于观测器和可达性分析的区间估计方法，包括：获取全向麦克纳姆轮自动导引车的参数；根据所述参数构造所述全向麦克纳姆轮自动导引车的离散时间非线性系统；根据所述离散时间非线性系统，通过对非线性项的处理，得到t-n-l结构的h∞观测器；根据所述离散时间非线性系统和所述观测器得到误差动态系统，并确定所述观测器的增益矩阵；根据所述观测器的增益矩阵，通过对所述误差动态系统进行可达性分析，以对所述全向麦克纳姆轮自动导引车的状态进行区间估计，并得到所述全向麦克纳姆轮自动导引车状态的区间。
4、在本专利技术的一个实施例中，根据所述参数构造所述全向麦克纳姆轮自动导引车的离散时间非线性系统的具体步骤包括：根据所述参数建立所述全向麦克纳姆轮自动导引车的运动学模型和所述全向麦克纳姆轮自动导引车的动力学模型；根据所述运动学模型和所述动力学模型得到所述全向麦克纳姆轮自动导引车的动力学系统；对所述动力学系统的状态空间方程离散化，得到离散时间非线性系统。
5、在本专利技术的一个实施例中，所述运动学模型表示为：
6、
7、其中，为所述全向麦克纳姆轮自动导引车中第b个轮子的角速度，r为所述全向麦克纳姆轮自动导引车的轮子半径，xroryr为相对坐标系，ψ为相对于所述相对坐标系的转动角度；
8、d1为所述全向麦克纳姆轮自动导引车宽度的d2为所述全向麦克纳姆轮自动导引车长度的
9、所述动力学模型表示为：
10、
11、其中，τ＝[τ1 τ2 τ3 τ4]t，τb(b＝1,2,3,4)为所述全向麦克纳姆轮自动导引车中第a个电机产生的力矩；τd为未知有界扰动，δm、δf均为不确定项；表示转动角度对时间的二阶导数；(b＝1,2,3,4)为所述全向麦克纳姆轮自动导引车中第b个轮子的静摩擦力；
12、
13、jω是所述全向麦克纳姆轮自动导引车的麦克纳姆轮绕中心轴的惯性矩，是粘性摩擦系数，jz是所述全向麦克纳姆轮自动导引车绕回转中心的惯性矩，m是所述全向麦克纳姆轮自动导引车的总质量。
14、在本专利技术的一个实施例中，所述动力学系统表示为：
15、
16、
17、其中，z1＝[xq yq ψ]t，xqoqyq为惯性坐标系，为的伪逆，
18、
19、
20、
21、所述离散时间非线性系统表示为：
22、zk+1＝azk+bτk+fk+dwwk
23、yk＝czk+dvvk
24、其中，k表示kh时刻；h为采样周期；τk为k时刻产生的力矩，yk为输出，fk＝-h[0f(zk)t]t为非线性项，wk为集总扰动，vk为测量噪声，a、c、dw、dv均为常数矩阵。
25、在本专利技术的一个实施例中，所述观测器表示为：
26、
27、其中，δk为中间变量，为zk的估计，in(n＝3，6，9)表示n维的单位矩阵，t+nc＝i6，是一个任意矩阵，表示n'维欧几里得空间，为γ的伪逆。
28、在本专利技术的一个实施例中，根据所述离散时间非线性系统和所述观测器得到误差动态系统的具体步骤包括：
29、定义
30、根据所述离散时间非线性系统和所述观测器得到初始的误差动态方程；所述初始的误差动态方程表示为：；
31、ek+1＝(ta-lc)ek+tδfk+fmβ
32、其中，ek为状态误差，l为观测器增益，fm＝[tdw-ldv-ndv]，
33、根据改写的李普希兹性质，存在第一函数和两个常数使得其中，η6(i)表示6维单位矩阵i6的第i列，η6(j)表示6维单位矩阵i6的第j列；
34、定义其中，θk被包含于一个凸集，所述凸集本文档来自技高网...
【技术保护点】
1.一种基于观测器和可达性分析的区间估计方法，其特征在于，包括：
2.根据权利要求1所述的基于观测器和可达性分析的区间估计方法，其特征在于，根据所述参数构造所述全向麦克纳姆轮自动导引车的离散时间非线性系统的具体步骤包括：
3.根据权利要求2所述的基于观测器和可达性分析的区间估计方法，其特征在于，所述运动学模型表示为：
4.根据权利要求3所述的基于观测器和可达性分析的区间估计方法，其特征在于，所述动力学系统表示为：
5.根据权利要求4所述的基于观测器和可达性分析的区间估计方法，其特征在于，
6.根据权利要求5所述的基于观测器和可达性分析的区间估计方法，其特征在于，根据所述离散时间非线性系统和所述观测器得到误差动态系统的具体步骤包括：
7.根据权利要求6所述的基于观测器和可达性分析的区间估计方法，其特征在于，确定所述观测器的增益矩阵的具体步骤包括：
8.根据权利要求7所述的基于观测器和可达性分析的区间估计方法，其特征在于，根据所述观测器的增益矩阵，通过对所述误差动态系统进行可达性分析，以对所述全向麦克
9.根据权利要求8所述的基于观测器和可达性分析的区间估计方法，其特征在于，根据下式对所述误差动态系统进行可达性分析：
10.一种基于观测器和可达性分析的区间估计系统，包括：
...【技术特征摘要】
1.一种基于观测器和可达性分析的区间估计方法，其特征在于，包括：
2.根据权利要求1所述的基于观测器和可达性分析的区间估计方法，其特征在于，根据所述参数构造所述全向麦克纳姆轮自动导引车的离散时间非线性系统的具体步骤包括：
3.根据权利要求2所述的基于观测器和可达性分析的区间估计方法，其特征在于，所述运动学模型表示为：
4.根据权利要求3所述的基于观测器和可达性分析的区间估计方法，其特征在于，所述动力学系统表示为：
5.根据权利要求4所述的基于观测器和可达性分析的区间估计方法，其特征在于，
6.根据权利要求5所述的基于观测器和可达性分析的区间估计方法，其特征在于，根据所述离散时间...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。