[发明专利]基于势垒函数的移动机器人自适应控制方法及系统有效
申请号: | 202011179990.1 | 申请日: | 2020-10-29 |
公开(公告)号: | CN112305916B | 公开(公告)日: | 2022-05-17 |
发明(设计)人: | 谢远龙;王书亭;吴昊;蒋立泉;孟杰;李鹏程;孙浩东;吴天豪;严一鸣;付清晨 | 申请(专利权)人: | 广东省智能机器人研究院 |
主分类号: | G05B13/04 | 分类号: | G05B13/04;B25J9/16 |
代理公司: | 广州粤高专利商标代理有限公司 44102 | 代理人: | 罗晓林;唐琴 |
地址: | 523000 广东*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 函数 移动 机器人 自适应 控制 方法 系统 | ||
1.一种基于势垒函数的移动机器人自适应控制方法,其特征在于,包括如下步骤,
步骤S110、根据控制输入信号,建立四轮动力学模型并转化为移动机器人状态空间方程;
其中,所述步骤S110的方法,包括:
步骤S111、建立四轮动力学模型:
其中,m表示移动机器人总质量,υx是车体重心处的纵向速度,Fix和Fiy分别表示第i个轮子的径向驱动力和轴向偏移力,变量上端的“·”表示求导操作,β和γ分别代表车体的侧滑角和横摆率,Iz表示通过重心绕偏航轴的惯性矩,lf和lr分别表示从前、后轴到车体重心的距离,定义虚拟前轮和虚拟后轮,δf和δr分别是虚拟前轮转向角和虚拟后轮转向角,Mω是由移动机器人通过四个轮子的牵引力矩产生的偏航力矩,d表示车身宽度,与分别表示作用在右后轮,左后轮,右前轮,左前轮上的径向驱动力;
步骤S112、基于定义的虚拟前轮及虚拟后轮,将四轮动力学模型简化为虚拟前、后轮模型:
其中,虚拟前轮角和虚拟后轮角满足:δr=kδf,k为预设系数;和分别表示虚拟前、后轮的轴向力,cos为余弦函数;
步骤S113、建立移动机器人状态空间方程:
其中,x是状态变量,x=[β,γ]T,T表示矩阵的转置,u为控制输入信号对应的控制输入量,u=[δf,Mω]T,为x的导数,f表示未建模动态和建模误差,A、B为参数矩阵;
步骤S114、通过线性化变换,获得变换后的移动机器人状态空间方程:
其中,η1和η2为变换后的移动机器人状态空间方程的状态变量,和分别为η1和η2的导数,为变换后系统的未建模动态和建模误差,为A的变换矩阵,和为矩阵的元素,φ=[0 B1]T,B1为B的变换矩阵,B1=(BTB)-1BT,T表示矩阵的转置;
步骤S120、基于状态空间方程设计滑模面和滑模控制律;
其中,所述步骤S120的方法,包括:
构建滑模面s,其中,滑模面s为
s=η2-Gη1,式中,G表示对角线元素为1的对角矩阵;
变换后的移动机器人状态空间方程中的控制输入量u满足
u=ω+v,
其中,ω为滑模控制等效律,v为超螺旋无颤振趋近律;
利用滑模面s的导数得到滑模控制等效律ω为
步骤S130、基于状态空间方程设计超螺旋无颤振趋近律;
步骤S140、基于滑模面构建势垒函数;
步骤S150、对控制输入信号进行非对称限幅。
2.根据权利要求1所述的基于势垒函数的移动机器人自适应控制方法,其特征在于,所述步骤S130中设计的超螺旋无颤振趋近律v满足:
ρ1=L(s)|s|α
ρ2=Lθ(s)
式中,表示计算的中间变量,表示的导数,α为分数阶阶次,L(s)为势垒函数,ρ1和ρ2为由势垒函数调节的系统控制增益,θ为预设的正偶数,tanh表示双曲正切函数,|s|表示求取s的绝对值。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于广东省智能机器人研究院,未经广东省智能机器人研究院许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011179990.1/1.html,转载请声明来源钻瓜专利网。
- 上一篇:光伏用B级太阳模拟滤光片及其镀制方法
- 下一篇:一种关于新技术的领域分类方法