University of Science and Technology of China A dissertation for master s degree Resarch on Service Robot s Navigation in Part Unknown Environment Aut

中 国 科 学 技 术 大 学 硕 士 学 位 论 文 环 境 部 分 未 知 情 况 下 的 服 务 机 器 人 导 航 研 究 作 者 姓 名 : 学 科 专 业 : 导 师 姓 名 : 完 成 时 间 : 许 心 德 模 式 识 别 与 智 能 系 统 关 胜 晓 副 教 授 二 九 年 五 月 二 日

University of Science and Technology of China A dissertation for master s degree Resarch on Service Robot s Navigation in Part Unknown Environment Author s Name: Xinde Xu speciality: pattern recognition & intelligent system Supervisor: Associate Professor Shengxiao Guan Finished time: May 2 nd, 2009

环 境 部 分 未 知 情 况 下 的 服 务 机 器 人 导 航 研 究 十 系 许 心 德 中 国 科 学 技 术 大 学

中 国 科 学 技 术 大 学 学 位 论 文 原 创 性 声 明 本 人 声 明 所 呈 交 的 学 位 论 文, 是 本 人 在 导 师 指 导 下 进 行 研 究 工 作 所 取 得 的 成 果 除 已 特 别 加 以 标 注 和 致 谢 的 地 方 外, 论 文 中 不 包 含 任 何 他 人 已 经 发 表 或 撰 写 过 的 研 究 成 果 与 我 一 同 工 作 的 同 志 对 本 研 究 所 做 的 贡 献 均 已 在 论 文 中 作 了 明 确 的 说 明 作 者 签 名 : 签 字 日 期 : 中 国 科 学 技 术 大 学 学 位 论 文 授 权 使 用 声 明 作 为 申 请 学 位 的 条 件 之 一, 学 位 论 文 著 作 权 拥 有 者 授 权 中 国 科 学 技 术 大 学 拥 有 学 位 论 文 的 部 分 使 用 权, 即 : 学 校 有 权 按 有 关 规 定 向 国 家 有 关 部 门 或 机 构 送 交 论 文 的 复 印 件 和 电 子 版, 允 许 论 文 被 查 阅 和 借 阅, 可 以 将 学 位 论 文 编 入 有 关 数 据 库 进 行 检 索, 可 以 采 用 影 印 缩 印 或 扫 描 等 复 制 手 段 保 存 汇 编 学 位 论 文 本 人 提 交 的 电 子 文 档 的 内 容 和 纸 质 论 文 的 内 容 相 一 致 保 密 的 学 位 论 文 在 解 密 后 也 遵 守 此 规 定 公 开 保 密 ( 年 ) 作 者 签 名 : 导 师 签 名 : 签 字 日 期 : 签 字 日 期 :

摘 要 摘 要 机 器 人 导 航 问 题 一 直 是 机 器 人 应 用 中 的 热 点 和 难 点 问 题, 而 服 务 机 器 人 由 于 所 处 的 环 境 不 可 能 是 完 全 确 定 的, 使 得 机 器 人 导 航 问 题 在 服 务 型 机 器 人 应 用 中 越 发 关 键 本 文 围 绕 移 动 机 器 人 导 航 问 题 在 以 下 几 个 方 面 做 出 了 研 究 和 探 讨 : 首 先, 论 文 简 要 地 介 绍 了 机 器 人 导 航 的 发 展 历 史 以 及 国 内 外 研 究 现 状, 分 析 了 机 器 人 导 航 领 域 的 几 个 主 要 研 究 方 向 其 次, 在 综 合 分 析 和 比 较 了 目 前 国 内 外 对 于 移 动 机 器 人 导 航 问 题 的 现 状 后, 本 文 将 环 境 部 分 未 知 的 情 况 下 的 导 航 问 题 划 分 为 两 个 层 次 第 一 层 是 全 局 路 径 规 划, 根 据 环 境 中 的 静 态 已 知 障 碍 物 利 用 蚁 群 算 法 找 出 全 局 最 优 路 径 ; 第 二 层 是 局 部 路 径 规 划, 利 用 全 局 最 优 路 径 提 供 的 局 部 目 标 点 以 及 传 感 器 探 测 到 的 局 部 障 碍 物 来 进 行 局 部 路 径 规 划, 该 层 包 含 两 方 面 内 容, 即 局 部 避 障 和 路 径 跟 踪 对 于 第 一 层 的 全 局 路 径 规 划, 采 用 了 链 接 图 来 建 立 环 境 全 局 地 图, 将 工 作 空 间 转 换 为 带 权 图 的 形 式, 然 后 使 用 蚁 群 算 法 对 带 权 图 进 行 搜 索, 得 到 从 起 始 点 到 目 标 的 一 条 全 局 最 优 路 径 对 于 第 二 层 的 局 部 避 障 算 法 采 用 的 是 VFH* 算 法,VFH* 算 法 的 是 由 VFF 算 法 发 展 而 来 的, 它 在 VFH+ 算 法 的 基 础 上 引 入 了 A* 搜 索 算 法, 使 得 VFH* 算 法 称 为 一 种 伪 全 局 路 径 规 划 方 法, 可 以 防 止 机 器 人 进 入 死 区 然 后, 针 对 VFH* 算 法 的 缺 陷, 在 VFH* 算 法 的 基 础 上 做 了 两 点 改 进, 使 得 VFH* 算 法 可 以 用 于 动 态 障 碍 物 的 环 境 中, 并 在 Aria 平 台 上 仿 真 实 现 了 文 中 的 算 法 最 后 对 全 文 进 行 了 总 结, 并 对 移 动 服 务 机 器 人 的 导 航 问 题 做 出 了 展 望 关 键 词 : 蚁 群 算 法 路 径 跟 踪 避 障 栅 格 地 图 VFH* I

