一种基于ARM和CPLD的智能轮式移动机器人控制系统
eeskill 2021-10-20

引言

智能移动机器人集成了机械、电子、计算机、自动控制、人工智能等多学科的研究成果,在当前机器人研究领域具有突出地位。控制系统是机器人的核心部分,目前应用在机器人底层控制系统的微控制器主要有8/16位单片机和数字信号处理器(DSP)两种类型。但使用8/16位单片机处理数据能力低,且硬件电路庞大,系统稳定性弱,DSP的设计初衷是为了数字信号处理,相比而言,嵌入式微处理器ARM具有几乎相同的内部资源和运算速度,但在控制方面性能优于DSP,而且许多ARM器件支持TCP/IP协议,有利于将来机器人的网络控制。综合考虑以上因素,这里提出了一种基于ARM和复杂可编程逻辑器件(CPLD)的智能轮式移动机器人控制系统,实现移动机器人的底层控制。

2系统组成及工作原理

该系统设计的轮式移动机器人机械导航结构采用四轮差速转向式的机械机构,前面两个轮是随动轮,起支撑作用,后面两个轮是驱动轮,由两台同步电机驱动,分别控制两个驱动轮的转速,可使机器人按照不同方向和速度移动,运动灵活,可控性好。

移动机器人以PC机作为上位机,利用摄像头对机器人的自身位置和外部环境进行分析,建立环境地图,进行路径规划。上位机发送运动控制指令给移动机器人的底层控制系统,提供左右驱动电机的理论速度值。以ARM和CPLD为核心的机器人控制系统与上位机通过无线收发模块实现通讯,根据上位机的命令控制电机的运行和超声渡传感器组的发送与接收;并根据障碍物信息,做出避障决策。智能移动机器人的控制系统结构框图如图1所示。

3控制系统硬件设计

3.1主控模块设计

该智能轮式移动机器人控制系统的核心控制器采用Samsung公司的S3C44B0X,它是基于ARM7TDMI核(适用于实时环境)的32位微处理器,具有高速运算能力、A/D转换器、丰富的I/O端口和中断,有利于实现移动机器人的电机控制、传感器信息处理、外部通讯以及复杂的控制算法。系统采用CPLD作为协处理器,提供可编程脉冲产生电路、光电编码器输入电路、超声波传感器输入电路,这里选择ALTERA公司的MAXⅡ系列EPM1270器件。该系统设计充分利用了CPLD的高速逻辑处理能力,主控制器ARM只需设定控制参数,这样就减轻主控制器的负担,提高系统的实时性,同时也减少了外围硬件电路,提高控制系统的稳定性和可重构性。

ARM与CPLD通过并行总线连接,该并行总线包括ARM器件的地址、数据、控制和多路可编程I/O总线。ARM通过访问特定地址和I/O端口来控制CPLD,CPLD则通过可编程I/O端口向ARM发送中断请求。

3.2电机控制和驱动模块的设计

轮式移动机器人的两个驱动轮速度分别由两台驱动电机控制,实现机器人不同方向和速度的运动。轮式移动机器人的性能要求电机转矩大,脉动小。在高、中、低速下驱动电机均有良好的性能,且控制方式简单,因此驱动电机选用方波驱动的交流永磁同步电机。这种电机根据转子位置反馈信息采用电子换相运行,电机转速与驱动信号的频率成正比,既具备交流电机结构简单,运行可靠,维护方便等优点,又具有直流电机动态特性好,调速性能优良的优点。

系统通过CPLD和外部驱动器件构成控制电路,采用方波驱动和定位控制(通电状态控制)的方式,控制两台永磁同步电机,获得可调的精确速度和位置控制,结构紧凑。两路电机控制原理相同,这里只介绍一路。

CPLD中的电机控制电路由分频电路、调速电路、相序分配电路组成。其中,分频电路由分频器构成;调速电路是利用MAX+PLUSⅡ的LPM宏单元库的算术运算模块lpm_counter构成可预置数的5位减计数器。根据所需的速度,设置预置数,计数器对分频电路输山的clk脉冲信号减计数至零时输出一个借位脉冲,并再次装入预置数进行减计数,将其借位脉冲cout作为调速电路的输出脉冲,cout借位脉冲的频率范围为fclk/1-fclk/31,即引入了步长为1的调速因子(预置数)。可通过改变调速因子对脉冲信号进行1~31倍的连续可调分频,从而调节电机的转速;而相序分配电路是以cout借位脉冲作为输入,利用两个D触发器和门电路输出4路相位相差90°的方波脉冲,作为两相同步电机的控制信号;stop信号控制电机的启停;dir信号控制电机的转向,正转时相电压uCD超前uAB 90°,反转时uAB超前uCD90°,各相信号的频率为cout脉冲频率的1/4。CPLD中输入的调速和相序分配电路原理见图2。仿真结果验证了设计逻辑的正确性,如图3所示。

