生产线搬运机械手控制系统设计探讨

1、消费线搬运机械手控制系统设计讨论 摘要:随着工业机器人技术的不断开展，以及人力资源本钱的逐步增加，迫切需要设计一种自动化搬运机械手。本文在广泛调研的根底上，搭建了一个两自由度平台以及一个皮带传输线，传输线上安装有视觉检测装置，电感式传感器。通过控制直流电机驱动传送带运动，运动到预设的位置以后，视觉系统检测到工件的信息，进而驱动机械手完成抓取动作。首先对电源模块、机械手驱动模块、视觉检测模块、通信模块进展了电路设计。在电路设计的根底上，采用模块化的设计方法，对驱动模块，通信模块，视觉检测模块进展了程序设计。关键词:步进电机驱动模块；STC12C5A60S2；机械手；视觉检测1引言工件分类是工业消

2、费制造中的重要环节，传统的分类方式主要依靠人工完成，人工分类受现场环境及主观因素影响较大。近年来人力资源本钱逐步增加，迫切需要一些自动化装置。随着工业4.0以及智能工厂的提出，越来越多的企业开场对智能化装置感兴趣。机械手具有速度快，精度高的特点，将机器视觉与机器人技术结合，实现工件的分类，成为工业流水线的开展趋势。此外，人工智能相关的技术，例如语音识别，图像处理，运动控制获得明显进步，从而为自动化系统设计提供了可能。文章首先讨论了机械手系统的根本构造，在分析的根底上，进展了机械手构造设计。在构造设计的根底上，对电源模块、机械手驱动模块、视觉检测模块、通信模块进展了电路设计。在电路设计的根底上，

3、进展了控制系统软件设计，采用模块化的设计方法，对驱动模块，通信模块，视觉检测模块进展了程序设计。2系统工作原理与机械本体分析其工作原理是：传送带上运输一外壳，工件到达传送带的位置，传送带上有标记，摄像头获取工件的位置信息，视觉处理模块将检测到工件的位置信息与颜色信息经处理发送到主机模块。主机模块处理位置数据，驱动二自由度平台运动，在到达规定位置时，通过驱动电磁铁得电，完成抓取动作。为了实现上述功能，首先进展了机械手本体设计，本文选择了一种二自由度平台，平台的构造如图1所示。3硬件电路设计为了给主从机控制系统、电磁阀以及其它外围设备供电，系统选择了LM25011芯片。LM25011具有较大的电压

4、输入范围，输入电压6V至42V电压，开关频率可达2MHZ，最大可以给负载提供达2A电流。输出电压具有非常小的纹波，满足为OPENMV供电等需求。系统电源模块电路图如图2所示。为了保证外壳通过传送带到达一个详细位置并停顿，系统选择了一种电感式接近开关，其型号为：LJ18A3-8-Z/BX，检测范围为8mm，是一种NPN型传感器。棕色线连接电源正极，兰色线连接电源负极，黑色为信号线。系统选择了一种高速光耦PC817，当传感器输出为低电平时，导通，系统输出低电平Motor_Stop连接至控制系统。当没有检测到外壳时，传感器输出高电平，不导通，系统输出高电平。由于工件每次都到达一个固定位置，为了实现对

5、工件进展检测，在传动带末端增加了一个检测装置。当工件到达末端时，电感式传感器给控制系统一个信号。控制系统检测到信号以后传送带停顿运动。在系统固定位置设置一个APRILTAG标记，得到物体相对于相机的三个平移坐标以及其它的三个旋转分量，从而可以得到工件相对于相机的位置，便于驱动机械手完成抓取动作。系统采用了主从式的构架，STC12C5A60S2单片机作为主机，接收OPENMV发送过来的数据信息，根据预先设置的数据格式完成数据处理。系统选择的通信速度9600bps、8个数据位、1个停顿位。预先设置的通信格式为起始标志+X轴数据+逗号+Y轴数据+字符b+完毕标记。为了实现对X、Z轴电机进展控制，系统

6、选择了42步进电机，选择的驱动器为FMDD50D40NOM。通过SW1-SW4设置电机电流为2A。通过SW5-SW8设置步进电机的细分数，系统设置细分数为800。4系统软件设计系统选择了一种视觉处理模块，其处理器为STM32。可以采用目前流行的MicroPython进展编程实现。1导入对应的模块，系统需要用到sensor、image、time。然后导入frompybimportUART，进展串口通信的配置。配置为使用串口3，波特率为9600bps。2需要寻找的颜色阈值设置，需要设置lmin，lmax，Amin，Amax，Bmin，Bmax。可以通过工具机器视觉阈值编辑器，提取目的对应的阈值。视

7、觉检测模块程序设计思路为：初始化摄像头传感器，采用RGB565像素格式，采用QQVGA其目的是为了进步速度，让新的设置生效，然后关闭白平衡。以后控制系统不停的循环，采集一张图像，寻找目的颜色，假如找到了对应的颜色，用矩形标注目的颜色对应的区域，向控制系统发送对应的一帧数据。控制系统与视觉检测模块主要采用串口进展数据传输。控制系统接收到数据以后，进展数据分析。首先需要完成的是数据存储，然后进展数据分析。假如接收到数据，数据量小于缓冲区的大小，并且起始字符为a，那么进展数据保存，说明为数据起始帧。假如标志位为1，说明起始数据正确。在起始数据正确的前提下，并且数据不为字符b，进展数据保存。假如接收到

8、的数据为b，那么说明接收到了数据传输完成标志，接收完成标志位置1，同时关闭串口中断。紧接着系统处理接收到的数据。根据设置的颜色，驱动电机完成对应的抓取动作，假如不为设置的颜色，那么控制系统不会运动。电感式传感器检测到工件到达预定的位置，视觉系统检测到工件的颜色符合待抓取的颜色以后，单片机控制步进电机驱动器，运动到待抓取点，进而驱动继电器的线圈，控制电磁铁完成抓取动作。运动到规定的位置以后，再释放物体。电机驱动程序主要包括底层的驱动函数，方向判别函数等。通过传入函数的脉冲数，脉冲的方向，需要驱动的电机轴，控制系统完成步进驱动器的控制。5实验与总结为了对系统功能进展验证，系统准备了红色与绿色两个不同颜色的物体。假设红色为抓取的物体，通过设置红色物体的阈值，当视觉传感器检测到红色物体时，向主控单元发送对应的数据。通过串口调试助手监测到的数据信息如表3所示。通过实验说明，控制系统可以稳定、可靠的抓取物体。6完毕语本文搭建了一个两自由度平台，组装了一个皮带传输线，传