Abstract ABSTRACT The navigation of mobile robot is one of the key and hot issues to successful application of mobile robot systems. Because the working environment of the service robot can t be completely determined, the navigation is more important to resarch for service robot than other robots. This thesis has made a deep and systematic study of the navigation of mobile robot. The following aspects are investigated and discussed: Firstly, the thesis briefly introduces the history of the mobile robotic development and summarizes different research aspects of the robot. Secondly, after analyzed and compared different research development level of foreign and domestic, the thesis proposes a solution to the robot navigation in part unknowen environment. The solution can be divided into two levels:the global path-planning level and the local path-planning level. The main purpose of the first level is to lay out a global path in the static global environment using Ant Colony Algorithm. According to the local environment detected by the sensors, the second level is to avoid obstacles when the unknown-obstacles appear. The second level includes two aspects: obstacle avoidance and path following. MAKLINK Graph is used to build the global working evrionment, which converts the workspace to weighted graph, then Ant Colony Algorithm is used to search the weighted graph and get the global optimal path from the begin position to the goal position. In the second level, this thesis uses VFH* algorithm to guide the robot aviod obstacles during fallowing the global optimal path. VFH* algorithm which introduces the A* search algorithm to the VFH+ algorithm is developed from VFF algorithm. Because of the search process, VFH* algorithm is a pseudo golbal path-planning and can prevent the robot goto the dead zone. Thirdly, the author make two improvents to VFH* algorithm to resolve its shortcomings. After the improvents, VFH* algorithm can be used in dynamic uncertainly envoriment. The algorithm is simulated in Aria platform. Finally, the full text is summarized and predicted the development of mobile robot s navigation. Key words: Ant Colony Algorithm, Path following, obstacle avoidance, grid map, VFH* algorithm II

目 录 目 录 第 1 章 绪 论...1 1.1 引 言...1 1.2 移 动 服 务 机 器 人 发 展 现 状...4 1.2.1 国 外 服 务 机 器 人 研 究 发 展 状 况... 4 1.2.2 国 内 移 动 服 务 机 器 人 发 展 现 状... 6 1.3 机 器 人 路 径 规 划...7 1.4 课 题 的 研 究 目 的 及 意 义...8 1.5 本 文 的 主 要 工 作...8 第 2 章 全 局 路 径 规 划...9 2.1 路 径 规 划 的 概 念...9 2.2 全 局 地 图 的 创 建...9 2.2.1 自 由 空 间 法... 9 2.2.2 构 造 空 间 法... 9 2.3 链 接 图 法 环 境 建 模...12 2.4 使 用 蚁 群 算 法 求 解 最 短 路 径...14 2.4.1 蚁 群 算 法 的 基 本 原 理... 14 2.4.2 基 本 蚁 群 系 统 模 型... 16 2.4.3 对 蚁 群 算 法 的 修 改 及 各 个 参 数 的 调 整... 19 2.4.4 实 验 结 果... 21 2.5 本 章 小 结...22 第 3 章 路 径 跟 踪... 23 3.1 路 径 跟 踪 的 概 念...23 3.2 Follow The Carrot 方 法...23 3.3 Pure Pursuit 方 法...25 3.4 本 章 小 结...26 第 4 章 基 于 VFH* 算 法 的 局 部 避 障... 27 4.1 局 部 避 障 的 发 展 历 程...27 4.1.1 RPC( 实 时 规 划 - 选 择 ) 算 法... 27 4.1.2 栅 格 法... 28 III

目 录 4.1.3 势 场 法... 29 4.1.4 VFF 算 法... 31 4.2 VFH 算 法...33 4.2.1 直 方 图 H 的 构 建... 33 4.2.2 转 角 的 求 取... 35 4.2.3 速 度 的 控 制... 37 4.3 VFH+ 算 法...38 p 4.3.1 建 立 原 始 的 向 量 场 直 方 图 H... 39 b 4.3.2 建 立 二 值 化 直 方 图 H... 40 m 4.3.3 建 立 Masked Polar Histogram( H )... 41 4.3.4 机 器 人 前 进 方 向 的 选 择... 43 4.4 VFH* 算 法...45 4.4.1 搜 索 树 的 参 数... 47 4.4.2 子 结 点 的 生 成... 48 4.4.3 A* 算 法... 51 4.4.4 Open 表 的 维 护... 52 4.4.5 VFH* 算 法 的 改 进... 55 4.5 本 章 小 结...59 第 5 章 实 验 平 台 及 仿 真 结 果... 61 5.1 Aria 仿 真 平 台...61 5.2 AIM 实 验 平 台...62 5.3 VC++ 2003 环 境 下 的 仿 真 结 果...65 5.4 本 章 小 结...68 第 6 章 总 结 与 展 望... 69 参 考 文 献... 71 致 谢... 75 在 读 期 间 发 表 的 学 术 论 文 与 取 得 的 研 究 成 果... 75 IV

