一种嵌入式裁片挂片机器人控制系统及机器人控制方法技术方案

本发明专利技术公开了一种嵌入式裁片挂片机器人控制系统，包括依次连接的硬件层、控制层和应用层，应用层包括若干个相互连接的PC上位机，PC上位机通过无线连接的方式与控制层相连；硬件层包括安装在机器人机械本体的若干个伺服电机，每个伺服电机连接有伺服驱动器，多个伺服驱动器之间通过CAN通信模块进行通信；控制层包括ARM嵌入式平台和各功能模块。本发明专利技术还公开了裁片挂片机器人的控制方法，求出机器人关节参数并通过运动控制芯片按照规划轨迹计算出末端执行器到达裁片位置的运动参数；驱动机器人抓取裁片后挂在衣架上。本发明专利技术的机器人控制系统，不需人工干预，自主识别裁片、确定裁片位置，准确有效的完成抓片和挂片动作。

A control system and robot control method for an embedded chip hanging robot

The invention discloses an embedded chip-hanging robot control system, which comprises a sequentially connected hardware layer, a control layer and an application layer. The application layer comprises a number of interconnected PC upper computers, which are connected with the control layer by wireless connection, and the hardware layer comprises a number of servos mounted on the robot mechanical body. Each servo motor is connected with a servo driver, and several servo drivers communicate with each other through CAN communication module. The control layer includes ARM embedded platform and each function module. The invention also discloses the control method of the slicing hanging robot, obtains the joint parameters of the robot and calculates the motion parameters of the end effector reaching the slicing position according to the planned trajectory through the motion control chip, and drives the robot to grab the slicing and hang it on the clothes rack. The robot control system of the invention can independently identify the cutting piece and determine the cutting position without manual intervention, and accurately and effectively complete the gripping and hanging motion of the slice.

