KR20130123231A - Remote control having a 6-axis gyro sensor and control method therof - Google Patents

Remote control having a 6-axis gyro sensor and control method therof Download PDF

Info

Publication number
KR20130123231A
KR20130123231A KR1020120046518A KR20120046518A KR20130123231A KR 20130123231 A KR20130123231 A KR 20130123231A KR 1020120046518 A KR1020120046518 A KR 1020120046518A KR 20120046518 A KR20120046518 A KR 20120046518A KR 20130123231 A KR20130123231 A KR 20130123231A
Authority
KR
South Korea
Prior art keywords
signal
gyro sensor
axis gyro
control
remote controller
Prior art date
Application number
KR1020120046518A
Other languages
Korean (ko)
Other versions
KR101380938B1 (en
Inventor
김봉석
임선
박재순
진한윤
Original Assignee
전자부품연구원
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 전자부품연구원 filed Critical 전자부품연구원
Priority to KR1020120046518A priority Critical patent/KR101380938B1/en
Publication of KR20130123231A publication Critical patent/KR20130123231A/en
Application granted granted Critical
Publication of KR101380938B1 publication Critical patent/KR101380938B1/en

Links

Images

Classifications

    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices
    • E02F9/2004—Control mechanisms, e.g. control levers
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices
    • E02F9/2025—Particular purposes of control systems not otherwise provided for
    • E02F9/205—Remotely operated machines, e.g. unmanned vehicles
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05G—CONTROL DEVICES OR SYSTEMS INSOFAR AS CHARACTERISED BY MECHANICAL FEATURES ONLY
    • G05G7/00—Manually-actuated control mechanisms provided with one single controlling member co-operating with one single controlled member; Details thereof
    • G05G7/02—Manually-actuated control mechanisms provided with one single controlling member co-operating with one single controlled member; Details thereof characterised by special provisions for conveying or converting motion, or for acting at a distance
    • G05G7/10—Manually-actuated control mechanisms provided with one single controlling member co-operating with one single controlled member; Details thereof characterised by special provisions for conveying or converting motion, or for acting at a distance specially adapted for remote control
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2200/00—Type of vehicle
    • B60Y2200/10—Road Vehicles
    • B60Y2200/15—Fork lift trucks, Industrial trucks
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2200/00—Type of vehicle
    • B60Y2200/40—Special vehicles
    • B60Y2200/41—Construction vehicles, e.g. graders, excavators
    • G—PHYSICS
    • G08—SIGNALLING
    • G08C—TRANSMISSION SYSTEMS FOR MEASURED VALUES, CONTROL OR SIMILAR SIGNALS
    • G08C17/00—Arrangements for transmitting signals characterised by the use of a wireless electrical link
    • G08C17/02—Arrangements for transmitting signals characterised by the use of a wireless electrical link using a radio link

Abstract

The present invention relates to a remote controller having a six-axis Gyro sensor and a control method thereof for blocking an operational transmission signal to prevent the unintentional operation of a driving unit which can be generated for the falling by detecting it using the sensor when the controller is fallen by the mistake of an operator while heavy equipment such as excavators and a driving device are operated by using the remote controller. The remote controller having the six-axis Gyro sensor according to the present invention comprises: a signal generating unit generating an operation control signal by the intentional or unintentional operation of the operator; a control device determining the intention of the signal generated in the signal generating unit based on the position and a posture signal of the controller in which the six-axis Gyro sensor senses; a transmission unit converting the operation control signal into a wireless signal and transmitting to the driving device if the signal determined in the control device is an intentional signal; and the driving device operated by the signal transmitted from the transmission unit. [Reference numerals] (10) Signal generation unit;(110) Six-axis Gyro sensor;(111) Control device;(12) Transmission unit;(13) Driving device

Description

6축 자이로센서를 구비한 원격조종기 및 그 제어방법{REMOTE CONTROL HAVING A 6-AXIS GYRO SENSOR AND CONTROL METHOD THEROF}REMOTE CONTROL HAVING A 6-AXIS GYRO SENSOR AND CONTROL METHOD THEROF}

본 발명은 원격조종기 및 그 제어방법에 관한 것으로, 보다 상세하게는, 원격조종기를 사용하여 굴삭기와 같은 중장비 및 그 구동장치를 조종하는 중에 조작자의 실수로 조종기가 낙하할 때 센서를 이용하여 이를 검출하여, 낙하 동안에 발생할 수 있는 구동장치의 비의도적인 작동을 방지하기 위해, 조작 전송신호를 차단하기 위한 6축 자이로센서를 구비한 원격조종기 및 그 제어방법에 관한 것이다.
The present invention relates to a remote controller and a method of controlling the same, and more particularly, by using a remote controller to detect this when the operator accidentally falls down while manipulating the heavy equipment such as an excavator and its driving device using a sensor. The present invention relates to a remote controller having a six-axis gyro sensor for blocking an operation transmission signal in order to prevent an unintentional operation of a driving device that may occur during a fall, and a control method thereof.