第 1 章 绪 论 第 1 章 绪 论 1.1 引 言 第 一 台 Unimate 型 机 器 人 在 美 国 问 世 至 今 已 45 年 了, 机 器 人 技 术 正 在 以 超 乎 一 般 人 所 预 料 的 速 度 向 前 发 展, 对 机 器 人 这 一 概 念 的 理 解 及 定 义 也 在 变 化 机 器 人 是 人 类 20 世 纪 的 重 大 发 明 之 一 据 国 外 专 家 预 测,21 世 纪 将 是 机 器 人 技 术 革 命 的 世 纪, 机 器 人 作 为 全 面 延 伸 和 扩 展 人 的 体 力 和 智 力 的 手 段 将 实 现 当 代 最 高 意 义 上 的 自 动 化 机 器 人 应 用 和 普 及 正 在 改 变 人 类 的 生 产 方 式 生 活 方 式 和 作 战 方 式 ( 张 效 祖,2004) 移 动 机 器 人 的 研 究 始 于 60 年 代 末 期 斯 坦 福 研 究 院 (SRI) 的 Nils Nilssen 和 Charles Rosen 等 人, 在 1966 年 至 1972 年 中 研 制 出 了 取 名 Shakey 的 自 主 移 动 机 器 人 其 目 的 是 为 了 研 究 应 用 人 工 智 能 技 术, 在 复 杂 环 境 下 机 器 人 系 统 的 自 主 推 理 规 划 和 控 制 到 了 70 年 代 末, 随 着 计 算 机 的 应 用 和 传 感 技 术 的 发 展, 移 动 机 器 人 研 究 又 出 现 了 新 的 高 潮 特 别 是 在 80 年 代 中 期, 设 计 和 制 造 机 器 人 的 浪 潮 席 卷 全 世 界 一 大 批 世 界 著 名 的 公 司 开 始 研 制 移 动 机 器 人 平 台, 这 些 移 动 机 器 人 主 要 作 为 大 学 实 验 室 及 研 究 机 构 的 移 动 机 器 人 实 验 平 台, 从 而 促 进 了 移 动 机 器 人 学 多 种 研 究 方 向 的 出 现 90 年 代 以 来, 以 研 制 高 水 平 的 环 境 信 息 传 感 器 和 信 息 处 理 技 术, 高 适 应 性 的 移 动 机 器 人 控 制 技 术, 真 实 环 境 下 的 规 划 技 术 为 标 志, 开 展 了 移 动 机 器 人 更 高 层 次 的 研 究 ( 李 磊 等,2002) 近 年 来, 随 着 传 感 器 等 领 域 的 技 术 进 步, 智 能 机 器 人 系 统 开 始 出 现 在 服 务 行 业 中 室 内 服 务 机 器 人 出 现 的 主 要 原 因 有 : 一 是 人 们 想 摆 脱 令 人 烦 恼 枯 燥 的 重 复 性 工 作, 如 家 务 劳 动 照 料 病 人 等 等 ; 二 是 电 器 成 本 的 下 降 在 机 器 人 系 统 中, 自 主 导 航 是 一 项 核 心 技 术, 是 机 器 人 研 究 领 域 的 重 点 和 难 点 问 题 服 务 机 器 人 是 机 器 人 家 族 中 的 一 个 年 轻 成 员, 到 目 前 为 止 尚 没 有 一 个 严 格 的 定 义 不 同 国 家 对 服 务 机 器 人 的 认 识 不 同 服 务 机 器 人 的 应 用 范 围 很 广, 主 要 从 事 维 护 保 养 修 理 运 输 清 洗 保 安 救 援 监 护 等 工 作 国 际 机 器 人 联 合 会 经 过 几 年 的 搜 集 整 理, 给 出 了 服 务 机 器 人 的 初 步 定 义 : 服 务 机 器 人 是 一 种 半 自 主 或 全 自 主 工 作 的 机 器 人, 它 能 完 成 有 益 于 人 类 健 康 的 工 作, 但 不 包 括 从 事 生 产 的 设 备 服 务 机 器 人 的 定 位 就 是 服 务 服 务 机 器 人 与 工 业 机 器 人 的 一 个 本 质 区 别 在 于, 工 业 机 器 人 的 工 作 环 境 都 是 已 知 的, 而 服 务 机 器 人 所 面 临 的 工 作 环 境 绝 大 多 数 都 是 未 知 的 服 务 机 器 人 往 往 是 可 以 移 动 的, 在 某 些 情 况 下, 服 务 机 器 人 可 以 由 一 个 移 动 平 台 构 成, 在 它 上 面 装 有 一 只 或 几 只 手 臂 ( 陆 新 华 等,2003) 80 目 前 在 国 际 上 已 经 出 现 了 多 种 服 务 机 器 人, 可 以 根 据 应 用 场 合 分 为 两 种 类 型 1