外部驱动器采用L298双H桥高电压大电流功率集成电路,将脉冲发牛电路产生的4相方波信号经总线收发器74LS245输出至L298的输入端IN1~IN4,控制H桥的通断,使电机正反转或停止。为防止电机在启停瞬间的反馈电压损坏L298,在L298输出端和电机之间加人8个二极管起断电续流的保护作用。

为了改善电机的控制性能,实现对机器人更精确和稳定的运动控制,需要获得电机的速度信息作为电机控制的反馈环节,该系统采用增量式光电编码器作速度检测,两个光电编码器分别与两路电机同轴相连,由CPLD配合ARM器件实现变脉冲数/脉冲周期测速,即变M/T测速,定时对电机速度进行采样。采样速度和上位机的给定速度所得差值传人PID控制器。从而实现对电机速度的闭环控制。

3.3超声传感模块

避障是智能移动机器人的基本功能,避障的首要任务是确定障碍物位置。PC机基于机器人视觉系统实现的路径规划易受视场光线强弱、背景色等因素干扰,针对这一问题,机器人在单片机控制系统中采用超声传感器测距实现机器人对障碍物的检测和定位。

超声波测距采用时间渡越测距法,即根据从超声波发生器发射出超声波到超声波在传播过程中遇到障碍物后超声波接收器接收到反射波所用时间t,以及超声波在空气中的传播速度v(v=331.4(1+T/273)1/2m/s;T为摄氏温度),得出机器人与障碍物之间的距离l=vt/2。该模块共采用3对超声换能器,分布于机器人的正前方、左前方、右前方。ARM发出控制信号启动内部定时器进行定时。控制信号经功率放大后作为超声传感驱动电路的启动信号,由超声传感器产生遇到障碍物时返回的高频振荡信号放大后通过接收电路引起ARM外部中断,在中断程序中可以获得定时器的计数值,并计算出距离。超声传感模块框图见。

4控制系统软件设计

4.1嵌入式操作系统

智能轮式移动机器人是一个典型的实时多任务系统,传统单任务顺序执行机制不能满足该系统设计的实时性要求,而且对于复杂系统来说可靠性不高,因此选用实时操作系统μC/OS-Ⅱ。它是一个源码公开,可移植,可固化,可裁剪的嵌入式操作系统,具有代码尺寸小,可占用实时内核,任务多,可确定执行时间,运行稳定可靠等特点。将μC/OS-Ⅱ移植到S3C44B0X上,并对操作系统进行裁剪,以节省存储空间。

基于实时内核的多任务系统可划分为系统层和应用层。系统层由内核和驱动程序库组成;应用层包括用于达成机器人任务目标的全部代码。在该系统软件应用层程序设计中,将机器人的任务分解成通信、信息采集、电机控制等多个用户任务。嵌入式操作系统μC/OS-Ⅱ对任务模块进行管理调度,协调机器人各项任务运行,保证了系统的实时性和可靠性。

4.2运动控制算法

为了保证移动机器人运动的稳定性和准确性,使得系统在控制机器人前进、后退、转弯、刹车等动作时都能快速响应且超调量小,在控制电机的过程中,系统采用了积分分离的PID控制算法。算法的具体实现方法如下:

5 结语

提出了一种基于ARM和CPLD的智能轮式移动机器人控制系统,这一方案充分利用ARM和CPLD的内部资源,既具有ARM微控制器体积小,运算速度快等特点,又具有CPLD的高速逻辑处理能力,灵活的可扩展性和可重构性。软硬件的调试和运行实验证明,系统控制灵活,实时性好,可靠性高,能够满足智能轮式移动机器人的控制需求。这种智能轮式移动机器人的控制系统可用于不同场合的移动机器人控制系统,并具有一定的普遍适用性,且性价比高,具有很强的实用价值。