일반적으로 원격에 있는 구동장치들, 예컨대 굴삭기, 크롤러(crawler), 지게차, 펌프카 등을 조종하기 위한 근격/원격조종기에는 적어도 하나의 버튼 (Button) 및 아날로그 스틱과 같은 조작 수단이 근격/원격조종기의 본체에 설치되어 있다. 조작자에 의해 조작 수단이 조작되면, 구동장치들을 원격으로 조작하기 위한 조작신호가 근격/원격조종기에서 발생되는데, 특히 원격조종기는 이들 조작신호를 소정의 송신신호로 변환하여 구동장치들, 상세하게는 구동장치들에 설치된 통신 모듈로 전송함으로써 구동장치들이 작동하여 소정의 작업을 수행한다. 여기에서 근격조종기는 유선조종기, 원격조종기는 무선조종기일 수 있으며, 구동장치들은 굴삭기, 크롤러(crawler), 지게차, 펌프카 등의 중장비 및 상기 중장비에 설치된 붐, 아암, 버킷 등의 작업대상물에 직접 접촉하여 작업대상물을 퍼 올리거나 다른 장소로 이동시키는 작업장치일 수 있다.
In general, there are at least one button and an analog stick for controlling a remote control device such as an excavator, crawler, forklift, pump car, etc. It is installed in the main body. When the operation means is operated by the operator, operation signals for remotely operating the driving devices are generated in the remote / remote controller, in particular, the remote controller converts these operation signals into predetermined transmission signals to drive devices, in detail. By transmitting to a communication module installed in the driving devices, the driving devices operate to perform a predetermined task. Here, the musculature controller may be a wired controller, a remote controller may be a wireless controller, the driving devices are in direct contact with the heavy equipment such as excavators, crawlers, forklifts, pump cars, and work objects such as booms, arms, buckets installed in the heavy equipment It may be a work device for spreading or moving the workpiece to another place.

이와 같이 구동장치가 소정의 작업을 수행하는 동안 조작자는 허리와 같은 신체의 일정부위에 조종기를 착용한 상태로 걷거나 뛰면서 작업방향으로 이동하는 중에도 조종기를 조작하게 되는데, 이때 조작자의 실수로 인해 조종기가 낙하하여 버튼 및 조이스틱이 의도하지 않게 작동되는 오작동 사고가 발생할 수 있으며, 또한 작업 중에 조작자가 휴식을 위해 의도적으로 잠깐 동안 조종기의 전원을 끄지않고 바닥에 내려놓은 경우에도 조이스틱 등에 외부 물체가 접촉되어 의도하지 않은 오작동 인한 사고가 발생할 수 있다.
In this way, while the driving device performs a predetermined task, the operator operates the controller while walking or running while wearing the controller on a certain part of the body such as the waist while moving in the working direction. Dropping may cause malfunction of the buttons and joysticks, which may lead to unintentional operation.In addition, external objects may come into contact with the joysticks, even when the operator intentionally puts them on the ground without turning off the controller for a short while to rest. Failure to do so may result in an accident.

종래의 원격조종기에서는, 구동장치가 소정의 작업을 수행할 때, 안전사고를 방지하는 신호 차단 메카니즘이 부재하고, 비상시에 구동장치를 조작자가 직접 온/오프시키는 비상정지 스위치 이외에는 구동장치로 전송되는 조작신호가 의도적인지 또는 비의도적인지를 판단하여 구동장치를 작동시키는 조작신호를 유지하거나 차단할 수 없었다. 또한 비의도적인 조작신호인지를 판단하여 구동장치의 작동 오류를 사전에 방지하는 시스템이 부재하여 조작자에 대한 주기적 안전교육을 통해서만 조작 실수로 인한 안전사고를 사전에 방지하고자 하였다.
In a conventional remote controller, when the drive device performs a predetermined operation, there is no signal blocking mechanism for preventing a safety accident, and is transmitted to the drive device except for an emergency stop switch that directly turns the drive device on and off in an emergency. It was not possible to maintain or block the operation signal for operating the drive by judging whether the operation signal was intentional or unintentional. In addition, there was no system to prevent operation error of the driving device by judging whether it was an unintentional operation signal and tried to prevent safety accidents due to operation mistakes only through periodic safety training for the operator.

본 발명은 상기의 문제를 해결하기 위하여 안출된 것으로, 본 발명의 목적은, 근격/원격 조정기, 특히 원격조종기를 조작하는 조작자의 의도적 사용 유무 및 조작자의 실수로 인한 조종기의 낙하 상태의 검출을 통해 조작자가 의도적으로 또는 비의도적으로 조종기를 조작했는지의 유무를 센서를 통해서 감지하여 구동장치에 전송되는 조작신호(데이터 송신)를 유지시키거나 차단하여 작업장의 안전 사고를 방지하는 6축 자이로센서를 구비한 원격조종기 및 그 제어 방법을 제공하기 위한 것이다.
The present invention has been made to solve the above problems, an object of the present invention, through the detection of the fall state of the controller due to the intentional use of the manipulators, especially the remote control manipulator and the operator's mistake It is equipped with a 6-axis gyro sensor that detects whether the operator has intentionally or unintentionally operated the controller through the sensor and maintains or blocks the operation signal (data transmission) transmitted to the driving device to prevent safety accidents in the workplace. It is to provide a remote controller and a control method thereof.

상기의 문제를 해결하기 위하여 본 발명에 따른 6축 자이로센서를 구비한 원격조종기는, 조작자의 의도적 또는 비의도적 조작에 의해 조종제어 신호를 발생하는 신호 발생부; 상기 신호 발생부에서 생성된 신호를 6축 자이로센서가 센싱한 원격조종기의 위치 및 자세 신호에 기반하여 의도적인지 여부를 판단하는 제어장치; 상기 제어장치에서 판단된 신호가 의도적 신호이면 조종제어 신호를 무선 신호로 변환시켜 구동장치로 전송하는 전송부; 상기 전송부에서 전송된 무선 신호에 의해 작동되는 구동장치; 를 포함하는 것을 특징으로 한다.
In order to solve the above problems, a remote controller having a six-axis gyro sensor according to the present invention includes a signal generator for generating a steering control signal by intentional or unintentional manipulation of the operator; A control device for determining whether the signal generated by the signal generator is intentional based on a position and attitude signal of a remote controller sensed by a 6-axis gyro sensor; A transmission unit for converting a steering control signal into a wireless signal and transmitting it to a driving device when the signal determined by the control device is an intentional signal; A driving device operated by a radio signal transmitted from the transmission unit; And a control unit.

