基于STM32F107的搬运机器人电机控制系统设计

用机器DEK印刷机夹边的价位人代替人力去做一MPM配件代理商些重复性的高强度的劳动是现代机器人研究的一个重要方向。搬运机器人在导航寻迹中，随着人工本钱的不时升高。需要后轮驱动电机和前轮舵机的协调工作。搬运机器人电机驱动有其特殊的应用要求，对电机的动态性能要求较高，能在任意时刻到达控制需要的指定位置并且使舵机停止在任意角度；电机驱动的转矩变化范围大，既有空载平整路面行使的高速度、低转矩工作环境，也有满负载爬坡的运行工况，同时还要求保持较高的运行效率。根据以上的技术要求，本文选用了控制技术幼稚，易于平滑调速的直流电机作为搬运机器人的执行饥构。1系统的硬件设计 1．1机器人电机控制器硬件结构 主控制器采用Cortex-M3内核的STM32F107控制器内部共有8个定时器，其中TIM1_CH1和TIM8_CH1为高级控制定时器引脚，TIM1_CH1用于电机编码器计数。TLM8_CH1用于舵机控制基准时间。通用定时器引脚TIM2CH1TIM3CH1TIM4_CH1TIM5_CH1分别用于电机和舵机驱动电路上下桥壁PWM发生。触发EXIT0中断的PA 0口和PB0口分别用于电机和舵机的过流中断保护。触发EXIT1中断的PA 1口和PB1口用于舵机两侧限位保护。电机驱动电路采用自举升压芯片IR2103和MOSFET管75N75后轮电机和舵机的相电流采集是通过康铜丝转换成电压，通过放大滤波处理，分别送至STM32F107AD采样引脚ADC12_IN1实现过电流保护。通过上位机串口通信或STM32F107内部顺序速度给定，控制电机的正反转、速度及舵机的转向。搬运机器人电机控制硬件结构框图如图1所示。1．2模块的选择与设计 1．2．1功率驱动的设计 电机的供电电源是由24V蓄电池提供，额定功率为240W由4个75N75组成桥式电路来实现。75N75MOSFET功率管，其最高耐压75V最高耐流75A电机驱动电路如图2所示。Q1Q4和Q2Q3分别组成两个桥路，分别控制电机的正转和反转。高端驱动的MOS管导通时源极电压和漏极电压相同且都等于供电电乐VCC所以要实现MOS管正常的驱动，栅极电压要比VCC大，这就需要专门的升压芯片IR2103控制器发生的PWM信号输入HIN引脚，控制器IO口输出的EN1EN2作为使能信号。输出端HO就可得到比VCC要高的电压，且高出的电压值正好是充在电容两端的电压。二极管提高导通速度，使得75N75导通电阻更小，降低了开关管的损失。同时IR2103两个输出口HOLO具有互锁功能，防止由于软件或硬件错误造成的电机上下桥臂直通造成短路。1．2．2过流保护的设计 电机控制系统中装置过流维护有两方面的意义：一是防止在电机正常运行时，电机出现超载或堵转而使得电枢绕组电流过大损害电机甚至引发火灾；另一方面是由于电机肩动时启动电流很大，往往不能直接启动，既需要等励磁绕组逐渐建立磁场后再正常运行，又希望电机以尽量快的速度肩动起来。有了过流维护对电流进行斩波，可以使电机平安快速地启动。过流维护原理图如图3所示。电机的相电流通过康铜丝转换成电压信号Vtext经过运算放大器放大后的模拟量AD1送至控制器AD转换模块，同时将经过电压比较器比较后的数字量EVA 送至控制器的外部中断口。2系统的软件设计 2．1μCOS-II体系结构 μCOS-II一种可移植的可植入ROM可裁剪的抢占式的实时多任务操作系统内核，具有执行效率高、占用空间小、实时性能优良和可扩展性强等特点，最小内核可编译至2KBμCOS-II用C语言和汇编语言编写的其中绝大部分代码郜是用C语言编写的只有极少局部与处置器密切相关的代码是用汇编语言编写。μCOS-II仅仅包括了任务调度、任务管理、时间管理、内存管理、任务间的通信和同步等基本功能。2．2μCOS-II系统下任务的分配 胜利地将μCOS-Ⅱ系统移植到STM32F107后，基于μCOS-II顺序设计是将一个大的应用顺序分成相对独立的多个任务来完成。定义好每个任务的优先级，μCOS-II内核对这些任务进行调度和管理。软件设计思路是根据机器人实际运行的需要由上位机通过串口对电机转速和舵机转动位置进行给定。电机的转速是由设定的速度值和由增量式编码器的采集值相比较，经过速度PID算法实现闭环控制。舵机的位置主要是由绝对值式编码器反馈现在位置，根据动作时间要求调节舵机转动的速度。本搬运机器人电机控制系统软件要实现的功能如下：◆上位机给定电机转速、舵机转动角度和动作时间；◆要求电机转速连续可调并且具有良好的静、动态性能，转速没计采用PI算法调节；◆要求舵机快速到达指定角度，有位置反馈作为舵机给定转速的调整；◆具有一定的故障维护功能。当电机出现堵转、电流过大以及舵机震动限位开关时，要求停止驱动模块工作。针对以上要实现的功能，可以将应用顺序设计分为以下几个任务：①启动任务。对系统进行初始化，创建初始电机状态，然后自我删除，启动任务进入睡眠状态。②电机和舵机保护任务。用于在过流或限位开关动作时响应外部中断，进入中断状态通过发任务信号量，任务顺序检测信号量有效并响应该任务，停止输出。任务优先级设为0级。③上位机给定任务。用于上位机控制电机和舵机，任务优先级设为1级。上位机数据输入寄存器时将发生一个中断，该中断将收到字节送入缓冲区并释放上位机给定任务的信号量；任务中检测到信号量有效便开始执行，将对应的字节信息解析成对应的电机转速和舵机转角位置信息给相应变量赋值。④电机转速控制任务。用于电机的闭环调速，任务优先级设为2级。⑤舵机控制任务。用于控制舵机在规定时间内到达指定位置，任务优先级设为3级。2．3启动任务 主程序中，调用SMT服务网μCOS-II其他任务之前，首先调用系统初始化函数OSInit初始化μCOS-II所有的变量和数据结构；同时，建立空闲任务OS_TaskIdl这个任务总是处于就绪态；调用OSTaskCreat函数建立启动任务；调用OSStart将控制权交给μCOS-II内核，开始运行多任务。启动任务是主顺序中创建的主要有3个功能：①用于系统初始化(PWM输出模块、串口、ADC模块、输入电平中断功能、定时器)②建立系统所要用到信号量。③建立系统的其他任务。最后调用OSTaskDelOS_PRIO_SELF进行自我删除，启动任务进入睡眠状态。主顺序任务流程如图4所示。2．4电机转速控制任务 增量式编码器每次发生外部中断，中断状态中发出任务信号量，任务顺序检测信号量有效并响应该任务，任务中通过测得电机当前转速和给定速度对比实现闭环控制。电机转速控制任务流程如图5所示。2．5舵机控制任务 舵机控制由一个定时器发生基准时间，每隔固定时间发送信号量，任务都将执行一次。舵机控制任务将对绝对值编码器测出的位置和给定的位置进行比拟，根据剩余时间调整舵机的转速。舵机控制任务流程如图6所示。3系统机电接口 机器人的舵机由直流电机外连一个301减速机组成。绝对式位置编码器同舵机相连，将舵机的角度信号送到驱动器控制板中。机器人前轮的两个轴由传动杆相连，其中一个轴由传动带与舵机相连，这样在舵机转动时，传动带带动传动杆，保证两个前轮能够同步转动。后轮驱动电机为直流电机，直接与增量式编码器相连，经减速比为251减速机减速后，经机械差速器驱动后轮转动。增量式编码器的信号同样送到驱动器控制板中。机电系统结构如图7所示。结语 本文实现了搬运机器人的电机和舵机控制器硬件的设计，胜利地在STM32F107上嵌入了实时操作系统μCOS-II完成了电机和舵机的转速闭环实验。利用Cortex-M3内核控制器和μCOS-II系统多任务实时性的特点，为后续的机器人图像视频采集和导航寻迹提供了软硬件基础。如果对现有PI算法进行改进，并且能够实现电机速度和电流双闭环控制，则机器人电机的特性将会更好，搬运机器人的应用前景将更加广阔。