第 1 章 绪 论 ( 肖 雄 军 等,2004),( 郝 宗 波,2003) 1-2 : A 类 型 : 机 器 人 代 替 人 类 完 成 脏 环 境 下 危 险 的 或 枯 燥 的 工 作 在 危 险 环 境 下 的 操 作 ( 如 高 温 真 空 水 下 辐 射 环 境 中 ) 救 火 操 作 ( 灭 火 救 人 等 ) 警 务 应 用 军 队 应 用 建 筑 应 用 ( 检 查 维 修 建 筑 物 ) 家 务 ( 清 洁 地 面 等 ) B 类 型 : 机 器 人 与 人 类 在 一 起 工 作, 减 轻 不 便 或 增 加 舒 适 快 乐 医 疗 ( 病 人 看 护 ) 引 导 盲 人 娱 乐 机 器 人 仿 真 是 将 机 器 人 控 制 算 法 应 用 到 实 际 机 器 人 上 面 的 一 个 重 要 的 先 决 步 骤, 目 前, 研 究 人 员 在 移 动 机 器 人 的 仿 真 领 域 进 行 了 大 量 的 研 究, 开 发 出 很 多 仿 真 软 件, 如 Webots Aria CARMEN MRPT(Mobile Robot Programming Tookit) 和 MobotSim 等 Webots 是 一 款 成 熟 的 移 动 式 机 器 人 仿 真 软 件 经 瑞 士 洛 桑 市 瑞 士 联 邦 科 技 中 心 协 同 开 发 测 试 与 验 证, 在 图 形 可 视 化 方 面, 它 采 用 先 进 的 OpenGL 加 速 技 术 建 立 包 含 光 线 阴 影 与 雾 化 效 果 等 复 杂 机 器 人 模 拟 环 境 并 允 许 依 VRML97 标 准 载 入 其 他 3D 绘 图 软 件 所 绘 制 的 3D 图 形 在 模 拟 现 实 物 理 系 统 方 面, 它 采 用 ODE(Open DynamicsEngine) 完 成 对 物 理 属 性 的 精 确 模 拟, 机 器 人 的 每 一 个 零 件 或 刚 体 均 可 以 设 定 碰 撞 边 界 质 量 分 布 矩 阵 静 态 与 动 态 摩 擦 系 数 弹 性 系 数, 伺 服 控 制 系 统 参 数 可 个 别 调 整 以 控 制 装 具 转 矩 位 置 或 速 度 使 用 节 点 组 合 链 建 构 复 杂 机 器 人 系 统, 让 使 用 者 轻 易 设 计 建 立 多 关 节 的 机 器 人 模 型 在 编 程 方 面, 机 器 人 的 控 制 器 可 以 用 C,C++ 或 者 JAVA 来 编 写, 其 内 部 自 带 了 免 费 的 开 发 环 境 MinGW, 同 样 通 过 设 置 我 们 也 可 以 使 用 Visual C++ 开 发 环 境 来 进 行 编 程 工 作, 而 Webots 亦 允 许 使 用 者 通 过 TCP/IP 方 式 使 用 Matab LabView 等 第 三 方 软 件 ( 王 斐 斐 等,2008) 采 用 C++ 来 编 写 机 器 人 控 制 器 的 时 候, 需 要 添 加 Controller.lib, 包 含 device 目 录 下 需 要 用 到 的 头 文 件, 如 robot.h,distance_sensor.h 等 在 机 器 人 运 行 前, 需 要 调 用 初 始 化 函 数 robot_live(), 该 函 数 的 参 数 为 用 户 自 定 义 的 函 数 的 指 针, 用 户 自 定 义 的 函 数 完 成 机 器 人 拥 有 的 设 备 的 激 活 然 后 调 用 robot_run() 函 数, 在 该 函 数 内 实 现 机 器 人 控 制 算 法, 该 函 数 每 隔 一 段 时 间 执 行 一 次 一 个 简 单 的 仿 真 实 验 如 图 1.1 所 示 2

第 1 章 绪 论 图 1.1 Webots 仿 真 图 本 文 采 用 的 是 Aria 仿 真 平 台, 将 在 第 五 章 详 细 介 绍, 这 里 不 再 赘 述 MobotSim 是 Windows 下 的 2D 动 态 移 支 机 器 人 仿 真 软 甲 它 提 供 了 一 个 图 形 界 面, 可 以 很 方 便 的 建 立 和 编 辑 机 器 人, 支 持 Basic 语 言 CARMEN 是 卡 耐 基 梅 隆 大 学 提 供 的 一 个 开 源 的 机 器 人 导 航 包, 采 用 模 块 化 设 计, 提 供 了 基 本 的 导 航 模 块, 包 括 传 感 器 控 制 避 障 定 位 路 径 规 划 和 地 图 创 建 该 软 件 可 以 在 网 站 http://carmen.sourceforge.net/getting_carmen.html 上 下 载 MRPT 是 提 供 给 机 器 人 设 计 和 开 发 者 的 一 个 可 扩 展 的 多 平 台 开 源 的 C++ 库 它 可 用 于 定 位 地 图 创 建 路 径 规 划 ( 避 障 ) 和 计 算 机 视 觉 该 库 中 包 含 大 量 的 函 数, 涵 盖 范 围 包 括 概 率 密 度 函 数 贝 叶 斯 推 理 卡 尔 曼 滤 波 图 像 处 理 路 径 规 划 避 障 MRPT 可 以 在 网 站 http://babel.isa.uma.es/mrpt/index.php/downloads 下 载, 它 的 运 行 界 面 如 图 1.2 所 示 3

