基于RTThread嵌入式实时系统的三路步进电机控制系统设计.docx

《基于RTThread嵌入式实时系统的三路步进电机控制系统设计.docx》由会员分享，可在线阅读，更多相关《基于RTThread嵌入式实时系统的三路步进电机控制系统设计.docx（10页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、基于RTThread嵌入式实时系统的三路步进电机控制系统设计基于RTThread嵌入式实时系统的三路步进电机控制系统设计网络导语：本文设计实现了一种三路步进电机控制系统，它基于RTThread嵌入式实时系统，进步了系统的实时性和后期的功能扩展才能。摘要:本文设计实现了一种三路步进控制系统，它基于RTThread，进步了系统的实时性和后期的功能扩展才能。系统控制电路采用STM32F4系列的微控制器，结合小功率步进电机驱动器A4988，完成了硬件电路板设计。软件中运用操作系统自带的finsh机制，实现对指令的初步解析，控制系统可以通过读取G指令,控制多路电机按照一定轨迹运动，同时可以调节电机运动的

2、加减速参数。实际工程验证证明该系统具有很好的稳定性。引言随着计算机技术和微电子技术的开展，步进电机作为自动化控制的执行单元，越来越多地运用在各种领域中，许多控制领域需要对多台步进电机进展同步协调控制,如军事、航空、机器人控制。十分是近年度来，随着嵌入式技术和集成化的开展，其应用范围逐步扩大，逐渐扩展到普通民用行业，如小型雕刻机、3D打印等。步进电机作为一种将电脉冲信号转换成相应的角位移或者线位移的机电元件，其最大的优点是易于开环控制、无积累误差。在应用中，对速度、位置的精度控制尤为重要，所以对于电机的控制要具有实时性1。传统上，单片机控制合适比拟简单的电机控制系统，对于复杂的系统，假设电机控制

3、只为其中的一个模块，既要求电机控制模块内部协调运动，又要求与其他模块保持同步，构造复杂，实现难度大。随着单片机本身性能的增强，在嵌入式系统的根底上，完成对多电机的实时协调控制具有很多优点。嵌入式系统的实时性特点可以使其胜任对多电机的协调控制；可裁减性特点可以使得系统容易扩展其他模块；可以支持多任务，使得程序开发更加容易，便于维护，同时可以进步系统的稳定性和可靠性2。本研究基于嵌入式实时系统设计出一套多步进电机控制系统，此系统基于嵌入式技术协同控制三路步进电机，以对多轴系统的速度、位置到达准确控制，并且可以实时调节电机的运动速度。本设计的重点为软件方面对电机的协同控制，使得系统对电机的定位精度到

4、达预期的目的。系统本身很容易地根据不同功能需求扩展出各种功能，具有一定实用价值。硬件电路设计1.1总体设计主控芯片采用内置的UART串口与上位机通信，接收上位机发送的控制指令，并向上位机发送系统当前状态。通过SPI接口读取SD卡中的Gcode文件，主控芯片逐行解析文件中的G指令，根据G指令中位置偏移和速度，最终得到驱动电机的脉冲，进而控制3路步进电机按照推荐速度准确到达目的位置。3路限位开关可以反应电机的位置信息，主要用于初始化步进电机系统，进而规定电机系统内部坐标系。本设计电路中主控制器采用ST公司的STM32F4系列微控制器，电机驱动芯片采用A4988，作为执行机构的步进电机使用两相四线的

5、42步进电机。1.2主控芯片本系统电路中主控芯片采用基于ARM内核的STM32F40x微控制器，芯片内部含有1MBFlash和256KBRAM，完全可以运行小型的嵌入式系统。该微控制器还包括了大量的片上外设资源，非常合适控制类应用。1.3驱动模块本系统电路中电机驱动模块采用Allegro公司的A4988电机驱动器，该驱动器是一个完好的带有内置转换器的微电机驱动器，它可在全、半、1/4、1/8及1/16步进形式时操作双极步进电动机，具有高达35V和2A的输出驱动才能，且控制简单，只需在驱动器相应引脚输入一个脉冲即可驱动步进电动机产生一个微步，程序不必再考虑相序表等电机底层的控制。本设备采用1/1

6、6细分形式，MS1、MS2、MS3引脚需置高电平，主控制器只需控制电机驱动芯片上的ENABLE、DIR、STEP三个引脚即可完全控制此步进电机。ENABLE为步进电机控制器的使能端；DIR为电机的方向控制端，用于控制电机的转动方向；STEP为电机的步数控制端，输入脉冲来控制电机的步数和转速。软件系统设计2.1软件总体设计根据设计需要实现的目的，本文把系统分为不同的子功能，充分利用嵌入式系统多任务的优势，把各个子功能作为系统中不同的任务进程实现，包括：上位机指令解析任务、用户界面显示、记录监视进程、运动规划管理进程、电机驱动任务，各个任务通过嵌入式系统的信号量进展同步。为了保证步进电机系统的实时

7、性，其中电机驱动进程为核心进程，设定其任务优先级最高，除中断外，没有任何进程可以抢占它的CPU控制权。系统设计有用户互交界面，终端选用串口工控彩屏，控制简单，作为系统脱离上位机时的控制方式。本文将主要介绍软件设计电机运动规划和底层驱动的实现：从串口或者SD卡读取运动指令，转换为实际的电机机构的挪动。使用finshshell机制从串口或者直接从SD卡读取指令，识别指令，随后存放入指令缓冲区；运动规划进程获得指令，把它们转化为Block块对象，其中包含了速度、方向、加速度等信息，并参加Planner中的环形缓冲队列中；无论什么时候Planner中存在Block块对象，电机驱动进程都将会启动，读取块

