产品推荐:水表|流量计|压力变送器|热电偶|液位计|冷热冲击试验箱|水质分析|光谱仪|试验机|试验箱

全网搜索
2023版仪器仪表采购宝典电子书

仪表网>技术中心>应用设计>正文

欢迎联系我

有什么可以帮您? 在线咨询

极品白丝嫩模被大哥操 基于STM32F107的搬运机器人电机控制系统设计

   2012年05月03日 16:41  
  摘要:针对搬运机器人的前轮转向舵机和后轮驱动电机的控制要求,采用以Cortex-M3为内核的STM32F107作为主控制器,采用嵌入实时操作系统μC/OS-II,将程序分成启动任务、电机转速控制任务、舵机控制任务等相对独立的多个任务,并设定了各任务的优先级。该系统能较好地实现搬运机器人的运动控制。
  
  引言
  
  随着人工成本的不断升高,用机器人代替人力去做一些重复性的高强度的劳动是现代机器人研究的一个重要方向。搬运机器人在导航寻迹中,需要后轮驱动电机和前轮舵机的协调工作。搬运机器人电机驱动有其特殊的应用要求,对电机的动态性能要求较高,能在任意时刻到达控制需要的位置并且使舵机停止在任意角度;电机驱动的转矩变化范围大,既有空载平整路面行使的高速度、低转矩工作环境,也有满负载爬坡的运行工况,同时还要求保持较高的运行效率。根据以上的技术要求,本文选用了控制技术成熟,易于平滑调速的直流电机作为搬运机器人的执行饥构。
  
  1、系统的硬件设计
  
  1.1机器人电机控制器硬件结构
  
  主控制器采用Cortex-M3内核的STM32F107。控制器内部共有8个定时器,其中TIM1_CH1和TIM8_CH1为控制定时器引脚,TIM1_CH1用于电机编码器计数。TLM8_CH1用于舵机控制基准时间。通用定时器引脚TIM2CH1、TIM3CH1、TIM4_CH1、TIM5_CH1分别用于电机和舵机驱动电路上下桥壁PWM的产生。
  
  触发EXIT0中断的PA0口和PB0口分别用于电机和舵机的过流中断保护。触发EXIT1中断的PA1口和PB1口用于舵机两侧限位保护。电机驱动电路采用自举升压芯片IR2103和MOSFET管75N75,后轮电机和舵机的相电流采集是通过康铜丝转换成电压,通过放大滤波处理,分别送至STM32F107的A/D采样引脚ADC12_IN1实现过电流保护。通过上位机串口通信或STM32F107内部程序速度给定,控制电机的正反转、速度及舵机的转向。搬运机器人电机控制硬件结构框图如图1所示。
  
  1.2模块的选择与设计
  
  1.2.1功率驱动的设计
  
  电机的供电电源是由24V的蓄电池提供,额定功率为240W,由4个75N75组成桥式电路来实现。75N75是MOSFET功率管,其zui高耐压75V,zui高耐流7,电机驱动电路如图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的、可裁剪的、抢占式的实时多任务操作系统内核,具有执行效率高、占用空间小、实时性能优良和可扩展性强等特点,zui小内核可编译至2KB。μC/OS-II是用C语言和汇编语言编写的,其中绝大部分代码郜是用C语言编写的,只有极少部分与处理器密切相关的代码是用汇编语言编写。μC/OS-II仅仅包含了任务调度、任务管理、时间管理、内存管理、任务间的通信和同步等基本功能。
  
  2.2μC/OS-II系统下任务的分配
  
  成功地将μC/OS-Ⅱ系统移植到STM32F107后,基于μC/OS-II的程序设计是将一个大的应用程序分成相对独立的多个任务来完成。定义好每个任务的优先级,μC/OS-II内核对这些任务进行调度和管理。
  
  软件设计思路是根据机器人实际运行的需要由上位机通过串口对电机转速和舵机转动位置进行给定。电机的转速是由设定的速度值和由增量式编码器的采集值相比较,经过速度PID算法实现闭环控制。舵机的位置主要是由值式编码器反馈现在位置,根据动作时间要求调节舵机转动的速度。本搬运机器人电机控制系统软件要实现的功能如下:
  
  ◆上位机给定电机转速、舵机转动角度和动作时间;
  
  ◆要求电机转速连续可调并且具有良好的静、动态性能,转速没计采用PI算法调节;
  
  ◆要求舵机快速到达角度,有位置反馈作为舵机给定转速的调整;
  
  ◆具有一定的故障保护功能。当电机出现堵转、电流过大以及舵机触动限位开关时,要求停止驱动模块工作。
  
  针对以上要实现的功能,可以将应用程序设计分为以下几个任务:
  
  ①启动任务。对系统进行初始化,创建初始电机状态,然后自我删除,启动任务进入睡眠状态。
  
  ②电机和舵机保护任务。用于在过流或限位开关动作时响应外部中断,进入中断状态通过发任务信号量,任务程序检测信号量有效并响应该任务,停止输出。任务优先级设为0级。
  
  ③上位机给定任务。用于上位机控制电机和舵机,任务优先级设为1级。上位机数据输入寄存器时将产生一个中断,该中断将收到的字节送入缓冲区并释放上位机给定任务的信号量;任务中检测到信号量有效便开始执行,将对应的字节信息解析成对应的电机转速和舵机转角位置信息给相应变量赋值。
  
  ④电机转速控制任务。用于电机的闭环调速,任务优先级设为2级。
  
  ⑤舵机控制任务。用于控制舵机在规定时间内到达位置,任务优先级设为3级。
  
  2.3启动任务
  
  主程序中,在调用μC/OS-II的其他任务之前,首先调用系统初始化函数OSInit(),初始化μC/OS-II所有的变量和数据结构;同时,建立空闲任务OS_TaskIdle(),这个任务总是处于就绪态;调用OSTaskCreate()函数建立启动任务;调用OSStart(),将控制权交给μC/OS-II内核,开始运行多任务。
  
  启动任务是在主程序中创建的,它主要有3个功能:
  
  ①用于系统初始化(PWM输出模块、串口、ADC模块、输入电平中断功能、定时器)。
  
  ②建立系统所要用到的信号量。
  
  ③建立系统的其他任务。
  
  zui后调用OSTaskDel(OS_PRIO_SELF)进行自我删除,启动任务进入睡眠状态。主程序任务流程如图4所示。
  
  2.4电机转速控制任务
  
  增量式编码器每次产生外部中断,在中断状态中发出任务信号量,任务程序检测信号量有效并响应该任务,任务中通过测得电机当前转速和给定速度对比实现闭环控制。电机转速控制任务流程如图5所示。
  
  2.5舵机控制任务
  
  舵机控制由一个定时器产生基准时间,每隔固定时间发送信号量,任务都将执行一次。舵机控制任务将对值编码器测出的位置和给定的位置进行比较,根据剩余时间调整舵机的转速。舵机控制任务流程如图6所示。
  
  3、系统机电接口
  
  机器人的舵机由直流电机外连一个30:1的减速机组成。式位置编码器同舵机相连,将舵机的角度信号送到驱动器控制板中。机器人前轮的两个轴由传动杆相连,其中一个轴由传动带与舵机相连,这样在舵机转动时,传动带带动传动杆,保证两个前轮能够同步转动。后轮驱动电机为直流电机,直接与增量式编码器相连,经减速比为25:1减速机减速后,经机械差速器驱动后轮转动。增量式编码器的信号同样送到驱动器控制板中。机电系统结构如图7所示。
  
  4、结束语
  
  本文实现了搬运机器人的电机和舵机控制器硬件的设计,成功地在STM32F107上嵌入了实时操作系统μC/OS-II,完成了电机和舵机的转速闭环实验。利用Cortex-M3内核控制器和μC/OS-II系统多任务实时性的特点,为后续的机器人图像视频采集和导航寻迹提供了软硬件基础。如果对现有PI算法进行改进,并且能够实现电机速度和电流双闭环控制,则机器人电机的特性将会更好,搬运机器人的应用前景将更加广阔。

