[发明专利]一种自平衡车控制方法、系统、存储介质及电子设备在审
申请号: | 202310310932.5 | 申请日: | 2023-03-28 |
公开(公告)号: | CN116300465A | 公开(公告)日: | 2023-06-23 |
发明(设计)人: | 张志飞;费敏锐;徐杰;黄文斌;邢潇;王小珍;张勇;叶航;杨尚升;柴爱武 | 申请(专利权)人: | 浙江涛涛车业股份有限公司 |
主分类号: | G05B13/04 | 分类号: | G05B13/04 |
代理公司: | 杭州裕阳联合专利代理有限公司 33289 | 代理人: | 张解翠 |
地址: | 321400 浙江省*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 平衡 控制 方法 系统 存储 介质 电子设备 | ||
1.一种自平衡车控制方法,其特征在于,包括:
S101、获取自平衡车运行过程的历史数据Data;
S102、搭建神经网络以获得系统的动能函数估计Tθ和势能函数Vθ;
S103、根据动能函数估计Tθ和势能函数Vθ计算出系统的拉格朗日量估计Lθ;
S104、根据历史数据Data运用欧拉-拉格朗日方程计算出系统的矢量场估计Xθ,通过积分获得系统的状态估计Φθ,并计算系统状态的估计误差ΔΦ;
S105、根据估计误差调整神经网络的参数θ;
S106、重复执行步骤S102-S105,响应于参数θ收敛至稳定值则执行步骤S107;
S107、根据拉格朗日量的精确估计,设计带阻尼的PD控制器;
S108、通过带阻尼的PD控制器使系统状态收敛至稳定的平衡点。
2.根据权利要求1所述的自平衡车控制方法,其特征在于,所述历史数据Data包括受控的自平衡车在控制输入作用下的运行过程的倾斜角度φ、倾斜角速度平移速度和系统的控制输入u。
3.根据权利要求2所述的自平衡车控制方法,其特征在于,所述神将网络包括输入层、隐藏层和输出层,输入层为历史数据输出层为系统动能函数估计Tθ和势能函数估计Vθ,通过对输出层进行做差运算,以获得系统的拉格朗日量估计Lθ,其中,Lθ=Tθ-Vθ,神经网络的最优参数θ通过反向传播算法进行动态学习而获得。
4.根据权利要求2所述的自平衡车控制方法,其特征在于,所述欧拉-拉格朗日方程具体化为受控自平衡车模型的公式为:
将公式(1)展开为:
求解公式(2),以得到矢量场估计:
5.根据权利要求2所述的自平衡车控制方法,其特征在于,通过积分获得系统的状态估计Φθ中所述积分的过程为:
6.根据权利要求5所述的自平衡车控制方法,其特征在于,计算系统状态的估计误差ΔΦ的公式为:
7.根据权利要求1所述的自平衡车控制方法,其特征在于,根据估计误差调整神经网络的参数θ中所述神经网络的调整公式为:
其中,E=||ΔΦ||2为误差函数,η为参数调整的步长。
8.根据权利要求1所述的自平衡车控制方法,其特征在于,所述参数θ收敛至稳定值的判断依据为:E≤ε。
9.根据权利要求2所述的自平衡车控制方法,其特征在于,所述带阻尼的PD控制器所满足的条件为:
所述条件通过设计控制输入uPD得以实现:
其中,所述带阻尼的PD控制器的求解过程为:通过公式(3)求得关于uPD的表达式,并将代入到的表达式,以使得关于φ的欧拉-拉格朗日方程满足公式(7),以反解出带阻尼的PD控制器uPD。
10.根据权利要求2所述的自平衡车控制方法,其特征在于,通过带阻尼的PD控制器使系统状态收敛至稳定的平衡点中所述系统状态收敛的过程为:在带阻尼的PD控制器的作用下,自平衡车的倾斜角表现为带阻尼的震荡过程,以使得自平衡车的倾斜角和角速度收敛至稳定的平衡点在该条件下,系统的PD控制输入为零,根据公式(3)可知自平衡车的平移加速度以自平衡车速度保持恒定值
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于浙江涛涛车业股份有限公司,未经浙江涛涛车业股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202310310932.5/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种恒压式填料密封
- 下一篇:一种清洗效果好的玻璃幕墙清洗装置及清洗方法