二 ○ 一 七 届 毕 业 设 计
六足机器人设计及步行控制研究
工 程 机 械 学 院
机 械 电 子 工 程
学
专
姓
学
院 :
业 :
名 :
号 :
指 导 教 师 :
完 成 时 间 :
摘 要
摘 要
步 行 机 器 人 是 一 种 由 计 算 机 控 制 的 余 驱 动 , 多 支 链 , 时 变 拓 扑
运 动 机 构 ,是 模 仿 动 物 运 动 形 式 的 特 种 机 器 人 。通 常 将 足 数 多 于 或 等
于 四 的 步 行 机 器 人 称 为 多 足 步 行 机 器 人 。相 较 于 轮 式 ,因 为 运 动 方 式
的 差 异 , 使 得 多 足 步 行 机 器 人 能 够 适 应 崎 岖 的 地 形 , 进 行 越 障 作 业 ,
并 具 有 较 强 的 机 动 性 。长 期 以 来 ,多 足 步 行 机 器 人 技 术 一 直 是 国 内 外
机 器 人 领 域 的 研 究 热 点 之 一 。
本 文 分 析 并 设 计 出 一 种 六 足 步 行 机 器 人 。主 要 对 该 机 器 人 的 机 械
结 构 进 行 设 计 。先 对 腿 部 机 构 ,机 身 结 构 进 行 分 析 比 较 与 选 型 ,然 后
完 成 了 零 部 件 设 计 以 及 三 维 模 型 建 模 , 并 将 所 建 模 型 导 入 到 ADMAS
进 行 了 动 力 学 分 析 。其 次 对 该 机 器 人 的 驱 动 系 统 ,控 制 系 统 设 计 做 了
大 致 的 介 绍 。在 完 成 机 器 人 设 计 工 作 后 ,主 要 对 步 行 控 制 展 开 了 研 究 。
先 对 六 足 机 器 人 进 行 了 运 动 学 分 析 ,建 立 了 六 足 机 器 人 的 D-H 模 型 ,
并 对 运 动 学 正 逆 问 题 进 行 了 求 解 。接 着 进 行 了 六 足 机 器 人 步 态 规 划 研
究 ,分 析 介 绍 了 步 态 规 划 中 相 序 变 换 ,占 地 系 数 ,稳 定 性 这 三 个 基 本
方 面 。最 后 设 计 出 了 六 足 机 器 人 三 足 步 态 步 行 控 制 算 法 。本 次 设 计 的
最 后 进 行 了 六 足 机 器 人 上 层 控 制 系 统 软 件 开 发 。利 用 基 于 模 型 设 计 的
方 法 , 在 建 立 上 层 控 制 系 统 Smiulink 模 型 后 , 通 过 CCS 与 MATLAB
的 联 合 配 置 ,实 现 了 控 制 代 码 的 自 动 生 成 。并 对 所 生 成 的 代 码 进 行 了
测 试 。 至 此 , 完 成 了 本 次 设 计 的 所 有 工 作 。
关 键 词 : 六 足 机 器 人 ,动 力 学 分 析 ,机 器 人 运 动 学 ,步 态 规 划 ,
三 维 建 模 , 基 于 模 型 设 计
I
摘 要
ABSTRACT
The walking robot
is a computer-controlled keng-driven, mult
time-varying topological movement mechanism, which
i-branched,
robot
that mimics the form of animal movement. A
is a special
walking robot with a foot number greater
to four
is usually called a walking robot. Compared with the wheel, bec
ause the movement of
the difference, so that multi-foot walking
robot can adapt
the obstacle operation, and
has a strong mobility. For a long time, multi-foot walking robo
roboti
technology has been one of
the hotspots in the field of
to the rugged terrain,
than or equal
t
cs at home and abroad.
the robot
the robot are introduced in detail. After
the robot design work, mainly on the walking
This paper analyzes and designs a six-legged walking robot.
is mainly designed. First
The mechanical structure of
of all,
the leg mechanism, body structure analysis and comparis
on and selection, and then completed the parts design and three-
dimensional model modeling, and the model was imported into A
the driving system and co
DAMS for dynamic analysis. Secondly,
ntrol system design of
t
he completion of
the six-legged
to start a study. Firstly,
control
is established, and the inverse problem of kinematics is s
robot
legged rob
olved. Then, we study the gait planning of
ot, and analyze the three basic aspects of phase sequence transfo
rmation,
land area coefficient and stability in gait planning. Fina
three-step gait walking control algorithm is
lly, a six-foot
designed. The design of
robot control system fo
r
design method, after
system Smiulink model,
nfiguration,
layer of software development. Based on the model
layer control
through the CCS and MATLAB joint co
to achieve the automatic generation of control code.
the establishment of
the D-H model of
the upper
robot
the last six-foot
the upper
the six -
II
摘 要
And the generated code was tested. At
the work of
this design.
this point, completed all
KEYWORDS six-legged robot, dynamic analysis,
robot kinem
atics, gait planning, 3D modeling, model-based design
III
目 录
目 录
摘 要 ..........................................................................................................I
ABSTRACT ........................................................................................... II
第 一 章 绪 论 ........................................................................................... 5
1.1 选 题 背 景 及 意 义 .................................................................................... 5
1.2 国 内 外 六 足 步 行 机 器 人 研 究 概 况 ....................................................5
1.2.1 国 外 多 足 步 行 机 器 人 研 究 成 果 ........................................... 6
1.2.2 国 内 多 足 步 行 机 器 人 研 究 成 果 ........................................... 8
1.3 本 文 的 研 究 内 容 .................................................................................. 10
1.4 本 文 的 结 构 安 排 .................................................................................. 10
第 二 章 六 足 步 行 机 器 人 系 统 设 计 与 分 析 ................................. 11
2.1 机 械 系 统 设 计 .......................................................................................11
2.1.1 腿 部 结 构 设 计 ..........................................................................11
2.1.2 整 体 结 构 设 计 ..........................................................................13
2.1.3 零 部 件 设 计 .............................................................................. 14
2.2 驱 动 系 统 的 设 计 .................................................................................. 18
2.2.1 驱 动 系 统 工 作 要 求 ................................................................ 18
2.2.2 驱 动 电 机 选 型 ..........................................................................18
2.3 控 制 系 统 设 计 .......................................................................................19
2.3.1 系 统 要 求 ................................................................................... 19
2.3.2 控 制 系 统 定 型 ..........................................................................20
2.4 动 力 学 仿 真 及 分 析 ............................................................................. 20
2.4.1 动 力 学 模 型 建 立 ..................................................................... 20
2.4.2 动 力 学 分 析 .............................................................................. 20
第 三 章 六 足 机 器 人 运 动 学 与 步 态 规 划 研 究 ............................ 23
3.1 六 足 机 器 人 运 动 学 分 析 .................................................................... 23
3.1.1 六 足 机 器 人 D-H 模 型 ...........................................................24
3.1.2 六 足 机 器 人 正 运 动 学 ............................................................25
3.1.3 六 足 机 器 人 逆 运 动 学 ............................................................27
3.2 六 足 机 器 人 步 态 规 划 研 究 ............................................................... 29
III
目 录
3.2.1 六 足 机 器 人 占 地 系 数 分 析 .................................................. 29
3.2.2 六 足 机 器 人 稳 定 性 分 析 ....................................................... 31
3.2.3 足 端 轨 迹 选 择 ..........................................................................32
第 四 章 三 足 步 态 算 法 设 计 .............................................................33
4.1 直 线 行 走 步 态 规 划 ............................................................................. 33
4.2 定 点 转 弯 步 态 规 划 ............................................................................. 35
4.3 步 态 控 制 算 法 框 图 ............................................................................. 35
第 五 章 基 于 Smiulink 模 型 的 上 层 控 制 系 统 软 件 开 发 ........37
5.1 基 于 模 型 的 设 计 方 法 介 绍 ............................................................... 37
5.2 MATLAB 与 CCS 的 联 合 配 置 ..........................................................37
5.2.1 CCS 的 特 点 及 功 能 概 述 ........................................................ 38
5.2.2 MATLAB 与 CCS 关 联 配 置 ................................................. 38
5.3 Smiulink 模 型 搭 建 ...............................................................................38
5.3.1 自 定 义 模 块 S-Function Builder 介 绍 .........................39
5.3.2 库 模 块 介 绍 .............................................................................. 41
5.3.3 模 型 工 作 原 理 ..........................................................................42
5.4 代 码 生 成 ................................................................................................ 43
第 六 章 SPI 串 口 通 信 测 试 ..............................................................43
6.1 测 试 方 法 ................................................................................................ 43
6.2 测 试 结 果 ................................................................................................ 45
IV
第 一 章 绪 论
第 一 章 绪 论
1.1 选 题 背 景 及 意 义
步 行 机 器 人 是 一 种 由 计 算 机 控 制 的 keng 余 驱 动 , 多 支 链 , 时 变 拓 扑 运
动 机 构 , 是 模 仿 动 物 运 动 形 式 的 特 种 机 器 人 。 由 仿 生 对 象 的 不 同 , 常 见 的
步 行 机 器 人 有 两 足 , 四 足 , 六 足 , 八 足 之 分 。 通 常 将 足 数 多 于 或 等 于 四 的
步 行 机 器 人 称 为 多 足 步 行 机 器 人 。 相 比 于 轮 式 , 履 带 式 机 器 人 在 移 动 时 ,
运 动 轨 迹 为 一 条 连 续 的 辙 迹 , 多 足 步 行 机 器 人 在 移 动 过 程 中 在 地 面 上 的 移
动 轨 迹 却 是 一 系 列 离 散 的 点 , 这 就 使 得 多 足 步 行 机 器 人 能 够 适 应 崎 岖 的 地
形 , 进 行 越 障 作 业 , 并 具 有 较 强 的 机 动 性 。 另 外 , 步 行 运 动 方 式 允 许 足 端
运 动 轨 迹 与 机 身 运 动 轨 迹 解 耦 , 使 得 机 械 系 统 具 有 主 动 隔 震 功 能 , 尽 管 地
面 崎 岖 不 平 , 机 身 都 可 以 保 持 相 对 的 平 稳 。 最 后 , 在 松 软 路 面 移 动 时 , 履
带 式 与 轮 式 机 器 人 会 受 到 极 大 的 牵 引 阻 力 , 致 使 效 率 低 下 , 机 动 性 变 差 。
而 步 行 机 器 人 则 不 受 此 影 响 , 仍 能 保 持 良 好 的 运 动 性 能 。 鉴 于 这 些 种 种 优
点 , 步 行 机 器 人 在 军 事 运 输 及 探 测 、 矿 山 开 采 、 水 下 建 筑 、 核 工 业 、 星 球
探 测 、 农 业 及 森 林 采 伐 等 许 多 行 业 有 着 非 常 广 阔 的 应 用 前 景 。
长 期 以 来 , 多 足 步 行 机 器 人 技 术 一 直 是 国 内 外 机 器 人 领 域 的 研 究 热 点
之 一 。 为 了 瞄 准 国 际 机 器 人 技 术 前 沿 , 为 我 国 多 足 机 器 人 工 程 实 用 化 开 发
提 供 关 键 技 术 的 支 持 , 开 展 多 足 步 行 机 器 人 相 关 理 论 和 技 术 的 研 究 具 有 重
要 的 科 学 意 义 和 应 用 价 值 。 本 选 题 主 要 研 究 两 个 问 题 : 一 是 六 足 机 器 人 系
统 的 设 计 ; 二 是 步 行 控 制 算 法 研 究 。 六 足 机 器 人 系 统 设 计 是 开 展 六 足 机 器
人 研 究 的 基 础 。 只 有 在 设 计 合 理 的 硬 件 结 构 上 , 才 能 实 现 对 机 器 人 控 制 软
件 更 好 的 研 究 ; 合 理 的 步 态 可 以 提 高 机 器 人 动 作 的 稳 定 性 , 对 复 杂 环 境 的
自 适 应 能 力 , 并 且 降 低 能 耗 , 提 高 机 器 人 的 使 用 寿 命 。 步 行 控 制 的 研 究 是
对 多 足 步 行 机 器 人 控 制 的 关 键 , 其 意 义 非 同 一 般 。
1.2 国 内 外 六 足 步 行 机 器 人 研 究 概 况
与 传 统 移 动 机 器 人 相 比 较 , 步 行 机 器 人 特 殊 的 仿 生 机 械 结 构 , 优 越 的
行 进 方 式 , 大 大 提 高 了 步 行 机 器 人 对 复 杂 环 境 的 适 应 能 力 , 从 而 拥 有 更 加
5
第 一 章 绪 论
广 泛 的 工 作 用 途 。 因 此 长 期 以 来 , 步 行 机 器 人 一 直 是 国 内 外 机 器 人 领 域 的
研 究 热 点 。 随 着 电 子 计 算 机 技 术 与 仿 生 学 理 论 的 迅 速 发 展 , 国 内 外 学 者 研
究 出 了 许 多 性 能 优 异 的 步 行 机 器 人 。
1.2.1 国 外 多 足 步 行 机 器 人 研 究 成 果
目 前 , 国 外 在 多 足 步 行 机 器 人 方 面 取 得 重 要 进 展 主 要 体 现 在 军 事 应 用
与 空 间 探 测 方 面 。 Attila ( 如 图 1.1 ) 是 九 十 年 代 由 Mobot 实 验 室 研 制 的 第
一 款 用 于 星 球 探 测 的 自 主 移 动 六 足 机 器 人 , 其 结 构 上 采 取 模 块 化 设 计 , 每
条 腿 都 是 一 个 独 立 单 元 。 腿 部 仿 照 昆 虫 身 体 架 构 采 用 多 关 节 开 链 形 式 , 每
条 腿 3 个 自 由 度 , 六 条 腿 总 计 18 个 自 由 度 , 保 证 了 机 器 人 的 灵 活 性 。 其 模
块 化 的 设 计 思 路 ,使 得 机 器 人 即 时 有 腿 出 现 故 障 ,仍 能 保 持 正 常 移 动 。Attila
机 身 长 35cm,质 量 为 2.8kg ,装 有 60 多 个 传 感 器 ,为 其 采 集 外 部 环 境 参 量 。
图 1.1 机 器 人 Attila
1996 年 , 美 国 Irobot 公 司 在 Darpa 与 海 军 研 究 所 的 资 助 下 设 计 出 了 一
款 用 于 侦 察 ,排 雷 的 机 器 人 Ariel( 如 图 1.2 )。其 体 长 56cm ,质 量 约 为 10.4kg 。
该 机 器 人 的 腿 部 结 构 具 有 两 个 自 由 度 ,其 中 跟 关 节 转 角 ±90 ° ,髋 关 节 转 角
±135 ° 。 该 机 器 人 仿 照 螃 蟹 进 行 设 计 , 使 得 机 器 人 更 容 易 越 障 和 保 持 站 立
姿 态 。 六 条 腿 对 称 布 置 , 使 得 控 制 简 单 , 反 应 灵 敏 , 机 动 性 强 , 但 转 弯 能
力 差 。因 为 其 工 作 的 特 殊 性 , 控 制 器 及 主 线 路 被 封 装 抗 冲 击 的 封 闭 匣 子 中 。
Ariel 安 装 有 多 种 传 感 器 , 以 使 机 器 人 完 成 自 主 移 动 , 侦 察 , 扫 雷 等 工 作 任
务 。 其 系 统 还 配 有 自 适 应 程 序 , 以 使 得 在 工 作 过 程 中 , 外 界 环 境 发 生 突 然
变 化 时 , 机 器 人 能 够 做 出 迅 速 有 效 的 反 应 。
6