一种大型桥梁检测无人机抗强扰动的控制方法
基本信息
申请号 | CN202110922387.6 | 申请日 | - |
公开(公告)号 | CN113759696A | 公开(公告)日 | 2021-12-07 |
申请公布号 | CN113759696A | 申请公布日 | 2021-12-07 |
分类号 | G05B11/42(2006.01)I | 分类 | 控制;调节; |
发明人 | 沈润杰;何斌;杨业;李刚;王志鹏;陆萍 | 申请(专利权)人 | 苏州同港无人机研究院有限公司 |
代理机构 | 上海创开专利代理事务所(普通合伙) | 代理人 | 张佑富 |
地址 | 215000江苏省苏州市张家港市塘桥镇横泾村兄华路38号 | ||
法律状态 | - |
摘要
摘要 | 本发明属于无人机控制技术领域,具体公开了一种大型桥梁检测无人机抗强扰动的控制方法,包括以下步骤:步骤一:对PID前馈补偿控制器进行设计;PID前馈补偿控制器设计步骤:S1:通过建立状态方程,建立无人机位置的动力学方程;S2:获取无人机在四个方向上的速度和加速度;S3:建立风对于系统影响的动力学方程;步骤二:对LQR控制器进行设计;LQR控制器设计步骤:通过建立状态方程,建立无人机姿态角的动力学方程;本发明当强扰动输入到系统,对扰动使用PID的前馈控制器进行负补偿,使其扰动对系统的影响逐渐趋近于零,在强扰动对于无人机的影响慢慢归于零的同时,使用LQR最优控制来将姿态调整为期望值,从而达到抗强扰动的功能。 |
