[实用新型]一种上下料机械手运动控制装置

说明书

技术领域

本实用新型属于运动控制系统技术领域，具体涉及一种多轴高速高精度协调运动并实现机械手的精确定位与抓取的上下料机械手运动控制装置。 

背景技术

机械手能模仿人手臂的某些动作功能，用以按固定程序抓取、搬运物件或操作工具的自动操作装置。它可代替人的繁重劳动以实现生产的机械化和自动化，能在有害环境下操作以保护人身安全。它对提高产品质量，提高生产效率和改善劳动条件起着十分重要的作用，广泛应用于机械制造、冶金、电子、轻工和原子能等部门。 

实用新型内容

(一)要解决的技术问题 

本实用新型要解决的技术问题是提供一种上下料机械手运动控制装置，旨在提高其速度与精度，简化控制系统，便捷操控，提高效率。 

(二)技术方案 

为解决上述技术问题，本实用新型所采用的技术方案如下： 

一种上下料机械手运动控制装置，包括主控制模块、运动控制模块以及用于手持设备上的人机交互模块，所述主控制模块与运动控制模块通过AHB系统总线连接，所述主控制模块与人机交互模块通过RS232串口连接； 

所述主控制模块包括STM32F103主控制器(1)、外扩存储器(6)以及外围设备，所述STM32F103主控制器(1)连接所述外扩存储器(6)和外围设备； 

所述运动控制模块包括四轴运动控制芯片(2)、伺服电机(12)、运动执行机构(13)以及反馈信号模块(14)，所述四轴运动控制芯片(2)通过所述伺服电机(12)控制所述运动执行机构(13)，所述运动执行机构(13)通过所述反馈信号模块(14)反馈于所述四轴运动控制芯片(2)； 

所述人机交互模块包括STM32F103从控制器(3)、液晶显示板(9)、按键芯片(10)以及按键阵列(11)，所述STM32F103从控制器(3)分别连接所述液晶显示板(9)和按键芯片(10)，所述按键芯片(10)连接所述按键阵列(11)。 

其中，所述外围设备包括气动单元驱动电路(5)、SD卡接口(8)及状态指示模块(7)，所述STM32F103主控制器(1)通过AHB系统总线连接所述外围设备。 

其中，所述运动控制模块还包括交流伺服驱动器(4)，所述四轴运动控制芯片(2)通过交流伺服驱动器(4)与所述伺服电机(12)连接。 

其中，所述STM32F103从控制器(3)通过AHB系统总线与所述液晶显示板(9)以及按键芯片(10)连接。 

其中，所述手持设备通过所述按键阵列(11)读取键值，从而对所述STM32F103主控制器(1)发送不同的控制命令编码。 

(三)有益效果 

本实用新型相比较与现有技术，其具有以下有益效果： 

1、人机交互模块使用另一块STM32微处理器快速处理按键值，完成与主STM32微处理器的短距离通信，并快速送显。本实用新型提出的基于ARM核的STM32微处理器的机械手运动控制装置提高了控制电机的脉冲发送速度，作业效率大大提升，并能短距离通过手持设备进行操控，方便快捷。 

2、所述手持设备的加入，减轻了STM32F103主控制器的数据处理量，同时提高了按键侦测的准确率，减少了程序代码，是系统更加稳定。由于手持设备的移动特性，也使对机械手的操作更加方便。 

3、所述主控制模块采用的STM32F103主控制器增加示教功能，在手持设备上选中示教功能后，可通过按键阵列调整各轴运动参数，进而保存下来，待下次开机后，即可按照上述参数使机械手自动运行；增加示教功能后，使机械手的适应性更好，可以针对不同的加工部件规划出不同的运动轨迹。 

4、所述运动控制模块采用专用的四轴运动控制芯片相比于PLC控制提高了脉冲的发送速度，使系统运行时的速度大大提高。并在在运动过程中，电机编码器实时的检测电机运行位置，并将电机当前运行位置实时反馈给所述四轴运动控制芯片，所述四轴运动控制芯片根据所述编码器反馈位置信号调整其运动算法，从而使所述运动能够进行精确的定位运动。 

附图说明

图1是本实用新型的一种上下料机械手运动控制装置的示意图； 

图2是本实用新型的一种上下料机械手运动控制装置的示教功能流程图； 

图3是本实用新型的一种上下料机械手运动控制装置的运动控制流程图。 

具体实施方式

下面结合附图和实施例，对本实用新型的具体实施方式作进一步详细描述。以下实施例用于说明本实用新型，但不用来限制本实用新型的范围。