一种码垛搬运机器人的控制系统的制作方法
【技术领域】
[0001]本实用新型涉及一种机械设备电子控制系统，尤其涉及一种码垛搬运机器人的控制系统。
【背景技术】
[0002]码垛搬运机器人是将输送装置输送来的物件，按一定排列方式码放在托盘、栈板(木质、塑胶)或移动平台等可便于运输的设备上，按照客户工艺要求的工作方式自动堆叠成垛的高技术自动化装备。当前市场上的码垛机器人多采用PLC或单片机进行控制，灵活性差，精度不高，运作速度较慢，工作范围局限，因此需要一种新的控制系统诞生。
【实用新型内容】
[0003]本实用新型的目的就在于为了解决上述问题而提供一种码垛搬运机器人的控制系统。
[0004]本实用新型通过以下技术方案来实现上述目的:
[0005]本实用新型包括ARM上位机、CPLD运动控制电路、DSP数据处理电路、伺服电机驱动器和伺服电机，所述ARM上位机的信号传输端与所述DSP数据处理电路的信号传输端连接，所述DSP数据处理电路与所述CPLD运动控制电路之间通过双口 RAM连接，所述CPLD运动控制电路的控制信号传输端与所述伺服电机驱动器的控制信号传输端连接，所述伺服电机驱动器的控制信号输出端与所述伺服电机的控制信号输入端连接，所述伺服电机的反馈信号输出端与所述伺服电机驱动器的反馈信号输入端连接，所述伺服电机的编码器信号输出端与所述CPLD运动控制电路的编码器信号输入端连接。
[0006]进一步，所述伺服电机驱动器和所述伺服电机均为多个，一个所述伺服电机和一个所述伺服电机驱动器组成一组驱动装置，每组所述驱动装置之间并联连接。
[0007]具体地，所述ARM上位机和所述DSP数据处理电路之间通过RS485总线连接；所述ARM上位机为ARM系列处理器。
[0008]本实用新型的有益效果在于:具有多任务处理功能、二次开发性能、人机界面交互性能和通用性。
[0009]本实用新型是一种码垛搬运机器人的控制系统，与现有技术相比，本实用新型采用具有三核控制器的控制系统，分模块化工作，结合三个微处理器各自特性，发挥其优势，分工处理整个控制过程，与传统的PLC和单片机控制的码垛搬运机器人相比，动作响应速度快，位置控制更为精确，系统稳定性高，码垛效率大大提升。同时采用多关节的机器人操作，运作灵活，工作范围也进一步扩大，具有推广应用的价值。
【附图说明】
[0010]图1是本实用新型的总体框架图；
[0011]图2是本实用新型的系统编辑指令构架图；
[0012]图3是本实用新型的系统处理方式流程图；
[0013]图4是本实用新型系统中DSP运动规划流程图；
[0014]图5是本实用新型系统中CPLD构架流程图。
【具体实施方式】
[0015]下面结合附图对本实用新型作进一步说明:
[0016]如图1所示:本实用新型包括ARM上位机、CPLD运动控制电路、DSP数据处理电路、伺服电机驱动器和伺服电机，所述ARM上位机的信号传输端与所述DSP数据处理电路的信号传输端连接，所述DSP数据处理电路与所述CPLD运动控制电路之间通过双口 RAM连接，所述CPLD运动控制电路的控制信号传输端与所述伺服电机驱动器的控制信号传输端连接，所述伺服电机驱动器的控制信号输出端与所述伺服电机的控制信号输入端连接，所述伺服电机的反馈信号输出端与所述伺服电机驱动器的反馈信号输入端连接，所述伺服电机的编码器信号输出端与所述CPLD运动控制电路的编码器信号输入端连接。
[0017]进一步，所述伺服电机驱动器和所述伺服电机均为多个，一个所述伺服电机和一个所述伺服电机驱动器组成一组驱动装置，每组所述驱动装置之间并联连接。从而实现对每个运动关节的控制。
[0018]具体地，所述ARM上位机和所述DSP数据处理电路之间通过RS485总线连接；所述ARM上位机为ARM系列处理器。
[0019]本实用新型的工作原理如下:
[0020]PC机编写G代码形式的指令，最终生成一串二进制文件下发到ARM上位机中去，ARM上位机通过对二进制代码的解析，得到结构体数据包并发送给CPLD运动控制电路，DSP数据处理电路进行插补和速度控制，处理完成将返回给ARM上位机完成指令，DSP数据处理电路将数据放在双口 RAM中，CPLD运动控制电路读取双口 RAM数据进行相应的脉冲输出和I/O 口的控制，伺服驱动器根据输入的差分信号脉冲驱动电机旋转，伺服电机上的正交编码器反馈信号给CPLD运动控制电路，CPLD运动控制电路会送回给DSP数据处理电路。
[0021]如图2所示，为了使得码垛机器人具有通用性和用户能够进行二次开发，做了一些特殊的指令，类似于CNC系统中的G代码，PC上位机编程好以后通过TCP/IP、USB/U盘以及串口把程序文件下载在ARM9中，ARM9主要取得用户的编写的文件后进行解析，然后将解析好的数据打包成结构体数据通过串口 /RS485下载到DSP芯片中，DSP数据处理电路读取各种命令字和G代码解析后运行BLOCK来进行运动规划调用各种算法，运行各种算法的同时，将算法输出的结果发给CPLD运动控制电路，CPLD运动控制电路最终发送脉冲给各个伺服电机进行工作。
[0022]本实用新型手动操作时，用户的各种输入都会组织成相应的命令数据包发送给DSP数据处理电路，然后DSP数据处理电路会自动识别这些命令，根据使用者的动作以及命令程序语句的要求进行坐标变换、轨迹规划及插补运算然后计算出各轴电机的相对于绝对坐标或者相对坐标的位置，随后把与设定点相应的下一级各关节位置向伺服控制电机发出，然后直接发送给CPLD运动控制电路运行，实现对每个关节运动的控制和协调作用。
[0023]如图3和图4所示，DSP数据处理电路要不断的去查询是否有控制脉冲的任务，如果没有什么也不做，如果接收到ARM9发送过来的任务结构体，则通过结构体中的命令，进行相应的解释和参数检查和运动规划，确定是梯形速度控制还是S曲线速度控制。然后进行运动和速度规划，规划完成后启动插补周期，每个周期发送任务结构体数据给CPLD运动控制电路，CPLD运动控制电路必须在相应的插补周期内运行完成相应的脉冲输出任务。
[0024]在DSP数据处理电路上建立六个任务结构体缓冲队列，这六个缓存队列分别对应六个轴的运动输出的任务，通过双口 RAM的最高两个地址来控制将要进行哪些轴的任务的运行。CPLD运动控制电路端读取双口 RAM中的最高两位的地址，可以知道哪些任务结构体更新过了需要运行。CPLD运动控制电路运行结束的时候同样需要对双口 RAM的最高地址进行写操作，DSP数据处理电路会周期性的读取双口 RAM的最高地址数据，来确认那些轴的任务运行已经完成将任务队列里面的数据写入到双口 RAM中去，同时更新双口 RAM最高地址的数据。
[0025]如图5所示，CPLD运动控制电路部分的程序设计主要是根据DSP和双口 RAM的特点，设计了当DSP数据处理电路插补算法和速度控制算法算出对各个轴的操作任务数据结构体，然后把DSP数据处理电路对应轴的任务弹出到双口 RAM对应轴的缓存区域中去。写入需要运动轴数据任务结构体以后就会写最高两个半字的数据，写完以后双口 RAM的中断引脚就会对CPLD运动控制电路产生一个中断，CPLD接收到中断就会到双口 RAM去中取任务缓存，六个轴的任务全部查询完以后一起对对应轴发脉冲。
[0026]以上显示和描述了本实用新型的基本原理和主要特征及本实用新型的优点。本行业的技术人员应该了解，本实用新型不受上述实施例的限制，上述实施例和说明书中描述的只是说明本实用新型的原理，在不脱离本实用新型精神和范围的前提下，本实用新型还会有各种变化和改进，这些变化和改进都落入要求保护的本实用新型范围内。本实用新型要求保护范围由所附的权利要求书及其等效物界定。
【主权项】
1.一种码垛搬运机器人的控制系统，其特征在于:包括ARM上位机、CPLD运动控制电路、DSP数据处理电路、伺服电机驱动器和伺服电机，所述ARM上位机的信号传输端与所述DSP数据处理电路的信号传输端连接，所述DSP数据处理电路与所述CPLD运动控制电路之间通过双口 RAM连接，所述CPLD运动控制电路的控制信号传输端与所述伺服电机驱动器的控制信号传输端连接，所述伺服电机驱动器的控制信号输出端与所述伺服电机的控制信号输入端连接，所述伺服电机的反馈信号输出端与所述伺服电机驱动器的反馈信号输入端连接，所述伺服电机的编码器信号输出端与所述CPLD运动控制电路的编码器信号输入端连接。
2.根据权利要求1所述的码垛搬运机器人的控制系统，其特征在于:所述伺服电机驱动器和所述伺服电机均为多个，一个所述伺服电机和一个所述伺服电机驱动器组成一组驱动装置，每组所述驱动装置之间并联连接。
3.根据权利要求1所述的码垛搬运机器人的控制系统，其特征在于:所述ARM上位机和所述DSP数据处理电路之间通过RS485总线连接。
4.根据权利要求1所述的码垛搬运机器人的控制系统，其特征在于:所述ARM上位机为ARM系列处理器。
【专利摘要】本实用新型公开了一种码垛搬运机器人的控制系统，包括ARM上位机、CPLD运动控制电路、DSP数据处理电路、伺服电机驱动器和伺服电机，与现有技术相比，本实用新型采用具有三核控制器的控制系统，分模块化工作，结合三个微处理器各自特性，发挥其优势，分工处理整个控制过程，与传统的PLC和单片机控制的码垛搬运机器人相比，动作响应速度快，位置控制更为精确，系统稳定性高，码垛效率大大提升。同时采用多关节的机器人操作，运作灵活，工作范围也进一步扩大，具有推广应用的价值。
【IPC分类】G05D1-02
【公开号】CN204287965
【申请号】CN201420784858
【发明人】姜树海, 朱亚荣, 张楠, 李蕾, 黄天乐, 李俊
【申请人】南京林业大学
【公开日】2015年4月22日
【申请日】2014年12月12日