【技术实现步骤摘要】
一种嵌入式裁片挂片机器人控制系统及机器人控制方法
本专利技术属于嵌入式机器人运动控制装置
，具体涉及一种嵌入式裁片挂片机器人控制系统，还涉及该裁片挂片机器人的控制方法。
技术介绍
随着国民经济发展迈入新常态，传统的依赖资源消耗以及劳动力持续投入的发展模式已经难以为继，纺织服装业的内生动力必须要不断增强。“工业4.0”大幕的徐徐拉开以及人口红利的消失、机器人技术的逐渐成熟以及在各行业应用的普及，机器人代替人以减少用工，将最终成为纺织服装企业的现实选择。通过“机器换人”提升产业的信息化技术水平，应用信息化主动破解低效高耗难题，促进企业由劳动密集型向技术密集型转变，是纺织服装企业可持续发展的不二选择。国内企业对焊接、喷涂、搬运等行业的单工位或工艺联合通用型工业机器人的研发取得了一些成绩，但不能满足纺织服装企业对机器人的特殊要求。劳动密集型企业难以进口价格高昂的机器人，根据纺织服装企业“机器换人”的实际需求，研发制造价格相对较低、质量可靠、实用性强的单工位机器人甚至工艺联合机器人，是减轻企业“机器换人”成本负担的有效方法。2014年开始，单工位的铺布机器人、工艺联合型的纺织机器人以及印染机器人开始在青岛、石狮、绍兴等地进行研发，尚未投入使用。研发我国具有自主知识产权的高性能机器人控制系统及应用系统迫在眉睫。因工业机器人配备PC工控机作为控制器导致体积大、占用空间大的问题，使用ARM嵌入式控制器配合运动控制芯片控制机器人，不但可以有效的缩小控制器体积而且实时稳定，具有明显的优势。目前，国外机器人公司已有的控制系统，如美国“PR2”的ROS控制系统、基于工业PLC的控制系统以及基于“IPC+运动控制器”的控制系统等都是基于PC机作为机器人控制器的运动控制系统；而目前国内尚无成熟的嵌入式机器人控制系统。现有的机器人控制系统都是基于PC机为运动控制器进行软件控制或以PC机为载体结合运动控制卡进行运动控制，这种设计虽然能够利用PC机丰富的资源，但造成运动控制器体积大，对机器人作业空间有很大的限制。而顺应控制系统小型化趋势的如基于嵌入式控制器的机器人控制系统，目前，国内尚无成熟的系统推出。
技术实现思路
本专利技术的目的是提供一种嵌入式裁片挂片机器人控制系统，有效的解决当前机器人由于控制器体积大，无法在狭小空间进行作业的问题。本专利技术的目的还在于提供一种嵌入式裁片挂片机器人的控制方法。本专利技术所采用的第一种技术方案是，一种嵌入式裁片挂片机器人控制系统，包括依次连接的硬件层、控制层和应用层，应用层包括若干个相互连接的具有热点功能的PC上位机，PC上位机通过无线连接的方式与控制层相连；硬件层包括安装在机器人机械本体的若干个伺服电机，每个伺服电机连接有伺服驱动器，多个伺服驱动器之间通过CAN通信模块进行通信；控制层包括ARM嵌入式平台和功能模块，功能模块包括DSP模块、运动控制芯片、视觉定位模块和射频识别模块；ARM嵌入式平台分别与DSP模块、视觉定位模块、射频识别模块相连和运动控制芯片相连通信，ARM嵌入式平台还通过CAN总线的方式与CAN通信模块相连；ARM嵌入式平台通过无线连接的方式与PC上位机相连。本专利技术的特点还在于，ARM嵌入式平台通过HPI接口与DSP模块相连进行通信、通过RS232串口分别与视觉定位模块和射频识别模块相连、通过配有ISA插槽的端子板与运动控制芯片相连，ARM嵌入式平台还通过CAN总线的方式与CAN通信模块相连。ARM嵌入式平台是以S3C6410芯片为核心，运动控制芯片是PCL6045BL控制芯片。本专利技术的所采用的第二种技术方案是，一种嵌入式裁片挂片机器人的控制方法，具体操作步骤如下：步骤1、对视觉定位模块的双目摄像机进行标定，获得双目摄像机的内参、外参以及畸变参数；步骤2、通过视觉定位模块的双目摄像机采集服装裁片的图像信号，然后通过ARM嵌入式平台实时在线传送给DSP模块；步骤3、DSP模块单元获得裁片的数字图像后，通过图像分割、边缘检测等一系列图像处理技术，获得图像的边缘信息；步骤4、根据步骤1获得双目摄像机的内参、外参以及畸变参数和步骤3的图像边缘信息，确定裁片的实际抓取位置，也就是机器人末端手爪要到达的位置；步骤5、根据机器人末端手爪要到达的位置，在笛卡尔坐标下进行轨迹规划；步骤6、运动控制芯片根据裁片的实际抓取位置与步骤5的轨迹规划结果进行计算，将裁片的实际抓取位置转化为机器人每一个关节的位置与运动速度，驱动机器人末端执行器运动到指定位置；步骤7、射频识别模块经电磁感应识别衣架标签，确定衣架位置，将此位置上传到ARM嵌入式平台，ARM嵌入式平台将衣架位置信息发送给运动控制卡，机器人按照步骤5与步骤6，将裁片挂在对应的衣架上。本专利技术的特点还在于，步骤6具体为：步骤6.1、根据轨迹规划的结果，将轨迹分解并计算出每个节点的位置、速度以及加速度等运动参数；步骤6.2、将裁片的位置设置为机器人手爪终端位置，此位置经过机器人运动学反解，转换为各关节的运动参数，机器人根据对应的各个关节角进而驱动关节电机实施抓取与放置动作，各个关节角求取如下：①关节角θ1其中，px表示机器人手爪坐标系原点作为机器人基础坐标系中的位置矢量p在机器人基础坐标系x轴上的投影、py表示p在y轴上的投影、d2表示关节1和关节2的x轴方向距离；②关节角θ3其中其中，a2表示连杆2的长度，a3表示连杆3的长度；d4表示关节3和关节4的x轴方向距离；③关节角θ2θ23＝arctan2((-a3-a2c3)pz+(c1px+s1py)(a2s3-d4),(-d4+a2s3)pz-(c1px+s1py)(-a2c3-a3))(8)其中：θ2＝θ23-θ3其中，pz表示机器人手爪坐标系原点作为机器人基础坐标系中的位置矢量p在z轴上的投影；s1是sinθ1的缩写，s2是sinθ2的缩写,s3是sinθ2的缩写；c1是cosθ1的缩写、c2是cosθ2的缩写、c3是cosθ1的缩写；④关节角θ4θ4＝arctan2(-axs1+ayc1,-axc1c23-ays1c23+azs23)(9)其中，ax、ay、az分别表示机器人手爪坐标系z轴相对于机器人基础坐标系的x轴、y轴以及z轴的旋转位置；c23表示cos(θ2+θ3)，s23表示sin(θ2+θ3)；⑤关节角θ5θ5＝arctan2(s5,c5)(11)其中，s5是sinθ5的缩写，c5是cosθ5的缩写；⑥关节角θ6θ6＝arctan2(s6,c6)(13)其中，其中：s6是sinθ6的缩写，c6是cosθ6的缩写；nx、ny、nz分别表示机器人手爪坐标系x轴相对于机器人基础坐标系的x轴、y轴以及z轴的旋转位置；c4是cosθ4的缩写；以上步骤求解出机器人运动学逆解参数后，在机器人控制过程中通过机器人末端的位姿，获得各个关节的角度，驱动机器人末端执行器运动到指定位置。本专利技术的有益效果是：①本专利技术一种嵌入式裁片挂片机器人控制系统，采用ARM嵌入式平台代替PC机作为机器人的控制器，进而缩小控制器体积。②本专利技术一种嵌入式裁片挂片机器人控制系统，采用分层分布控制并通过CAN总线获取机器人各关节节点的轴信息和坐标信息，在应用层及控制层设置运动控制参数控制机器人运动。③本专利技术一种嵌入式裁片挂片机器人本文档来自技高网...

