您所在的位置: 成果库 工业机器人多机协同位置轨迹速度预处理方法

工业机器人多机协同位置轨迹速度预处理方法

成果类型:: 发明专利

发布时间: 2023-12-25 14:52:49

科技成果产业化落地方案
方案提交机构:成果发布人| 黄哲芬 | 2023-12-25 14:52:49

本发明的目的在于提供一种工业机器人多机协同位置轨迹速度预处理方法,在PC上设置包含有多个机器人子线程的多机控制系统,每个机器人子线程都设有:控制指令存储区、译码模块、轨迹数据缓冲区、协同数据缓冲区、速度预处理模块、速度信息存储模块、运动控制模块、粗插补数据缓冲区、以及数据处理模块;每个机器人子线程都有与之对应的硬件层可编程I/O接口卡用以连接一台机器人;机器人子线程与机器人子线程之间,子线程与各自的可编程I/O接口卡之间,通过协同指令实现多机协同工作。

提出一种基于“PC机+可编程I/O接口”的工业机器人多机协同位置轨迹速度预处理方法。实现多机系统每台机器人在兼顾运动轨迹控制指令和多机协同指令的条件下,以允许的最大速度完成多轨迹段的连续运行。其主要方案包括译码模块从控制指令存储区提取出控制指令,并根据指令的不同,将控制指令信息存入轨迹数据缓冲区或协同数据缓冲区。开始进行速度预处理时,速度预处理模块使用倒序法从轨迹数据缓冲区中提取出各轨迹段的轨迹数据,并设定该轨迹段对应的速度信息,设定完成后将每条轨迹段的速度信息存入速度信息存储模块。使用倒序法完成第一次速度预处理后,速度预处理模块按照速度信息存储顺序从速度信息存储模块中取出每段轨迹段的速度信息,依次完成速度微调,并将速度信息存入速度信息存储模块,实现速度信息的第二次预处理。预处理完成后,运动控制模块从速度信息存储模块中取出每段轨迹段的速度信息,并根据每段轨迹段速度信息中对应的指令类型不同,输出相应的粗插补数据到粗插补数据缓冲区,数据处理模块从粗插补数据缓冲区中依次取出每段轨迹段的粗插补数据,结合协同数据缓冲区中协同指令的协同数据完成多机协同控制。

本发明属于工业机器人运动控制技术领域,具体涉及一种工业机器人多机协同位置轨迹速度预处理方法。

在计算机技术、网络技术等新技术的支持下,机器人技术发展迅猛,基于PC平台,采用“PC+”的控制模式进行相关机器人控制系统的研发具有较大优势,为合理利用计算机资源,可基于“PC机+可编程I/O接口”的控制模式开发相应的多机器人控制系统,为确保多机器人之间能协同进行作业,需要保证底层控制算法可以合理的协调运动轨迹控制指令与协同指令。

发明人:林述温 陈伟鹏福州大学(Fuzhou University),简称福大,位于福建省福州市,创建于1958年,是国家“双一流”建设高校,国家“211工程”建设高校,国家教育部、国家国防科技工业局与福建省人民政府共建高校,福建省三所重点建设的高水平大学之一,福建省一流大学建设高校,入选国家建设高水平大学公派研究生项目、教育部首批“卓越工程师教育培养计划”高校、新工科研究与实践项目、数据中国“百校工程”项目、国家“111计划”、“高校国际化示范学院推进计划”、国家级大学生创新创业训练计划、全国首批深化创新创业教育改革示范高校、中国政府奖学金来华留学生接收院校、全国专业学位研究生教育综合改革试点单位、国家集成电路人才培养基地、首批高等学校科技成果转化和技术转移基地、高校国家知识产权信息服务中心。

相比于现有技术,本发明及其优选方案能够实现在保证加减速距离足够并且兼顾多机协同指令的条件下,坚持时间最优原则,以允许的最大速度完成多轨迹段的连续运行。

当前专利未经权利人许可不得实施,希望将科技成果转让给研发实力雄厚的企业,由受让人对科技成果实施转化。交易的是科技成果中的知识产权,可以包括专利权、专利申请权、技术秘密等。科技成果转让后,转让方获得转让费,不再是科技成果的所有人;受让方向转让方支付转让费,并成为科技成果的新的所有人。