DIY编程器网

标题: 基于STM32F107的搬运机器人电机控制系统设计 [打印本页]

作者: admin 时间: 2015-5-1 19:07
标题: 基于STM32F107的搬运机器人电机控制系统设计
　　摘要: 针对搬运机器人的前轮转向舵机和后轮驱动电机的控制要求，采用以Cortex-M3为内核的STM32F107作为主控制器，采用嵌入实时操作系统μC/OSII，将程序分成启动任务、电机转速控制任务、舵机控制任务等相对独立的多个任务,并设定了各任务的优先级。该系统能较好地实现搬运机器人的运动控制。
　　关键词: 搬运机器人；STM32F107；运动控制；μC/OS-II；任务调度

　　Electrical Engineering and Automatization College, Tianjin Polytechnic University, Tianjin 3000000, China
Abstract： With the problem of transfer robot front wheel steering engine and rear wheel driver engine control, the design takes STM32F107 as the kernel based on Cortex-M3 and embedded realtime operating system μC/OSII. It divides the program into initiating task, motors speed control task, steering engine control task and other relatively independent tasks, setting the priority of each task. The system can achieve motion control for transfer robot.
　　Key words: transfer robot; STM32F107; motion control; μC/OS-II; task scheduling
　　引言
　　随着人工成本的不断升高，用机器人代替人力去做一些重复性的高强度的劳动是现代机器人研究的一个重要方向。搬运机器人在导航寻迹中，需要后轮驱动电机和前轮舵机的协调工作。搬运机器人电机驱动有其特殊的应用要求，对电机的动态性能要求较高，能在任意时刻到达控制需要的指定位置并且使舵机停止在任意角度；电机驱动的转矩变化范围大，既有空载平整路面行使的高速度、低转矩工作环境，也有满负载爬坡的运行工况，同时还要求保持较高的运行效率[1]。根据以上的技术要求，本文选用了控制技术成熟，易于平滑调速的直流电机作为搬运机器人的执行机构。
1　系统的硬件设计
1.1　机器人电机控制器硬件结构
　　主控制器采用Cortex-M3内核的STM32F107。控制器内部共有8个定时器，其中TIM1_CH1和TIM8_CH1为高级控制定时器引脚，TIM1_CH1用于电机编码器计数。TIM8_CH1用于舵机控制基准时间。通用定时器引脚TIM2_CH1、TIM3_CH1、TIM4_CH1、TIM5_CH1分别用于电机和舵机驱动电路上下桥壁PWM的产生。触发EXIT0中断的PA0口和PB0口分别用于电机和舵机的过流中断保护。触发EXIT1中断的PA1口和PB1口用于舵机两侧限位保护。电机驱动电路采用自举升压芯片IR2103和MOSFET管75N75，后轮电机和舵机的相电流采集是通过康铜丝转换成电压，通过放大滤波处理，分别送至STM32F107的A/D采样引脚ADC12_IN1实现过电流保护。通过上位机串口通信或STM32F107内部程序速度给定，控制电机的正反转、速度及舵机的转向。搬运机器人电机控制硬件结构框图如图1所示。

图1　搬运机器人电机控制硬件结构框图
1.2　模块的选择与设计
1.2.1　功率驱动的设计
　　电机的供电电源是由24 V的蓄电池提供，额定功率为240 W，由4个75N75组成桥式电路来实现。75N75是MOSFET功率管，其最高耐压75 V，最高耐流75 A，电机驱动电路如图2所示。

图2　电机驱动电路
　　Q1、Q4和Q2、Q3分别组成两个桥路，分别控制电机的正转和反转。高端驱动的MOS管导通时源极电压和漏极电压相同且都等于供电电压VCC，所以要实现MOS管正常的驱动，栅极电压要比VCC大，这就需要专门的升压芯片IR2103。控制器产生的PWM信号输入HIN引脚，控制器I/O口输出的EN1、EN2作为使能信号。输出端HO就可得到比VCC要高的电压，且高出的电压值正好是充在电容两端的电压。二极管提高导通速度，使得75N75的导通电阻更小，降低了开关管的损失。同时IR2103的两个输出口HO、LO具有互锁功能，防止由于软件或硬件错误造成的电机上下桥臂直通造成短路。
1.2.2　过流保护的设计
　　在电机控制系统中安装过流保护有两方面的意义：一是防止在电机正常运行时，电机出现超载或堵转而使得电枢绕组电流过大损害电机甚至引发火灾；另一方面是由于电机启动时启动电流很大，往往不能直接启动，既需要等励磁绕组逐渐建立磁场后再正常运行，又希望电机以尽量快的速度启动起来。有了过流保护对电流进行斩波，可以使电机安全快速地启动。过流保护原理图如图3所示。
　　电机的相电流通过康铜丝转换成电压信号Vtext，经过运算放大器放大后的模拟量AD1送至控制器A/D转换模块，同时将经过电压比较器比较后的数字量EVA送至控制器的外部中断口。
2　系统的软件设计
2.1　μC/OSII的体系结构
　　μC/OSII是一种可移植的、可植入ROM的、可裁剪的、抢占式的实时多任务操作系统内核，具有执行效率高、占用空间小、实时性能优良和可扩展性强等特点，最小内核可编译至2 KB。μC/OSII是用C语言和汇编语言编写的，其中绝大部分代码都是用C语言编写的，只有极少部分与处理器密切相关的代码是用汇编语言编写。μC/OSII仅仅包含了任务调度、任务管理、时间管理、内存管理、任务间的通信和同步等基本功能[2]。
2.2　μC/OSII系统下任务的分配
　　成功地将μC/OSII系统移植到STM32F107后，基于μC/OSII的程序设计是将一个大的应用程序分成相对独立的多个任务来完成。定义好每个任务的优先级，μC/OSII内核对这些任务进行调度和管理。
　　软件设计思路是根据机器人实际运行的需要由上位机通过串口对电机转速和舵机转动位置进行给定。电机的转速是由设定的速度值和由增量式编码器的采集值相比较，经过速度PID算法实现闭环控制。舵机的位置主要是由绝对值式编码器反馈现在位置，根据动作时间要求调节舵机转动的速度。本搬运机器人电机控制系统软件要实现的功能如下：