바람직하게는, 상기 제어장치는, 6축 자이로센서가 센싱한 조종기의 위치 및 자세 신호가 미리 정해진 6축 자이로센서(gyro sensor)의 위치 및 자세 신호 범위 내에 있으면 의도적 조작으로 판단하고, 6축 자이로센서(gyro sensor)의 위치 및 자세 신호 범위 외에 있으면 비의도적 신호로 판단한다.
Preferably, the control device, if the position and attitude signal of the manipulator sensed by the six-axis gyro sensor is within the predetermined position and attitude signal range of the six-axis gyro sensor (gyro sensor) to determine by intentional operation, the six-axis gyro If it is outside the position and posture signal range of the sensor (gyro sensor), it is determined as an unintentional signal.

또한, 상기 6축 자이로센서를 구비한 원격조종기의 제어방법은, 원격조종기의 의도적 또는 비의도적 조작에 의해 조종제어 신호가 발생하는 단계; 6축 자이로센서에 의해 조종기의 자세 및 위치가 센싱되는 단계; 상기 센싱된 신호에 기반하여 제어장치가 의도적 조작 여부를 판단하는 단계; 상기 센싱된 신호가 의도적 조작으로 판명된 경우 전송부로 조종제어 신호를 전송하는 단계; 상기 전송부에서 조정제어신호를 무선신호로 변환시켜 구동장치로 전송하는 단계; 상기 무선신호에 의해 구동장치가 작동하는 단계; 를 포함한다.
In addition, the control method of the remote controller having the six-axis gyro sensor, the control step of generating a control signal by intentional or unintentional operation of the remote controller; Sensing the attitude and position of the manipulator by a six-axis gyro sensor; Determining, by the controller device, whether the operation is intentional based on the sensed signal; Transmitting a steering control signal to a transmitter when the sensed signal is determined to be intentional manipulation; Converting, by the transmission unit, an adjustment control signal into a wireless signal and transmitting the same to a driving device; Operating a driving device by the radio signal; .

이상에서 설명한 것과 같은 특징을 갖는 본 발명에 따른 6축 자이로센서를 구비한 원격조종기 및 그 제어방법은, 조정기의 의도적 사용 유무를 검출할 수 있는 센서를 조종기에 장착함으로써 의도적 조작의 유무를 판단하는 별도의 검출 장치를 제작하여 설치할 필요 없으며, 조종기의 제어방법 및 시스템 구성에 맞게 센서 자유도를 선택적으로 사용할 수 있고, 6축 자이로센서를 이용하여 조종기의 조작 상태를 판단하므로 비의도적 사용으로 인한 작업물체 낙하시 조종기의 안전 메카니즘 신호를 발생할 수 있다.
In the remote controller equipped with a six-axis gyro sensor according to the present invention having the features as described above, and a control method thereof, the controller is equipped with a sensor capable of detecting the presence or absence of intentional use of the regulator to determine whether there is intentional operation. There is no need to make and install a separate detection device, and the sensor degree of freedom can be selectively used according to the control method and system configuration of the remote controller, and the six-axis gyro sensor judges the operation status of the remote controller. When falling, the safety mechanism signal of the remote controller may be generated.

도 1은 본 발명에 따른 6축 자이로센서를 구비한 원격조종기의 구성도이다.
도 2는 본 발명에 따른 6축 자이로센서를 구비한 원격조종기의 제어방법의 흐름도이다.1 is a block diagram of a remote controller having a six-axis gyro sensor according to the present invention.
2 is a flowchart of a control method of a remote controller having a six-axis gyro sensor according to the present invention.

본 발명의 이점 및 특징, 그리고 그것들을 달성하는 방법은 첨부되는 도면과 함께 상세하게 후술되는 실시예를 참조하면 명확해질 것이다. 그러나, 본 발명은 이하에서 개시되는 실시예에 한정되는 것이 아니라 서로 다른 다양한 형태로 구현될 것이다.
BRIEF DESCRIPTION OF THE DRAWINGS The advantages and features of the present invention, and how to accomplish them, will become apparent by reference to the embodiments described in detail below with reference to the accompanying drawings. However, the present invention is not limited to the embodiments described below, but may be embodied in various forms.

본 명세서에서 본 실시예는 본 발명의 개시가 완전하도록 하며, 본 발명이 속하는 기술 분야에서 통상의 지식을 가진 자에게 발명의 범주를 완전하게 알려주기 위해 제공되는 것이다. 그리고 본 발명은 청구항의 범주에 의해 정의될 뿐이다. 따라서, 몇몇 실시예들에서, 잘 알려진 구성 요소, 잘 알려진 동작 및 잘 알려진 기술들은 본 발명이 모호하게 해석되는 것을 피하기 위하여 구체적으로 설명되지 않는다.
The present embodiments are provided so that the disclosure of the present invention is thoroughly disclosed and that those skilled in the art will fully understand the scope of the present invention. And the present invention is only defined by the scope of the claims. Accordingly, in some embodiments, well known components, well known operations, and well-known techniques are not specifically described to avoid an undesirable interpretation of the present invention.