第 1 章 绪 论 图 1.2 MRPT 运 行 示 意 图 1.2 移 动 服 务 机 器 人 发 展 现 状 智 能 化 是 服 务 机 器 人 的 主 要 发 展 方 向 人 们 在 智 能 化 方 面 进 行 了 各 种 各 样 的 探 索, 最 先 进 的 智 能 化 技 术 已 经 可 以 让 机 器 人 达 到 人 类 3 岁 婴 儿 左 右 的 智 力 水 平, 但 是 要 进 一 步 提 高 智 能 水 平 以 向 人 类 看 齐, 却 仍 然 是 一 个 巨 大 的 挑 战 1.2.1 国 外 服 务 机 器 人 研 究 发 展 状 况 据 欧 洲 经 济 委 员 会 和 国 际 机 器 人 技 术 联 合 会 的 调 查, 到 1998 年 底, 世 界 服 务 机 器 人 的 总 数 估 计 最 少 为 5000 台, 其 中 不 包 括 真 空 吸 尘 机 器 人 目 前, 国 外 在 智 能 服 务 机 器 人 方 面 的 研 究 很 多, 而 且 已 经 开 发 出 一 些 商 业 化 产 品 在 西 方 发 达 国 家, 移 动 式 自 主 服 务 机 器 人 已 广 泛 应 用 于 医 疗 福 利 服 务 商 场 超 市 服 务 家 庭 服 务 等 领 域 工 业 机 器 人 之 父 恩 格 尔 伯 格 创 建 的 TRC 公 司 在 1990 年 推 出 了 世 界 上 第 一 台 机 器 人 护 士, 用 于 在 医 院 传 送 各 种 医 疗 物 品 ; 而 后 Panasonic 发 展 了 医 院 智 能 跑 腿 机 器 人, 具 备 区 分 人 和 其 他 物 体 的 能 力 ; 在 2002 年, 日 本 有 11000 个 机 器 人 应 用 于 服 务 行 业 瑞 士 EPFL 联 邦 研 究 院 的 导 游 机 器 人 为 瑞 士 EXPO.02 展 览 馆 做 了 5 个 多 月 的 导 览 工 作, 接 待 了 数 千 游 客 (Burgard et al,2000) 英 国 Dyson 公 司 开 发 的 DC06 型 自 主 式 真 空 吸 尘 器, 在 导 航 和 行 进 路 径 控 制 上, 采 用 螺 旋 式 清 扫 路 径, 记 忆 清 扫 过 的 位 置, 自 动 确 定 前 进 方 向, 具 备 自 动 避 障 和 非 正 常 情 况 下 的 智 能 决 策 能 力 DC06 是 从 墙 上 开 始 工 作 的, 然 后 向 房 间 中 央 以 一 种 螺 旋 方 式 清 洁 室 内 的 房 间, 这 样 可 以 避 免 撞 上 障 碍 物, 当 它 走 到 楼 梯 的 尽 头 4