8、对象，并启动定时器中断。2.2嵌入式系统选择在实时嵌入式系统的选择上，本设计选用了RTThread嵌入式操作系统，它是一款类Linux系统，它是一款国内的开源全抢占的实时操作系统内核3。RTThread实时操作系统内核是一个高效的硬实时内核，它具备非常优异的实时性、稳定性、可裁减性，最小可以只有3KBROM和1KBRAM占用。其内核包提供了大局部的同步和通信机制，并且任务调度算法基于优先级的全抢占式线程调度，最多可支持256个线程优先级。此嵌入式系统支持从ARM7到CortexM3等多种类型内核的处理器。除了内核之外，此嵌入式系统还用于文件系统、TCP/IP协议栈、图形用户界面、用户shell

9、组件，本设计中就运用了系统的shell组件来简化命令解析功能。上位机指令解析任务依靠嵌入式系统中的finshshell机制，finshshell是RTThread内置的用户命令行组件，用户可以通过串口设备使用finshshell，它在系统中被设计为一个独立的进程，其进程默认优先级为8，进程试图从外部设备中获得用户的输入，然后对用户命令进展解析执行。依靠嵌入式系统提供的shell机制，可以轻易地自定义用户指令，通过如下宏定义实现：FINSH_FUNCTION_EXPORT_ALIAS。本文中实现一个Gcode_recevchar*movecmd函数，参数movecmd为一行或者多行G指令，函数的

10、构造流程，其中指令缓冲区为全局的自定义的构造体。构造体包含一个环形缓冲区和一个信号量，通过这个全局变量实现进程间的数据分享，并且用信号量防止缓冲区数据的竞争。通过宏定义“FINSH_FUNCTION_EXPORT_ALIAS(Gcode_recev,G,Gcode_recev(“),我们可以通过串口终端以G(“cmd)的形式执行运动指令，到达调试的目的。除此之外，系统还实现了关启电机、去除运动缓冲、查看参数等函数功能。2.3运动规划管理系统的实际使用状态通常为一端不断读取运动指令，另一端不断驱动多路步进电机挪动。两端中间存在一个构造体队列来缓冲两端执行速度的差异。系统通过串口或者SD卡可以识别

11、的运动指令(通常为G指令)，指令中包含了电机挪动的目的坐标和速度参数。读取一行运动指令后，系统结合全局信息对指令进展解析，为了防止电机启动时，启动速度过快造成失步，或者电机停顿时速度过快而不能准确定位，步进电机的运动方式采用梯形运动方式。在程序中，设计了Planner_t构造体。stage1局部为一个环形缓冲区，缓冲区大小可以根据实际使用情况定义。代码如下：typedefstruct/stage1stepBlock_tstepBlockBUFFER_SIZE;int32_thead,tail,len;/stage2VPlanner_t;而stepBlock_t构造体中包含了各步进电机运动的方向

12、、步数、主步数即各电机运动步数的最大值、加速前步数、减速前步数、速度等信息，用于底层的电机驱动函数代码如下：typedefstruct/stage1int32_tsteps3;booldirSTEPPER_NUM;int32_tsteps_event_count;/stage2int32_taccelerate_until;int32_tdecelerate_after;floatacceleration;stepBlock_t;2.4电机驱动以上只是对步进电机运动的规划，并没有涉及到底层的电机驱动，实际的电机驱动一般采用两种方式：定时器PWM脉冲或者定时器中断4。本文中采用定时器中断函数在操

13、作系统下层直接驱动步进电机，只需在中断函数中向某个电机驱动器CLK引脚发送一个脉冲，即可驱动电机一微步。在系统中的多个用户任务进程中，电机驱动进程是最重要的，它实际上完成了对步进电机最底层的控制，为了保证当前运动指令下电机运行的流畅，此进程对时间要求非常敏感，它在系统中决定了电机运动速度的上限。进程流程图如图5所示,此进程用一个不断循环的函数实现，对应于规划管理进程不断向Planner构造体中填充块数据，电机驱动进程那么不断从Planner中取出块数据，根据Block块中的参数启动Timer定时器，首次设置定时器参数，最终在定时器中断效劳函数中驱动电机运动。STM32F40x系列微控制器用于多

14、个定时器资源，并且其时钟频率最高可到达84MHz。本系统中，电机的最大转速为1500PRM，驱动器取16细分时，假设要到达此速度，需要定时器频率约为72kHz，考虑到系统多任务的复杂性，也完全可以知足需要。定时器中断在系统中的应用仅保证两个微步间隔时间的准确性，为了保证嵌入式系统的实时性，定时器的中断效劳函数执行时间应尽量缩短5，因此在中断效劳函数中只做两件必要的任务：给步进电机脉冲和更新定时器。结语本文在RTThread的嵌入式实时系统的根底上实现了对多路步进电机的控制，基于嵌入式系统，系统功能按模块设计实现，大大减小了设计的整体难度，并且有利于系统后期的功能扩展,以较低的本钱实现多路步进电机的控制。基于此设计的3D打印机工程已经在使用，且系统运行稳定。