图3　过流保护原理图
◆ 上位机给定电机转速、舵机转动角度和动作时间；
◆ 要求电机转速连续可调并且具有良好的静、动态性能，转速设计采用PI算法调节；
◆ 要求舵机快速到达指定角度，有位置反馈作为舵机给定转速的调整；
◆ 具有一定的故障保护功能。当电机出现堵转、电流过大以及舵机触动限位开关时，要求停止驱动模块工作。
　　针对以上要实现的功能，可以将应用程序设计分为以下几个任务：
① 启动任务。对系统进行初始化，创建初始电机状态，然后自我删除，启动任务进入睡眠状态。
② 电机和舵机保护任务。用于在过流或限位开关动作时响应外部中断，进入中断状态通过发任务信号量，任务程序检测信号量有效并响应该任务，停止输出。任务优先级设为0级。
③ 上位机给定任务。用于上位机控制电机和舵机，任务优先级设为1级。上位机数据输入寄存器时将产生一个中断，该中断将收到的字节送入缓冲区并释放上位机给定任务的信号量；任务中检测到信号量有效便开始执行，将对应的字节信息解析成对应的电机转速和舵机转角位置信息给相应变量赋值。
④ 电机转速控制任务。用于电机的闭环调速，任务优先级设为2级。
⑤ 舵机控制任务。用于控制舵机在规定时间内到达指定位置，任务优先级设为3级。
2.3　启动任务
　　主程序中，在调用μC/OSII的其他任务之前，首先调用系统初始化函数OSInit()，初始化μC/OSII所有的变量和数据结构；同时，建立空闲任务OS_TaskIdle()，这个任务总是处于就绪态；调用OSTaskCreate()函数建立启动任务；调用OSStart()，将控制权交给μC/OSII内核，开始运行多任务。
　　启动任务是在主程序中创建的，它主要有3个功能：
① 用于系统初始化(PWM输出模块、串口、ADC模块、输入电平中断功能、定时器)。
② 建立系统所要用到的信号量。
③ 建立系统的其他任务。
　　最后调用OSTaskDel(OS_PRIO_SELF)进行自我删除，启动任务进入睡眠状态。主程序任务流程如图4所示。

图4　主程序任务流程
2.4　电机转速控制任务
　　增量式编码器每次产生外部中断，在中断状态中发出任务信号量，任务程序检测信号量有效并响应该任务，任务中通过测得电机当前转速和给定速度对比实现闭环控制。电机转速控制任务流程如图5所示。

图5　电机转速控制任务流程
2.5　舵机控制任务
　　舵机控制由一个定时器产生基准时间，每隔固定时间发送信号量，任务都将执行一次。舵机控制任务将对绝对值编码器测出的位置和给定的位置进行比较，根据剩余时间调整舵机的转速。舵机控制任务流程如图6所示。

图6　舵机控制任务流程
3　系统机电接口
　　机器人的舵机由直流电机外连一个30:1的减速机组成。绝对式位置编码器同舵机相连，将舵机的角度信号送到驱动器控制板中。机器人前轮的两个轴由传动杆相连，其中一个轴由传动带与舵机相连，这样在舵机转动时，传动带带动传动杆，保证两个前轮能够同步转动。后轮驱动电机为直流电机，直接与增量式编码器相连，经减速比为25:1减速机减速后，经机械差速器驱动后轮转动。增量式编码器的信号同样送到驱动器控制板中。机电系统结构如图7所示。

图7　机电系统结构
结语
　　本文实现了搬运机器人的电机和舵机控制器硬件的设计，成功地在STM32F107上嵌入了实时操作系统μC/OSII，完成了电机和舵机的转速闭环实验。利用Cortex-M3内核控制器和μC/OSII系统多任务实时性的特点，为后续的机器人图像视频采集和导航寻迹提供了软硬件基础。如果对现有PI算法进行改进，并且能够实现电机速度和电流双闭环控制，则机器人电机的特性将会更好，搬运机器人的应用前景将更加广阔。
参考文献
[1] 张雷. 基于同步续流的电动叉车直流电机控制系统研究[D].哈尔滨:哈尔滨理工大学,2010.
[2] 陈是知. μC/OSII内核分析、移植与驱动程序开发[M].北京：人民邮电出版社，2007.

作者: qpw10023 时间: 2015-6-12 23:03
我爱你！很重要材料。

作者: wjl882008 时间: 2015-12-7 12:03
这个很不错

作者: 益升ic 时间: 2016-3-10 23:54
学习了好好学习

作者: lance_ma 时间: 2017-3-23 12:36

作者: 李小路 时间: 2020-10-1 11:27
谢谢分享！

欢迎光临 DIY编程器网 (http://diybcq.com/)