声明: 本文转载自其它媒体或授权刊载,目的在于信息传递,并不代表本站赞同其观点和对其真实性负责,如有新闻稿件和图片作品的内容、版权以及其它问题的,请联系我们及时删除。(联系我们,邮箱:evan.li@aspencore.com )
0
评论
热门推荐
  • 相关技术文库
  • 单片机
  • 嵌入式
  • MCU
  • STM
  • ARM Cortex系列处理器知识点汇总

    最近因为要为芯片选定核,所以就在了解哪些核合适且性价比好,这是一个需要结合产品各类技术、市场分析的活,看似简单却还是需要一些储备的,今天选了一篇ARM Cortex系列的科普文章与大家分享。 众所周知,英国的ARM公司是嵌入式微处理器世界当中的佼佼者。AR

    05-11
  • 你的CPU属于哈佛结构还是冯诺依曼结构?

    现代的CPU基本上归为冯诺伊曼结构(也称普林斯顿结构)和哈佛结构。 冯洛伊曼结构就是我们所说的X86架构,而哈佛结构就是ARM架构。一个广泛用于桌面端(台式/笔记本/服务器/工作站等),一个雄踞移动领域,我们的手持设备(平板\手机用的大多就是他了)。 01

    05-10
  • 如何批量修改MCU封装管脚定义

    在做产品开发时,为了缩短研发周期,我们一般都是直接找来参考设计做参考。这些参考资料要么是来自原厂的,要么是来自方案商的。  接触过这么多的参考设计资料,发现大部分的资料都有一个通病,就是不少MCU的PIN脚定义都只是标出IO口的定义,其它复用​​​​功能

    05-08
  • MCU为什么要消抖动

    简单的说,进入了电子,不管是学纯模拟,还是学单片机,DSP、ARM等处理器,或者是我们的FPGA,一般没有不用到按键的地方。按键:人机交互控制,主要用于对系统的控制,信号的释放等。因此在这里,FPGA上应用的按键消抖动,也不得不讲! 一、为什么要消抖动 在

    05-07
  • 51单片机的ISP下载知识

    本文详细介绍了串口、51单片机的ISP下载等基础知识,已经学过单片机的也可以看看,加强一下对这方面的了解。 串口 串行接口简称串口,也称串行通信接口,是采用串行通信方式的扩展接口。 我们比较熟悉的USB接口,全名通用串行总线(Universal Serial BUS),就

    05-06
  • 硬件开发如何选择合适的MCU

    点击上方关注我们! 我在做硬件开发时,如果遇到的是一个新产品,新项目,之前没有做过的,没有任何的经验,在选MCU时,我一般是这样操作的。 首先,根据产品的需求,整理出一份硬件规格。比如,电源管理,传感器接口,人机交互接口等。 然后,整理出整个原理

    05-06
  • 单片机的功耗怎么算的?

    单片机的功耗是非常难算的,而且在高温下,单片机的功耗还是一个特别重要的参数。暂且把单片机的功耗按照下面的划分。 暂且把单片机的功耗按照下面的划分。 1.内部功耗(与频率有关) 2.数字输入输出口功耗 2.1输入口 2.2输出高 2.3输出低 3.模拟输入口功耗从

    05-07
  • 嵌入式工程师必备工具:I2C和SPI总线协议

    IIC vs SPI 现今,在低端数字通信应用领域,我们随处可见IIC (Inter-Integrated Circuit) 和 SPI (Serial Peripheral Interface)的身影。原因是这两种通信协议非常适合近距离低速芯片间通信。Philips(for IIC)和Motorola(for SPI) 出于不同背景和市场需求

    04-30
  • 嵌入式面试注意事项

    找工作也是一门技能,有的人很快就找到自己喜欢的工作,有的人找了很久也没找到合适的工作。 下面给大家分享几点找工作过程中存在的“潜规则”内容。 1、面试的本质不是考试,而是告诉面试官你会做什么 经验不够的小伙伴特别容易犯的一个错误,不清楚面试官到

    04-29
  • 为什么需要RTOS?

    很多单片机初学者都是从裸机开始的,裸机确实也能开发出好的产品,但作为一个嵌入式软件工程师,如果只能用裸机开发产品,那肯定是不够的。 要从裸机的思维转变到RTOS的思维,其实需要一个过程,而且开始的一段时间会很痛苦。但过一段时间理解了一些内容,能

    04-28
  • 使用RTOS的8个理由

    嵌入式系统中,有很多方式实现任务调度。功能有限的小系统中,无限循环足够实现系统功能。当软件设计变得庞大且复杂时,设计师应该考虑使用实时操作系统。 下面给大家分享使用RTOS的8个理由: 1.硬实时响应 基于优先级抢占的RTOS,根据任务的实时需求,执行优

    04-26
  • 单片机延时程序,Keil C编译器实现

    应用单片机的时候,经常会遇到需要短时间延时的情况。需要的延时时间很短,一般都是几十到几百微妙(us)。有时候还需要很高的精度,比如用单片机驱动 DS18B20的时候,误差容许的范围在十几us以内,不然很容易出错。这种情况下,用计时器往往有点小题大做。而

    04-26
下载排行榜
更多
广告
X
广告