명세서 전체에 걸쳐 동일 참조 부호는 동일 구성 요소를 지칭한다. 그리고, 본 명세서에서 사용된(언급된) 용어들은 실시예들을 설명하기 위한 것이며 본 발명을 제한하고자 하는 것은 아니다. 본 명세서에서, 단수형은 문구에서 특별히 언급하지 않는 한 복수형도 포함한다. 또한, '포함(또는, 구비)한다'로 언급된 구성 요소 및 동작은 하나 이상의 다른 구성요소 및 동작의 존재 또는 추가를 배제하지 않는다.
Like reference numerals refer to like elements throughout the specification. Moreover, terms used herein (to be referred to) are intended to illustrate embodiments and are not intended to limit the invention. In the present specification, the singular form includes plural forms unless otherwise specified in the specification. Also, components and acts referred to as " comprising (or comprising) " do not exclude the presence or addition of one or more other components and operations.

다른 정의가 없다면, 본 명세서에서 사용되는 모든 용어(기술 및 과학적 용어를 포함)는 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자에게 공통적으로 이해될 수 있는 의미로 사용될 수 있을 것이다. 또 일반적으로 사용되는 사전에 정의되어 있는 용어들은 정의되어 있지 않은 한 이상적으로 또는 과도하게 해석되지 않는다.
Unless defined otherwise, all terms (including technical and scientific terms) used herein may be used in a sense commonly understood by one of ordinary skill in the art to which this invention belongs. Also, commonly used predefined terms are not ideally or excessively interpreted unless they are defined.

본 발명은 굴삭기와 같은 중장비를 조종하는 원격조종기를 사용하여 중장비를 조정하는 중에 조작자의 실수로 조정기가 낙하시에 조종기에 설치된 센서, 바람직하게는 6축 자이로센서를 이용하여 조종기의 위치 및 자세를 검출하여, 낙하 동안에 발생할 수 있는 구동장치의 비의도적인 동작을 방지하기 위해, 구동장치로 전송되는 조작 무선신호를 차단하기 위한 6축 자이로센서를 구비한 원격조종기 및 그 제어방법에 관한 것이다.
The present invention is to adjust the position and attitude of the controller using a sensor installed in the controller when the operator accidentally falls, preferably a six-axis gyro sensor, while adjusting the heavy equipment using a remote controller for manipulating heavy equipment such as an excavator. To detect and prevent unintentional operation of the drive that may occur during a fall. The present invention relates to a remote controller equipped with a six-axis gyro sensor for blocking a transmitted operation radio signal, and a control method thereof.

도 1 및 도 2를 참조하여, 하기에서는 본 발명에 따른 6축 자이로센서를 구비한 원격조종기의 바람직한 실시예를 설명한다. 1 and 2, the following describes a preferred embodiment of a remote controller having a six-axis gyro sensor according to the present invention.

본 발명에 따른 구동장치를 조종하는, 6축 자이로센서(110)를 구비한 원격조종기는, 의도적 또는 비의도적 조작에 의해 조종제어 신호를 발생하는 신호 발생부(10); 상기 신호 발생부(10)에서 생성된 신호를 6축 자이로센서(110)가 센싱한 원격조종기의 위치 및 자세 신호에 기반하여 의도적인지 여부를 판단하는 제어장치(111); 상기 제어장치(111)에서 판단된 신호가 의도적 신호이면 조종제어 신호를 무선 신호로 변환시켜 구동장치(13)로 전송하는 전송부(12); 상기 전송부(12)에서 전송된 무선 신호에 의해 작동되는 구동장치(13)를 포함한다.
A remote controller having a six-axis gyro sensor 110 for manipulating a driving device according to the present invention includes: a signal generator 10 for generating a steering control signal by intentional or unintentional manipulation; A control device (111) for determining whether the signal generated by the signal generator (10) is intentional based on the position and attitude signal of the remote controller sensed by the 6-axis gyro sensor (110); A transmission unit 12 for converting a steering control signal into a wireless signal and transmitting the signal to the driving device 13 when the signal determined by the control device 111 is an intentional signal; And a driving device 13 operated by the radio signal transmitted from the transmission unit 12.

바람직하게는, 상기 제어장치(111)는, 6축 자이로센서(110)가 센싱한 조종기의 위치 및 자세 신호가 미리 정해진 6축 자이로센서(gyro sensor,110))의 위치 및 자세 신호 범위 내에 있으면 의도적 조작으로 판단하고, 6축 자이로센서(gyro sensor)의 위치 및 자세 신호 범위 외에 있으면 비의도적 신호로 판단한다. 신호 발생부(10)는 구동장치(13)를 직접 조종하는 조이스틱이나 조작 버튼일 수 있다. 또한 본 명세서에서는 설명되지 않으나 6축 자이로센서(110) 및 제어장치(111)는 일반적인 제어부(11)에 포함될 수 있다.
Preferably, the control device 111, if the position and attitude signal of the manipulator sensed by the six-axis gyro sensor 110 is within the position and attitude signal range of the predetermined six-axis gyro sensor (110). It is determined by intentional operation, and is judged as an unintentional signal if it is outside the position and posture signal range of the 6-axis gyro sensor. The signal generator 10 may be a joystick or an operation button for directly manipulating the driving device 13. In addition, although not described herein, the 6-axis gyro sensor 110 and the control device 111 may be included in the general control unit 11.