【技术保护点】
1.一种嵌入式裁片挂片机器人控制系统，其特征在于，包括依次连接的硬件层、控制层和应用层，所述应用层包括若干个相互连接的具有热点功能的PC上位机，所述PC上位机通过无线连接的方式与所述控制层相连；所述硬件层包括安装在机器人机械本体的若干个伺服电机，每个所述伺服电机连接有伺服驱动器，多个所述伺服驱动器之间通过CAN通信模块进行通信；所述控制层包括ARM嵌入式平台和功能模块，所述功能模块包括DSP模块、运动控制芯片、视觉定位模块和射频识别模块；所述ARM嵌入式平台分别与DSP模块、视觉定位模块、射频识别模块相连和运动控制芯片相连通信，所述ARM嵌入式平台还通过CAN总线的方式与CAN通信模块相连；所述ARM嵌入式平台通过无线连接的方式与PC上位机相连。

【技术特征摘要】
1.一种嵌入式裁片挂片机器人控制系统，其特征在于，包括依次连接的硬件层、控制层和应用层，所述应用层包括若干个相互连接的具有热点功能的PC上位机，所述PC上位机通过无线连接的方式与所述控制层相连；所述硬件层包括安装在机器人机械本体的若干个伺服电机，每个所述伺服电机连接有伺服驱动器，多个所述伺服驱动器之间通过CAN通信模块进行通信；所述控制层包括ARM嵌入式平台和功能模块，所述功能模块包括DSP模块、运动控制芯片、视觉定位模块和射频识别模块；所述ARM嵌入式平台分别与DSP模块、视觉定位模块、射频识别模块相连和运动控制芯片相连通信，所述ARM嵌入式平台还通过CAN总线的方式与CAN通信模块相连；所述ARM嵌入式平台通过无线连接的方式与PC上位机相连。2.根据权利要求1所述的一种嵌入式裁片挂片机器人控制系统，其特征在于，所述ARM嵌入式平台通过HPI接口与DSP模块相连进行通信、通过RS232串口分别与视觉定位模块和射频识别模块相连、通过配有ISA插槽的端子板与运动控制芯片相连，所述ARM嵌入式平台还通过CAN总线的方式与CAN通信模块相连。3.根据权利要求1所述的一种嵌入式裁片挂片机器人控制系统，其特征在于，所述ARM嵌入式平台是以S3C6410芯片为核心，所述运动控制芯片是PCL6045BL控制芯片。4.一种嵌入式裁片挂片机器人的控制方法，其特征在于，具体按照以下步骤实施：步骤1、对视觉定位模块的双目摄像机进行标定，获得双目摄像机的内参、外参以及畸变参数；步骤2、通过视觉定位模块的双目摄像机采集服装裁片的图像信号，然后通过ARM嵌入式平台实时在线传送给DSP模块；步骤3、DSP模块单元获得裁片的数字图像后，通过图像分割、边缘检测等一系列图像处理技术，获得图像的边缘信息；步骤4、根据步骤1获得双目摄像机的内参、外参以及畸变参数和步骤3的图像边缘信息，确定裁片的实际抓取位置，也就是机器人末端手爪要到达的位置；步骤5、根据机器人末端手爪要到达的位置，在笛卡尔坐标下进行轨迹规划；步骤6、运动控制芯片根据裁片的实际抓取位置与步骤5的轨迹规划结果进行计算，将裁片的实际抓取位置转化为机器人每一个关节的位置与运动速度，驱动机器人末端执行器运动到指定位置；步骤7、射频识别模块经电磁感应识别衣架标签，确定衣架位置，将此位置上传到A...

【专利技术属性】
技术研发人员：王晓华，柯莉红，张蕾，杨涛，
申请(专利权)人：西安工程大学，
类型：发明
国别省市：陕西,61