您的位置首页>企业动态>

利用ARM和Linux实现智能机器人的控制

导读大家好,我是极客范的本期栏目编辑小友,现在为大家讲解利用ARM和Linux实现智能机器人的控制问题。引用现有的智能机器人采用DC电机作为驱动

大家好,我是极客范的本期栏目编辑小友,现在为大家讲解利用ARM和Linux实现智能机器人的控制问题。

引用

现有的智能机器人采用DC电机作为驱动轮时,一般由单片机或高速DSP控制。智能机器人被称为智能机器人,因为它有一个发育良好的“大脑”。大脑中起作用的是中央计算机,它与操作它的人有直接的联系。最重要的是,这样的计算机可以执行根据目的安排的动作。正因为如此,我们说这些机器人是真正的机器人,尽管它们的外观可能有所不同。而且,同一个机器人往往需要一个以上的CPU来实现其各自的功能。然而,随着对机器人智能化要求的日益提高,需要一种新的控制器(使用一个处理器)来满足机器人的各种行为需求,如视频采集和无线通信。本文介绍的基于ARM的智能机器人平台为智能机器人的发展提供了一种新的方法。随着Linux的引入,其他智能模块以设备的形式存在,只有在用户需要的时候才会调用相关的设备驱动,使得数据融合更加方便,多任务处理更加稳定。

使用ARM和嵌入式Linux作为智能机器人平台有很大的优势,但国内还没有用该平台开发智能机器人的系统。本设计完成了系统驱动程序的初步编写,并通过实际验证取得了良好的效果。

1驱动电路和速度测量方法

1.1总体结构和驱动电路

系统的整体框图如图1所示

本设计中使用的LMD18200真值表列于表1。电机的工作状态通过ARM的I/O口控制(例如D口的DO~3)。

1.2速度测量方法

ARM没有捕捉外部脉冲的计数器,它的定时器用来计算内部脉冲。编码器的输出信号连接到外部中断处理器(EINTl),并设置上沿触发变量。在中断中,一个全局变量I由I设置和累加。设置定时器定时器0,使其0.36s产生一个内部定时器中断。当一个定时器周期结束时,触发定时器中断,在定时器0中断中读出I的值,即得到码盘在0.36s内旋转产生的脉冲数;然后,我被清除,准备在下一个定时器周期捕获脉冲。

1.3测量精度分析

智能机器人选择的光学编码器精度为256线,即256脉冲/转。电机减速比为13,336,071,车轮半径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。可以看出,k 1.10的误差较小,最接近真实值,所以这个值就是所需的比例因子。

2速度调节

一般的PID调节,PID调节是工业控制中应用最广泛的调节方法之一。在各种自动控制书籍和资料中,经常看到PID这个词。那么什么是PID调节呢?PID是英文单词比例、积分和微分系数的缩写。实际上,PID调节由三种调节方式组成:比例调节、积分调节和微分调节。它们各自的作用如下:比例调节:按比例反映系统的偏差。一旦系统出现偏差,比例调节会立即产生调节来减少偏差。如果比值大,可以加快调整速度,减小误差。但是,如果比值过大,系统的稳定性会降低,甚至系统不稳定。当偏差E较大时(如启动或大幅提速时),积分会产生较大的超调,使系统振荡。所以采用积分分离法,一开始就取消积分效果,直到调整后的数量相近才引入积分效果。具体步骤如下:

设置一个值a0,E(m)-R(m)-M(m),其中R(m)为给定值,M(m)为测量值;

当E(m)a时,PD控制可以避免过冲过大,使系统具有更快的响应;

当E(m)n,即偏差E(m)比较小时,PID控制可以保证系统的精度。

采用积分分离方法后,被控变量的超调量明显减小,过渡时间缩短,调节性能提高。

3驱动设计

yle="text-indent: 2em;">本系统的驱动设计如图2、图3、图4所示。