第 1 章 绪 论 时 会 停 下 来, 防 止 其 从 楼 梯 上 摔 下 来 若 发 现 旁 边 有 动 物 或 人 时, 会 立 刻 停 下 来 它 由 三 台 微 机 和 许 多 传 感 器 构 成, 运 用 了 最 先 进 的 微 处 理 器 控 制 的 SR 驱 动 电 机 内 有 三 台 电 脑 接 收 由 50 个 光 红 外 线 和 超 声 波 传 感 器 传 送 的 信 息, 每 秒 钟 接 收 16 次 该 吸 尘 机 器 人 靠 蓄 电 池 工 作, 当 蓄 电 池 里 的 电 量 不 足 时, 它 会 自 动 走 向 墙 角 的 充 电 处 进 行 自 动 充 电 类 似 产 品 还 有 瑞 典 Electrolux 开 发 的 全 自 动 吸 尘 器 以 及 日 本 松 下 电 器 公 司 的 电 气 化 住 宅 设 备 研 究 所 试 制 成 功 的 自 走 式 电 池 吸 尘 器 ( 陆 新 华 等,2003) 81-82 Help-Mate 是 一 个 由 美 国 运 输 研 究 会 (TRC) 研 制 的 自 主 式 运 送 系 统, 它 主 要 在 医 院 里 担 任 送 饭 和 传 递 物 品 的 工 作, 以 使 得 护 士 和 其 他 医 务 人 员 能 有 更 多 的 时 间 照 顾 病 人 它 的 导 航 系 统 是 基 于 建 筑 物 的 AutoCAD 地 图 模 型 识 别 法 和 测 距 法 相 结 合 的 传 感 器 融 合 系 统, 它 比 仅 由 观 察 天 花 板 的 氖 灯 和 机 器 人 旁 边 的 墙 来 定 位 的 系 统, 具 有 更 高 的 准 确 性 该 机 器 人 也 能 在 无 线 调 制 解 调 器 的 帮 助 下 开 门 和 乘 坐 电 梯 ( 陆 新 华 等,2003) 81-82 Cye 是 美 国 Probotics 公 司 1999 年 生 产 的 一 种 小 型 家 用 移 动 式 服 务 机 器 人, 它 可 牵 引 一 辆 小 型 拖 车 在 室 内 运 送 饮 料 信 件 等 生 活 用 品, 或 牵 引 吸 尘 器 进 行 室 内 清 扫 工 作 Cye 采 用 双 轮 差 动 驱 动 方 式, 利 用 地 图 输 入 的 方 式 来 获 取 环 境 信 息, 并 且 可 以 跟 踪 声 音 信 号, 任 务 完 成 后 能 自 动 返 回 总 站 待 命 它 的 外 形 像 一 个 安 装 有 两 个 轮 子 的 畚 箕, 由 个 人 电 脑 通 过 无 线 连 接 方 式 对 其 进 行 控 制, 控 制 信 号 从 一 个 插 在 个 人 电 脑 串 行 端 口 内 含 信 号 发 射 器 的 小 盒 子 发 出 在 Cye 开 始 工 作 之 前, 它 必 须 绘 制 出 周 围 的 环 境 用 户 使 用 电 脑 鼠 标 指 挥 它 来 到 关 键 性 的 标 志 处, 如 门 口 和 角 落 等, 然 后 它 就 可 以 开 始 自 己 的 工 作 了 Cye 还 可 以 通 过 探 测 轮 子 的 阻 力 来 了 解 周 围 的 环 境, 能 通 过 安 装 在 轮 子 上 的 码 盘 来 得 出 自 己 的 当 前 位 置 但 是, Cye 也 有 许 多 缺 点, 例 如 无 法 处 理 好 吸 尘 器 缠 绕 在 一 起 的 电 线 等, 而 且 工 作 时 发 出 的 噪 声 也 相 当 大 ( 陆 新 华 等,2003) 81-82 由 德 国 的 西 门 子 电 子 公 司 和 荷 兰 的 清 洁 设 备 制 造 商 RTB 公 司 联 合 开 发 的 一 种 名 为 Schrobbie 的 清 洁 机 器 人 已 经 在 荷 兰 的 一 些 零 售 连 锁 超 级 市 场 开 始 使 用 了 这 种 机 器 人 可 以 在 清 洁 地 板 的 同 时 播 放 音 乐 并 向 购 物 者 传 递 商 品 销 售 信 息 它 可 以 在 营 业 时 间 以 智 能 方 式 在 超 市 内 移 动, 一 边 走 一 边 擦 洗 地 板 Schrobbie 装 备 了 特 殊 的 导 航 系 统, 可 以 躲 开 障 碍 物, 一 旦 遇 到 顾 客, 会 礼 貌 地 请 顾 客 避 让 机 器 人 Schrobbie 十 分 灵 敏, 它 会 识 别 墙 角 和 货 架 的 准 确 位 置, 既 不 碰 撞 也 不 遗 漏 需 要 清 扫 的 地 方 该 机 器 人 的 智 能 导 航 系 统 是 西 门 子 公 司 开 发 的 Sinas,Sinas 的 特 别 之 处 在 于 它 不 需 要 安 装 附 加 的 导 航 辅 助 设 备, 能 独 立 的 使 自 己 适 应 周 围 环 境 为 了 获 取 周 围 的 环 境 知 识, 机 器 人 首 先 要 有 一 个 环 境 学 习 过 程, 其 间 通 过 使 用 内 嵌 激 光 扫 描 仪 的 眼 来 创 建 一 幅 基 于 陆 标 的 地 图 它 将 该 地 图 存 储 在 自 己 的 内 5

