Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP7405602B2 - Noise removal device - Google Patents
[go: Go Back, main page]

JP7405602B2 - Noise removal device - Google Patents

Noise removal device Download PDF

Info

Publication number
JP7405602B2
JP7405602B2 JP2019234412A JP2019234412A JP7405602B2 JP 7405602 B2 JP7405602 B2 JP 7405602B2 JP 2019234412 A JP2019234412 A JP 2019234412A JP 2019234412 A JP2019234412 A JP 2019234412A JP 7405602 B2 JP7405602 B2 JP 7405602B2
Authority
JP
Japan
Prior art keywords
data
welding gun
acceleration data
acceleration
robot
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2019234412A
Other languages
Japanese (ja)
Other versions
JP2021102249A (en
Inventor
晃市郎 林
聡 稲垣
元 鈴木
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fanuc Corp
Original Assignee
Fanuc Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fanuc Corp filed Critical Fanuc Corp
Priority to JP2019234412A priority Critical patent/JP7405602B2/en
Publication of JP2021102249A publication Critical patent/JP2021102249A/en
Application granted granted Critical
Publication of JP7405602B2 publication Critical patent/JP7405602B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Description

本発明は、ノイズ除去装置に関する。 The present invention relates to a noise removal device.

ロボット動作時の振動を低減することで高速化や軌跡精度を向上することは生産効率や品質の向上に直結する。そこで、ロボットが動作する際に発生する振動や軌跡ずれを低減したいという要望がある。特に、溶接ガンを用いたスポット溶接の際にロボットが振動しないように動作することが望まれている。
この点、振動を除去したい箇所や高精度軌跡を実現したい箇所に加速度センサを取り付け、ロボット動作中の振動を加速度センサが計測し、学習制御を行うことで振動を低減する方法が提案されている。例えば、特許文献1、2参照。
加速度センサによってロボットの振動を計測する際、センサデータにはノイズが含まれている。このノイズによりロボットの振動を正確に計測できなくなり、ロボットの振動除去のための正しい補正ができなくなることがある。そこで、センサデータのノイズ除去には、一般的にローパスフィルタやメディアンフィルタ等が用いられる。
Improving speed and trajectory accuracy by reducing vibration during robot operation directly leads to improvements in production efficiency and quality. Therefore, there is a desire to reduce vibrations and trajectory deviations that occur when robots operate. In particular, it is desired that the robot operate without vibration during spot welding using a welding gun.
In this regard, a method has been proposed in which an acceleration sensor is attached to a location where vibrations are to be removed or where a high-precision trajectory is to be achieved, the acceleration sensor measures vibrations during robot movement, and the vibrations are reduced by performing learning control. . For example, see Patent Documents 1 and 2.
When measuring robot vibration using an acceleration sensor, the sensor data contains noise. This noise may make it impossible to accurately measure the robot's vibrations and make it impossible to make correct corrections to remove the robot's vibrations. Therefore, a low-pass filter, a median filter, or the like is generally used to remove noise from sensor data.

特開2011-167817号公報Japanese Patent Application Publication No. 2011-167817 特開2018-118353号公報JP 2018-118353 Publication

例えば、溶接ガンが取り付けられたロボットの振動除去のために溶接ガンに加速度センサを設置する場合がある。加速度センサが計測中に溶接ガンを動作させる場合、加速度センサは、溶接ガンの動作の衝撃により瞬間的に大きな値の信号を検出してしまう。この信号はロボットの動作軌跡を推定する上で誤差の要因となるノイズである。
また、瞬間的に発生するノイズを除去するためにローパスフィルタを適用すると、ノイズのない部分の信号にも影響が出てしまう。また、ローパスフィルタは、ノイズを完全に除去できるわけではない。
For example, an acceleration sensor may be installed on a welding gun to remove vibrations from a robot to which the welding gun is attached. When the welding gun is operated while the acceleration sensor is measuring, the acceleration sensor instantaneously detects a signal with a large value due to the impact of the operation of the welding gun. This signal is noise that causes errors in estimating the robot's motion trajectory.
Furthermore, if a low-pass filter is applied to remove instantaneously generated noise, signals in noise-free areas will also be affected. Furthermore, low-pass filters cannot completely remove noise.

そこで、溶接ガンを動作させて加速度センサの計測を行う場合でも、溶接ガンの影響により発生するノイズを除去することが望まれている。 Therefore, even when the welding gun is operated to measure the acceleration sensor, it is desired to remove the noise generated due to the influence of the welding gun.

本開示のノイズ除去装置の一態様は、ロボットに取り付けられた溶接ガンに設置された加速度センサの加速度データからノイズを除去するノイズ除去装置であって、前記溶接ガンが動作した動作区間の前記加速度センサの加速度データを擬似加速度データに置き換えて出力するデータ置換部を備える。 One aspect of the noise removal device of the present disclosure is a noise removal device that removes noise from acceleration data of an acceleration sensor installed in a welding gun attached to a robot, wherein the noise removal device removes noise from acceleration data of an acceleration sensor installed in a welding gun attached to a robot, the The sensor includes a data replacement unit that replaces sensor acceleration data with pseudo acceleration data and outputs the pseudo acceleration data.

一態様によれば、溶接ガンを動作させて加速度センサの計測を行う場合でも、溶接ガンの影響により発生するノイズを除去することができる。 According to one aspect, even when the welding gun is operated and the acceleration sensor is measured, noise generated due to the influence of the welding gun can be removed.

第1実施形態に係るロボットシステムの機能的構成例を示す機能ブロック図である。1 is a functional block diagram showing an example of a functional configuration of a robot system according to a first embodiment. FIG. 取得された加速度データの一例を示す図である。It is a figure which shows an example of the acquired acceleration data. 図2の加速度データから動作区間の加速度データが削除された一例を示す図である。3 is a diagram illustrating an example in which acceleration data in a motion section is deleted from the acceleration data in FIG. 2. FIG. 抽出された加速度データに対するフーリエ解析の結果の一例を示す図である。It is a figure which shows an example of the result of the Fourier analysis with respect to the extracted acceleration data. 動作区間が疑似加速度データに置き換えられた加速度データの一例を示す図である。FIG. 7 is a diagram showing an example of acceleration data in which motion sections are replaced with pseudo acceleration data. ノイズ除去装置の置換処理について説明するフローチャートである。It is a flowchart explaining replacement processing of a noise removal device. 第2実施形態に係るロボットシステムの機能的構成例を示す機能ブロック図である。FIG. 3 is a functional block diagram showing an example of the functional configuration of a robot system according to a second embodiment. 動作区間の加速度データが削除された加速度データの一例を示す図である。FIG. 7 is a diagram illustrating an example of acceleration data from which acceleration data in a motion section has been deleted. 動作区間が疑似加速度データに置き換えられた加速度データの一例を示す図である。FIG. 7 is a diagram showing an example of acceleration data in which motion sections are replaced with pseudo acceleration data. 図9の加速度データに対して平均化フィルタが適用された加速度データの一例を示す図である。10 is a diagram showing an example of acceleration data to which an averaging filter is applied to the acceleration data of FIG. 9. FIG. 動作区間と隣接する区間との継ぎ目の加速度データの値が近いタイミングの加速度データを埋め込んだ一例を示す図である。FIG. 7 is a diagram illustrating an example of embedding acceleration data at timings where the values of the acceleration data at the joint between a motion section and an adjacent section are close to each other. ノイズ除去装置の置換処理について説明するフローチャートである。It is a flowchart explaining replacement processing of a noise removal device.

以下、第1実施形態について図面を用いて説明する。
<第1実施形態>
図1は、第1実施形態に係るロボットシステムの機能的構成例を示す機能ブロック図である。図1に示すように、ロボットシステムは、ロボット10、ロボット制御装置20、及びノイズ除去装置30を有する。
The first embodiment will be described below with reference to the drawings.
<First embodiment>
FIG. 1 is a functional block diagram showing an example of the functional configuration of the robot system according to the first embodiment. As shown in FIG. 1, the robot system includes a robot 10, a robot control device 20, and a noise removal device 30.

ロボット10、ロボット制御装置20、及びノイズ除去装置30は、図示しない接続インタフェースを介して互いに直接接続されてもよい。なお、ロボット10、ロボット制御装置20、及びノイズ除去装置30は、LAN(Local Area Network)等のネットワークを介して相互に接続されていてもよい。この場合、ロボット10、ロボット制御装置20、及びノイズ除去装置30は、かかる接続によって相互に通信を行うための図示しない通信部を備えてもよい。
なお、ノイズ除去装置30は、後述するように、ロボット制御装置20に含まれてもよい。
The robot 10, the robot control device 20, and the noise removal device 30 may be directly connected to each other via a connection interface (not shown). Note that the robot 10, the robot control device 20, and the noise removal device 30 may be connected to each other via a network such as a LAN (Local Area Network). In this case, the robot 10, the robot control device 20, and the noise removal device 30 may be provided with a communication unit (not shown) for communicating with each other through such a connection.
Note that the noise removal device 30 may be included in the robot control device 20, as described later.

<ロボット10>
ロボット10は、例えば、産業用ロボット等である。ロボット10は、例えば、図1に示すように、6軸の垂直多関節ロボットであり、6つの関節軸11(1)-11(6)と、関節軸11(1)-11(6)の各々により連結されるアーム部12を有する。ロボット10は、ロボット制御装置20からの駆動指令に基づいて、関節軸11(1)-11(6)の各々に配置されるサーボモータ(図示しない)の各々を駆動することにより、アーム部12等の可動部材を駆動する。また、ロボット10の可動部材の先端部、例えば、関節軸11(6)の先端部には、例えば、溶接ガン、握持ハンド、レーザ照射装置等のエンドエフェクタが取り付けられる。そして、図1のロボット10には、エンドエフェクタとして、溶接ガン13が取り付けられる。また、溶接ガン13には、加速度センサ100が設置される。
なお、ロボット10は、6軸の垂直多関節ロボットとしたが、6軸以外の垂直多関節ロボットでもよく、水平多関節ロボットやパラレルリンクロボット等でもよい。
<Robot 10>
The robot 10 is, for example, an industrial robot. The robot 10, for example, as shown in FIG. It has arm portions 12 connected to each other. The robot 10 drives the arm portion 12 by driving each of the servo motors (not shown) arranged at each of the joint axes 11(1) to 11(6) based on a drive command from the robot control device 20. drive movable members such as Further, an end effector such as a welding gun, a gripping hand, a laser irradiation device, etc. is attached to the tip of the movable member of the robot 10, for example, the tip of the joint shaft 11 (6). A welding gun 13 is attached to the robot 10 in FIG. 1 as an end effector. Further, an acceleration sensor 100 is installed in the welding gun 13.
Although the robot 10 is a six-axis vertically articulated robot, it may be a vertically articulated robot other than six axes, a horizontally articulated robot, a parallel link robot, or the like.

加速度センサ100は、ロボット10の動作に伴う可動部材の先端部における加速度を所定のサンプリング時間で周期的に検出する。加速度センサ100は、図示しないクロック部を有し、加速度を検出する度に、当該クロック部から出力される時刻情報を、検出した時刻として取得する。また、加速度センサ100は、例えば、検出された加速度及び時刻情報を含むセンサ信号を、ロボット制御装置20及びノイズ除去装置30に送信する。
なお、所定のサンプリング時間は、ロボット10の動作内容やロボット10が配置される工場の環境等に応じて適宜設定されてもよい。
また、ロボット10及び溶接ガン13の動作タイミングと、加速度センサ100のデータ取得タイミングとは、後述するロボット制御装置20内で同期されていてもよい。
The acceleration sensor 100 periodically detects the acceleration at the tip of the movable member as the robot 10 moves at a predetermined sampling time. The acceleration sensor 100 has a clock unit (not shown), and each time it detects acceleration, it acquires time information output from the clock unit as the detected time. Further, the acceleration sensor 100 transmits a sensor signal including, for example, the detected acceleration and time information to the robot control device 20 and the noise removal device 30.
Note that the predetermined sampling time may be set as appropriate depending on the operation content of the robot 10, the environment of the factory where the robot 10 is placed, and the like.
Further, the operation timing of the robot 10 and the welding gun 13 and the data acquisition timing of the acceleration sensor 100 may be synchronized within the robot control device 20, which will be described later.

<ロボット制御装置20>
ロボット制御装置20は、プログラムに基づいて、ロボット10に対して動作指令信号を出力し、ロボット10の動作を制御する制御装置(「ロボットコントローラ」とも呼ばれる)である。
具体的には、ロボット制御装置20は、後述するノイズ除去装置30によりノイズが除去された加速度センサ100からの加速度データ(センサデータ)に基づいて、ロボット10の先端部の溶接ガン13における振動を低減するように、ロボット10に対して動作指令信号を出力し、ロボット10の動作を制御する。なお、加速度データに基づいて、ロボット10の先端部の溶接ガン13における振動を低減するように、ロボット10に対して動作指令信号を出力する方法は、特許文献1、2等の公知の手法を用いることができ、詳細な説明は省略する。
<Robot control device 20>
The robot control device 20 is a control device (also referred to as a "robot controller") that outputs a motion command signal to the robot 10 and controls the motion of the robot 10 based on a program.
Specifically, the robot control device 20 reduces vibrations in the welding gun 13 at the tip of the robot 10 based on acceleration data (sensor data) from the acceleration sensor 100 from which noise has been removed by a noise removal device 30, which will be described later. A motion command signal is output to the robot 10 to control the motion of the robot 10 so as to reduce the amount of energy. Note that a method for outputting an operation command signal to the robot 10 based on the acceleration data to reduce vibrations in the welding gun 13 at the tip of the robot 10 is based on known methods such as those disclosed in Patent Documents 1 and 2. can be used, and detailed explanation will be omitted.

なお、ロボット制御装置20は、溶接ガン13を用いたロボット10による溶接動作の動作シーケンスを予め有する。例えば、スポット溶接の場合、ロボット制御装置20は、ロボット10に対して、溶接ガン13を溶接する場所(ナゲット作成位置)まで移動させた後、溶接ガン13のチップが溶接対象のワークまで近づく「アプローチ」、溶接ガン13のチップが前記ワークに当接する「ガン閉じ」、溶接する「加圧」、及び溶接ガン13が前記ワークを放す「ガン開き」を含む動作シーケンス「スポット命令」を出力する。換言すれば、ロボット制御装置20が動作シーケンス「スポット命令」をロボット10に出力することで、後述するノイズ除去装置30は、溶接ガン13が動作するタイミングを検知することができる。
ここで、動作シーケンス「スポット命令」の「ガン閉じ」では、溶接ガン13のチップが前記ワークに当接する瞬間であることから、「溶接ガン13を打つ」ともいう。また、動作シーケンス「スポット命令」の「加圧」には、電極を加圧してから通電開始するまでの時間「スクイズ」、溶接電流を流す時間「ウェルド」、及びナゲット凝固のために加圧を保持する時間「ホールド」が含まれる。また、動作シーケンス「スポット命令」の「ガン開き」には、加圧解放から次の溶接に移行するまでの時間「オフ」が含まれる。
Note that the robot control device 20 has an operation sequence of a welding operation performed by the robot 10 using the welding gun 13 in advance. For example, in the case of spot welding, the robot controller 20 causes the robot 10 to move the welding gun 13 to the welding location (nugget creation position), and then causes the tip of the welding gun 13 to approach the workpiece to be welded. "approach", "gun close" in which the tip of the welding gun 13 contacts the workpiece, "pressure" to weld, and "gun open" in which the welding gun 13 releases the workpiece. . In other words, when the robot control device 20 outputs the operation sequence "spot command" to the robot 10, the noise removal device 30, which will be described later, can detect the timing at which the welding gun 13 operates.
Here, the "gun close" of the operation sequence "spot command" is the moment when the tip of the welding gun 13 comes into contact with the workpiece, so it is also called "hitting the welding gun 13." In addition, "pressure" in the operation sequence "spot command" includes "squeeze", the time from when the electrode is pressurized until the start of energization, "weld", the time during which welding current is applied, and "pressure" for the nugget solidification. Includes "hold" time. Further, the "gun open" of the operation sequence "spot command" includes the time "off" from pressurization release to transition to the next welding.

<ノイズ除去装置30>
ノイズ除去装置30は、コンピュータ装置等であり、ロボット10に取り付けられた溶接ガン13に設置された加速度センサ100により検出された加速度及び時刻情報を含むセンサ信号を受信する。ノイズ除去装置30は、受信したセンサ信号に含まれる加速度センサ100の加速度データからノイズを除去する。そして、ノイズ除去装置30は、ノイズ除去された加速度データをロボット制御装置20に出力する。
図1に示すように、本実施形態に係るノイズ除去装置30は、制御部300、及び記憶部310を含んで構成される。さらに、制御部300は、データ置換部301を含んで構成される。
<Noise removal device 30>
The noise removal device 30 is a computer device or the like, and receives a sensor signal including acceleration detected by an acceleration sensor 100 installed on a welding gun 13 attached to the robot 10 and time information. The noise removal device 30 removes noise from the acceleration data of the acceleration sensor 100 included in the received sensor signal. Then, the noise removal device 30 outputs the noise-removed acceleration data to the robot control device 20.
As shown in FIG. 1, the noise removal device 30 according to this embodiment includes a control section 300 and a storage section 310. Furthermore, the control section 300 is configured to include a data replacement section 301.

なお、ノイズ除去装置30は、図1の機能ブロックの動作を実現するために、CPU(Central Processing Unit)等の図示しない演算処理装置を備える。また、ノイズ除去装置30は、各種の制御用プログラムを格納したROM(Read Only Memory)やHDD(Hard Disk Drive)等の図示しない補助記憶装置や、演算処理装置がプログラムを実行する上で一時的に必要とされるデータを格納するためのRAM(Random Access Memory)といった図示しない主記憶装置を備える。 Note that the noise removal device 30 includes an arithmetic processing device (not shown) such as a CPU (Central Processing Unit) in order to realize the operations of the functional blocks shown in FIG. In addition, the noise removal device 30 is used to store various control programs in an auxiliary storage device (not shown) such as a ROM (Read Only Memory) or an HDD (Hard Disk Drive), or a temporary storage device when the arithmetic processing unit executes the programs. A main storage device (not shown) such as a RAM (Random Access Memory) is provided for storing data required for the computer.

そして、ノイズ除去装置30において、演算処理装置が補助記憶装置からOSやアプリケーションソフトウェアを読み込み、読み込んだOSやアプリケーションソフトウェアを主記憶装置に展開させながら、これらのOSやアプリケーションソフトウェアに基づいた演算処理を行なう。この演算結果に基づいて、ノイズ除去装置30が各ハードウェアを制御する。これにより、図1の機能ブロックによる処理は実現される。つまり、ノイズ除去装置30は、ハードウェアとソフトウェアが協働することにより実現することができる。 Then, in the noise removal device 30, the arithmetic processing unit reads the OS and application software from the auxiliary storage device, expands the read OS and application software to the main storage device, and performs arithmetic processing based on these OS and application software. Let's do it. Based on this calculation result, the noise removal device 30 controls each piece of hardware. Thereby, the processing by the functional blocks of FIG. 1 is realized. In other words, the noise removal device 30 can be realized by hardware and software working together.

データ置換部301は、ロボット10から受信したセンサ信号から、加速度センサ100により検出された加速度及び時刻情報を取得する。データ置換部301は、取得した加速度データのうち、溶接ガン13が動作した動作区間の加速度センサ100の加速度データを後述する擬似加速度データに置き換えて、ロボット制御装置20に出力する。
図2は、取得された加速度データの一例を示す図である。なお、図2の横軸は時刻を示し、図2の縦軸は加速度を示す。また、図2は、例えば、「スポット命令」の動作シーケンスにより溶接ガン13が動作した期間、すなわち溶接ガン13が打つタイミングである動作区間を、破線の矩形で示す。
なお、破線で示す動作区間では、上述した「アプローチ」、「ガン開き」、「加圧」、及び「ガン開き」の一連のスポット溶接の動作が行われる。例えば、ノイズ除去装置30(制御部300)は、ロボット制御装置20からロボット10に出力される動作指令信号に基づいて、前記動作区間を特定するようにしてもよい。
The data replacement unit 301 acquires the acceleration detected by the acceleration sensor 100 and time information from the sensor signal received from the robot 10. Of the acquired acceleration data, the data replacement unit 301 replaces the acceleration data of the acceleration sensor 100 in the operation section in which the welding gun 13 operated with pseudo acceleration data, which will be described later, and outputs the data to the robot control device 20.
FIG. 2 is a diagram showing an example of acquired acceleration data. Note that the horizontal axis in FIG. 2 indicates time, and the vertical axis in FIG. 2 indicates acceleration. Further, in FIG. 2, for example, a period in which the welding gun 13 operates according to the operation sequence of the "spot command", that is, an operation section that is the timing of the welding gun 13 to strike, is indicated by a broken rectangle.
In addition, in the operation section indicated by the broken line, a series of spot welding operations of "approach", "gun opening", "pressurization", and "gun opening" described above are performed. For example, the noise removal device 30 (control unit 300) may specify the motion section based on a motion command signal output from the robot control device 20 to the robot 10.

データ置換部301は、例えば、溶接ガン13の動作による衝撃の影響を受けた、破線で示す動作区間の加速度データを、図3に示すように、一旦削除する。そして、データ置換部301は、溶接ガン13が動作していない区間であって、かつ、ロボット10が溶接ガン13の動作時と同様の姿勢(動作)をしている区間の加速度データを抽出する。
具体的には、スポット溶接中においてロボット10は静止することから、データ置換部301は、溶接ガン13のチップが当たった後のガン軸が停止している状態、かつ、ロボット10が同姿勢で静止している状態の区間の加速度データ、すなわち動作区間前後の加速度データを抽出する。例えば、図3に示す加速度データの場合、動作区間直後の区間であれば溶接ガン13が動作しておらず、かつ、ロボット10が溶接ガン13の動作時と同様の姿勢(動作)であることから、データ置換部301は、動作区間直後の区間の加速度データを抽出する。データ置換部301は、抽出した加速度データに対してFFT(Fast Fourier Transform)等のフーリエ解析を行う。そして、データ置換部301は、フーリエ解析して得られた周波数スペクトルデータを後述する記憶部310に記憶する。
図4は、抽出された加速度データに対するフーリエ解析の結果の一例を示す図である。
データ置換部301は、記憶部310に記憶された図4のフーリエ解析の結果に基づいて、正弦波を合成した合成波形を、疑似加速度データとして生成する。データ置換部301は、生成した疑似加速度データを、動作区間の加速度データとして置き換える。
For example, the data replacement unit 301 temporarily deletes the acceleration data in the motion section indicated by the broken line, which is affected by the impact caused by the motion of the welding gun 13, as shown in FIG. Then, the data replacement unit 301 extracts acceleration data for a section where the welding gun 13 is not operating and the robot 10 is in the same posture (movement) as when the welding gun 13 is operating. .
Specifically, since the robot 10 is stationary during spot welding, the data replacement unit 301 records the state in which the gun axis after being hit by the tip of the welding gun 13 is stopped and the robot 10 is in the same posture. Extract acceleration data in a stationary section, that is, acceleration data before and after a motion section. For example, in the case of the acceleration data shown in FIG. 3, the welding gun 13 is not operating in the section immediately after the operation section, and the robot 10 is in the same posture (movement) as when the welding gun 13 is operating. From this, the data replacement unit 301 extracts the acceleration data of the section immediately after the motion section. The data replacement unit 301 performs Fourier analysis such as FFT (Fast Fourier Transform) on the extracted acceleration data. Then, the data replacement unit 301 stores the frequency spectrum data obtained through the Fourier analysis in the storage unit 310, which will be described later.
FIG. 4 is a diagram showing an example of the results of Fourier analysis on the extracted acceleration data.
The data replacement unit 301 generates a composite waveform of sine waves as pseudo acceleration data based on the result of the Fourier analysis shown in FIG. 4 stored in the storage unit 310. The data replacement unit 301 replaces the generated pseudo acceleration data as acceleration data of the motion section.

図5は、動作区間が疑似加速度データに置き換えられた加速度データの一例を示す図である。
そして、データ置換部301は、動作区間の加速度データとして疑似加速度データに置き換えられた加速度データを、出力データとしてロボット制御装置20に出力する。そうすることで、ノイズ除去装置30は、溶接ガン13を動作させて加速度センサ100の計測を行う場合でも、溶接ガン13の影響により発生するノイズを除去することができる。
FIG. 5 is a diagram showing an example of acceleration data in which motion sections are replaced with pseudo acceleration data.
Then, the data replacement unit 301 outputs the acceleration data replaced with the pseudo acceleration data as the acceleration data of the motion section to the robot control device 20 as output data. By doing so, the noise removal device 30 can remove noise generated due to the influence of the welding gun 13 even when the welding gun 13 is operated and the acceleration sensor 100 is measured.

なお、データ置換部301は、疑似加速度データの生成にあたり、動作区間と動作区間に隣接する区間との加速度データが滑らかに繋がるように、動作区間における削除前の加速度データの両端の値と、疑似加速度データの両端の値との差が所定の閾値以下となるように、合成する正弦波の位相を調整するようにしてもよい。ここで、所定の閾値は、要求されるノイズ除去の精度に応じて適宜決定されてもよい。 Note that when generating the pseudo acceleration data, the data replacement unit 301 replaces the values at both ends of the acceleration data before deletion in the motion section with the pseudo acceleration data so that the acceleration data of the motion section and the section adjacent to the motion section are smoothly connected. The phase of the sine wave to be synthesized may be adjusted so that the difference between the values at both ends of the acceleration data is equal to or less than a predetermined threshold. Here, the predetermined threshold value may be determined as appropriate depending on the required accuracy of noise removal.

また、データ置換部301は、次の溶接ガン13の動作時におけるロボット10の動作(姿勢)が、図2の動作区間におけるロボット10の動作(姿勢)と同様の場合、記憶部310に記憶された周波数スペクトルデータを使用してもよい。そうすることで、データ置換部301は、溶接ガン13が動作する度に、加速度データを抽出しフーリエ解析を行う必要がなくなり、処理時間を短縮することができる。ただし、この場合、データ置換部301は、周波数スペクトルデータとともに、動作区間におけるロボット10の動作(姿勢)のデータも記憶するようにすることが好ましい。 Furthermore, if the motion (posture) of the robot 10 during the next operation of the welding gun 13 is similar to the motion (posture) of the robot 10 in the motion section of FIG. Frequency spectrum data may also be used. By doing so, data replacement unit 301 does not need to extract acceleration data and perform Fourier analysis every time welding gun 13 operates, and can shorten processing time. However, in this case, it is preferable that the data replacement unit 301 also stores data on the motion (posture) of the robot 10 in the motion section along with the frequency spectrum data.

記憶部310は、RAM等であり、データ置換部301によりフーリエ解析して得られた周波数スペクトルデータ等を記憶する。 The storage unit 310 is a RAM or the like, and stores frequency spectrum data etc. obtained by Fourier analysis by the data replacement unit 301.

<ノイズ除去装置30の置換処理>
次に、本実施形態に係るノイズ除去装置30の置換処理に係る動作について説明する。
図6は、ノイズ除去装置30の置換処理について説明するフローチャートである。ここで示すフローは、ノイズ除去装置30がロボット制御装置20からロボット10に出力される動作指令信号に基づいて、溶接ガン13の動作を検知する度に繰り返し実行される。
<Replacement process of noise removal device 30>
Next, the operation related to the replacement process of the noise removal device 30 according to the present embodiment will be described.
FIG. 6 is a flowchart illustrating the replacement process of the noise removal device 30. The flow shown here is repeatedly executed every time the noise removal device 30 detects the operation of the welding gun 13 based on the operation command signal output from the robot control device 20 to the robot 10.

ステップS11において、データ置換部301は、ロボット10から受信したセンサ信号から、加速度センサ100により検出された加速度データを取得する。 In step S11, the data replacement unit 301 acquires acceleration data detected by the acceleration sensor 100 from the sensor signal received from the robot 10.

ステップS12において、データ置換部301は、ステップS11で取得された加速度データのうち、溶接ガン13が動作した動作区間の加速度データを削除する。 In step S12, the data replacement unit 301 deletes the acceleration data of the operation section in which the welding gun 13 operated from among the acceleration data acquired in step S11.

ステップS13において、データ置換部301は、溶接ガン13が動作していない区間であって、かつ、ロボット10が溶接ガン13の動作時と同様の姿勢をしている区間の加速度データを抽出する。 In step S13, the data replacement unit 301 extracts acceleration data for a section in which the welding gun 13 is not operating and in which the robot 10 is in the same posture as when the welding gun 13 is operating.

ステップS14において、データ置換部301は、ステップS13で抽出された加速度データに対してフーリエ解析を行う。 In step S14, the data replacement unit 301 performs Fourier analysis on the acceleration data extracted in step S13.

ステップS15において、データ置換部301は、ステップS14でのフーリエ解析の結果に基づいて、正弦波を合成した合成波形を、疑似加速度データとして生成する。 In step S15, the data replacement unit 301 generates a synthesized waveform obtained by synthesizing the sine waves as pseudo acceleration data based on the result of the Fourier analysis in step S14.

ステップS16において、データ置換部301は、ステップS15で生成された疑似加速度データを、動作区間の加速度データとして置き換える。そして、データ置換部301は、動作区間において疑似加速度データに置き換えた加速度データをロボット制御装置20に出力する。 In step S16, the data replacement unit 301 replaces the pseudo acceleration data generated in step S15 as acceleration data of the motion section. Then, the data replacement unit 301 outputs the acceleration data replaced with the pseudo acceleration data in the motion section to the robot control device 20.

以上により、第1実施形態のノイズ除去装置30は、ロボット10に取り付けられた溶接ガン13に設置された加速度センサ100から取得された加速度データのうち、溶接ガン13が動作した動作区間の加速度データを削除する。ノイズ除去装置30は、溶接ガン13が動作していない区間であって、かつ、ロボット10が溶接ガン13の動作時と同様の姿勢をしている区間の加速度データを抽出し、抽出された加速度データに対してフーリエ解析を行う。ノイズ除去装置30は、フーリエ解析の結果に基づいて、正弦波を合成した合成波形を、疑似加速度データとして生成し、生成した疑似加速度データを動作区間の加速度データとして置き換える。
これにより、ノイズ除去装置30は、溶接ガン13を動作させて加速度センサ100の計測を行う場合でも、溶接ガン13の影響により発生するノイズを除去することができる。
以上、第1実施形態について説明した。
As described above, the noise removal device 30 according to the first embodiment is configured to use acceleration data in the operation section in which the welding gun 13 operates, among the acceleration data acquired from the acceleration sensor 100 installed on the welding gun 13 attached to the robot 10. Delete. The noise removal device 30 extracts acceleration data of a section where the welding gun 13 is not operating and where the robot 10 is in the same posture as when the welding gun 13 is operating, and extracts the extracted acceleration data. Perform Fourier analysis on the data. Based on the result of the Fourier analysis, the noise removal device 30 generates a composite waveform of sine waves as pseudo acceleration data, and replaces the generated pseudo acceleration data as acceleration data of the motion section.
Thereby, the noise removal device 30 can remove the noise generated due to the influence of the welding gun 13 even when the welding gun 13 is operated and the acceleration sensor 100 is measured.
The first embodiment has been described above.

<第2実施形態>
第2実施形態に係るノイズ除去装置30Aは、溶接ガンが動作していない区間であって、かつ、ロボットが溶接ガンの動作時と同様の姿勢をしている区間における加速度センサの加速度データの時系列データを、動作区間の擬似加速度データとする点が、第1実施形態と異なる。
以下に、第2実施形態について説明する。
<Second embodiment>
The noise removal device 30A according to the second embodiment uses acceleration data of an acceleration sensor in a section where the welding gun is not operating and where the robot is in the same posture as when the welding gun is operating. This embodiment differs from the first embodiment in that the series data is pseudo acceleration data of the motion section.
A second embodiment will be described below.

図7は、第2実施形態に係るロボットシステムの機能的構成例を示す機能ブロック図である。なお、図1のロボットシステムの要素と同様の機能を有する要素については、同じ符号を付し、詳細な説明は省略する。
第2実施形態に係るノイズ除去装置30Aは、第1実施形態に係るノイズ除去装置30と同様に、制御部300a、及び記憶部310aを含んで構成される。また、制御部300aは、データ置換部301aを含んで構成される。
FIG. 7 is a functional block diagram showing an example of the functional configuration of the robot system according to the second embodiment. Note that elements having the same functions as the elements of the robot system in FIG. 1 are given the same reference numerals, and detailed explanations are omitted.
The noise removal device 30A according to the second embodiment is configured to include a control section 300a and a storage section 310a, similarly to the noise removal device 30 according to the first embodiment. Further, the control section 300a is configured to include a data replacement section 301a.

データ置換部301aは、図8に示すように、第1実施形態に係るデータ置換部301と同様に、溶接ガン13の動作による衝撃の影響を受けた、破線で示す動作区間の加速度データを一旦削除する。そして、データ置換部301aは、第1実施形態に係るデータ置換部301と同様に、溶接ガン13が動作していない区間であって、かつ、ロボット10が溶接ガン13の動作時と同様の姿勢(動作)をしている区間、すなわち動作区間前後の区間の加速度データの時系列データを抽出する。データ置換部301aは、抽出した加速度データの時系列データを後述する記憶部310aに記憶する。そして、データ置換部301aは、例えば、図9に示すように、記憶部310aに記憶された加速度データの時系列データを、疑似加速度データとして動作区間に埋め込んで置き換える。 As shown in FIG. 8, like the data replacing unit 301 according to the first embodiment, the data replacing unit 301a temporarily replaces the acceleration data in the operation section indicated by the broken line, which is affected by the impact caused by the operation of the welding gun 13. delete. Similarly to the data replacing unit 301 according to the first embodiment, the data replacing unit 301a is configured in a section in which the welding gun 13 is not operating, and in which the robot 10 is in the same posture as when the welding gun 13 is operating. (movement), that is, the time series data of acceleration data of the section before and after the motion period is extracted. The data replacement unit 301a stores time-series data of the extracted acceleration data in a storage unit 310a, which will be described later. Then, for example, as shown in FIG. 9, the data replacement unit 301a embeds and replaces the time series data of the acceleration data stored in the storage unit 310a in the motion section as pseudo acceleration data.

ここで、図9に示すように、疑似加速度データに置き換える際に、任意のタイミングで波形に置き換えると、動作区間の境界付近で加速度データの波形に連続性がなくなり、高周波のデータになってしまう。この加速度データの波形の不連続性を避けるため、データ置換部301aは、加速度データの継ぎ目周辺、すなわち動作区間の境界周辺で平均化フィルタ(平滑化フィルタ)等を適用してもよい。そうすることで、図10に示すように、動作区間と隣接する区間との加速度データが滑らかに繋がるようにすることができる。
また、平均化フィルタを適用する区間を動作区間の境界周辺にすることで、ノイズのない部分の加速度データに対する平均化フィルタの影響を最小限に抑えることができる。
なお、図10では、動作区間の左端の境界周辺の加速度データに対して平均化フィルタを適用したが、動作区間の右端の境界周辺の加速度データに対しても平均化フィルタを適用してもよい。
Here, as shown in Figure 9, when replacing the pseudo acceleration data with a waveform at an arbitrary timing, the waveform of the acceleration data loses continuity near the boundary of the operation section and becomes high frequency data. . In order to avoid this discontinuity in the waveform of the acceleration data, the data replacement unit 301a may apply an averaging filter (smoothing filter) or the like around the joint of the acceleration data, that is, around the boundary of the motion section. By doing so, as shown in FIG. 10, it is possible to smoothly connect the acceleration data between the motion section and the adjacent section.
Furthermore, by applying the averaging filter to the area around the boundary of the motion section, the influence of the averaging filter on acceleration data in noise-free areas can be minimized.
Note that in FIG. 10, the averaging filter is applied to the acceleration data around the left-most boundary of the motion section, but the averaging filter may also be applied to the acceleration data around the right-most boundary of the motion section. .

そして、データ置換部301aは、動作区間において疑似加速度データに置き換えた加速度データをロボット制御装置20に出力する。
なお、データ置換部301aは、次の溶接ガン13の動作時におけるロボット10の姿勢(動作)が、図8の動作区間におけるロボット10の姿勢(動作)と同様の場合、記憶部310aに記憶された加速度データの時系列データを使用してもよい。そうすることで、データ置換部301aは、溶接ガン13が動作する度に、加速度データの時系列データを抽出する必要がなくなり、処理時間を短縮することができる。ただし、この場合、データ置換部301aは、加速度データの時系列データとともに、動作区間におけるロボット10の姿勢(動作)のデータも記憶するようにすることが好ましい。
The data replacement unit 301a then outputs the acceleration data replaced with the pseudo acceleration data in the motion section to the robot control device 20.
Note that, if the posture (motion) of the robot 10 during the next operation of the welding gun 13 is the same as the posture (motion) of the robot 10 in the motion section of FIG. Time series data of acceleration data may also be used. By doing so, the data replacement unit 301a does not need to extract time-series data of acceleration data every time the welding gun 13 operates, and can shorten processing time. However, in this case, it is preferable that the data replacement unit 301a also stores data on the posture (motion) of the robot 10 in the motion section, along with the time series data of the acceleration data.

なお、データ置換部301aは、抽出した加速度データの時系列データを疑似加速度データとして動作区間に埋め込んで、加速度データの継ぎ目付近で平均化フィルタを適用したが、これに限定されない。例えば、データ置換部301aは、図11に示すように、動作区間と動作区間に隣接する区間との継ぎ目の加速度データの値が近いタイミングでデータを埋め込んでもよい。 Note that the data replacement unit 301a embeds the extracted time series data of the acceleration data as pseudo acceleration data in the motion section and applies an averaging filter near the joint of the acceleration data, but the present invention is not limited thereto. For example, as shown in FIG. 11, the data replacement unit 301a may embed data at a timing when the values of the acceleration data at the joint between the motion section and the section adjacent to the motion section are close.

記憶部310aは、溶接ガン13が動作していない区間であって、かつ、ロボットが溶接ガン13の動作時と同様の姿勢をしている区間における、データ置換部301aにより抽出された加速度データの時系列データを記憶する。 The storage unit 310a stores acceleration data extracted by the data replacement unit 301a in an area where the welding gun 13 is not operating and the robot is in the same posture as when the welding gun 13 is operating. Store time series data.

<ノイズ除去装置30Aの置換処理>
次に、第2実施形態に係るノイズ除去装置30Aの置換処理に係る動作について説明する。
図12は、ノイズ除去装置30Aの置換処理について説明するフローチャートである。ここで示すフローは、ノイズ除去装置30Aがロボット制御装置20からロボット10に出力される動作指令に基づいて、溶接ガン13の動作を検知する度に繰り返し実行される。
なお、図12に示す置換処理において、ステップS21及びステップS22の処理は、図7の第1実施形態のステップS11及びステップS12の処理と同様であり、説明は省略する。
<Replacement process of noise removal device 30A>
Next, the operation related to the replacement process of the noise removal device 30A according to the second embodiment will be described.
FIG. 12 is a flowchart illustrating the replacement process of the noise removal device 30A. The flow shown here is repeatedly executed every time the noise removal device 30A detects the operation of the welding gun 13 based on the operation command output from the robot control device 20 to the robot 10.
Note that in the replacement process shown in FIG. 12, the processes in step S21 and step S22 are the same as the processes in step S11 and step S12 in the first embodiment in FIG. 7, and the description thereof will be omitted.

ステップS23において、データ置換部301aは、溶接ガン13が動作していない区間であって、かつ、ロボット10が溶接ガン13の動作時と同様の姿勢をしている区間の加速度データを、疑似加速度データとして抽出する。 In step S23, the data replacement unit 301a converts the acceleration data of the section in which the welding gun 13 is not operating and in which the robot 10 is in the same posture as when the welding gun 13 is operating into a pseudo acceleration. Extract as data.

ステップS24において、データ置換部301aは、ステップS23で抽出された疑似加速度データを動作区間の加速度データとして置き換える。 In step S24, the data replacement unit 301a replaces the pseudo acceleration data extracted in step S23 as acceleration data of the motion section.

ステップS25において、データ置換部301aは、ステップS24で置き換えられた加速度データの継ぎ目周辺で平均化フィルタを適用し平滑化する。そして、データ置換部301aは、動作区間において疑似加速度データに置き換えた加速度データをロボット制御装置20に出力する。 In step S25, the data replacement unit 301a smoothes the acceleration data replaced in step S24 by applying an averaging filter around the joint. The data replacement unit 301a then outputs the acceleration data replaced with the pseudo acceleration data in the motion section to the robot control device 20.

以上により、第2実施形態のノイズ除去装置30Aは、ロボット10に取り付けられた溶接ガン13に設置された加速度センサ100から取得された加速度データのうち、溶接ガン13が動作した動作区間の加速度データを削除する。ノイズ除去装置30Aは、溶接ガン13が動作していない区間であって、かつ、ロボット10が溶接ガン13の動作時と同様の姿勢をしている区間の加速度データの時系列データを、疑似加速度データとして抽出する。ノイズ除去装置30Aは、抽出した疑似加速度データを動作区間の加速度データとして置き換える。
これにより、ノイズ除去装置30Aは、溶接ガン13を動作させて加速度センサ100の計測を行う場合でも、溶接ガン13の影響により発生するノイズを除去することができる。
以上、第2実施形態について説明した。
As described above, the noise removal device 30A according to the second embodiment is configured to collect acceleration data of the operation section in which the welding gun 13 operates, among the acceleration data acquired from the acceleration sensor 100 installed on the welding gun 13 attached to the robot 10. Delete. The noise removal device 30A converts time-series data of acceleration data in a section in which the welding gun 13 is not operating and in which the robot 10 is in the same posture as when the welding gun 13 is operating into a pseudo acceleration. Extract as data. The noise removal device 30A replaces the extracted pseudo acceleration data as acceleration data of the motion section.
Thereby, the noise removal device 30A can remove noise generated due to the influence of the welding gun 13 even when the welding gun 13 is operated to measure the acceleration sensor 100.
The second embodiment has been described above.

以上、第1実施形態、及び第2実施形態について説明したが、ノイズ除去装置30、30Aは、上述の実施形態に限定されるものではなく、目的を達成できる範囲での変形、改良等を含む。 Although the first embodiment and the second embodiment have been described above, the noise removal devices 30 and 30A are not limited to the above-described embodiments, and include modifications, improvements, etc. within the range that can achieve the purpose. .

<変形例>
上述の第1実施形態、及び第2実施形態では、ノイズ除去装置30、30Aは、ロボット制御装置20と異なる装置として例示したが、ノイズ除去装置30、30Aの一部又は全部の機能を、ロボット制御装置20が備えるようにしてもよい。
<Modified example>
In the first and second embodiments described above, the noise removal devices 30 and 30A are exemplified as devices different from the robot control device 20, but some or all of the functions of the noise removal devices 30 and 30A can be performed on the robot. The control device 20 may be provided.

なお、第1実施形態、及び第2実施形態に係るノイズ除去装置30、30Aに含まれる各機能は、ハードウェア、ソフトウェア又はこれらの組み合わせによりそれぞれ実現することができる。ここで、ソフトウェアによって実現されるとは、コンピュータがプログラムを読み込んで実行することにより実現されることを意味する。
また、ノイズ除去装置30、30Aに含まれる各構成部は、電子回路等を含むハードウェア、ソフトウェア又はこれらの組み合わせにより実現することができる。
Note that each function included in the noise removal devices 30 and 30A according to the first embodiment and the second embodiment can be realized by hardware, software, or a combination thereof. Here, being realized by software means being realized by a computer reading and executing a program.
Further, each component included in the noise removal devices 30 and 30A can be realized by hardware including an electronic circuit, software, or a combination thereof.

プログラムは、様々なタイプの非一時的なコンピュータ可読媒体(Non-transitory computer readable medium)を用いて格納され、コンピュータに供給することができる。非一時的なコンピュータ可読媒体は、様々なタイプの実体のある記録媒体(Tangible storage medium)を含む。非一時的なコンピュータ可読媒体の例は、磁気記録媒体(例えば、フレキシブルディスク、磁気テープ、ハードディスクドライブ)、光磁気記録媒体(例えば、光磁気ディスク)、CD-ROM(Read Only Memory)、CD-R、CD-R/W、半導体メモリ(例えば、マスクROM、PROM(Programmable ROM)、EPROM(Erasable PROM)、フラッシュROM、RAMを含む。また、プログラムは、様々なタイプの一時的なコンピュータ可読媒体(Transitory computer readable medium)によってコンピュータに供給されてもよい。一時的なコンピュータ可読媒体の例は、電気信号、光信号、及び電磁波を含む。一時的なコンピュータ可読媒体は、電線及び光ファイバ等の有線通信路、又は、無線通信路を介して、プログラムをコンピュータに供給できる。 The program can be stored and provided to the computer using various types of non-transitory computer readable media. Non-transitory computer-readable media include various types of tangible storage media. Examples of non-transitory computer-readable media include magnetic recording media (e.g., flexible disks, magnetic tape, hard disk drives), magneto-optical recording media (e.g., magneto-optical disks), CD-ROMs (Read Only Memory), and CD-ROMs. R, CD-R/W, semiconductor memory (including, for example, mask ROM, PROM (Programmable ROM), EPROM (Erasable PROM), flash ROM, RAM). Programs may also be stored in various types of temporary computer-readable media. (Transitory computer readable medium). Examples of transitory computer readable media include electrical signals, optical signals, and electromagnetic waves. Transient computer readable media include electrical wires, optical fibers, etc. The program can be supplied to the computer via a wired communication path or a wireless communication path.

なお、記録媒体に記録されるプログラムを記述するステップは、その順序に沿って時系列的に行われる処理はもちろん、必ずしも時系列的に処理されなくとも、並列的あるいは個別に実行される処理をも含むものである。 Note that the step of writing a program to be recorded on a recording medium includes not only processes that are performed in chronological order, but also processes that are not necessarily performed in chronological order but are executed in parallel or individually. It also includes.

以上を換言すると、本開示のノイズ除去装置は、次のような構成を有する各種各様の実施形態を取ることができる。 In other words, the noise removal device of the present disclosure can take various embodiments having the following configurations.

(1)本開示のノイズ除去装置30は、ロボット10に取り付けられた溶接ガン13に設置された加速度センサ100の加速度データからノイズを除去するノイズ除去装置であって、溶接ガン13が動作した動作区間の加速度センサ100の加速度データを擬似加速度データに置き換えて出力するデータ置換部301を備える。
このノイズ除去装置30によれば、溶接ガン13を動作させて加速度センサ100の計測を行う場合でも、溶接ガン13の影響により発生するノイズを除去することができる。
(1) The noise removal device 30 of the present disclosure is a noise removal device that removes noise from acceleration data of an acceleration sensor 100 installed in a welding gun 13 attached to a robot 10, and includes the motion of the welding gun 13. A data replacement unit 301 is provided that replaces the acceleration data of the acceleration sensor 100 in the section with pseudo acceleration data and outputs the data.
According to this noise removal device 30, even when the welding gun 13 is operated to measure the acceleration sensor 100, noise generated due to the influence of the welding gun 13 can be removed.

(2) (1)に記載のノイズ除去装置30において、溶接ガン13が動作していない区間であって、かつ、ロボット10が溶接ガン13の動作時と同様の姿勢をしている区間における加速度センサ100の加速度データをフーリエ解析して得られる周波数スペクトルデータを記憶する記憶部310をさらに備え、データ置換部301は、記憶部310に記憶された周波数スペクトルデータを用いて、正弦波を合成して擬似加速度データとしてもよい。
そうすることで、動作区間におけるノイズを精度良く除去することができる。
(2) In the noise removal device 30 described in (1), acceleration in a section where the welding gun 13 is not operating and the robot 10 is in the same posture as when the welding gun 13 is operating. The data replacement unit 301 further includes a storage unit 310 that stores frequency spectrum data obtained by Fourier analysis of the acceleration data of the sensor 100, and the data replacement unit 301 synthesizes a sine wave using the frequency spectrum data stored in the storage unit 310. It may also be used as pseudo acceleration data.
By doing so, noise in the operating section can be removed with high accuracy.

(3) (1)に記載のノイズ除去装置30Aにおいて、溶接ガン13が動作していない区間であって、かつ、ロボット10が前記溶接ガンの動作時と同様の姿勢をしている区間における加速度センサ100の加速度データを時系列データとして記憶する記憶部310aをさらに備え、データ置換部301aは、記憶部310aに記憶された時系列データを擬似加速度データとしてもよい。
そうすることで、動作区間におけるノイズを精度良く除去することができる。
(3) In the noise removal device 30A described in (1), acceleration in a section where the welding gun 13 is not operating and the robot 10 is in the same posture as when the welding gun is operating. The storage unit 310a may further include a storage unit 310a that stores acceleration data of the sensor 100 as time-series data, and the data replacement unit 301a may use the time-series data stored in the storage unit 310a as pseudo acceleration data.
By doing so, noise in the operating section can be removed with high accuracy.

(4) (1)から(3)のいずれかに記載のノイズ除去装置30、30Aにおいて、溶接ガン13の動作は、溶接ガン13に対する動作指令信号に基づく動作であってもよい。
そうすることで、溶接ガン13が動作する動作区間を精度良く検知することができる。
(4) In the noise removing device 30, 30A according to any one of (1) to (3), the operation of the welding gun 13 may be an operation based on an operation command signal for the welding gun 13.
By doing so, the operating range in which the welding gun 13 operates can be detected with high accuracy.

(5) (2)に記載のノイズ除去装置30において、データ置換部301は、正弦波を合成するときに、動作区間と隣接する区間の加速度データと滑らかに繋がるように正弦波の位相を調整してもよい。
そうすることで、動作区間と隣接する区間との加速度データを滑らかに繋げることができる。
(5) In the noise removal device 30 described in (2), when synthesizing the sine wave, the data replacement unit 301 adjusts the phase of the sine wave so that it smoothly connects the motion section and the acceleration data of the adjacent section. You may.
By doing so, it is possible to smoothly connect the acceleration data between the motion section and the adjacent section.

(6) (3)に記載のノイズ除去装置30Aにおいて、データ置換部301aは、動作区間と隣接する区間の加速度データと滑らかに繋がるように、動作区間と隣接する区間との繋ぎ目周辺の加速度データに対して平均化フィルタを適用してもよい。
そうすることで、動作区間と隣接する区間との加速度データを滑らかに繋げることができる。
(6) In the noise removal device 30A described in (3), the data replacement unit 301a converts the acceleration around the joint between the motion section and the adjacent section so that the motion section and the adjacent section are smoothly connected to the acceleration data of the adjacent section. An averaging filter may be applied to the data.
By doing so, it is possible to smoothly connect the acceleration data between the motion section and the adjacent section.

10 ロボット
20 ロボット制御装置
30、30A ノイズ除去装置
100 加速度センサ
300、300a 制御部
301、301a データ置換部
310、310a 記憶部
10 robot 20 robot control device 30, 30A noise removal device 100 acceleration sensor 300, 300a control section 301, 301a data replacement section 310, 310a storage section

Claims (5)

ロボットに取り付けられた溶接ガンに設置された加速度センサの加速度データからノイズを除去するノイズ除去装置であって、
前記溶接ガンが動作した動作区間の前記加速度センサの加速度データを擬似加速度データに置き換えて出力するデータ置換部と、
前記溶接ガンが動作していない区間であって、かつ、前記ロボットが前記溶接ガンの動作時と同様の姿勢をしている区間における前記加速度センサの加速度データをフーリエ解析して得られる周波数スペクトルデータを記憶する記憶部と、を備え
前記データ置換部は、前記記憶部に記憶された前記周波数スペクトルデータを用いて、正弦波を合成して前記擬似加速度データとするノイズ除去装置。
A noise removal device that removes noise from acceleration data of an acceleration sensor installed in a welding gun attached to a robot,
a data replacement unit that replaces the acceleration data of the acceleration sensor in the operation section in which the welding gun operated with pseudo acceleration data and outputs the pseudo acceleration data;
Frequency spectrum data obtained by Fourier analysis of acceleration data of the acceleration sensor in a section where the welding gun is not operating and the robot is in the same posture as when the welding gun is operating. and a storage unit for storing the information.
The data replacement unit is a noise removal device that synthesizes a sine wave using the frequency spectrum data stored in the storage unit to generate the pseudo acceleration data.
ロボットに取り付けられた溶接ガンに設置された加速度センサの加速度データからノイズを除去するノイズ除去装置であって、
前記溶接ガンが動作した動作区間の前記加速度センサの加速度データを擬似加速度データに置き換えて出力するデータ置換部と、
前記溶接ガンが動作していない区間であって、かつ、前記ロボットが前記溶接ガンの動作時と同様の姿勢をしている区間における前記加速度センサの加速度データを時系列データとして記憶する記憶部と、を備え
前記データ置換部は、前記記憶部に記憶された前記時系列データを前記擬似加速度データとするノイズ除去装置。
A noise removal device that removes noise from acceleration data of an acceleration sensor installed in a welding gun attached to a robot,
a data replacement unit that replaces the acceleration data of the acceleration sensor in the operation section in which the welding gun operated with pseudo acceleration data and outputs the pseudo acceleration data;
a storage unit that stores acceleration data of the acceleration sensor as time-series data in a section in which the welding gun is not operating and in which the robot is in the same posture as when the welding gun is operating ; , comprising ;
The data replacement unit is a noise removal device that uses the time series data stored in the storage unit as the pseudo acceleration data.
前記溶接ガンの動作は、前記溶接ガンに対する動作指令信号に基づく動作である、請求項1又は請求項2に記載のノイズ除去装置。 The noise removal device according to claim 1 or 2 , wherein the operation of the welding gun is an operation based on an operation command signal for the welding gun. 前記データ置換部は、前記正弦波を合成するときに、前記動作区間と隣接する区間の加速度データと滑らかに繋がるように前記正弦波の位相を調整する、請求項に記載のノイズ除去装置。 2. The noise removal device according to claim 1 , wherein the data replacement unit adjusts the phase of the sine wave so that it smoothly connects with acceleration data of an interval adjacent to the motion interval when synthesizing the sine wave. 前記データ置換部は、前記動作区間と隣接する区間の加速度データと滑らかに繋がるように、前記動作区間と前記隣接する区間との繋ぎ目周辺の加速度データに対して平均化フィルタを適用する、請求項に記載のノイズ除去装置。 The data replacement unit applies an averaging filter to acceleration data around a joint between the motion section and the adjacent section so that the motion section and the acceleration data of the adjacent section are smoothly connected. The noise removal device according to item 2 .
JP2019234412A 2019-12-25 2019-12-25 Noise removal device Active JP7405602B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019234412A JP7405602B2 (en) 2019-12-25 2019-12-25 Noise removal device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019234412A JP7405602B2 (en) 2019-12-25 2019-12-25 Noise removal device

Publications (2)

Publication Number Publication Date
JP2021102249A JP2021102249A (en) 2021-07-15
JP7405602B2 true JP7405602B2 (en) 2023-12-26

Family

ID=76755579

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019234412A Active JP7405602B2 (en) 2019-12-25 2019-12-25 Noise removal device

Country Status (1)

Country Link
JP (1) JP7405602B2 (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011167817A (en) 2010-02-19 2011-09-01 Fanuc Ltd Robot having learning control function
JP2013061834A (en) 2011-09-14 2013-04-04 Seiko Epson Corp Robot device and control method of the same
JP2018051635A (en) 2016-09-26 2018-04-05 セイコーエプソン株式会社 Robot control device, robot and robot system
JP2018171665A (en) 2017-03-31 2018-11-08 セイコーエプソン株式会社 Device, robot, and robot system
JP2019185415A (en) 2018-04-11 2019-10-24 日産自動車株式会社 Abnormality determination device and abnormality determination method
JP2019195871A (en) 2018-05-09 2019-11-14 ファナック株式会社 Control system and driven body control method

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011167817A (en) 2010-02-19 2011-09-01 Fanuc Ltd Robot having learning control function
JP2013061834A (en) 2011-09-14 2013-04-04 Seiko Epson Corp Robot device and control method of the same
JP2018051635A (en) 2016-09-26 2018-04-05 セイコーエプソン株式会社 Robot control device, robot and robot system
JP2018171665A (en) 2017-03-31 2018-11-08 セイコーエプソン株式会社 Device, robot, and robot system
JP2019185415A (en) 2018-04-11 2019-10-24 日産自動車株式会社 Abnormality determination device and abnormality determination method
JP2019195871A (en) 2018-05-09 2019-11-14 ファナック株式会社 Control system and driven body control method

Also Published As

Publication number Publication date
JP2021102249A (en) 2021-07-15

Similar Documents

Publication Publication Date Title
JP5353656B2 (en) Robot controller
JP6456051B2 (en) Robot system control method, robot system, robot system control program, and recording medium
US7136256B2 (en) Head positioning control method for a storage device and head positioning control device
JP7294883B2 (en) CONTROL DEVICE, MACHINE SYSTEM, AND TIME SYNCHRONIZATION METHOD
CN102233587A (en) Apparatus and method for detecting contact position of robot
JP2010131711A (en) Method of controlling robot arm
KR20140004789A (en) Motor control device
US20230083001A1 (en) Deburring device and control system
JP7405602B2 (en) Noise removal device
CN104516313A (en) Position control with collision avoidance and adaption of machine model to real machine
JP6997068B2 (en) Robot control device, robot control system, and robot control method
JP3586125B2 (en) Magnetic disk drive and head positioning control system applied to the magnetic disk drive
WO2013089110A1 (en) Positioning device, and plc system
WO2016067901A1 (en) Contact control device
CN114127659B (en) Control system, control method and non-volatile storage device
JP2005317130A (en) Disk storage device, head positioning control system and method thereof
JP2021003788A (en) Control device and control method
JP6956138B2 (en) Waveform display device and waveform display method
KR20030041089A (en) Positioning control apparatus
JP2014124735A (en) Robot control method, robot control device, program, and robot
JP4574580B2 (en) Offline teaching device for work robots
JP2003165079A (en) Industrial robot
US11318606B2 (en) Controlling an automation assembly
CN113059243B (en) Control device and recording medium having program recorded thereon
CN115319274B (en) Platform position prediction method of IFOV system and galvanometer command delay compensation

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20221021

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230831

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230912

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20231106

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20231114

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20231214

R150 Certificate of patent or registration of utility model

Ref document number: 7405602

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150