원격에 있는 구동장치(13)들, 예컨대 굴삭기, 크롤러(crawler), 지게차, 펌프카 등을 조종하기 위한 근격/원격조종기는 일반적으로 조작자가 착용하고 작업하는 장소로 구동장치(13)를 좌우 또는 상하로 이동시키면서 작업을 하는데, 이때 조작자는 작업이 원할히 되도록 구동장치의 위치 및 방향을 확인하는데, 이때 구동장치와 동일한 방향으로 보행하거나 뛰어서 이동하게 된다. 이 경우 조종기에 설치된 6축 자이로센서(110)로 부터 발생하는 위치 및 자세 이탈 신호를 비의도적 조작 신호로 제어장치(111)가 판단하여 조종제어 신호가 전송부(12)로 전송되지 않도록 차단함으로써 구동장치(13)의 작동이 멈추게 된다. 이와 같은 조종기에서의 비의도적 조작이 아닌 경우에도 제어장치(111)는, 낙하와 같이 조종기가 수직 하방으로 또는 좌우로 흔들리면서 낙하하는 경우로 판단하여, 오류적 판단을 하게 되므로, 구동장치를 멈추게 하는 것이다.
A remote / driven remote control device, such as an excavator, crawler, forklift, pump car, etc., is generally used by the operator to operate and operate the drive device 13 side to side or up and down. While moving to work, the operator checks the position and direction of the drive device so that the work is smooth, at this time walking or jumping in the same direction as the drive device. In this case, the six-axis gyro sensor 110 installed in the remote controller The control unit 111 determines the position and posture deviation signal generated from the control unit 111 as an unintentional operation signal, and stops the operation of the driving device 13 by blocking the control control signal from being transmitted to the transmission unit 12. Even when the controller is not unintentional operation, the control unit 111 determines that the controller falls down by shaking it vertically downward or from side to side, such as falling, and thus makes an error judgment. will be.

상기와 같은 오류적 판단을 방지하고자 6축 자이로센서(110)로 부터 센싱되는 위치 및 자세 신호의 범위를 한정하여, 상기 정해진 범위 내에서의 수평이동, 수직이동 및 축 회전은 원격조종기 조작자의 의도적 조작으로 인한 신호로 제어장치가 판단하도록 설정하고, 상기 정해진 범위 이외에서 센싱되는 위치 및 자세 신호는 비의도적인 조작으로 인한 신호로 설정한다.
6-axis gyro sensor 110 to prevent such an error determination as described above By limiting the range of the position and posture signal sensed from, the horizontal movement, vertical movement and shaft rotation within the predetermined range is set to determine by the control device as a signal due to the intentional operation of the remote controller operator, and other than the predetermined range The position and posture signal sensed by the signal is set as a signal due to unintentional manipulation.

즉 조종기, 특히 원격 조종기는 탈부착 가능하게 조작자의 신체에 착용하기 때문에 원격 조종기를 작동하는 동안에 조작자가 의도하지 않게 신체에서 이탈되는 비의도적 낙하가 발생하기 쉽다. 또한 구동장치를 조종하기 위해 조종기에 늘 손을 올려놓고 아래로 누르면서 조종기를 작동하기 때문에 하부쪽인 중력 방향으로 하중이 작용하여 조종기가 의도하지 않게 낙하(落下) 사고가 발생하게 된다.
That is, since the remote controller, particularly the remote controller, is detachably worn on the operator's body, an unintentional fall is likely to occur when the remote controller is inadvertently detached from the body during operation. In addition, since the manipulator is always placed on the remote controller and the controller is pressed down to control the drive, the load acts in the direction of gravity, which is the lower side, causing the controller to accidentally fall.

이 경우에 신체에 착용된 조종기가 느슨하게 되어 의도하지 않게 움직이거나, 신체에서 해제되어 지면으로 낙하하는 경우가 발생하게 된다. 이러한 경우 조종기에 설치되어 있는 버튼 또는 조이스틱이 원하지 않게 작동되어 구동장치들이 작동되는 오작동의 사고가 발생할 수 있다. 특히 조이스틱의 경우에는 조종기로부터 외부로 돌출되어 설치되어 있는데, 돌출 설치는 조종기가 낙하시에나 비의도적으로 움직였을 때 지면 및 외부 물체에 의한 눌림으로 인해 오작동되는 경우가 많다. 이를 방지하고자, 기구적인 장치, 예컨대 비상 스위치 등을 적용하여 오작동인 경우 빠르게 구동장차를 멈추게 할 수는 있으나, 근본적인 해결책은 되지 못한다. 본 발명은 비의도적인 낙하의 경우 짧게는 수십 ms(밀리 초)에 6축 자이로센서(110)가 이를 검출하여 제어장치(111)가 조종제어 신호를 전송부(12)에 전송하지 못하게 함으로써 조종기의 비의도적인 동작 상태를 원천적으로 막을 수 있어서, 구동장치(13)의 오작동을 차단할 수 있다,
In this case, the manipulator worn on the body may loosen and move unintentionally, or may be released from the body and fall to the ground. In this case, the buttons or joysticks installed in the remote controller may be operated undesirably, which may cause a malfunction of the drives. In particular, the joystick is protruded outward from the remote controller, and the protruding installation is often malfunctioned due to the ground and external objects being pressed by the remote controller when the remote controller is dropped or unintentionally moved. To prevent this, a mechanical device such as an emergency switch can be applied to stop the driving vehicle quickly in case of malfunction, but it is not a fundamental solution. In the present invention, in case of unintentional fall, the six-axis gyro sensor 110 detects this in a few tens of ms (milliseconds) at a short time so that the controller 111 does not transmit the control signal to the transmitter 12. It is possible to prevent the unintentional operation state of the source, thereby preventing the malfunction of the drive device 13,