第 1 章 绪 论 存 中, 以 后 地 图 和 其 它 可 用 的 来 自 激 光 扫 描 仪 超 声 陀 螺 仪 等 传 感 器 数 据 来 实 现 导 航 它 能 识 别 和 避 开 障 碍 物, 灵 巧 的 通 过 狭 小 的 过 道, 紧 贴 着 墙 壁 和 架 子 的 边 缘 移 动, 当 它 陷 入 死 区 时, 能 自 动 发 觉 并 退 出 ( 陆 新 华 等,2003) 81-82 在 改 善 老 年 和 残 疾 人 行 走 和 出 行 方 面, 传 统 的 轮 椅 助 行 代 步 工 具 正 被 智 能 轮 椅 智 能 助 行 器 所 代 替 韩 国 在 2001 年 和 2004 年 分 别 研 制 了 两 种 轮 椅 机 器 人 :KOREAS I 和 KOREAS II 1.2.2 国 内 移 动 服 务 机 器 人 发 展 现 状 我 国 从 20 世 纪 90 年 代 开 始 进 行 服 务 机 器 人 技 术 跟 踪 研 究, 并 取 得 一 定 成 果 但 是, 我 国 服 务 机 器 人 的 研 究 没 有 形 成 系 统, 基 本 上 是 各 个 大 学 研 究 院 所 根 据 国 外 的 研 究 状 况, 或 是 为 了 培 养 学 生 兴 趣, 而 进 行 的 一 些 零 散 的 研 究, 处 于 相 对 落 后 状 态 ( 余 运 昌 等,2007) 在 非 典 期 间 国 内 开 发 了 几 款 护 士 助 手 服 务 机 器 人, 如 中 科 院 自 动 化 所 的 艾 姆, 哈 工 大 的 护 士 助 手 等, 这 两 款 机 器 人 均 能 够 在 非 典 病 区 执 行 消 毒, 运 送 医 疗 器 械 设 备, 运 送 实 验 样 品 及 实 验 结 果, 为 病 人 送 药 品 送 饭 及 生 活 用 品 处 理 隔 离 病 区 垃 圾 协 助 护 士 工 作 等, 两 种 机 器 人 均 有 一 定 智 能, 可 以 自 主 避 障, 还 能 进 行 无 线 遥 控 等 哈 尔 滨 工 业 大 学 研 制 的 轮 式 智 能 服 务 机 器 人 能 无 缆 行 走 自 动 避 障 语 音 识 别 并 能 与 人 对 话, 用 于 服 务 场 合 的 导 游 导 购 等 中 科 院 自 动 化 所 为 吴 江 科 技 馆 研 制 的 导 览 机 器 人 茜 茜 ( 如 图 1.3 所 示 ) 能 够 在 复 杂 的 展 馆 环 境 中 循 线 漫 游, 并 自 动 规 避 障 碍 物 和 行 人, 在 规 定 的 展 项 前 确 定 自 身 位 置 并 调 整 姿 态, 准 确 地 在 预 定 位 置 面 向 展 项 进 行 讲 解, 茜 茜 还 具 有 非 特 定 人 语 音 识 别 功 能, 接 收 语 音 命 令 控 制, 与 游 客 进 行 语 音 交 互, 还 能 表 演 舞 蹈 朗 诵 讲 笑 话 等, 投 入 应 用 并 正 常 运 行 已 经 一 年 多 ; 为 四 川 科 技 馆 研 制 的 蓉 城 小 姐 具 有 自 主 移 动 和 迎 宾 接 待 功 能, 已 经 实 际 从 事 了 近 2 年 时 间 的 服 务 工 作, 同 一 系 列 的 机 器 人 还 在 10 多 次 展 览 会 和 各 种 商 业 场 合 完 成 了 导 览 迎 宾 及 讲 解 等 工 作 国 内 在 助 老 / 助 残 机 器 人 的 研 究 尽 管 是 刚 刚 起 步, 但 是 在 关 键 技 术 研 究 方 面 有 较 好 的 研 究 基 础, 多 家 单 位 已 经 开 展 相 关 的 技 术 与 产 品 研 究 如 中 科 院 自 动 化 所 研 制 了 一 种 具 有 视 觉 和 口 令 导 航 功 能 并 能 与 人 进 行 语 音 交 互 的 智 能 轮 椅 ; 哈 尔 滨 工 业 大 学 已 经 开 发 出 双 臂 作 业 型 智 能 服 务 机 器 人 ( 郝 宗 波,2003) 7 6

第 1 章 绪 论 图 1.3 中 科 院 自 动 化 所 导 览 机 器 人 1.3 机 器 人 路 径 规 划 路 径 规 划 是 移 动 机 器 人 导 航 中 最 重 要 的 任 务 之 一, 对 移 动 机 器 人 路 径 规 划 系 统 的 主 要 要 求 是 ( 郭 戈 等,2003):(1) 在 环 境 地 图 中 寻 找 一 条 路 径, 保 证 机 器 人 沿 该 路 径 移 动 时 不 与 外 界 发 生 碰 撞 ;(2) 能 够 处 理 用 传 感 器 感 知 的 环 境 模 型 中 的 不 确 定 因 素 和 路 径 执 行 中 出 现 的 误 差 ;(3) 通 过 使 机 器 人 避 开 外 界 物 体 而 使 其 对 机 器 人 传 感 器 感 知 范 围 的 影 响 降 到 最 小 ;(4) 能 够 按 照 需 要 找 到 最 优 路 径 不 论 采 用 何 种 导 航 方 式, 智 能 移 动 机 器 人 主 要 完 成 路 径 规 划, 定 位 和 避 障 等 任 务 根 据 机 器 人 对 环 境 信 息 的 了 解 程 度, 机 器 人 路 径 规 划 可 以 划 分 为 : 环 境 信 息 完 全 已 知 的 全 局 路 径 规 划 和 环 境 信 息 完 全 未 知 或 部 分 未 知, 需 要 通 过 传 感 器 对 障 碍 物 位 置 形 状 或 尺 寸 进 行 探 测 的 局 部 路 径 规 划 ( 龙 飞 等,2005) 31 全 局 路 径 规 划 的 任 务 是 根 据 先 验 地 理 环 境 信 息 找 出 从 起 始 点 到 目 标 点 的 符 合 一 定 性 能 的 可 行 或 最 优 路 径 局 部 路 径 规 划 使 得 机 器 人 在 沿 全 局 路 径 的 行 进 过 程 中, 根 据 传 感 器 不 断 感 知 的 周 围 环 境 信 息 和 自 身 的 状 态 信 息, 规 划 出 一 条 无 障 碍 可 通 行 的 局 部 路 径 在 实 际 的 工 作 中, 环 境 是 由 已 知 的 静 态 障 碍 物 和 每 天 可 能 变 化 位 置 的 静 态 障 碍 物 ( 比 如 桌 椅 摆 放 的 位 置 ) 以 及 动 态 障 碍 物 ( 比 如 在 房 间 中 行 走 的 人 ) 所 组 成 7