免责声明

  • 凡本网注明“来源:仪表网”的所有作品,均为浙江兴旺宝明通网络有限公司-仪表网合法拥有版权或有权使用的作品,未经本网授权不得转载、摘编或利用其它方式使用上述作品。已经本网授权使用作品的,应在授权范围内使用,并注明“来源:仪表网”。违反上述声明者,本网将追究其相关法律责任。
  • 本网转载并注明自其它来源(非仪表网)的作品,目的在于传递更多信息,并不代表本网赞同其观点或和对其真实性负责,不承担此类作品侵权行为的直接责任及连带责任。其他媒体、网站或个人从本网转载时,必须保留本网注明的作品第一来源,并自负版权等法律责任。
  • 如涉及作品内容、版权等问题,请在作品发表之日起一周内与本网联系,否则视为放弃相关权利。
仪表网-仪器仪表行业“互联网+”服务平台
浙公网安备 33010602001308号
网械平台备案证:(浙) 网械平台备字[2020]第00008号
ICP备案号:浙B2-20100369-24
  • 网上标识信息
  • 营业执照(副本)
  • 经营性网站备案信息
  • 行业网站百强奖状
  • 不良信息举报信息
联系我们

客服热线: 13199863987

加盟热线: 13199863987

媒体合作: 0571-87759945

投诉热线: 0571-87759942

关注我们
  • 下载仪表站APP

  • Ybzhan手机版

  • Ybzhan公众号

  • Ybzhan小程序

企业未开通此功能
详询客服 : 0571-87759942