机器人控制理论与技术课件

1单独使用本体感受型传感器的问题误差的不确定性随着时间快速增长！消除的方法：引入外传感器信息！关键的问题：如何融合本体感受型传感器和外传感器的信息？1单独使用本体感受型传感器的问题误差的不确定性随着时间快速增2机器人位置更新的两个步骤2机器人位置更新的两个步骤3感知更新与动作更新问题描述已知条件当前位置估计当前时刻位置估计值的协方差当前控制输入传感器的观测值地图求取目标下一时刻的位置新位置的协方差3感知更新与动作更新问题描述已知条件4基于Kalman滤波器的位置估计4基于Kalman滤波器的位置估计5Kalman滤波器简介卡尔曼滤波器的本质是利用递归算法获得贝叶斯规则最优解贝叶斯规则指的是在已知观测信号的分布的前提下由真实变量的先验估计推算其后验概率分布；最优解指的是后验估计的误差协方差最小，即最小均方误差准则。5Kalman滤波器简介卡尔曼滤波器的本质是利用递归算法获得6Kalman滤波器示例（1）6Kalman滤波器示例（1）7Kalman滤波器示例（2）对下一时刻温度值进行估计：23℃计算估计值的方差：计算Kalman增益Kg：计算最优估计值：更新估计值偏差：7Kalman滤波器示例（2）对下一时刻温度值进行估计：238Kalman滤波器计算的五个步骤对k位置进行估计：计算估计值的方差：P(k|k-1)=P(k-1|k-1)+Q计算Kalman增益Kg：计算最优估计值：更新估计值偏差：8Kalman滤波器计算的五个步骤对k位置进行估计：9基于Kalman滤波器的定位方法9基于Kalman滤波器的定位方法10基于Kalman滤波器的定位方法根据里程计信息和机器人运动学模型，可以估计出当前机器人位置：1m估计方差为0.3前一时刻机器人位置的方差：0.2；机器人根据超声传感器测量得到当前的位置：1.2m超声传感器方差0.3；试利用Kalman滤波器估计当前机器人位置。10基于Kalman滤波器的定位方法根据里程计信息和机器人运11基于Kalman滤波器的定位方法对下一时刻位置进行估计：1m计算估计值的方差：计算Kalman增益Kg：计算最优估计值：更新估计值偏差：11基于Kalman滤波器的定位方法对下一时刻位置进行估计：12位置估计概率密度分布曲线12位置估计概率密度分布曲线13动态位置估计13动态位置估计14Markov定位方法首先将机器人的位姿空间栅格化成地图中有限的、离散的位姿

一般用网格地图或拓扑地图来表示通过扫描所有可能的状态确定概率最高的状态。14Markov定位方法首先将机器人的位姿空间栅格化成地图中15Markov定位方法（1）开始机器人没有任何先验知识，因此开始时刻假设为一致分布；机器人探测到第一个支柱只看到了一个支柱，那么机器人在第1，2，3支柱处的概率是一致的。当机器人运动时基于运动模型建立了一个新的位置概率分布机器人探测到第二个支柱基于前面的先验知识，机器人在第2个支柱前的概率最大。15Markov定位方法（1）开始16Markov定位方法（2）MuseumLaserscan116Markov定位方法（2）Museum17Markov定位方法（3）MuseumLaserscan217Markov定位方法（3）Museum18Markov定位方法（2）MuseumLaserscan318Markov定位方法（2）Museum19Markov定位方法（4）MuseumLaserscan1319Markov定位方法（4）Museum20Markov定位方法（5）MuseumLaserscan2120Markov定位方法（5）Museum21MarkovVSKalmanMarkov考虑了从任何位置开始的定位，因而可以恢复不明确的状况；要在整个状态空间中更新所有位置的概率，因此计算时间较长；存储器和计算能力有可能限制了精度和地图的尺寸；Kalman必须从已知的起始位置开始定位；可以被用于连续环境表示中；21MarkovVSKalmanMarkov22常用的机器人控制结构22常用的机器人控制结构23自主移动机器人学中的三个关键问题：我在哪里？（WhereamI?）我要去哪里？（WhereamIgoing?）我如何去那里？（HowdoIgetthere?）23自主移动机器人学中的三个关键问题：我在哪里？24自主移动机器人路径规划问题给定机器人的初始位置（当前位置）Ps、终止位置（目标位置）Pg

、环境地图M。求取一条从Ps到Pg的可行路径R(x,y)。24自主移动机器人路径规划问题给定机器人的初始位置（当前位置25自主移动机器人轨迹规划问题给定机器人的初始位置（当前位置）Ps、终止位置（目标位置）Pg、环境地图M，和工作时间约束，比如给定起始时刻Ts和终止时刻Te。求取一条从Ps到Pg的可行轨迹(x(t),y(t))，使得Ps=(x(Ts),y(Ts)，Pg=(x(Te),y(Te))。25自主移动机器人轨迹规划问题给定机器人的初始位置（当前位置26自主移动机器人运动规划问题给定机器人的初始位置（当前位置）Ps、终止位置（目标位置）Pg、环境地图M。工作时间约束，比如给定起始时刻Ts和终止时刻Te。机器人的运动学模型KM:求取一条可以使机器人在给定的时间约束下从Ps运动到Pg的控制输入u(t)。26自主移动机器人运动规划问题给定机器人的27自主移动机器人运动规划问题

一般来讲，移动机器人有三个自由度（X,Y,θ）。因此，移动机器人的运动规划不是在2个位置自由度（X,Y）构成的2维空间，而是要搜索位置和姿态构成的3维空间。如图所示。27自主移动机器人运动规划问题一般来讲，移动机器人有28自主移动机器人规划问题28自主移动机器人规划问题29全局规划Vs局部规划全局规划所需的先验信息是包括了起点终点的全局的环境信息。规划的结果是从起点到终点的完整路径、轨迹或控制输入。局部规划所需的信息是当前机器人位置周围的局部环境信息。规划的结果是下一时刻的位置，及从当前位置运动到下一时刻位置的路径、轨迹或控制输入。29全局规划Vs局部规划全局规划所需的先验信息是包括了起30离线规划Vs在线规划离线规划是基于环境先验完全信息的规划。完整的先验信息只能适用于静态环境，这种情况下，路径、轨迹和控制输入是离线规划得到的；在线规划是基于传感器信息等不确定环境的规划。在这种情况下，路径、轨迹或控制输入必须是在线规划的。30离线规划Vs在线规划离线规划是基于环境先验完全信息的31可行路径最短路径路径的多样性与优化31可行路径最短路径路径的多样性与优化32路径规划技术的应用外行星探测军事侦察城市交通工业生产网络游戏……32路径规划技术的应用外行星探测33外行星探索NASA开发的勇气号和机遇号。火星探索车33外行星探索NA