[发明专利]基于自适应事件触发的轮式机器人匀速直线编队控制方法有效
申请号: | 201910497475.9 | 申请日: | 2019-06-10 |
公开(公告)号: | CN110262484B | 公开(公告)日: | 2023-04-18 |
发明(设计)人: | 张皓;王祝萍;宋首锐 | 申请(专利权)人: | 同济人工智能研究院(苏州)有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 上海科盛知识产权代理有限公司 31225 | 代理人: | 翁惠瑜 |
地址: | 215100 江苏省苏州*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 自适应 事件 触发 轮式 机器人 匀速 直线 编队 控制 方法 | ||
1.一种基于自适应事件触发的轮式机器人匀速直线编队控制方法,所述轮式机器人包括一个领导机器人和多个跟随机器人,其特征在于,该方法包括以下步骤:
S1:设定跟随机器人与领导机器人匀速直线编队时的期望相对位置,构建基于事件触发机制的外部信号观测器,获取每个跟随机器人相对领导机器人的观测值;
S2:计算跟随机器人与领导机器人的位置误差,结合机器人线性化模型,获取跟随机器人的标准位置和标准控制输入;
S3:基于跟随机器人的标准位置和标准控制输入,构建完全分布式自适应控制器,获得跟随机器人的实时系统控制输入;
所述步骤S2中,机器人线性化模型的获取步骤具体为:
S201:建立轮式机器人非线性模型;
S202:构建机器人状态向量,线性化机器人非线性模型;
所述步骤S202中,线性化机器人非线性模型的结果包括领导机器人线性化模型和跟随机器人线性化模型,所述领导机器人线性化模型的表达式为:
式中,为领导机器人线性化模型,v1(t)为领导机器人状态向量;
所述跟随机器人线性化模型的表达式为:
式中,为跟随机器人i的线性化模型,xi(t)为跟随机器人i在t时刻笛卡尔坐标系中的状态向量,ui(t)为跟随机器人i在t时刻的系统控制输入值,v2(t)为跟随机器人在笛卡尔坐标系中的线速度,Ei=04×4。
2.根据权利要求1所述的一种基于自适应事件触发的轮式机器人匀速直线编队控制方法,其特征在于,所述领导机器人状态向量v1(t)的表达式为:
式中,xp0(t)为领导机器人在t时刻沿笛卡尔坐标系x轴方向的坐标,yp0(t)领导机器人在t时刻沿笛卡尔坐标系y轴方向的坐标,νx0(t)为领导机器人在t时刻沿笛卡尔坐标系x轴方向的速度,vx0(t)=v0(t)cosθ0(t),v0(t)为领导机器人t时刻在笛卡尔坐标系中的线速度,θ0(t)为领导机器人t时刻在笛卡尔坐标系中质心的角度,νy0(t)为领导机器人在t时刻沿笛卡尔坐标系y轴方向速度,vy0(t)=v0(t)sinθ0(t)。
3.根据权利要求1所述的一种基于自适应事件触发的轮式机器人匀速直线编队控制方法,其特征在于,跟随机器人的所述状态向量的表达式为:
xi(t)=[xpi(t)-xp0(t)-xdi(t),ypi(t)-yp0(t)-ydi(t),νxi(t),νyi(t)]
式中xi(t)为跟随机器人i在t时刻笛卡尔坐标系中的状态向量,xpi(t)为跟随机器人i沿笛卡尔坐标系x轴方向的坐标,xp0(t)为领导机器人沿笛卡尔坐标系x轴方向的坐标,ypi(t)为跟随机器人i沿笛卡尔坐标系y轴方向的坐标,yp0(t)为领导机器人沿笛卡尔坐标系y轴方向的坐标,νxi(t)为跟随机器人i沿笛卡尔坐标系x轴方向的速度,vxi(t)=vi(t)cosθi(t),vi(t)为跟随机器人i在t时刻笛卡尔坐标系中的线速度,θi(t)为跟随机器人在t时刻笛卡尔坐标系中质心的角度,νyi(t)为跟随机器人i沿笛卡尔坐标系y轴方向的速度,vyi(t)=vi(t)sinθi(t),为最终形成编队时跟随机器人i与领导机器人的期望相对位置。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于同济人工智能研究院(苏州)有限公司,未经同济人工智能研究院(苏州)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910497475.9/1.html,转载请声明来源钻瓜专利网。