• 沒有找到結果。

    

本章详细描述了本实验室自主研制的 HIT II型全自主足球机器人的硬件体

系 结构和 实现方 案,分别介绍 了机器人 的五大模块 :嵌入 式主控计算机 、异构

双 目视觉系统、运动控制系统、无线通信系统和电源系统。还简要介绍了 H工T- n全 自主机器人足球队的软件系统结构和单机器人的软件系统结构。该机器人

最 大 的特 点是 以工业 嵌入式 计算机 系统 为核 心 ,使之 具有 体积 小、计算 能 力

强、稳定性高等特点,可以适应各种比赛情况。该系统在 2002年 5月汉城举 办的第七届世界杯机器人足球大赛中获得 RoboSot比赛项目的冠军。这说明该 系统软硬件体系结构设计是合理的。我们设计的机器人不但可用于足球比赛,

而且同样适用于其他移动机器人系统。

哈尔滨 工业 大学 工学硕 士学位 论文

电路。机器人踢球装置驱动电机只需要小功率的微型直流电机,电机板通过芯 片 L298N直接驱动该电机带动踢球板旋转。

3 . 2 . 2电机驱动程序的设计与开发

    

电机驱动程序是运行在主控计算机上 ,它负责电机驱动板上的控制芯片 LM629的数据读写和发送指令,从而实现对电机的控制.所以 LM629的特

性 、工 作原理及指令集是开发 电机驱动程序 的基础 。   

(1) LM69工作原理:

    

如 电路 框图 32所示,LM69通过其 1O端 口与主控 计算机通信,计算 出 一个梯 形速度 图并进行数 字滤波 。用增量编码 器反馈实际位 置。无论是位置控

制还是速度控制方式,这个梯形速度图发生器都要计算出相应的梯形速度分布

图。在运行 时,LM69进行预定位置 (速度 图发 生器 计算的位置 )与实际位置

作减法运算,把运算结果看作电机运转的误差,然后由数字 PID滤波器处理该 误差后输出下一采样周期的 PWM 调速信号,驱动 电机到达预定位置。表 3-1 给出 LM629的综合性能数据。

       表 31  LM69综合性能数据

       Tab.3-1 LM629 specifications summary

位置 范围 4 一13计数

速度 范围 0一1,073,741,823 / 216计数/采样,即。一16,383计数/采样,分辨率

       2 6计数/采样

加速 度范 围 0一16,383/2 16计数深样2,分辨率1/2"计数/采样2

工作 方式 位置控制和速度控 制

控制算法 比例、积分、微分 (PID )

采 样时 间间 隔 微分:2一28 X K(对于fK = MHz,即26一       

6 u )比例、积分:2

  

2) 位置反馈接 口

    

增量编码器的三个信号 A. B和雨 接至 LM629。两个正交信号 A. B用

来跟 踪 电机 绝对位 置,它们组成 4 个不 同逻辑状态 ,此逻 辑状态 的每一 次改

变,相应的 LM629内位置寄存器数值加一或减一。这样,系统分辨率比该编

码器 的条文数高 4倍 。编码器信号输入 与 LM69的时钟 同步。

     I

lv信号是电机每旋转一周产生一个低电平。当编码器 3个信号都是低电 平时产生 index信号送内部专门的 index寄存器,记录了电机的绝对位置。其

相關文件