机器人导航——路径跟踪

要完成一套完整的机器人路径规划,并完成其物理实验并非一件简单的事情。

参考:http://wenku.baidu.com/link?url=n11mP6EDlM78NZYZ4yQYXzmzPeBV6BeLNOUjIv3mAOJIsz7Uc8q44YJxT4eJDHcV92cnCNTg9tBvGzqp48snlnYA4csqDFpwB81ukF_YdOO

在运用好的路径规划算法,规划好一条从起点到目标点最优的路径后,如何让机器人来寻着这条最优的路径走,是一个需要解决的问题。

路径跟踪(Path tracking),是在平面坐标系下设定一条理想的几何路径,然后要求机器人从某一处出发,按照某种控制规律到达该路径上,并实现其跟踪运动。

机器人路径跟踪示意图

运动学方程

运动学模型直接刻画出了系统位置与速度之间的数学关系,以两轮驱动移动机器人为例,如图所示,运用物理学质点运动分析法可得到
这里写图片描述
离散化可表示为:
这里写图片描述

控制规律

假设参考路径可由一系列的参考点组成,即qr=[xr, yr,θr]T,定义位姿误差,即
这里写图片描述
这里写图片描述
下面就可以设计合适的控制器达到机器人精确跟随参考路径。

PI控制器的设计

线速度控制器
这里写图片描述

仿真结果

这里写图片描述
这里写图片描述

评论 12
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值