DSP

基于ARM9和Linux的 机器人控制系统设计

2019-07-13 20:03发布

 

基于ARM9和Linux的 机器人控制系统设计

[日期:2008-11-28] 来源:单片机与嵌入式系统应用  作者:齐齐哈尔大学 罗磊 戴学丰 刘树东 [字体: ]   引 言
   
现有智能机器人用直流电机作为驱动轮时一般都是用单片机或者高速的DSP等进行控制,而且同一机器人往往需用多个CPU来实现各自的功能,但随着对机器人的智能化要求越来越高,需要一种新的控制器(使用一个处理器)来满足机器人的各种行为要求,例如视频采集、无线通信。本文介绍的利用ARM实现的智能机器人平台,为智能机器人的开发提供了一个新方法。平台采用的ARM9是基于三星公司的S3C2410处理器,主频高达200 MHz,支持蓝牙、触摸屏以及USBHOST接口,可以传输高速图像。嵌入式Linux系统是一个多用户操作系统,它允许多个用户同时访问系统而不会造成用户之间的相互干扰。另外,Linux系统还支持真正的多用户编程,一个用户可以创建多个进程,并使各个进程协同工作来满足用户的需求。Linux的引入使其他智能模块都以设备的形式存在,只有在用户需要的时候才调用相关设备驱动从而使数据融合更方便,运行多任务也更稳定。
    利用ARM和嵌人式Linux作为智能机器人平台具有很大的优势,但在国内还未发现用该平台开发智能机器人的系统。本设计完成了对该系统驱动的初步编写,并通过实际验证,取得了良好效果。
1 驱动电路及测速方法
1.1 总体结构及驱动电路

    系统的整体结构框图如图l所示。 081128095567151.jpg     本设计采用的LMD18200的真值表如表1所列。通过ARM的I/0口(例如D口的DO~3)来控制电机的工作状态。 081128093621565.jpg 1.2 测速方法
    ARM没有捕获外部脉冲的计数器,它的定时器是用来计算内部脉冲的。码盘输出信号接外部中断处理程序(EINTl)并设置上沿触发变量,在中断中设置一全局变量i,用i++累加。设置定时器timer0,使它O.36 s产生1次内部定时器中断。当一个定时器周期完成时引发定时器中断,在timer0中断中读出i的值,即得到O.36 s内码盘转动所产生的脉冲数;接着将i清零,为下一个定时器周期捕获脉冲作准备。此时timer0自动重载,下一次码盘计数开始。
1.3 测量精度分析
   
智能机器人选用的光码盘精度为256线,即256脉冲/转。电机减速比为1:71,车轮半径R为6 cm,车轮间距为41.1 cm。车轮转一圈所产生的脉冲数n=71×256=18 176,可以得到每个脉冲之间的距离d=27πR/n=2×3.14×0.06/18 176=0.207×10-4m,即每个脉冲对应的控制精度达0.02 mm。考虑到负载变化(例如负载变化车轮变形等机械误差)的影响,理论值与实际值会出现误差,因此在控制精度d前乘以一个修正系数k。表2为机器人直线行走的实验数据。可以看出,k为1.10误差较小,最接近真实值,因此该值就是所需的比例系数。
2 速度调节

    一般的PID调节,当偏差E较大时(如启动或大幅度提速时),由于积分的作用会产生很大的超调量,使系统振荡,因此选用积分分离的方法,开始时取消积分作用,直到被调量相差不多时才引入积分作用。具体步骤如下:
    ①设定一个值a>0,E(m)一R(m)一M(m),其中R(m)为给定值,M(m)为测量值;
    ②当E(m)≥a时,采用PD控制,可以避免过大的超调,又可以使系统有较快的响应;
    ③当E(m)≤n,即偏差值E(m)比较小时,采用PID控制,可以保证系统的精度。 081128095567153.jpg     使用积分分离方法后显著降低了被控变量的超调量并缩短了过渡时间,使调节性能得到改善。
3 驱动设计
    本系统的驱动设计如图2、图3、图4所示。 081128095567152.jpg 081128095567154.jpg     设备驱动程序是操作系统内核与机器硬件之间的接口。它作为应用和实际设备之间的软件层,为应用程序屏蔽了硬件的细节。对于应用程序,硬件设备只是一个设备文件,应用程序可以像操作普通文件一样对硬件设备进行操作。设备驱动程序是Linux内核的一部分,它实现以下的功能:对设备初始化和释放,把数据从内核传送到硬件和从硬件读取数据,读取应用程序传送给设备文件的数据和回送应用程序请求的数据,检测和处理设备出现的错误。用到的结构如下: 081128095567155.jpg
    设备打开的时候就会调用dcmotor__open函数进行申请中断号。带内存管理的单元的地址映射,设置B端口的2、3引脚为PWM输出,端口D配置为电机使能刹车制动引脚。 081128095567156.jpg 081128095567157.jpg
    以下所有的函数都是在ioctl()中实现的。在Dcmo—tor_Start里调用timer0_2_3_start(),设置timer0为接收两路电机的码盘信号,并检测电机速度;timer2、timer3提供2路PWM输出,并设置定时器自动重载。具体实现如下: 081128095567158.jpg
    Select_Speed可以动态选择要运行的速度。它是用户的接口,用户可以调用该函数把速度值传到驱动从而控制电机。例如,在应用程序中执行ioctl(fdl, 081128095567159.jpg
timer0中断是核心程序,它可根据PID的调节值来改变占空比。为了便于随时改变占空比的值可定义两个全局变量tmp2、tmp3,通过把它们的值写入TCMPB来改变占空比。 0811280955671510.jpg
    在All_Forward、All_Back、All_Stop中,通过设置端口DO~3的高低电平,实现前进、后退、停止;在Left_Curve、Right_Curve中,设置左右轮的旋转方向,使两轮旋转方向不同,再根据差速在应用程序中给定预定时间,以达到转弯效果。
4 结 论
    利用ARM和Linux操作系统实现智能机器人的闭环控制是可行的,而且可以充分利用ARM的强大功能实现其他智能模块的扩展。