[发明专利]具有无线传感器的机械系统

说明书

技术领域

本发明涉及一种具有无线传感器的机械系统。

背景技术

近年来，在机床或工业用机器人中，为了提高生产效率要求动作的高速化。但机床或机器人高速动作时，与此相应地，在机床或机器人的前端部发生振动。为了抑制这样的振动，已知有在机器人的机械臂前端部安装无线化了的加速度传感器，根据从加速度传感器通过无线传送的传感器信号，来抑制机械臂前端部的振动的装置。例如在日本特开2011-161562(JP2011-161562A)号公报中记载了这样的装置。

但是，在无线通信中，有时在信号传送中产生延迟。然而，在JP2011-161562A记载的装置中，不考虑这样的无线传送的延迟，在来自加速度传感器的传感器信号的传送中产生延迟时，很难高精度地抑制机械臂前端部的振动。

发明内容

本发明的一个方式提供一种机械系统，其具备：具有通过电动机驱动的可动部件的机械装置；和控制机械装置的控制装置，该机械系统的特征在于，具备：传感器部，其被设置在可动部件的前端部上，周期地检测前端部的位置、速度或加速度；无线信号路径，其将表示由传感器部检测出的位置、速度或加速度的传感器信号，通过无线从机械装置发送给控制装置；数据取得部，其取得与经由无线信号路径接收到的传感器信号对应的可动部件的前端部的位置、速度或加速度的第一时序系列数据；数据运算部，其根据电动机的驱动指令，来运算与第一时序系列数据对应的可动部件的前端部的位置、速度或加速度的第二时序系列数据；延迟时间运算部，其根据由数据取得部取得的第一时序系列数据与由数据运算部运算出的第二时序系列数据的相关程度，来运算第一时序系列数据相对于第二时序系列数据的延迟时间；以及修正部，其根据由延迟时间运算部运算出的延迟时间，来修正第一时序系列数据。

此外，本发明的其他方式提供一种机械系统，其具备：具有通过电动机驱动的可动部件的机械装置；和控制机械装置的控制装置，该机械系统的特征在于，具备：旋转量检测部，其检测电动机的旋转量；传感器部，其被设置在可动部件的前端部上，周期地检测前端部的位置、速度或加速度；无线信号路径，其将表示由传感器部检测出的位置、速度或加速度的传感器信号，通过无线从机械装置发送给控制装置；数据取得部，其取得与经由无线信号路径接收到的传感器信号对应的可动部件的前端部的位置、速度或加速度的第一时序系列数据；数据运算部，其根据由旋转量检测部得到的检测值，来运算与第一时序系列数据对应的可动部件的前端部的位置、速度或加速度的第二时序系列数据；延迟时间运算部，其根据由数据取得部取得的第一时序系列数据与由数据运算部运算出的第二时序系列数据的相关程度，来运算针对第二时序系列数据的第一时序系列数据的延迟时间；以及修正部，其根据由延迟时间运算部运算出的延迟时间，来修正第一时序系列数据。

附图说明

通过与附图关联的以下的实施方式的说明，使本发明的目的、特征以及优点更加明确。在所述附图中，

图1是概要性地表示本发明的实施方式的机械系统的结构的图。

图2是表示应用了本发明的机械装置的一例的工业用机器人的结构的图。

图3是表示通过本发明的第一实施方式的机械系统的控制器执行的处理的一例的流程图。

图4A是表示在图3的步骤S1的处理中取得的第一时序系列数据的特性的图。

图4B是表示在图3的步骤S1的处理中取得的第一时序系列数据的特性与在步骤S2的处理中取得的第二时序系列数据的特性的关系的图。

图4C是表示将图4B的第一时序系列数据的特性进行了移位的状态的图。

图5是表示图3的变形例的流程图。

图6A是表示机器人的动作速度较快时的第一时序系列数据和第二时序系列数据的各特性的图。

图6B是表示机器人的动作速度较慢时的第一时序系列数据和第二时序系列数据的各特性的图。

图7是表示通过本发明的第二实施方式的机械系统的控制器执行的处理的一例的流程图。

图8是表示在图7的处理中求出的第一时序系列数据的动作开始时刻的图。

图9是表示在图7的处理中求出的第二时序系列数据的动作开始时刻的图。

具体实施方式

(第一实施方式)