多轴接合单元的控制装置及控制方法 【技术领域】
本发明是一种多控制装置及控制方法, 特别是一种多轴接合单元的控制装置及控制方法。 背景技术 在电子产品的生产制程中, 在长条形或 U 字体型的运送带形成的生产线上, 由多 数的操作人员进行组装。 然而, 以人力组装电子产品的方式, 不仅效率低、 成本高, 且不易掌 控组装品质, 随着人力成本的逐年增加, 生产自动化逐渐取代人力组装, 而在生产自动化的 过程中, 机器手臂扮演一个相当重要的角色。
习知机器手臂的大多是由编程程式预先描述好其固定工作路径, 之后一直反复重 复同样的动作。但随着机器手臂所进行的动作愈加复杂, 以编程程序描述工作路径愈来愈 困难, 因此, 此种方式逐渐被机器人教导所取代。 机器人教导是指对一具有存储装置的机器 人教导动作程序、 位置及速度, 使机器人可依设定存储装置的消息, 重新做出伸缩、 屈伸、 上 下移动、 左右移动、 旋转动作等复合动作来达到使用者需要的动作。然而, 其必须设置价值
不菲的力感测器、 加速规等元件侦测人教导机器人的力道, 辅以位置侦测, 才能使机器人达 到动作灵活、 平滑的目的。
由于此种机器人的成本过高, 使得机器人教导大多是应用在工业用机器手臂。因 此, 如何简化教导系统, 使其在不需要额外的力感测相关元件的情况下, 具有动作灵活、 平 顺的效果, 由此解决现有教导系统成本过高的问题, 是一个刻不容缓的待解决课题。 发明内容
有鉴于此, 本发明提出一种多轴接合单元的控制装置, 包含 : 多轴接合单元, 用以 进行至少一动作 ; 计量模块, 用以计量多轴接合单元进行动作的参数变化 ; 路径获取模块, 依据参数变化获取工作路径 ; 及路径编辑模块, 由工作路径获取多个转折点, 并依据多个转 折点获取简化路径, 提供多轴接合单元依据简化路径位移而重复进行动作。
本发明还提出一种多轴接合单元的控制方法, 包含下列步骤 : 以多轴接合单元进 行至少一动作 ; 计量多轴接合单元进行动作的参数变化 ; 依据参数变化获取工作路径 ; 由 工作路径获取多个转折点 ; 及依据多个转折点获取简化路径, 提供多轴接合单元依据简化 路径位移而重复进行动作。
本发明在录制多轴接合单元的工作路径后, 经由路径编辑模块编辑成简化路径, 不仅可有效缩简记录工作路径的数据量, 且对伺服系统的特性也较符合, 并能有效的融合 基本动作组合出更多复杂的动作模式, 此外, 本发明可不需设置额外的力感测相关元件, 有 效解决现有教导系统成本过高的问题, 因而可广泛应用于机器手臂、 机器人、 机器狗、 等多 接合而需要描述大量行为模式又不希望增加感测器的伺服控制系统。
以下在实施方式中详细叙述本发明的详细特征以及优点, 其内容足以使任何熟习 相关技艺者了解本发明的技术内容并据以实施, 且根据本说明书所揭露的内容、 申请专利范围及附图, 任何熟习相关技艺者可轻易地理解本发明相关的目的及优点。 附图说明
图 1 为本发明的方块示意图。 图 2A 为本发明工作路径的示意图。 图 2B 为本发明简化路径的示意图。 图 3A 为本发明二个工作路径在融合前的示意图。 图 3B 为本发明二个工作路径在融合后的示意图。 图 4 为本发明的动作流程图。 主要元件符号说明 : 10.............. 多轴接合单元 20.............. 计量模块 21.............. 时间计量单元 22.............. 位置计量单元 30.............. 路径获取模块 40.............. 路径编辑模块 60.............. 主机 70.............. 存储单元具体实施方式
请参阅图 1 所示, 为显示本发明的多轴接合单元的控制装置。
本发明的多轴接合单元的控制装置, 包含 : 多轴接合单元 10、 计量模块 20、 路径获 取模块 30、 路径编辑模块 40。
多轴接合单元 10 用以进行动作, 如: 伸缩、 屈伸、 上下移动、 左右移动、 旋转等动 作, 或是夹持物品、 打点、 焊接等较为繁复的动作, 在此, 多轴接合单元 10 可经由伺服马达 与齿轮传动模块所驱动, 且其较佳地可为机械手臂, 但本发明非以此为限, 也可为机器人、 机器狗等不同类型的伺服控制系统。
计量模块 20 用以计量多轴接合单元 10 进行动作的参数变化, 其中, 计量模块 20 可设置于多轴接合单元 10 上, 且多轴接合单元 10 动作时的参数变化较佳地可包含时间变 化与位置变化, 意即计量模块 20 计量多轴接合单元 10 在进行动作时, 每一个时点的时间信 息与位置信息, 但本发明的参数变化为时间变化与位置变化仅为举例, 非以此为限。
在此, 计量模块 20 较佳地可由时间计量单元 21 与位置计量单元 22 所组成, 其中, 时间计量单元 21 用以计量多轴接合单元 10 动作时的时间变化, 位置计量单元 22 用以计量 多轴接合单元 10 动作时的位置变化。
路径获取模块 30 依据计量模块 20 所计量的参数变化获取工作路径, 即路径获取 模块 30 依据每一个时点的时间信息与位置信息绘制出多轴接合单元 10 在进行此动作的工 作路径。
路径编辑模块 40 由路径获取模块 30 所绘制的工作路径中获取多个转折点, 并依 据多个转折点获取简化路径, 在此, 路径编辑模块 40 可自动地将其所获取的多个转折点经由连接而绘制简化路径, 或可由使用者选定其所需要的多个转折点, 再经由连接而绘制简 化路径。此外, 计量模块 20 计量多轴接合单元 10 在每一个时点的时间信息与位置信息, 因 此转折点当然包含时间信息与位置信息, 而使用者可利用路径编辑模块 40 编辑转折点的 时间信息或位置信息。
在前述说明中, 本发明的路径获取模块 30 与路径编辑模块 40 较佳地可为软件, 并 可经由主机 60 执行路径获取模块 30 与路径编辑模块 40, 或经由主机 60 执行其中一个, 但 本发明非以此为限, 本发明的路径获取模块 30 与路径编辑模块 40 或可为硬件, 分别设置于 多轴接合单元 10 或主机 60。在此, 主机 60 可为工业计算机、 个人计算机、 笔记本计算机或 其他具备运算功能的电子装置。再者, 本发明还可包含存储单元 70, 用以存储计量模块 20 所计量的参数变化, 但非以此为限, 也可存储路径获取模块 30 所绘制的工作路径或路径编 辑模块 40 所绘制的简化路径, 此外, 存储单元 70 较佳地可设置于存储单元 70, 或可依实际 需求设置于主机 60。
请参阅图 2A 与图 2B 所示, 使用者可推动多轴接合单元 10, 使多轴接合单元 10 进 行特定的动作。在多轴接合单元 10 进行动作的过程中, 以时间计量单元 21 计量时间变化, 以位置计量单元 22 计量位置变化, 并将多轴接合单元 10 在每一时点对应的时间信息与位 置信息存储于存储单元 70。在多轴接合单元 10 完成特定的动作后, 路径获取模块 30 依据 每一时点对应的时间信息与位置信息绘制成工作路径 ( 如图 2A 所示 ), 续以路径编辑模块 40 对工作路径取出多个转折点, 并依序连接各转折点而绘制简化路径 ( 如图 2B 所示 ), 由 于简化路径仅包含多个转折点的时间信息与位置信息, 而非整个工作路径中所有时点的时 间信息与位置信息, 因此可有效缩简记录工作路径的数据量。此后, 多轴接合单元 10 依据 路径编辑模块 40 所绘制的简化路径位移而重复进行动作。 在此, 使用者可利用路径编辑模块 40 编辑转折点的时间信息或位置信息, 由此调 整简化路径而使多轴接合单元 10 进行动作时能更灵活、 平顺。此外, 使用者也可利用路径 编辑模块 40 将工作路径或简化路径的特定区段复制至简化路径的适当位置处, 抑或利用 路径编辑模块 40 调整简化路径的波形。
请参阅图 3A 与图 3B 所示, 当多轴接合单元 10 的不同动作被绘制成多个简化路径 后, 可经由路径编辑模块 40 将各个简化路径融合成一个简化路径。由于不同动作的组装间 可能会有动作与动作间连接时的所造成的不连续区段, 为了消除此种现象, 因此在动作与 动作的接轨之后, 通过曲线拟合的方法将原本的不连续的线段找出适当的数学描述方法加 以描述, 即路径编辑模块 40 连接二个的简化路径时, 可利用曲线拟合连接二个简化路径相 邻的二个转折点而形成一个简化路径。
如图 4 所示, 本发明的多轴接合单元的控制方法, 包含下列步骤 :
步骤 401 : 以多轴接合单元 10 进行至少一动作。
使用者推动多轴接合单元 10, 使多轴接合单元 10 进行特定的动作。
步骤 402 : 计量多轴接合单元 10 进行动作的参数变化。
在多轴接合单元 10 进行动作的过程中, 以时间计量单元 21 计量时间变化, 以位置 计量单元 22 计量位置变化, 并在计量时间变化与位置变化等参数变化后, 将多轴接合单元 10 在每一时点对应的时间信息与位置信息存储于存储单元 70。
步骤 403 : 依据参数变化获取工作路径。
在多轴接合单元 10 完成特定的动作后, 路径获取模块 30 依据每一时点对应的时 间信息与位置信息绘制成工作路径 ( 如图 2A 所示 )。
步骤 404 : 由工作路径获取多个转折点。
以路径编辑模块 40 对路径获取模块 30 所绘制的工作路径取出多个转折点, 在此, 转折点包含时间信息与位置信息, 但本发明非以此为限。
步骤 405 : 依据多个转折点获取简化路径, 提供多轴接合单元 10 依据简化路径位 移而重复进行动作。
在获取多个转折点后, 路径编辑模块 40 依序连接各转折点而绘制简化路径 ( 如图 2B 所示 ), 此后, 多轴接合单元 10 依据路径编辑模块 40 所绘制的简化路径位移而重复进行 动作。
在此, 路径编辑模块 40 可编辑转折点的时间信息或位置信息而调整简化路径, 使 多轴接合单元 10 进行动作时能更灵活、 平顺。此外, 路径编辑模块 40 可将工作路径或简化 路径的特定区段复制至简化路径的适当位置处, 抑或调整简化路径的波形。
当多轴接合单元 10 的不同动作被绘制成多个简化路径后, 可经由路径编辑模块 40 将各个简化路径融合成一个简化路径, 其中, 路径编辑模块 40 连接二个的简化路径时, 可利用曲线拟合连接二个简化路径相邻的二个转折点而形成一个简化路径。 本发明利用原有的位置反馈消息编辑成简化路径, 由于其仅包含多个转折点的时 间信息与位置信息, 因此可有效缩简记录工作路径的数据量, 且对伺服系统的特性也较符 合, 再者, 本发明能有效的融合基本动作组合出更多复杂的动作模式, 并不会因动作不连续 而不平顺, 此外, 本发明可不需设置额外的力感测相关元件, 有效解决现有教导系统成本过 高的问题, 因而可广泛应用于机器手臂、 机器人、 机器狗、 等多接合而需要描述大量行为模 式又不希望增加感测器的伺服控制系统。
虽然本发明的技术内容已经以较佳实施例揭露如上, 然而其并非用以限定本发 明, 任何本领域技术人员, 在不脱离本发明的精神所作些许的更动与润饰, 都应涵盖于本发 明的范畴内, 因此本发明的保护范围应当视后附的权利要求所界定的为准。