欠驱动auv自适应轨迹跟踪控制装置及控制方法专利名称：欠驱动auv自适应轨迹跟踪控制装置及控制方法技术领域：本发明是一种AUV轨迹跟踪控制装置，本发明也涉及一种AUV轨迹跟踪控制方法 具体地说是一种基于非线性控制理论的欠驱动AUV在模型参数未知情况下的轨迹跟踪控制装置及方法背景技术：导致水下机器人欠驱动的原因主要有以下几个方面(1)减少成本和重量对于水下机器人来说，推进器的成本很高而且消耗系统的能源较大，因而现在大多数水下机器人是欠驱动力的 推进效率的影响全驱动水下机器人当前进速度增加时，槽道推进器的推力减额将越来越严重，该自由度上的运动很难预测3)系统可靠性的需要当全驱动系统的一个或多个推进装置驱动失败或失灵时，完全驱动变成欠驱动近年来，水下机器人的轨迹跟踪(Trajectory tracking)控制得到许多学者的关注轨迹跟踪(TT) 控制问题的难点在于要求系统在指定时间到达指定位置，它的实现要比路径跟踪O^ath following)困难得多，对于全驱动系统，TT问题已经能够较好解决，而欠驱动自治水下机器人(Autonomous underwatervehicle, AUV)由于系统的独立控制输入量少于其自由度， 使系统具有不可积的加速度约束，并且AUV的运动学和动力学模型具有高度非线性和耦合性，使控制设计更加困难。
欠驱动AUV的轨迹跟踪控制的典型方法是利用多变量模型的局部线性化和解耦使系统自由度与控制输入自由度相等，然后利用线性或非线性控制方法设计控制器然而，这些方法只能保证在选定的运行点邻域内是稳定的基于Lyapimov的非线性设计可以克服上述限制Jiang，2002针对欠驱动水面船提出了基于Lyapimov直接方法的全局跟踪控制问题，但没有考虑模型参数不确定情况发明内容本发明的目的在于提供能够在惯性质量参数和水动力参数未知情况下实现欠驱动AUV的轨迹跟踪控制，即在指定时间内按指定速度到达指定位置的欠驱动AUV自适应轨迹跟踪控制装置本发明的目的还在于提供一种欠驱动AUV自适应轨迹跟踪控制方法本发明的目的是这样实现的本发明的欠驱动AUV自适应轨迹跟踪控制装置包括参考路径生成器1、微分同胚变换器6、纵向速度虚拟控制器9、艏摇角速度虚拟控制器10、参数估计器11、纵向推力及转艏力矩控制器14，测量元件3采集的AUV实际位置和航向角以及参考路径生成器1产生的参考位置和参考航向角信息，通过微分同胚变换器6得到新的状态变量，然后将新的状态变量及传感器5采集的速度和角速度信息，传递给参数估计器11和纵向推力及转艏力矩控制器14，通过解算得到控制指令去驱动执行机构，调整AUV的纵向推力和转艏力矩。
本发明的欠驱动AUV自适应轨迹跟踪控制装置还可以包括1、参考路径生成器1通过给定期望纵向速度和艏摇角速度，将产生的位置、航向角信息传递给微分同胚变换器6的同时将期望侧向速度信号反馈给参数估计器11和角速度虚拟控制器102、测量元件3包括位置、角度传感器4和线速度、角速度传感器5，位置、角度传感器4采集的信息传递给微分同胚变换器6，线速度、角速度传感器5采集的信息同时传递给纵向推力及转艏力矩控制器14和参数估计器113、纵向速度虚拟控制器9根据新的状态变量信息及参考线速度、参考艏摇角速度信息得到线速度虚拟控制量，然后将该量传递给参数估计器114、角速度虚拟控制器10根据参考线速度、角速度、实际线速度、角速度、中间状态变量、新的状态变量信息，产生角速度虚拟控制量，然后将该量传递给参数估计器115、参数估计器11根据参考速度、实际速度及新的状态变量信息，通过李亚普诺夫直接法产生参数的估计值，并将这些信息传递给纵向推力及转艏力矩控制器146、纵向推力及转艏力矩控制器14分为纵向推力控制器15和转艏力矩控制器16， 针对跟踪误差动态方程根据参考纵向速度、参考艏摇角速度、新的状态变量、参数估计值、 实际的线速度和角速度信息，通过李亚普诺夫法和反步法解算出纵向推力和转艏力矩信息传递给AUV的执行机构，调整AUV的位置、航向和速度。
本发明的欠驱动AUV自适应轨迹跟踪控制方法包括由参考路径生成器1、微分同胚变换器6、纵向速度虚拟控制器9、艏摇角速度虚拟控制器10、参数估计器11、纵向推力及转艏力矩控制器14构成控制装置；(1)、参考路径生成器通过参考输入产生期望轨迹，得到期望的位置、航向角和速度信息；O)、位置传感器采集AUV的位置、航向角信息，将期望的位置、航向角和当前的状态信息一起传递给微分同胚变换器；(3)、微分同胚变换器包括大地坐标到船体坐标变换器和欠驱动项补偿器，大地坐标到船体坐标变换器得到船体坐标系下的状态变量，并将该中间变量信息传递给欠驱动项补偿器，然后由欠驱动项补偿器得到新的状态变量；0)、虚拟控制器包括纵向线速度虚拟控制和艏摇角速度虚拟控制，线速度控制器根据新的状态变量信息、参考纵向速度、参考艏摇角速度信息产生线速度虚拟控制量，并同时传递给参数估计器和纵向推力控制器；艏摇角速度虚拟控制器根据中间状态变量、参考线速度、角速度、新的状态变量信息产生角速度虚拟控制量，传递给参数估计器；(5)、参数估计器利用李亚普诺夫直接法将产生的参数估计值传递给纵向推力控制器和转艏力矩控制器；(6)、控制器通过李亚普诺夫法和反步法解算出纵向推力和转艏力矩量传递给AUV 的执行机构，调整AUV的位置、航向、速度。
此发明的优点在于无需已知AUV的惯性质量参数和水动力阻尼参数，实现在指定时间按指定速度到达指定位置由于本发明考虑的AUV是欠驱动的，可以减少系统的能源消耗和制造成本，减少系统的重量，提高推进效率并且当全驱动系统的一个或多个推进装置驱动失败或失灵时，可以保证AUV的可靠运行本发明通过仿真试验验证了方案的可行性和有效性图1为欠驱动AUV自适应轨迹跟踪控制系统总体结构图；图2为位置和艏向跟踪误差曲线；图3为线速度和角速度跟踪误差曲线；图4为纵向推力和艏摇力矩曲线；图5为AUV模型参数估计值具体实施例方式下面对本发明进行详细描述图1给出了本发明的欠驱动AUV自适应轨迹跟踪控制装置的组成在图1中各数字代表的装置如下1-参考路径生成器；2-水下机器人AUV ；3_测量元件；4-位置、角度传感器；5-线速度、角速度传感器；6-微分同胚变换器；7-大地坐标到船体坐标变换器；8-欠驱动项补偿器；9-线速度虚拟控制器；10-角速度虚拟控制器； 11-参数估计器；12-参数— θ 4估计值；I3-参数θ5— θ 1(|估计值；14-控制器；15-纵向推力控制器；16-转艏力矩控制器结合图1，本发明的欠驱动AUV自适应轨迹跟踪控制装置包括参考路径生成器1， 微分同胚变换器6，纵向速度虚拟控制器9，艏摇角速度虚拟控制器10，参数估计器11，控制器14。
传感器4采集AUV的实际位置和航向角以及参考路径生成器1产生的参考位置和参考航向角信息，通过微分同胚变换器6得到新的状态变量，然后将新的状态变量及传感器5 采集的速度和角速度信息，传递给参数估计器11和纵向推力及转艏力矩控制器14，通过解算得到控制指令去驱动执行机构，调整AUV的纵向推力和转艏力矩，实现欠驱动AUV轨迹跟S示ο参考路径生成器1通过虚拟AUV模型方程产生参考位置信号xd、yd和参考航向角 ￥d，传感器采集的AUV的实际位置X，y、航向角Ψ信息同时传递给大地坐标到船体坐标变换器 7，该系统通过(Z1, z2，z3) = (xcos(￥)+ysin(￥), -xsin ( ψ)+ycos ( ψ), Ψ)得到中间状态变量Zl，ζ2, ζ3，及中间变量的误差量ζ1ε，z2e, ，并发送给欠驱动项补偿器8欠驱动项补偿器8根据中间状态变量Z1, Z2, Z3和误差量ζ1ε，z2e, Z3e通过关系式 (I1, I2, I3) = (Zle-XfdZ2e, he，Z3e)，X1X)得到新的状态变量 ξ2，ξ 3，及跟踪误差动态方程权利要求1.一种欠驱动AUV自适应轨迹跟踪控制装置，包括参考路径生成器(1)、微分同胚变换器(6)、纵向速度虚拟控制器(9)、艏摇角速度虚拟控制器(10)、参数估计器(11)、纵向推力及转艏力矩控制器(14)，其特征是测量元件(3)采集的AUV实际位置和航向角以及参考路径生成器(1)产生的参考位置和参考航向角信息，通过微分同胚变换器(6)得到新的状态变量，然后将新的状态变量及传感器( 采集的速度和角速度信息，传递给参数估计器(11)和纵向推力及转艏力矩控制器(14)，通过解算得到控制指令去驱动执行机构，调整 AUV的纵向推力和转艏力矩。
2.根据权利要求1所述的欠驱动AUV自适应轨迹跟踪控制装置，其特征是参考路径生成器(1)通过给定期望纵向速度和艏摇角速度，将产生的位置、航向角信息传递给微分同胚变换器(6)的同时将期望侧向速度信号反馈给参数估计器(11)和角速度虚拟控制器 (10)3.根据权利要求2所述的欠驱动AUV自适应轨迹跟踪控制装置，其特征是测量元件 (3)包括位置、角度传感器(4)和线速度、角速度传感器(5)，位置、角度传感器(4)采集的信息传递给微分同胚变换器(6)，线速度、角速度传感器( 采集的信息同时传递给纵向推力及转艏力矩控制器(14)和参数估计器(11)4.根据权利要求3所述的欠驱动AUV自适应轨迹跟踪控制装置，其特征是纵向速度虚拟控制器(9)根据新的状态变量信息及参考线速度、参考艏摇角速度信息得到线速度虚拟控制量，然后将该量传递给参数估计器(11)5.根据权利要求4所述的欠驱动AUV自适应轨迹跟踪控制装置，其特征是角速度虚拟控制器(10)根据参考线速度、角速度、实际线速度、角速度、中间状态变量、新的状态变量信息，产生角速度虚拟控制量，然后将该量传递给参数估计器(11)6.根据权利要求5所述的欠驱动AUV自适应轨迹跟踪控制装置，其特征是参数估计器(11)根据参考速度、实际速度及新的状态变量信息，通过李亚普诺夫直接法产生参数的估计值，并将这些信息传递给纵向推力及转艏力矩控制器(14)。
7.根据权利要求6所述的欠驱动AUV自适应轨迹跟踪控制装置，其特征是纵向推力及转艏力矩控制器(14)分为纵向推力控制器(1 和转艏力矩控制器(16)，针对跟踪误差动态方程根据参考纵向速度、参考艏摇角速度、新的状态变量、参数估计值、实际的线速度和角速度信息，通过李亚普诺夫法和反步法解算出纵向推力和转艏力矩信息传递给AUV的执行机构，调整AUV的位置、航向和速度8.—种欠驱动AUV自适应轨迹跟踪控制方法，其特征是由参考路径生成器(1)、微分同胚变换器(6)、纵向速度虚拟控制器(9)、艏摇角速度虚拟控制器(10)、参数估计器(11)、纵向推力及转艏力矩控制器(14)构成控制装置；(1)参考路径生成器通过参考输入产生期望轨迹，得到期望的位置、航向角和速度信息；(2)位置传感器采集AUV的位置、航向角信息，将期望的位置、航向角和当前的状态信息一起传递给微分同胚变换器；(3)微分同胚变换器包括大地坐标到船体坐标变换器和欠驱动项补偿器，大地坐标到船体坐标变换器得到船体坐标系下的状态变量，并将该中间变量信息传递给欠驱动项补偿器，然后由欠驱动项补偿器得到新的状态变量；(4)虚拟控制器包括纵向线速度虚拟控制和艏摇角速度虚拟控制，线速度控制器根据新的状态变量信息、参考纵向速度、参考艏摇角速度信息产生线速度虚拟控制量，并同时传递给参数估计器和纵向推力控制器；艏摇角速度虚拟控制器根据中间状态变量、参考线速度、角速度、新的状态变量信息产生角速度虚拟控制量，传递给参数估计器；(5)参数估计器利用李亚普诺夫直接法将产生的参数估计值传递给纵向推力控制器和转艏力矩控制器；(6)控制器通过李亚普诺夫法和反步法解算出纵向推力和转艏力矩量传递给AUV的执行机构，调整AUV的位置、航向、速度。
全文摘要本发明提供的是一种欠驱动AUV自适应轨迹跟踪控制装置及控制方法测量元件(3)采集的。