一种搬运机器人电机控制系统设计
|
搬运机器人电机驱动有其特殊的应用要求，对电机的动态性能要求较高，能在任意时刻到达控制需要的指定位置并且使舵机停止在任意角度;电机驱动的转矩变化范围大，既有空载平整路面行使的高速度、低转矩工作环境，也有满负载爬坡的运行工况，同时还要求保持较高的运行效率。根据以上的技术要求，本文选用了控制技术成熟，易于平滑调速的直流电机作为搬运机器人的执行饥构。 1 系统的硬件设计 1.1 机器人电机控制器硬件结构 主控制器采用Cortex-M3内核的STM32F107。控制器内部共有8个定时器，其中TIM1_CH1和TIM8_CH1为高级控制定时器引脚，TIM1_CH1用于电机编码器计数。TLM8_CH1用于舵机控制基准时间。通用定时器引脚TIM2 CH1、TIM3 CH1、TIM4_CH1、TIM5_CH1分别用于电机和舵机驱动电路上下桥壁PWM的产生。 触发EXIT0中断的PA0口和PB0口分别用于电机和舵机的过流中断保护。触发EXIT1中断的PA1口和PB1口用于舵机两侧限位保护。电机驱动电路采用自举升压芯片IR2103和MOSFET管75N75，后轮电机和舵机的相电流采集是通过康铜丝转换成电压，通过放大滤波处理，分别送至STM3 2F107的A/D采样引脚ADC12_IN1实现过电流保护。通过上位机串口通信或STM32F107内部程序速度给定，控制电机的正反转、速度及舵机的转向。搬运机器人电机控制硬件结构框图如图1所示。
1.2 模块的选择与设计 1.2.1 功率驱动的设计 电机的供电电源是由24 V的蓄电池提供，额定功率为240W，由4个75N75组成桥式电路来实现。75N75是MOSFET功率管，其最高耐压75V，最高耐流75 A，电机驱动电路如图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/OS-II的体系结构 μC/OS-II是一种可移植的、可植入ROM的、可裁剪的、抢占式的实时多任务操作系统内核，具有执行效率高、占用空间小、实时性能优良和可扩展性强等特点，最小内核可编译至2 KB。μC/OS-II是用C语言和汇编语言编写的，其中绝大部分代码郜是用C语言编写的，只有极少部分与处理器密切相关的代码是用汇编语言编写。μC/OS-II仅仅包含了任务调度、任务管理、时间管理、内存管理、任务间的通信和同步等基本功能。 2.2 μC/OS-II系统下任务的分配 成功地将μC/OS-Ⅱ系统移植到STM32F107后，基于μC/OS-II的程序设计是将一个大的应用程序分成相对独立的多个任务来完成。定义好每个任务的优先级，μC/OS-II内核对这些任务进行调度和管理。 软件设计思路是根据机器人实际运行的需要由上位机通过串口对电机转速和舵机转动位置进行给定。电机的转速是由设定的速度值和由增量式编码器的采集值相比较，经过速度PID算法实现闭环控制。舵机的位置主要是由绝对值式编码器反馈现在位置，根据动作时间要求调节舵机转动的速度。本搬运机器人电机控制系统软件要实现的功能如下： ◆上位机给定电机转速、舵机转动角度和动作时间; ◆要求电机转速连续可调并且具有良好的静、动态性能，转速没计采用PI算法调节; ◆要求舵机快速到达指定角度，有位置反馈作为舵机给定转速的调整; ◆具有一定的故障保护功能。当电机出现堵转、电流过大以及舵机触动限位开关时，要求停止驱动模块工作。 |