이와 같은 오작동으로 인해 야기되는 구동장치의 비정상적인 동작은 전체 시스템 손상 및 작업장에서의 안전사고를 일으킬 수 있으므로, 조종기가 신체로부터의 낙하와 같이 위치 및 방향(자세)을 이탈하는 것을 센싱하여, 센싱된 신호가 조작자가 의도하지 않은 것으로 판명될 때 전송부(12)에서 구동장치(13)로 작동(무선)신호를 못 보내도록 제어장치(111)가 전송부(12)로 전송하는 조종 제어신호를 차단함으로서 구동장치(13)가 작동되지 않게 한다.
Abnormal operation of the drive caused by such malfunctions may cause damage to the entire system and safety accidents in the workplace. Therefore, the controller may sense the position and direction (falling posture) such as falling from the body. When the signal is found to be unintentional by the operator, the control unit 111 transmits a steering control signal transmitted to the transmission unit 12 so that the transmission unit 12 cannot transmit an operation (wireless) signal to the drive unit 13. By blocking, the drive device 13 is not operated.

이하에서는 본 발명에 따른 6축 자이로센서를 구비한 원격조종기의 제어방법에 대하여 설명하기로 한다. 본 발명의 원격조종기의 제어방법은, 원격조종기의 의도적 또는 비의도적 조작에 의해 조종제어 신호가 발생하는 단계; 6축 자이로센서(110)에 의해 원격조종기의 자세 및 위치가 센싱되는 단계; 상기 센싱된 신호에 기반하여 제어장치(111)가 의도적 조작 여부를 판단하는 단계; 상기 센싱된 신호가 의도적 조작으로 판명된 경우 전송부(12)로 조종제어 신호를 전송하는 단계; 상기 전송부(12)에서 조정제어신호를 무선신호로 변환시켜 구동장치(13)로 전송하는 단계; 상기 무선신호에 의해 구동장치(13)가 작동하는 단계; 를 포함한다.
Hereinafter, a method of controlling a remote controller having a six-axis gyro sensor according to the present invention will be described. The control method of the remote controller of the present invention includes the steps of generating a steering control signal by intentional or unintentional manipulation of the remote controller; Sensing the posture and the position of the remote controller by the 6-axis gyro sensor 110; Determining whether the control device 111 intentionally operates based on the sensed signal; Transmitting a control signal to the transmitter 12 when the sensed signal is determined to be intentional manipulation; Converting an adjustment control signal into a radio signal by the transmitting unit 12 and transmitting the converted control signal to the driving device; Operating a driving device (13) by the radio signal; .

바람직하게는, 상기 6축 자이로센서(110)에 의해 센싱된 신호가 제어장치(111)에서 비의도적 조작으로 판명된 경우, 제어장치(111)는 전송부(12)로 전송되는 조종제어 신호를 차단하고 시작 단계로 복귀하는 단계를 더 포함하고, 상기 전송부(12)로 전송되는 조종제어 신호의 차단으로 인해, 전송부(12)는 무선 신호를 구동장치(13)로 전송하지 않아 구동장치가 작동되지 않는다.
Preferably, when the signal sensed by the six-axis gyro sensor 110 is determined to be unintentional operation in the control device 111, the control device 111 is a control signal transmitted to the transmission unit 12 Blocking and returning to the start step, and due to the blockage of the steering control signal transmitted to the transmission unit 12, the transmission unit 12 does not transmit a radio signal to the drive device 13 driving device Does not work.

상세하게는, 원격조종기에 설치된 6축 자이로센서(110)로 부터 6축의 x,y,z축의 변위속도, x,y,z축의 각속도를 입력받아 조작상태의 상황 인지를 제어장치(111)가 제어 알고리즘을 통해 원격조종기의 조작 여부 및 어떠한 조작 상태인지를 판별한다. 또한 제어장치(111)는, 조종기의 낙하 여부를 판별하여, 의도적(정상상태)인지 또는 비의도적(위험상태)를 구분하여, 비의도적인 경우 유/무선 신호를 차단함과 동시에 각종 데이터를 저장 후 조종기 전체의 전원을 오프하게 된다. 즉, 6축 자이로센서(110)에 의해 상기 원격조종기의 상태, 예컨대 위치 및 자세가 낙하 등의 비도적인 상태인 것으로 탐지되어, 원격조종기가 비의도적으로 동작하는 것으로 제어장치(111)에 의해 검출되면, 구동장치의 오작동을 방지하고자 하는 안전메카니즘이 가동되어, 제어장치(111)가 전송부(12)에서 구동장치(13)로 전송되는 무선신호를 차단하여 구동장치를 멈추게 한다. 즉, 전송부를 오프시키고, 기존의 조종기의 작동 데이터를 저장하면서 오류를 정정한 후, 조종기의 파워를 오프시키는 제어의 연속 흐름을 갖춘다. 본 발명에서 원격조종기에 어떤 센서를 사용할 것인가, 또한 조종기의 비의도적 낙하의 범위, 즉 조종기의 위치 및 자세의 변화 범위를 어느 범위로 까지 해야할 것인가는 원격조종기를 사용하여 작업시 중장비 및 구동장치의 작업 행태 및 조작자의 행동 범위 등을 고려하는 것이 바람직하다.
In detail, the control unit 111 receives the displacement speed of the x-, y-, and z-axes and the angular speeds of the x-, y-, and z-axes of the six axes from the six-axis gyro sensor 110 installed in the remote controller. The control algorithm determines whether the remote controller is operated and in what type of operation. In addition, the control unit 111 determines whether the controller falls, and intentionally (normal state) or unintentional (dangerous state), and in case of unintentional blocking the wired / wireless signal and storing various data at the same time. After that, the whole power of the remote controller is turned off. That is, the six-axis gyro sensor 110 detects that the state of the remote controller, for example, the position and posture, is an unintentional state such as a fall, and the remote controller detects that the remote controller operates unintentionally. When the safety mechanism to prevent the malfunction of the driving device is activated, the control device 111 stops the driving device by cutting off the radio signal transmitted from the transmission unit 12 to the driving device 13. That is, it has a continuous flow of control that turns off the transmitter, corrects an error while storing operation data of the existing controller, and then turns off the power of the controller. Which sensor to use for the remote control in the present invention, and to what extent the range of unintentional fall of the remote controller, that is, the range of change of position and attitude of the remote controller to the range of heavy equipment and driving device when working with the remote controller It is desirable to consider work behavior and the range of actions of the operator.

