一种办公转椅生产的运动控制方法技术

本发明专利技术提供了一种办公转椅生产的运动控制方法，具体包括：根据D

【技术实现步骤摘要】
一种办公转椅生产的运动控制方法


[0001]本专利技术涉及工业生产的运动控制领域，特别是指一种办公转椅生产的运动控制方法。

技术介绍

[0002]由于现有的办公转椅自动化生产中，主要是依赖于工业机器人来完成相关工艺操作，而能否准确控制工业机器人的操作臂按照工控机的控制指令完成指定的操作，决定工艺流程是否能顺利完成；且当前没有标准化的针对办公转椅全生产工艺流程的工业机器人运动控制方案。

技术实现思路

[0003]本专利技术的主要目的在于克服现有技术中的上述缺陷，提出一种办公转椅生产的运动控制方法，可针对办公转椅自动化生产流程中的打孔/铆钉、喷胶/贴棉/封箱以及码垛工艺实现工业机器人的运动控制，有利于完成办公转椅自动化生产的精准控制，高效有序地完成办公转椅自动化生产的各项工艺流程。
[0004]本专利技术采用如下技术方案：
[0005]一种办公转椅生产的运动控制方法，包括如下步骤：
[0006]根据D
‑
H参数确定规则确定工业机器人各个关节的扭角、距离、长度及角度范围，建立工业机器人的数学模型；
[0007]根据标定参数矩阵实现打孔位置、连接点位置、喷胶区域、贴棉区域的在线定位；
[0008]从工控计算机中获取转椅生产线所处的工艺步骤，即转椅木板打孔及铆钉工艺、转椅扶手连接件锁付工艺、转椅木板喷胶及贴棉工艺、转椅成品封箱工艺和转椅成品码垛工艺；
[0009]若处于“转椅木板打孔及铆钉工艺、转椅扶手连接件锁付工艺，转椅木板喷胶及贴棉工艺、转椅成品封箱工艺”，则求解出工业机器人末端机械臂轨迹路径及关节信息；
[0010]若处于“转椅成品码垛工艺”，则确定出码垛机器人的运动路径；
[0011]验证“轨迹路径”是否能准确地根据提供的定位位置完成相关的工艺操作，验证“运动路径”产生的路线是否满足路径最优的要求；如果不符合要求，则需要重新求解进行轨迹规划；或重新进行路径规划；如果符合要求，则得到可行的运动控制方案。
[0012]具体地，所述根据标定参数矩阵实现打孔位置、连接点位置、喷胶区域、贴棉区域的在线定位，具体包括：
[0013]采用张正友标定法对摄像机进行标定；
[0014]利用张正友标定法进行标定后，获得摄像机的内参矩阵、旋转向量、变换矩阵、系数矩阵及摄像机畸变矩阵，使得工业机器人的摄像机明确所要识别的实际环境所处的相对位置。
[0015]具体地，若处于“转椅木板打孔及铆钉工艺、转椅扶手连接件锁付工艺，转椅木板
喷胶及贴棉工艺、转椅成品封箱工艺”，则求解出工业机器人末端机械臂轨迹路径及关节信息，具体包括：
[0016]则通过初始化位姿、导入机器人模型、设置插值点数，并将确定的机器人各个关节的扭角、距离、长度及角度范围进行输入；
[0017]对机器人各个关节的扭角、距离、长度及角度范围数据进行多项式插值，生成关节运动轨迹序列，得到机器人末端机械臂的位姿信息，并显示机器人末端机械臂运动轨迹；
[0018]通过逆运动学解的计算根据运动轨迹反解出关节信息。
[0019]具体地，若处于“转椅木板打孔及铆钉工艺、转椅扶手连接件锁付工艺，转椅木板喷胶及贴棉工艺、转椅成品封箱工艺”，则求解出工业机器人末端机械臂轨迹路径及关节信息，具体为：
[0020]导入转椅自动生产线码垛机器人的工作区域地图，并在地图上绘制起始点和终止点，以及起始位姿和目标位姿；
[0021]根据所规划的转椅成品堆放位置，指定机器人的状态空间及状态边界定义工业机器人的约束，包括机器人转向控制及速度限制；
[0022]使用快速随机搜索树算法，采用随机采样的方式以路径最优作为路径规划的目标。
[0023]具体地，所述对机器人各个关节的扭角、距离、长度及角度范围数据进行多项式插值，具体为：
[0024]对机器人各个关节的扭角、距离、长度及角度范围数据进行五项多项式插值。
[0025]由上述对本专利技术的描述可知，与现有技术相比，本专利技术具有如下有益效果：
[0026](1)本专利技术提出的方法与传统的单一控制方法相比，本专利技术方法针对办公转椅生产的各项工艺流程，设计合适的运动控制方法，能够完备和准确地完成相关工艺操作；
[0027](2)通过对办公转椅自动化工艺生产步骤进行判别，进入所对应的操作控制步骤，再通过计算工业机器人的运动学解或者利用路径规划算法，以及通过三维运动轨迹仿真，得到机器人所要完成的运动控制操作是否满足要求；有助于提升工业机器人的智能化运动控制水平，且运动控制方案流程有序进行，精准高效。
附图说明
[0028]图1为本专利技术实施例提供的办公转椅生产的运动控制方案实施流程图；
具体实施方式
[0029]以下通过具体实施方式对本专利技术作进一步的描述。
[0030]如图1所示，为本申请实施例提供的办公转椅运动控制方案实施流程图，具体实施方案包括：
[0031](1)建立工业机器人的数学模型，主要是根据D
‑
H参数确定规则确定机器人各个关节的扭角、距离、长度及角度范围，通常D
‑
H参数表可由具体型号的工业机器人操作说明书获得；可选地，本申请可使用安川MH12型机器人作为转椅生产流程中的操作机器人，该机器人有6个串联转动关节，可根据生产厂家提供的说明书获取其6个关节的四类参数(扭角、距离、长度及角度范围)的相关细节，根据机器人的使用说明书也可得到机器人的连杆变换矩
阵表达式；该步骤主要通过具体型号的工业机器人使用说明书完成；
[0032](2)实时视觉定位及标定，该步骤主要通过机器视觉系统的视觉识别算法获得，具体为打孔位置、连接点位置、喷胶区域、贴棉区域，要实现各个位置的在线定位，需要获取标定参数矩阵；可选地，本申请可采用张正友标定法对摄像机进行标定，利用张正友标定法进行标定后，最终会获得摄像机的内参矩阵、旋转向量、变换矩阵、系数矩阵及摄像机畸变矩阵，使得工业机器人的摄像机知道所要识别的实际环境(如木板打孔位置)所处的相对位置；
[0033](3)判断工艺步骤，通过工控计算机与工业机器人的交互，可以从工控计算机中获取转椅生产线所处的工艺步骤，即
①
转椅木板打孔及铆钉工艺、
②
转椅扶手连接件锁付工艺、
③
转椅木板喷胶及贴棉工艺、
④
转椅成品封箱及码垛工艺；
[0034](4)若处于“打孔/铆钉/锁付”工艺，则进行圆弧轨迹规划；若处于“喷胶/贴棉/封箱”工艺，则进行直线轨迹规划；具体的轨迹规划包括：通过初始化位姿、导入机器人模型、设置插值点数并根据步骤(1)所得到的关节信息进行输入，对机器人关节信息多项式差值(可选五次多项式进行插值)，生成关节运动轨迹序列，得到机器人末端机械臂的位姿信息，显示运动轨迹；逆运动学解的计算主要是通过轨迹路径反解出关节信息；将所得到的轨迹路径及关节信息导入三维运动轨迹仿真模块；
[0本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种办公转椅生产的运动控制方法，其特征在于，包括如下步骤：根据D
‑
H参数确定规则确定工业机器人各个关节的扭角、距离、长度及角度范围，建立工业机器人的数学模型；根据标定参数矩阵实现打孔位置、连接点位置、喷胶区域、贴棉区域的在线定位；从工控计算机中获取转椅生产线所处的工艺步骤，即转椅木板打孔及铆钉工艺、转椅扶手连接件锁付工艺、转椅木板喷胶及贴棉工艺、转椅成品封箱工艺和转椅成品码垛工艺；若处于“转椅木板打孔及铆钉工艺、转椅扶手连接件锁付工艺，转椅木板喷胶及贴棉工艺、转椅成品封箱工艺”，则求解出工业机器人末端机械臂轨迹路径及关节信息；若处于“转椅成品码垛工艺”，则确定出码垛机器人的运动路径；验证“轨迹路径”是否能准确地根据提供的定位位置完成相关的工艺操作，验证“运动路径”产生的路线是否满足路径最优的要求；如果不符合要求，则需要重新求解进行轨迹规划；或重新进行路径规划；如果符合要求，则得到可行的运动控制方案。2.根据权利要求1所述的一种办公转椅生产的运动控制方法，其特征在于，所述根据标定参数矩阵实现打孔位置、连接点位置、喷胶区域、贴棉区域的在线定位，具体包括：采用张正友标定法对摄像机进行标定；利用张正友标定法进行标定后，获得摄像机的内参矩阵、旋转向量、变换矩阵、系数矩阵及摄像机畸变矩阵，使得工业机器人的摄像机明确所要识别的实际环境所处的相对位置。3.根据权利要求1所述的一种办公转椅生产...

【专利技术属性】
技术研发人员：曾念寅，吴佩树，谢路生，李寒，
申请(专利权)人：厦门大学，
类型：发明
国别省市：