本章详细描述了本实验室自主研制的 HIT II型全自主足球机器人的硬件体
系 结构和 实现方 案,分别介绍 了机器人 的五大模块 :嵌入 式主控计算机 、异构
双 目视觉系统、运动控制系统、无线通信系统和电源系统。还简要介绍了 H工T- n全 自主机器人足球队的软件系统结构和单机器人的软件系统结构。该机器人
最 大 的特 点是 以工业 嵌入式 计算机 系统 为核 心 ,使之 具有 体积 小、计算 能 力
强、稳定性高等特点,可以适应各种比赛情况。该系统在 2002年 5月汉城举 办的第七届世界杯机器人足球大赛中获得 RoboSot比赛项目的冠军。这说明该 系统软硬件体系结构设计是合理的。我们设计的机器人不但可用于足球比赛,
而且同样适用于其他移动机器人系统。
哈尔滨 工业 大学 工学硕 士学位 论文
电路。机器人踢球装置驱动电机只需要小功率的微型直流电机,电机板通过芯 片 L298N直接驱动该电机带动踢球板旋转。
3 . 2 . 2电机驱动程序的设计与开发
电机驱动程序是运行在主控计算机上 ,它负责电机驱动板上的控制芯片 LM629的数据读写和发送指令,从而实现对电机的控制.所以 LM629的特
性 、工 作原理及指令集是开发 电机驱动程序 的基础 。
(1) LM629工作原理:
如 电路 框图 3-2所示,LM629通过其 1/O端 口与主控 计算机通信,计算 出 一个梯 形速度 图并进行数 字滤波 。用增量编码 器反馈实际位 置。无论是位置控
制还是速度控制方式,这个梯形速度图发生器都要计算出相应的梯形速度分布
图。在运行 时,LM629进行预定位置 (速度 图发 生器 计算的位置 )与实际位置
作减法运算,把运算结果看作电机运转的误差,然后由数字 PID滤波器处理该 误差后输出下一采样周期的 PWM 调速信号,驱动 电机到达预定位置。表 3-1 给出 LM629的综合性能数据。
表 3-1 LM629综合性能数据
Tab.3-1 LM629 specifications summary
位置 范围 -1,073,741,824 一1,073,741,823计数
速度 范围 0一1,073,741,823 / 216计数/采样,即。一16,383计数/采样,分辨率
1/2 16计数/采样
加速 度范 围 0一16,383/2 16计数深样2,分辨率1/2"计数/采样2
工作 方式 位置控制和速度控 制
控制算法 比例、积分、微分 (PID )
采 样时 间间 隔 微分:2048/fcLK一2048 X 256/fCLK(对于fc:L.K = 8MHz,即256一
65526 u s)比例、积分:2048/fCLK
C2) 位置反馈接 口
增量编码器的三个信号 A. B和雨 接至 LM629。两个正交信号 A. B用
来跟 踪 电机 绝对位 置,它们组成 4 个不 同逻辑状态 ,此逻 辑状态 的每一 次改
变,相应的 LM629内位置寄存器数值加一或减一。这样,系统分辨率比该编
码器 的条文数高 4倍 。编码器信号输入 与 LM629的时钟 同步。
I
lv信号是电机每旋转一周产生一个低电平。当编码器 3个信号都是低电 平时产生 index信号送内部专门的 index寄存器,记录了电机的绝对位置。其