KR20170065874A - Method for detecting damage on driving part of mobile robot - Google Patents
Method for detecting damage on driving part of mobile robot Download PDFInfo
- Publication number
- KR20170065874A KR20170065874A KR1020150172187A KR20150172187A KR20170065874A KR 20170065874 A KR20170065874 A KR 20170065874A KR 1020150172187 A KR1020150172187 A KR 1020150172187A KR 20150172187 A KR20150172187 A KR 20150172187A KR 20170065874 A KR20170065874 A KR 20170065874A
- Authority
- KR
- South Korea
- Prior art keywords
- robot
- torque
- value
- sensor
- damage
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 27
- 230000033001 locomotion Effects 0.000 claims abstract description 15
- 230000008569 process Effects 0.000 claims abstract description 8
- 230000002159 abnormal effect Effects 0.000 claims description 7
- 230000006866 deterioration Effects 0.000 abstract description 5
- 239000003638 chemical reducing agent Substances 0.000 description 7
- 238000003466 welding Methods 0.000 description 7
- 238000012423 maintenance Methods 0.000 description 4
- 238000012986 modification Methods 0.000 description 4
- 230000004048 modification Effects 0.000 description 4
- 238000004519 manufacturing process Methods 0.000 description 3
- 230000007246 mechanism Effects 0.000 description 3
- 230000008439 repair process Effects 0.000 description 3
- 230000005856 abnormality Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000003860 storage Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/005—Manipulators for mechanical processing tasks
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0075—Means for protecting the manipulator from its environment or vice versa
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
본 발명은 이동형 로봇의 구동부에 대한 손상을 감지하는 방법에 있어서: 다양한 모션으로 로봇을 구동하며 토크의 변동에 대응한 진동 데이터를 획득하여 대표값으로 저장하는 제1단계; 로봇의 실제 작업 과정에서 토크센서(25)와 진동센서(35)를 탑재하고 토크의 변동에 대응한 진동 데이터의 실제값을 생성하는 제2단계; 및 대표값과 실제값을 대비하여 그 차이가 설정된 범위를 벗어나면 경보를 발생하는 제3단계;를 포함하여 이루어지는 것을 특징으로 한다.
이에 따라, 로봇의 구동부에 토크센서과 진동센서를 탑재하고 상호 연관성을 기준으로 손상을 판단하여 로봇의 이동시 발생하는 손상으로 유발되는 구동부 기능저하를 방지하는 효과가 있다.A method for detecting damage to a driving unit of a mobile robot, the method comprising: a first step of driving the robot in various motions and acquiring vibration data corresponding to a variation in torque and storing the vibration data as a representative value; A second step of mounting the torque sensor (25) and the vibration sensor (35) in the actual working process of the robot and generating an actual value of the vibration data corresponding to the variation of the torque; And a third step of comparing the representative value with the actual value and generating an alarm when the difference is out of the set range.
Accordingly, the torque sensor and the vibration sensor are mounted on the driving unit of the robot and the damage is judged based on the correlation, thereby preventing the deterioration of the driving unit caused by the damage caused when the robot is moved.
Description
본 발명은 로봇의 손상을 감지하는 방법에 관한 것으로서, 보다 구체적으로는 이동하며 작업하기 위한 로봇의 이동시 발생하는 손상으로 유발되는 기능저하를 방지하는 이동형 로봇의 구동부 손상감지 방법에 관한 것이다.The present invention relates to a method of detecting a damage to a robot, and more particularly, to a method of detecting a damage to a drive unit of a mobile robot that prevents a function deterioration caused by a damage caused when a robot moves.
선박 건조현장에서 이동형 용접로봇이 아직 본격적인 상용화 단계에 있지 않으나 지속적인 관심하에 활발한 연구개발이 진행되면서 양산설계로 진일보하고 있다. 일예로 이동형 용접로봇은 일정 작업공간에서의 용접작업이 끝나면 다음 칸의 U-cell로 이동해야 한다. U-cell 이동 때마다 로봇의 기구부, 특히 모터부가 충격을 받게 되는 점은 해결되어야 하는 설계요소의 하나이다.In the field of shipbuilding, mobile welding robots are not yet in full commercialization stage, but they are proceeding to mass production design with active research and development under constant concern. For example, a mobile welding robot should move to the U-cell of the next column after welding in a certain work space. It is one of the design factors that should be solved that the robot part, especially the motor part, is impacted every time the U-cell moves.
통상 현장 작업자들은 로봇의 2, 3축 링크부위를 들어 올리는 경우가 자주 있는데 이러한 경우 모터의 감속기를 파손시키는 주 원인이 된다. 감속기 부분에 실제 손상이 일어난 이후에야 비로소 인지하는 경우가 허다하며, 감속기쪽에 문제가 발생했는지 알아보기 위해 기구부를 분해해야 하는 일이 발생한다. 용접로봇의 감속기 파손은 곧 생산성 저하와 직결되는 문제를 야기시킨다. 즉, 정확한 데이터(신호)를 기반으로 하지 않고 작업자의 직감으로 기구부를 분해 시 생산을 멈추거나 자칫 멀쩡한 기구를 교체하는 문제가 발생할 수도 있다.Typically, field workers lift up the robot's 2, 3-axis linkage frequently, which causes the motor's reducer to break down. It is often the case that only after the actual damage has occurred in the decelerator section, it is often the case that the mechanism section needs to be disassembled to see if there is a problem on the decelerator side. Damage of the reducer of the welding robot causes a problem that productivity is directly deteriorated. In other words, when disassembling the mechanism part with the intuition of the operator rather than based on the correct data (signal), the production may be stopped or a problem may arise in that the mechanism is replaced.
이와 관련하여 참조할 수 있는 선행기술문헌으로서 한국 공개특허공보 제2009-0130959호(선행문헌 1), 한국 등록특허공보 제1495949호(선행문헌 2) 등이 알려져 있다.Korean Prior Art Document No. 2009-0130959 (Prior Document 1) and Korean Patent Registration No. 1495949 (Prior Document 2) are known as prior art documents which can be referred to in this connection.
선행문헌 1은 선박엔진의 진동을 감지하는 센서부와, 상기 센서부에서 감지된 진동신호를 수신하여 고속푸리에변환된 진동데이터로 변환하는 데이터변환부와, 진동데이터 값과 데이터베이스에 저장된 임계값을 비교처리하는 데이터처리부와, 상기 데이터처리부에서 비교처리된 값을 출력하고 출력된 값에 대한 정보를 수정 및 신규입력하는 입출력부를 포함한다.The prior art document 1 includes a sensor unit for sensing the vibration of the marine engine, a data converter for receiving the vibration signal sensed by the sensor unit and converting the received vibration signal into fast Fourier transformed vibration data, And an input / output unit for outputting the comparison processed value in the data processing unit and correcting and inputting information about the output value.
선행문헌 2는 로봇의 동작 프로그램에 근거하여 생성된 위치 지령에 따라서 모터를 제어하는 모터 드라이버로부터 모터로 출력되는 토크 신호에 대해서, 토크 신호로부터 중력 보상 토크 및 로봇의 다른 축에 의한 간섭력 토크를 제거한 후에 하이 패스 필터를 적용하여, 추출된 감속기의 진동 성분에 의해 감속기의 이상을 판정한다.In the prior art 2, the gravity compensation torque from the torque signal and the interference force torque due to the other axis of the robot are compared with the torque signal output from the motor driver for controlling the motor to the motor in accordance with the position command generated based on the operation program of the robot After the removal, a high pass filter is applied, and the abnormality of the speed reducer is judged by the vibration component of the extracted speed reducer.
선행문헌 1은 선박 엔진에 관련되는 것으로서 진동 감지를 통한 손상 모니터링이므로 로봇에 적용하기 미흡하고, 선행문헌 2는 토크의 변화를 이용하여 진동을 연산하는 방식이므로 작동의 신뢰성을 높이기에 한계성을 드러낸다.The prior art document 1 is related to a marine engine, and since it is monitoring damage through vibration detection, it is insufficient to be applied to a robot, and in the prior art document 2, vibration is calculated using a change in torque.
상기와 같은 종래의 문제점들을 개선하기 위한 본 발명의 목적은, 로봇의 이동시 발생하는 손상으로 유발되는 구동부 기능저하를 방지하기 위해 토크센서과 진동센서를 탑재하고 상호 연관성을 기준으로 판단하는 이동형 로봇의 구동부 손상감지 방법을 제공하는 데 있다.In order to solve the above-mentioned problems, it is an object of the present invention to provide a mobile robot which is mounted with a torque sensor and a vibration sensor to prevent deterioration of the driving part caused by damage occurring when moving the robot, And to provide a method of detecting damage.
상기 목적을 달성하기 위하여, 본 발명은 이동형 로봇의 구동부에 대한 손상을 감지하는 방법에 있어서: 다양한 모션으로 로봇을 구동하며 토크의 변동에 대응한 진동 데이터를 획득하여 대표값으로 저장하는 제1단계; 로봇의 실제 작업 과정에서 토크센서와 진동센서를 탑재하고 토크의 변동에 대응한 진동 데이터의 실제값을 생성하는 제2단계; 및 대표값과 실제값을 대비하여 그 차이가 설정된 범위를 벗어나면 경보를 발생하는 제3단계;를 포함하여 이루어지는 것을 특징으로 한다.In order to achieve the above object, the present invention provides a method of detecting damage to a driving unit of a mobile robot, the method comprising: acquiring vibration data corresponding to a variation in torque and driving the robot in various motions, ; A second step of mounting a torque sensor and a vibration sensor in an actual working process of the robot and generating an actual value of vibration data corresponding to a variation in torque; And a third step of comparing the representative value with the actual value and generating an alarm when the difference is out of the set range.
본 발명의 세부 구성으로서, 상기 제2단계는 6축 다관절 로봇의 경우 2축과 3축의 구동축부에 토크센서와 진동센서를 탑재하는 것을 특징으로 한다.In the detailed construction of the present invention, the second step is characterized in that a torque sensor and a vibration sensor are mounted on the two-axis and three-axis drive shaft portions of a six-axis articulated robot.
본 발명의 세부 구성으로서, 상기 제3단계는 설정치를 초과하는 토크 증가율이 발생하는 순간에 실제값과 대표값을 대비하여 이상 상태를 판단하는 것을 특징으로 한다.In the detailed configuration of the present invention, in the third step, an abnormal state is determined by comparing an actual value with a representative value at the moment when a torque increase rate exceeding a set value occurs.
이때, 상기 제3단계는 이상 상태가 설정된 시간 이상으로 지속되는 경우 로봇의 구동부에 대한 손상으로 판단하는 것을 특징으로 한다.In this case, if the abnormal state continues for a predetermined time or more, the third step determines that the robot is damaged.
본 발명의 변형예로서, 상기 제3단계는 로봇의 특정 모션에서 토크가 설정치 이상으로 증대하는 것을 판단하는 과정을 더 구비하는 것을 특징으로 한다.As a modification of the present invention, the third step further includes a step of determining that the torque increases beyond a predetermined value in a specific motion of the robot.
이상과 같이 본 발명에 의하면, 로봇의 구동부에 토크센서과 진동센서를 탑재하고 상호 연관성을 기준으로 손상을 판단하여 로봇의 이동시 발생하는 손상으로 유발되는 구동부 기능저하를 방지하는 효과가 있다.As described above, according to the present invention, the torque sensor and the vibration sensor are mounted on the driving unit of the robot and the damage is determined based on the correlation, thereby preventing the deterioration of the driving unit caused by the damage caused when the robot is moved.
도 1은 본 발명에 따른 방법을 적용하기 위한 로봇을 나타내는 구성도
도 2는 본 발명에 따른 제어부의 주요 작동을 예시하는 플로우차트
도 3은 본 발명에 따른 제어부가 활용하는 데이터를 나타내는 도표BRIEF DESCRIPTION OF THE DRAWINGS Figure 1 is a block diagram illustrating a robot for applying the method according to the present invention;
2 is a flowchart illustrating a main operation of the control unit according to the present invention;
3 is a graph showing data utilized by the control unit according to the present invention;
이하, 첨부된 도면에 의거하여 본 발명의 실시예를 상세하게 설명하면 다음과 같다.Hereinafter, embodiments of the present invention will be described in detail with reference to the accompanying drawings.
본 발명은 이동형 로봇의 구동부에 대한 손상을 감지하는 방법에 관하여 제안한다. 로봇은 본체부(10) 상에 다수의 아암이 구동축부(20)를 이용하여 연결되고 내부에는 서보드라이버(30)를 수용하는 구조이다. 구동축부(20)는 구동부는 감속기와 모터를 구비하고 아암의 관절운동을 수행한다. 서보드라이버(30)는 마이크로프로세서, 메모리, 입출력인터페이스를 지닌 마이컴 회로로 구성된다. 이동형 로봇은 본체부(10)에 손잡이를 구비하고 작업자 1-2인이 운반 가능한 구조이다. 작업자는 교시조작기(50)을 이용해 로봇을 조작하며, 로봇의 모션을 계획하고 궤적을 계산하는 일련의 작업은 제어부(100)에서 수행된다.The present invention proposes a method for detecting damage to a driving unit of a mobile robot. The robot has a structure in which a plurality of arms are connected to the
본 발명에 따른 제1단계는 다양한 모션으로 로봇을 구동하며 토크의 변동에 대응한 진동 데이터를 획득하여 대표값으로 저장하는 과정으로 진행된다. 제1단계는 도 2(a)에 예시되는 것으로서, 로봇의 출하전에 테스트 장비를 갖춘 제조현장에서 수행된다. 용접과 관련된 로봇의 모션은 크게 하향, 수평, 직립, 상향으로 구분되고, 각각의 대분류 모션은 세부적인 소분류 모션으로 구분할 수 있다. 가장 심플한 방법은 모션과 무관하게 토크의 값에 대응하는 진동 데이터를 획득하는 것이다. 즉, 로봇을 정상적으로 동작시키면서 각 축 모터 동작시의 자코비안(Jacobian) 수식으로 토크를 구한 뒤 이 값에 해당하는 진동센서(Vibration Sensor) 값을 실제 로봇구동을 통해 생성한다. 생성된 실측값은 필터링을 거친 후에 연산을 거쳐 평균값에 해당하는 대표값으로 제어부(100)의 저장장치에 저장한다.The first step according to the present invention is a process of driving the robot in various motions and acquiring vibration data corresponding to the variation of torque and storing it as a representative value. The first step is illustrated in Fig. 2 (a) and is performed at a manufacturing site equipped with test equipment before shipment of the robot. The motions of robot related to welding are divided into downward, horizontal, upright, and upward, and each major motion can be divided into detailed subdivision motions. The simplest method is to acquire vibration data corresponding to the value of torque regardless of motion. That is, while the robot is operating normally, the torque is calculated by a Jacobian equation at the time of operation of each axis motor, and a vibration sensor value corresponding to this value is generated through actual robot driving. The generated actual values are filtered and then stored in the storage unit of the
본 발명에 따른 제2단계는 로봇의 실제 작업 과정에서 토크센서(25)와 진동센서(35)를 탑재하고 토크의 변동에 대응한 진동 데이터의 실제값을 생성하는 과정으로 진행된다. 도 2(b)에 예시되는 제2단계 이후는 제1단계의 테이터를 제어부(100)에 탑재한 로봇이 작업현장에 투입된 이후에 수행된다. The second step according to the present invention proceeds with the process of mounting the
이때의 로봇은 구동축부(20)에 토크센서(25)와 진동센서(35)를 탑재하고 서보드라이버(30)의 출력인터페이스로 연결한 상태이다. 실제 작업과정에서 로봇이 구동하는 동안 토크와 진동 데이터를 실제값으로 생성하여 입력한다. 물론 이 과정에서도 제어부(100)는 입력되는 신호에서 노이즈를 제거하는 필터링 처리를 거친다.At this time, the robot mounts the
본 발명의 세부 구성으로서, 상기 제2단계는 6축 다관절 로봇의 경우 2축과 3축의 구동축부(20)에 토크센서(25)와 진동센서(35)를 탑재하는 것을 특징으로 한다. 선박과 관련된 용접에 있어서 이동형 6축 다관절 로봇이 용접자동화에 적합한 것으로 실증된다. 다만 작업자가 로봇을 파지하고 이동하는 경우 주로 2축과 3축에서 많은 하중을 받아 처짐 등의 손상이 유발되기 쉽다. 이에 축과 3축의 구동축부(20)에 토크센서(25)와 진동센서(35)를 탑재하지만 반드시 이에 국한되지 않고 로봇의 제원에 따라 다른 축에도 동일한 방식으로 설치할 수 있다.In the detailed construction of the present invention, the second step is characterized in that the
본 발명에 따른 제3단계는 대표값과 실제값을 대비하여 그 차이가 설정된 범위를 벗어나면 경보를 발생하는 과정으로 진행된다. 제어부(100)는 대표값과 실제값의 차이가 현저하게 발생하면 사용자에게 경고를 보내어 점검, 보수, 정비가 제공되도록 한다. 이러한 유지ㆍ보수 상태를 사전에 경보로 제공하면 공정에 차질을 주지 않아 생산성 저하 문제를 해결한다.The third step according to the present invention compares the representative value with the actual value and proceeds to generate an alarm when the difference is out of the set range. When the difference between the representative value and the actual value occurs significantly, the
본 발명의 세부 구성으로서, 상기 제3단계는 설정치를 초과하는 토크 증가율이 발생하는 순간에 실제값과 대표값을 대비하여 이상 상태를 판단하는 것을 특징으로 한다. 도 3에 나타내는 것처럼 작업 과정에서 로봇의 토크센서(25)와 진동센서(35)로부터 입력되는 신호는 큰 주기와 짧은 주기로 반복되면서 변화된다. 만일 도표의 우측과 같이 어느 순간에 토크 증가율이 설정치(비율) 이상으로 급격하게 증가하면 실제값과 대표값의 대비를 수행한다. 이는 해당 로봇의 제1단계에서 이미 테스트되어 메모리에 저장된 고유의 설정치를 기준으로 한다.In the detailed configuration of the present invention, in the third step, an abnormal state is determined by comparing an actual value with a representative value at the moment when a torque increase rate exceeding a set value occurs. As shown in FIG. 3, the signals input from the
이때, 상기 제3단계는 이상 상태가 설정된 시간 이상으로 지속되는 경우 로봇의 구동부에 대한 손상으로 판단하는 것을 특징으로 한다. 만일 토크의 증가가 구동축부(20)의 손상에 의한 것이 아니고 일시적 외란에 의한 것이라면 경보를 발생하지 않아야 한다. 이에, 실제값과 대표값의 현격한 차이가 설정된 시간 이상으로 지속되어야 구동부의 감속기 등에 손상이 발생한 것으로 판단한다. 물론 이러한 시간도 해당 로봇의 제1단계에서 이미 테스트되어 메모리에 저장된 고유의 설정치를 기준으로 한다.In this case, if the abnormal state continues for a predetermined time or more, the third step determines that the robot is damaged. If the increase in torque is due to temporary disturbance rather than damage to the
본 발명의 변형예로서, 상기 제3단계는 로봇의 특정 모션에서 토크가 설정치 이상으로 증대하는 것을 판단하는 과정을 더 구비하는 것을 특징으로 한다. 반복된 작업에 있어서 로봇의 모션은 정해진 수로 구분되므로 제1단계에서 이러한 모션에 대응한 값을 룩업테이블로 저장한다. 제2단계 및 제3단계는 전술한 동일한 방식으로 진행하지만 제3단계에서 룩업테이블을 기준으로 과도한 토크와 진동을 검출할 수도 있다. 이와 같이 하면 로봇의 구동부 손상을 판단하는 작동의 신뢰성을 높이고 연산처리의 속도도 향상할 수 있다.As a modification of the present invention, the third step further includes a step of determining that the torque increases beyond a predetermined value in a specific motion of the robot. Since the motions of the robot in the repeated operation are divided into a predetermined number, in the first step, values corresponding to the motions are stored in a lookup table. The second and third steps are performed in the same manner as described above, but in the third step, excessive torque and vibration may be detected based on the lookup table. In this way, it is possible to increase the reliability of the operation for judging the damage of the driving part of the robot and to improve the speed of the arithmetic processing.
이와 같이 본 발명은 로봇 구동부의 감속기 상태를 계속적으로 모니터링 하므로서 로봇의 생산성에 영향을 주지 않고 정상작업이 없는 시간을 이용하여 로봇의 유지/보수 작업이 가능케 한다.As described above, the present invention continuously monitors the decelerator state of the robot driving unit, thereby enabling maintenance / repair work of the robot using the time without normal operation without affecting the productivity of the robot.
본 발명은 기재된 실시예에 한정되는 것은 아니고, 본 발명의 사상 및 범위를 벗어나지 않고 다양하게 수정 및 변형할 수 있음은 이 기술의 분야에서 통상의 지식을 가진 자에게 자명하다. 따라서 그러한 변형예 또는 수정예들은 본 발명의 특허청구범위에 속한다 해야 할 것이다.It will be apparent to those skilled in the art that various modifications and variations can be made in the present invention without departing from the spirit and scope of the invention as defined by the appended claims. It is therefore intended that such variations and modifications fall within the scope of the appended claims.
10: 본체부
20: 구동축부
25: 토크센서
30: 서보드라이버
35: 진동센서
50: 교시조작기
100: 제어부10: main body portion 20: drive shaft portion
25: Torque sensor 30: Servo driver
35: Vibration sensor 50: Instruction actuator
100:
Claims (5)
다양한 모션으로 로봇을 구동하며 토크의 변동에 대응한 진동 데이터를 획득하여 대표값으로 저장하는 제1단계;
로봇의 실제 작업 과정에서 토크센서(25)와 진동센서(35)를 탑재하고 토크의 변동에 대응한 진동 데이터의 실제값을 생성하는 제2단계; 및
대표값과 실제값을 대비하여 그 차이가 설정된 범위를 벗어나면 경보를 발생하는 제3단계;를 포함하여 이루어지는 것을 특징으로 하는 이동형 로봇의 구동부 손상감지 방법.A method for detecting damage to a driving unit of a mobile robot, comprising:
A first step of driving the robot in various motions and acquiring vibration data corresponding to a variation in torque and storing the acquired vibration data as representative values;
A second step of mounting the torque sensor (25) and the vibration sensor (35) in the actual working process of the robot and generating an actual value of the vibration data corresponding to the variation of the torque; And
And a third step of comparing the representative value with the actual value and generating an alarm if the difference is out of the set range.
상기 제2단계는 6축 다관절 로봇의 경우 2축과 3축의 구동축부(20)에 토크센서(25)와 진동센서(35)를 탑재하는 것을 특징으로 하는 이동형 로봇의 구동부 손상감지 방법.The method according to claim 1,
Wherein the second step comprises mounting the torque sensor (25) and the vibration sensor (35) on the two-axis and three-axis drive shaft portions (20) of the six-axis articulated robot.
상기 제3단계는 설정치를 초과하는 토크 증가율이 발생하는 순간에 실제값과 대표값을 대비하여 이상 상태를 판단하는 것을 특징으로 하는 이동형 로봇의 구동부 손상감지 방법.The method according to claim 1,
Wherein the third step determines an abnormal state by comparing an actual value with a representative value at the moment when a torque increase rate exceeding a set value occurs.
상기 제3단계는 이상 상태가 설정된 시간 이상으로 지속되는 경우 로봇의 구동부에 대한 손상으로 판단하는 것을 특징으로 하는 이동형 로봇의 구동부 손상감지 방법.The method of claim 3,
Wherein the third step determines that the damage to the driving unit of the robot is damaged if the abnormal state continues for a predetermined time or more.
상기 제3단계는 로봇의 특정 모션에서 토크가 설정치 이상으로 증대하는 것을 판단하는 과정을 더 구비하는 것을 특징으로 하는 이동형 로봇의 구동부 손상감지 방법.The method according to claim 1,
Further comprising the step of determining that the torque is increased beyond a predetermined value in a specific motion of the robot, in the third step.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR1020150172187A KR102486112B1 (en) | 2015-12-04 | 2015-12-04 | Method for detecting damage on driving part of mobile robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR1020150172187A KR102486112B1 (en) | 2015-12-04 | 2015-12-04 | Method for detecting damage on driving part of mobile robot |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| KR20170065874A true KR20170065874A (en) | 2017-06-14 |
| KR102486112B1 KR102486112B1 (en) | 2023-01-09 |
Family
ID=59218114
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| KR1020150172187A Active KR102486112B1 (en) | 2015-12-04 | 2015-12-04 | Method for detecting damage on driving part of mobile robot |
Country Status (1)
| Country | Link |
|---|---|
| KR (1) | KR102486112B1 (en) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN115213938A (en) * | 2021-03-31 | 2022-10-21 | 住友重机械工业株式会社 | Speed reducer state monitoring device and speed reducer state monitoring method |
| CN115916488A (en) * | 2020-06-16 | 2023-04-04 | 发那科株式会社 | robot controller |
| CN119704256A (en) * | 2023-12-29 | 2025-03-28 | 武汉纳优电子技术有限公司 | A wafer transfer robot testing system and method |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20090130959A (en) | 2008-06-17 | 2009-12-28 | 주성엔지니어링(주) | Substrate processing equipment |
| KR20120028837A (en) * | 2010-09-15 | 2012-03-23 | 가부시키가이샤 야스카와덴키 | Reducer abnormality determination method, abnormality determination device, and robot system |
| JP2015199149A (en) * | 2014-04-04 | 2015-11-12 | キヤノン株式会社 | Robot control method, robot device, program and record medium |
-
2015
- 2015-12-04 KR KR1020150172187A patent/KR102486112B1/en active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20090130959A (en) | 2008-06-17 | 2009-12-28 | 주성엔지니어링(주) | Substrate processing equipment |
| KR20120028837A (en) * | 2010-09-15 | 2012-03-23 | 가부시키가이샤 야스카와덴키 | Reducer abnormality determination method, abnormality determination device, and robot system |
| KR101495949B1 (en) | 2010-09-15 | 2015-02-25 | 가부시키가이샤 야스카와덴키 | Reducer abnormality determination method, abnormality determination device, and robot system |
| JP2015199149A (en) * | 2014-04-04 | 2015-11-12 | キヤノン株式会社 | Robot control method, robot device, program and record medium |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN115916488A (en) * | 2020-06-16 | 2023-04-04 | 发那科株式会社 | robot controller |
| US12275133B2 (en) | 2020-06-16 | 2025-04-15 | Fanuc Corporation | Robot control device |
| CN115213938A (en) * | 2021-03-31 | 2022-10-21 | 住友重机械工业株式会社 | Speed reducer state monitoring device and speed reducer state monitoring method |
| CN119704256A (en) * | 2023-12-29 | 2025-03-28 | 武汉纳优电子技术有限公司 | A wafer transfer robot testing system and method |
Also Published As
| Publication number | Publication date |
|---|---|
| KR102486112B1 (en) | 2023-01-09 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107614212B (en) | Industrial robot and fault judgment method thereof | |
| KR101495949B1 (en) | Reducer abnormality determination method, abnormality determination device, and robot system | |
| CN102785253B (en) | Robot system having error detection function of robot and control method thereof | |
| US10350749B2 (en) | Robot control device having learning control function | |
| JP6143222B2 (en) | Machine tool abnormality diagnosis apparatus and abnormality diagnosis method | |
| EP1845427B1 (en) | Control | |
| JP4335286B2 (en) | Robot control apparatus and robot control method having component protection function | |
| JP6145153B2 (en) | Robot controller that records the occurrence of emergency stop of robot | |
| US20160279794A1 (en) | Robot controller capable of performing fault diagnosis of robot | |
| CN106003147B (en) | Robot system and abnormality judgment method | |
| US20160082593A1 (en) | Robot controller for avoiding problem regarding robot at the time of emergency stop | |
| JP2018062026A (en) | Robot control device with function for restricting speed and acceleration of robot | |
| US20190255709A1 (en) | Vibration analyzer and vibration analysis method | |
| JP2006281421A (en) | Robot and robot abnormality detection method | |
| JP4391381B2 (en) | Abnormality determination device for reduction gear of articulated robot and abnormality determination method for reduction gear of articulated robot | |
| KR101820580B1 (en) | Safe robot with path progress variables | |
| JP2006154998A (en) | Controller | |
| JP2019171490A (en) | Operation history management system | |
| KR20170065874A (en) | Method for detecting damage on driving part of mobile robot | |
| CA2986207A1 (en) | Failure diagnostic device and failure diagnostic method | |
| CN109828512A (en) | Board diagnostic method and its system | |
| JP6748153B2 (en) | Machine tool abnormality detection device | |
| JP3871030B2 (en) | Servo control method | |
| JP3855629B2 (en) | Robot interference detection device | |
| JP7267725B2 (en) | Robot control method, program, recording medium, robot system, article manufacturing method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PA0109 | Patent application |
Patent event code: PA01091R01D Comment text: Patent Application Patent event date: 20151204 |
|
| PG1501 | Laying open of application | ||
| PA0201 | Request for examination |
Patent event code: PA02012R01D Patent event date: 20201127 Comment text: Request for Examination of Application Patent event code: PA02011R01I Patent event date: 20151204 Comment text: Patent Application |
|
| E902 | Notification of reason for refusal | ||
| PE0902 | Notice of grounds for rejection |
Comment text: Notification of reason for refusal Patent event date: 20220331 Patent event code: PE09021S01D |
|
| E701 | Decision to grant or registration of patent right | ||
| PE0701 | Decision of registration |
Patent event code: PE07011S01D Comment text: Decision to Grant Registration Patent event date: 20221024 |
|
| GRNT | Written decision to grant | ||
| PR0701 | Registration of establishment |
Comment text: Registration of Establishment Patent event date: 20230104 Patent event code: PR07011E01D |
|
| PR1002 | Payment of registration fee |
Payment date: 20230105 End annual number: 3 Start annual number: 1 |
|
| PG1601 | Publication of registration |