第 1 章 绪 论 1.4 课 题 的 研 究 目 的 及 意 义 在 移 动 机 器 人 路 径 规 划 理 论 和 方 法 的 研 究 中, 确 定 性 环 境 的 路 径 规 划 问 题 即 离 线 的 全 局 路 径 规 划 方 已 取 得 了 大 量 的 研 究 和 应 用 成 果 使 用 链 接 图 将 全 局 确 定 性 环 境 转 换 成 带 权 值 的 图, 而 对 于 带 权 图 求 两 固 定 点 之 间 的 最 短 距 离 可 以 用 已 经 成 熟 的 遗 传 算 法 以 及 蚁 群 算 法 求 解 但 是, 对 于 存 在 未 知 障 碍 物 的 环 境 下 的 路 径 规 划 虽 然 也 取 得 了 一 定 的 研 究 成 果, 但 是 还 没 有 完 善 的 体 系 结 构, 仍 然 有 不 少 关 键 理 论 和 技 术 问 题 急 需 解 决 要 想 让 机 器 人 进 入 服 务 领 域, 必 须 解 决 环 境 部 分 未 知 情 况 下 的 路 径 规 划, 因 为 服 务 机 器 人 的 服 务 对 象 是 人, 而 有 人 存 在 的 环 境 必 然 是 变 化 的, 比 如 人 的 行 走, 人 往 环 境 中 移 入 或 移 除 物 体 对 于 不 同 的 环 境 和 不 同 的 障 碍 物, 机 器 人 导 航 的 方 法 也 有 所 不 同 本 课 题 依 托 国 家 863 项 目 动 态 环 境 下 智 能 导 览 机 器 人 关 键 技 术 与 应 用 研 究, 从 实 际 应 用 出 发, 针 对 全 局 静 态 环 境 已 知, 但 存 在 不 可 预 测 的 未 知 动 态 或 静 态 障 碍 物 的 一 种 动 态 环 境, 进 行 机 器 人 的 导 航 研 究 论 文 将 导 航 分 成 两 个 层 次 : 先 由 全 局 静 态 环 境 离 线 的 规 划 出 全 局 最 优 路 径, 然 后 根 据 传 感 器 获 取 的 局 部 障 碍 物 和 全 局 最 优 路 径 提 供 的 局 部 目 标 点 来 进 行 局 部 避 障 路 径 规 划 和 导 航 是 自 主 移 动 机 器 人 领 域 的 两 个 至 关 重 要 的 问 题, 因 为 移 动 机 器 人 需 要 在 工 作 环 境 中 抵 达 目 标 点, 并 做 出 相 应 的 行 为 本 论 文 中 采 用 的 方 法 涉 及 到 人 工 智 能 理 论 路 径 跟 踪 蚁 群 算 法 VFH* 算 法 以 及 VC 和 MATLAB 仿 真 在 项 目 实 施 过 程 中, 增 强 了 分 析 问 题 的 能 力, 丰 富 了 知 识 面, 为 将 来 进 一 步 的 学 习 和 工 作 打 下 坚 实 的 基 础 1.5 本 文 的 主 要 工 作 本 论 文 的 主 要 内 容 如 下 : 第 1 章 主 要 介 绍 了 机 器 人 的 发 展 历 史, 国 内 外 在 移 动 服 务 机 器 人 方 面 的 研 究 现 状, 概 括 性 地 描 述 了 移 动 机 器 人 导 航 的 研 究 方 法, 分 析 了 本 文 的 研 究 内 容 和 意 义 第 2 章 介 绍 了 全 局 地 图 的 构 造 方 法 现 有 的 主 要 几 种 全 局 路 径 规 划 方 法, 然 后 采 用 蚁 群 算 法 规 划 出 全 局 最 优 路 径 第 3 章 介 绍 了 Follow The Carrot 和 Pure Pursuit 两 种 路 径 跟 踪 算 法 第 4 章 先 介 绍 了 几 种 主 流 的 避 障 算 法, 然 后 根 据 传 感 器 数 据 和 路 径 跟 踪 算 法 提 供 的 局 部 目 标 点, 使 用 VFH* 算 法 进 行 局 部 避 障 研 究 第 5 章 介 绍 实 验 中 使 用 到 的 Aria 平 台 和 AIM 平 台 的 相 关 参 数 以 及 实 验 仿 真 结 果 第 6 章 总 结 了 本 论 文 所 做 的 工 作, 并 提 出 以 后 需 要 改 进 的 方 面 8