使用webots的MPC的移动机器人轨迹跟踪控制

上一篇文章中使用MPC对机器人的一个方向自由度进行了控制,
基于MPC的移动机器人轨迹跟踪控制qpOASES例程
现在使用速度与角速度对机器人进行平面运动控制。
所以机器人的控制量为U=[v ;w],状态量为X=[x;y;c] (x,y为平面坐标,c为机器人自身角度)
机器人模型为:
在这里插入图片描述
可以简写成
在这里插入图片描述
设置机器人的参考轨迹为与参考控制量为Xr,Ur
将f(X,U)围绕点(Xr,Ur)进行泰勒展开,即对X,U求偏导
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
所以有
在这里插入图片描述
随后进行离散化:
在这里插入图片描述

随后设计目标函数,
对N个步长内进行预测“
在这里插入图片描述
即有:
在这里插入图片描述在这里插入图片描述

优化目标函数为:
在这里插入图片描述
其中 Q R为单位矩阵,代表权重。
随后将其展开合并同类项,并写为qpOASES要求的格式:
在这里插入图片描述
请添加图片描述

  • 1
    点赞
  • 6
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值