设备驱动程序是操作系统内核与机器硬件之间的接口。它作为应用和实际设备之间的软件层,为应用程序屏蔽了硬件的细节。对于应用程序,硬件设备只是一个设备文件,应用程序可以像操作普通文件一样对硬件设备进行操作。把数据从内核传送到硬件和从硬件读取数据,读取应用程序传送给设备文件的数据和回送应用程序请求的数据,检测和处理设备出现的错误。用到的结构如下:

设备打开的时候就会调用dcmotor__open函数进行申请中断号。带内存管理的单元的地址映射,设置B端口的2、3引脚为PWM输出,端口D配置为电机使能刹车制动引脚。

以下所有的函数都是在ioctl()中实现的。在Dcmo-tor_Start里调用timer0_2_3_start(),设置timer0为接收两路电机的码盘信号,并检测电机速度;timer2、timer3提供2路PWM输出,并设置定时器自动重载。具体实现如下:

Select_Speed可以动态选择要运行的速度。它是用户的接口,用户可以调用该函数把速度值传到驱动从而控制电机。例如,在应用程序中执行ioctl(fdl,

timer0中断是核心程序,它可根据PID的调节值来改变占空比。为了便于随时改变占空比的值可定义两个全局变量tmp2、tmp3,通过把它们的值写入TCMPB来改变占空比。

在All_Forward、All_Back、All_Stop中,通过设置端口DO~3的高低电平,实现前进、后退、停止;在Left_Curve、Right_Curve中,设置左右轮的旋转方向,使两轮旋转方向不同,再根据差速在应用程序中给定预定时间,以达到转弯效果。

4 结 论

利用ARM和Linux操作系统实现智能机器人的闭环控制是可行的,闭环控制是控制论的一个基本概念。指作为被控的输出以一定方式返回到作为控制的输入端,并对输入端施加控制影响的一种控制关系。在控制论中,闭环通常指输出端通过"旁链"方式回馈到输入,所谓闭环控制。输出端回馈到输入端并参与对输出端再控制,这才是闭环控制的目的,这种目的是通过反馈来实现的。而且可以充分利用ARM的强大功能实现其他智能模块的扩展。

引 言

现有智能机器人用直流电机作为驱动轮时一般都是用单片机或者高速的DSP等进行控制,智能机器人之所以叫智能机器人,这是因为它有相当发达的“大脑”。在脑中起作用的是中央计算机,这种计算机跟操作它的人有直接的联系。最主要的是,这样的计算机可以进行按目的安排的动作。正因为这样,我们才说这种机器人才是真正的机器人,尽管它们的外表可能有所不同。而且同一机器人往往需用多个CPU来实现各自的功能,但随着对机器人的智能化要求越来越高,需要一种新的控制器(使用一个处理器)来满足机器人的各种行为要求,例如视频采集、无线通信。本文介绍的利用ARM实现的智能机器人平台,为智能机器人的开发提供了一个新方法。Linux的引入使其他智能模块都以设备的形式存在,只有在用户需要的时候才调用相关设备驱动从而使数据融合更方便,运行多任务也更稳定。

利用ARM和嵌人式Linux作为智能机器人平台具有很大的优势,但在国内还未发现用该平台开发智能机器人的系统。本设计完成了对该系统驱动的初步编写,并通过实际验证,取得了良好效果。

1 驱动电路及测速方法

1.1 总体结构及驱动电路

系统的整体结构框图如图l所示。

本设计采用的LMD18200的真值表如表1所列。通过ARM的I/0口(例如D口的DO~3)来控制电机的工作状态。

1.2 测速方法

ARM没有捕获外部脉冲的计数器,它的定时器是用来计算内部脉冲的。码盘输出信号接外部中断处理程序(EINTl)并设置上沿触发变量,在中断中设置一全局变量i,用i++累加。设置定时器timer0,使它O.36 s产生1次内部定时器中断。当一个定时器周期完成时引发定时器中断,在timer0中断中读出i的值,即得到O.36 s内码盘转动所产生的脉冲数;接着将i清零,为下一个定时器周期捕获脉冲作准备。

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调节,PID调节是工业控制中应用最广泛的一种调节方式,在各种自控书籍及资料中,也经常看到PID这个字眼,那么什么是PID调节呢,PID是英文单词比例(Proportion),积分(Integral),微分(Differential coefficient)的缩写。PID调节实际上是由比例、积分、微分三种调节方式组成,它们各自的作用如下:比例调节作用:是按比例反应系统的偏差,系统一旦出现了偏差,比例调节立即产生调节作用用以减少偏差。比例作用大,可以加快调节,减少误差,但是过大的比例,使系统的稳定性下降,甚至造成系统的不稳定。当偏差E较大时(如启动或大幅度提速时),由于积分的作用会产生很大的超调量,使系统振荡,因此选用积分分离的方法,开始时取消积分作用,直到被调量相差不多时才引入积分作用。具体步骤如下:

①设定一个值a>0,E(m)一R(m)一M(m),其中R(m)为给定值,M(m)为测量值;

②当E(m)≥a时,采用PD控制,可以避免过大的超调,又可以使系统有较快的响应;

③当E(m)≤n,即偏差值E(m)比较小时,采用PID控制,可以保证系统的精度。

使用积分分离方法后显着降低了被控变量的超调量并缩短了过渡时间,使调节性能得到改善。

3 驱动设计

本系统的驱动设计如图2、图3、图4所示。

设备驱动程序是操作系统内核与机器硬件之间的接口。它作为应用和实际设备之间的软件层,为应用程序屏蔽了硬件的细节。对于应用程序,硬件设备只是一个设备文件,应用程序可以像操作普通文件一样对硬件设备进行操作。把数据从内核传送到硬件和从硬件读取数据,读取应用程序传送给设备文件的数据和回送应用程序请求的数据,检测和处理设备出现的错误。用到的结构如下:

设备打开的时候就会调用dcmotor__open函数进行申请中断号。带内存管理的单元的地址映射,设置B端口的2、3引脚为PWM输出,端口D配置为电机使能刹车制动引脚。

以下所有的函数都是在ioctl()中实现的。在Dcmo-tor_Start里调用timer0_2_3_start(),设置timer0为接收两路电机的码盘信号,并检测电机速度;timer2、timer3提供2路PWM输出,并设置定时器自动重载。具体实现如下:

Select_Speed可以动态选择要运行的速度。它是用户的接口,用户可以调用该函数把速度值传到驱动从而控制电机。例如,在应用程序中执行ioctl(fdl,

timer0中断是核心程序,它可根据PID的调节值来改变占空比。为了便于随时改变占空比的值可定义两个全局变量tmp2、tmp3,通过把它们的值写入TCMPB来改变占空比。

在All_Forward、All_Back、All_Stop中,通过设置端口DO~3的高低电平,实现前进、后退、停止;在Left_Curve、Right_Curve中,设置左右轮的旋转方向,使两轮旋转方向不同,再根据差速在应用程序中给定预定时间,以达到转弯效果。

4 结 论

利用ARM和Linux操作系统实现智能机器人的闭环控制是可行的,闭环控制是控制论的一个基本概念。指作为被控的输出以一定方式返回到作为控制的输入端,并对输入端施加控制影响的一种控制关系。在控制论中,闭环通常指输出端通过"旁链"方式回馈到输入,所谓闭环控制。输出端回馈到输入端并参与对输出端再控制,这才是闭环控制的目的,这种目的是通过反馈来实现的。而且可以充分利用ARM的强大功能实现其他智能模块的扩展。

.dfma { position: relative; width: 1000px; margin: 0 auto; } .dfma a::after { position: absolute; left: 0; bottom: 0; width: 30px; line-height: 1.4; text-align: center; background-color: rgba(0, 0, 0, .5); color: #fff; font-size: 12px; content:"广告"; } .dfma img { display: block; }
郑重声明:本文版权归原作者所有,转载文章仅为传播更多信息之目的,如作者信息标记有误,请第一时间联系我们修改或删除,多谢。