买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

申请/专利权人：中国人民解放军海军工程大学

摘要：本发明提供了一种基于摆角误差转换滑模的倒立摆系统稳定控制方法，其通过安装微型陀螺仪测量倒立摆的摆角，并根据摆角误差信号采用指数柔化误差信号与整数分数混合数字微分方法设计数字与滞后混合微分滤波器，求解摆角误差混合阻尼信号；然后采用指数柔化误差信号进行指数衰减变换得到摆角动态预设参考信号，并结合传递函数进行近似微分解算得到了基于性能预设的摆角误差转换阻尼信号，并构成摆角误差转换滑模信号。然后采用自适应方法设计常值干扰估计律信号、转换误差阻尼估计律信号、混合阻尼干扰估计律信号实现了干扰综合补偿，最终叠加摆角误差转换滑模信号、摆角预设混合微分信号实现倒立摆的预设性能摆角跟踪控制。

主权项：1.一种基于摆角误差转换滑模的倒立摆系统稳定控制方法，其特征在于，包括以下步骤：步骤S10，在倒立摆上安装微型陀螺仪，测量倒立摆的摆角；然后设定期望摆角，并进行比较，得到摆角误差信号；再设计一种数字与滞后混合微分滤波器，首先采用滤波器输出信号与摆角误差信号进行比较，得到混合误差信号；再对混合误差信号进行指数型类柔化变换，求取指数柔化误差信号；再对摆角误差信号求取整数分数混合数字微分信号；然后采用混合误差信号、指数柔化误差信号与整数分数混合数字微分信号求取滤波器微分因子信号；然后根据滤波器微分因子进行线性积分得到滤波器的输出信号；最后采用滤波器的输出信号、摆角误差信号与滤波器微分因子信号以及整数分数混合数字微分信号求解摆角误差混合阻尼信号如下：e1＝θ-θd；ewn＝e1n-el0n； edwln＝ewn+ef1n+T2ed1nT1； 其中θ为在倒立摆上安装微型陀螺仪测量得到的倒立摆的摆角信号；θd为期望摆角信号，e1为摆角误差信号；ew为混合误差信号；a1为指数变换的常值参数，ε0为常值柔化参数，ef1为指数柔化误差信号；T为常值微分参数，ed1为整数分数混合数字微分信号；T1、T2为常值滤波参数，edw1为滤波器微分因子信号；el0为滤波器的输出信号；ed为摆角误差混合阻尼信号；步骤S20，根据所述的摆角误差信号与指数柔化误差信号进行指数型抗饱和变换，求解摆角动态收敛时间参数；然后根据摆角动态收敛时间参数与指数柔化误差信号进行指数衰减变换得到摆角动态预设参考信号；再根据摆角误差信号与摆角动态预设参考信号求商得到动态比率信号，再根据动态比率信号进行对数变换得到摆角误差转换信号如下： 其中中k1、k2、ε1为常值时间参数，w1为摆角动态收敛时间参数；a2为指数变换的常值参数，p1为摆角动态预设参考信号，λ1为动态比率信号；ka3、ka4为常值参数，y1为摆角误差转换信号；步骤S30，根据所述的摆角动态预设参考信号进行整数与分数混合数字微分运算，得到摆角动态预设混合数字微分信号信号；然后根据所述的摆角动态预设参考信号采用传递函数进行近似微分解算，得到摆角预设传函微分信号；再将摆角动态预设混合数字微分信号信号与摆角预设传函微分信号进行综合得到摆角预设混合微分信号；然后根据所述的摆角误差混合阻尼信号以及摆角预设混合微分信号、摆角动态预设参考信号与动态比率信号求解摆角误差转换阻尼信号如下： 其中p1b为摆角动态预设混合数字微分信号；T2、T3、T4为传递函数的常值参数，s为传递函数的微分算子，p1c为摆角预设传函微分信号，p1d为摆角预设混合微分信号；k1、k2、k3、k4为常值参数；y1d为摆角误差转换阻尼信号；步骤S40，根据所述的摆角误差转换信号进行积分，得到摆角误差转换积分信号；再根据所述的摆角误差转换信号进行指数柔化变换，得到摆角误差转换指数柔化变换信号；再根据摆角误差转换阻尼信号进行指数柔化变换，得到摆角误差转换阻尼指数柔化变换信号；然后叠加摆角误差转换信号、摆角误差转换积分信号、摆角误差转换阻尼信号形成摆角误差转换滑模信号如下：sy＝∫y1dt； s1＝y1d+c1y1+c3yw1+c4sy+c5ywd；其中sy为摆角误差转换积分信号；yw1为摆角误差转换指数柔化变换信号；ywd为摆角误差转换阻尼指数柔化变换信号；c1，c3，c4，c5为滑模常值参数，s1为摆角误差转换滑模信号；步骤S50，根据所述的摆角误差转换滑模信号采用自适应方法设计常值干扰估计律信号、转换误差阻尼估计律信号、混合阻尼干扰估计律信号，再分别进行积分得到常值干扰估计信号、转换误差阻尼估计信号、混合阻尼干扰估计信号；进行叠加得到干扰综合补偿信号；然后对摆角误差转换滑模信号进行非线性变换得到滑模非线性变换信号；对摆角误差转换滑模信号进行指数柔化变换得到滑模指数柔化变换信号；最后叠加干扰综合补偿信号、摆角误差转换滑模信号、摆角预设混合微分信号、摆角误差混合阻尼信号得到倒立摆加速度控制信号，将其输送给倒立摆小车驱动系统，实现倒立摆的摆角稳定控制如下： ud＝-k5s1-k6sw1-k7ed-k8p1d-k9sw2+T1；其中kr1、kr2、kr3为常值参数，用于调节干扰估计信号的收敛速率；rd1为常值干扰估计律信号、rd2为转换误差阻尼估计律信号、rd3为混合阻尼干扰估计律信号；为常值干扰估计信号、为转换误差阻尼估计信号、为混合阻尼干扰估计信号；T1为干扰综合补偿信号；c6为常值参数，sw1为滑模非线性变换信号；sw2为滑模指数柔化变换信号；k5、k6、k7、k8、k9为常值控制参数，ud为倒立摆加速度控制信号。

全文数据：

权利要求：

百度查询： 中国人民解放军海军工程大学 一种基于摆角误差转换滑模的倒立摆系统稳定控制方法