본 발명에서의 원격조정기 조작자의 의도적 상태는 구동장치를 작동시키기 위한 정상적인 조작 상태를 의미하며, 비의도적 상태는 비정상적인 조작 상태, 즉 구동장치가 조작자의 조종과는 무관하게 작동되는 위험상태를 의미한다.
The intentional state of the remote controller operator in the present invention means a normal operation state for operating the drive device, the unintentional state means an abnormal operation state, that is, a dangerous state in which the drive device is operated regardless of the operator's control. .

이상의 설명은 본 발명의 기술 사상을 예시적으로 설명한 것에 불과하며, 본 발명이 속하는 기술 분야에서 통상의 지식을 갖는 자라면 본 발명의 본질적인 특성에서 벗어나지 않는 범위에서 다양한 수정 및 변형이 가능할 것이다. 따라서 본 발명에 게시된 실시예들은 본 발명의 기술 사상을 한정하기 위한 것이 아니라 설명하기 위한 것이고, 이런 실시예에 의하여 본 발명의 기술 사상 범위가 한정되는 것은 아니다. 본 발명의 보호범위는 아래의 청구범위에 의하여 해석되어야 하며, 그와 동등한 범위 내에 있는 모든 기술 사상은 본 발명의 권리범위에 포함되는 것으로 해석되어야 할 것이다.
While the present invention has been particularly shown and described with reference to exemplary embodiments thereof, it is to be understood that the invention is not limited to the disclosed exemplary embodiments. Therefore, the embodiments disclosed in the present invention are not intended to limit the scope of the present invention but to limit the scope of the present invention. The scope of protection of the present invention should be construed according to the following claims, and all technical ideas within the scope of equivalents should be construed as falling within the scope of the present invention.

10.신호 발생부 11.제어부
110.6축 자이로센서 111.제어장치
12.전송부 13.구동장치10.Signal Generator 11.Control Unit
110.6 axis gyro sensor 111.control device
12. Transmission unit 13. Driving device

Claims (6)

구동장치를 조종하는, 6축 자이로센서를 구비한 원격조종기에 있어서,
조작자의 의도적 또는 비의도적 조작에 의해 조종제어 신호를 발생하는 신호 발생부;
상기 신호 발생부에서 생성된 신호를 6축 자이로센서가 센싱한 조종기의 위치 및 자세 신호에 기반하여 의도적인지 여부를 판단하는 제어장치;
상기 제어장치에서 판단된 신호가 의도적 신호이면 조종제어 신호를 무선 신호로 변환시켜 구동장치로 전송하는 전송부;
상기 전송부에서 전송된 신호에 의해 작동되는 구동장치; 를 포함하는 것을 특징으로 하는 6축 자이로센서를 구비한 원격조종기.
In a remote controller with a six-axis gyro sensor for controlling the drive unit,
Generating control signals by intentional or unintentional manipulation of the operator. A signal generator;
A control device for determining whether the signal generated by the signal generator is intentional based on a position and attitude signal of a manipulator sensed by a six-axis gyro sensor;
A transmission unit for converting a steering control signal into a wireless signal and transmitting it to a driving device when the signal determined by the control device is an intentional signal;
A driving device operated by a signal transmitted from the transmission unit; Remote controller with a six-axis gyro sensor, characterized in that it comprises a.
제 1항에 있어서,
상기 제어장치는, 6축 자이로센서가 센싱한 조종기의 위치 및 자세 신호가 미리 정해진 6축 자이로센서(gyro sensor)의 위치 및 자세 신호 범위 내에 있으면 의도적 조작으로 판단하고, 6축 자이로센서(gyro sensor)의 위치 및 자세 신호 범위 외에 있으면 비의도적 신호로 판단하는 것을 특징으로 하는 6축 자이로센서를 구비한 원격조종기.
The method of claim 1,
The control device determines that the position and posture signal of the controller sensed by the 6-axis gyro sensor is intentional operation if it is within a predetermined position and posture signal range of the 6-axis gyro sensor, and the 6-axis gyro sensor Remote control device with a six-axis gyro sensor characterized in that it is determined by the unintentional signal if the position and posture signal range is outside.
제 1항에 있어서,
상기 신호발생부는 버튼 이거나 조이스틱 인 것을 특징으로 하는 6축 자이로센서를 구비한 원격조종기.
The method of claim 1,
The signal generator is a remote controller having a six-axis gyro sensor, characterized in that the button or joystick.
구동장치를 조종하는, 6축 자이로센서를 구비한 원격조종기의 제어방법에 있어서,
상기 제어방법은,
원격조종기의 의도적 또는 비의도적 조작에 의해 조종제어 신호가 발생하는 단계;
6축 자이로센서에 의해 조종기의 자세 및 위치가 센싱되는 단계;
상기 센싱된 신호에 기반하여 제어장치가 의도적 조작 여부를 판단하는 단계;
상기 센싱된 신호가 의도적 조작으로 판명된 경우 전송부로 조종제어 신호를 전송하는 단계;
상기 전송부에서 조정제어신호를 무선신호로 변환시켜 구동장치로 전송하는 단계;
상기 무선신호에 의해 구동장치가 작동하는 단계;
를 포함하는 것을 특징으로 하는 제어방법.
Steering drive, In the control method of a remote controller having a six-axis gyro sensor,
In the control method,
Generating a control signal by intentional or unintentional manipulation of the remote controller;
Sensing the attitude and position of the manipulator by a six-axis gyro sensor;
Determining, by the controller device, whether the operation is intentional based on the sensed signal;
Transmitting a steering control signal to a transmitter when the sensed signal is determined to be intentional manipulation;
Converting, by the transmission unit, an adjustment control signal into a wireless signal and transmitting the same to a driving device;
Operating a driving device by the radio signal;
Control method comprising a.
제 4항에 있어서,
상기 6축 자이로센서에 의해 센싱된 신호가 제어장치에서 비의도적 조작으로 판명된 경우, 제어장치는 전송부로 전송되는 조종제어 신호를 차단하고 시작 단계로 복귀하는 단계를 더 포함하는 것을 특징으로 하는 제어방법.
5. The method of claim 4,
If the signal sensed by the six-axis gyro sensor is determined to be unintentional operation in the control device, the control device further comprises the step of blocking the control control signal transmitted to the transmitter and returning to the start step Way.
제 5항에 있어서,
상기 전송부로 전송되는 조종제어 신호의 차단으로 인해, 전송부는 무선 신호를 구동장치로 전송하지 않아 구동장치가 작동되지 않는 것을 특징으로 하는 제어방법.


