[发明专利]基于势垒函数的移动机器人自适应控制方法及系统有效

专利信息
申请号: 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的绝对值。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于广东省智能机器人研究院,未经广东省智能机器人研究院许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/202011179990.1/1.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code back_top