6. The method of claim 5,
Due to the blockage of the steering control signal transmitted to the transmitter, the transmitter does not transmit a radio signal to the driver, and thus the driver is not operated.


KR1020120046518A 2012-05-02 2012-05-02 Remote control having a 6-axis gyro sensor and control method therof KR101380938B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020120046518A KR101380938B1 (en) 2012-05-02 2012-05-02 Remote control having a 6-axis gyro sensor and control method therof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020120046518A KR101380938B1 (en) 2012-05-02 2012-05-02 Remote control having a 6-axis gyro sensor and control method therof

Publications (2)

Publication Number Publication Date
KR20130123231A true KR20130123231A (en) 2013-11-12
KR101380938B1 KR101380938B1 (en) 2014-04-01

Family

ID=49852612

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020120046518A KR101380938B1 (en) 2012-05-02 2012-05-02 Remote control having a 6-axis gyro sensor and control method therof

Country Status (1)

Country Link
KR (1) KR101380938B1 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106906867A (en) * 2017-03-29 2017-06-30 深圳市源畅通科技有限公司 A kind of excavator control system with automatic early-warning function
FR3096162A1 (en) * 2019-05-15 2020-11-20 Robert Bosch Gmbh "Work machine remote control"

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05118057A (en) * 1991-10-28 1993-05-14 Komatsu Ltd Wireless control device for work machine
JPH0648139A (en) * 1992-07-24 1994-02-22 Toyota Motor Corp Suspension behavior detecting device and suspension control device
JPH1060952A (en) * 1996-08-16 1998-03-03 Hitachi Constr Mach Co Ltd Safety device for remote controlling construction machine

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106906867A (en) * 2017-03-29 2017-06-30 深圳市源畅通科技有限公司 A kind of excavator control system with automatic early-warning function
FR3096162A1 (en) * 2019-05-15 2020-11-20 Robert Bosch Gmbh "Work machine remote control"

Also Published As

Publication number Publication date
KR101380938B1 (en) 2014-04-01

Similar Documents

Publication Publication Date Title
US9568939B2 (en) Tactile feedback for joystick position/speed controls
US9669548B2 (en) Mobile collaborative robot
JP6794667B2 (en) Construction machinery control system and control program
JP5433141B2 (en) Danger prevention method, danger prevention system, control method and control system for crane
JP5768828B2 (en) Robot system and control method of robot system
RU2011123098A (en) VEHICLE REMOTE CONTROL SYSTEM FOR LOADING AND UNLOADING WORKS AND METHODS OF CONTROL IT
EP2924177B1 (en) Work vehicle
KR100967214B1 (en) Leveling control system and method for industrial equipment
WO2010141054A1 (en) Tactile feedback for joystick position/speed controls
CN112384663B (en) Excavator
US11905144B2 (en) Control of a handling machine
JP2009142941A (en) Control device and control method
AU2016282421B2 (en) Remote control
KR101380938B1 (en) Remote control having a 6-axis gyro sensor and control method therof
US7980402B2 (en) Radio remote control device for a working machine
JP2010058216A (en) Remote control device
US20220297984A1 (en) Construction and/or material-handling machine
KR20130009316A (en) Apparatus for controlling robot with embedded physical impact sensor and method for controlling robot using the same
EP4000816A1 (en) Robot safety weight compensation system and method capable of compensating weight of robot
JP5490521B2 (en) Work vehicle safety device and work vehicle
KR101843506B1 (en) Apparatus for restricting excessive inclination of crane
RU2396201C1 (en) Method of increasing safety (versions) and safety system of jib hoisting crane (versions)
KR101459322B1 (en) Device limiting a joystick
RU2642026C1 (en) Remote control system of machine with mast attachment
KR102256168B1 (en) Aerial work vehicles having detecting censor for worktable

Legal Events

Date Code Title Description
A201 Request for examination
E902 Notification of reason for refusal
E701 Decision to grant or registration of patent right
GRNT Written decision to grant
FPAY Annual fee payment

Payment date: 20161229

Year of fee payment: 4

FPAY Annual fee payment

Payment date: 20171207

Year of fee payment: 5

FPAY Annual fee payment

Payment date: 20190304

Year of fee payment: 6

FPAY Annual fee payment

Payment date: 20200115

Year of fee payment: 7