KR20190057978A - Following system for solar panel cleaning robot of mobile robot and method thereof - Google Patents
Following system for solar panel cleaning robot of mobile robot and method thereof Download PDFInfo
- Publication number
- KR20190057978A KR20190057978A KR1020170155520A KR20170155520A KR20190057978A KR 20190057978 A KR20190057978 A KR 20190057978A KR 1020170155520 A KR1020170155520 A KR 1020170155520A KR 20170155520 A KR20170155520 A KR 20170155520A KR 20190057978 A KR20190057978 A KR 20190057978A
- Authority
- KR
- South Korea
- Prior art keywords
- robot
- mobile robot
- cleaning robot
- solar panel
- cleaning
- Prior art date
Links
- 238000004140 cleaning Methods 0.000 title claims abstract description 88
- 238000000034 method Methods 0.000 title claims description 22
- 230000005540 biological transmission Effects 0.000 claims abstract description 6
- 238000003032 molecular docking Methods 0.000 claims abstract description 6
- 230000033001 locomotion Effects 0.000 claims description 7
- 230000001133 acceleration Effects 0.000 claims description 3
- 239000002245 particle Substances 0.000 claims description 3
- 238000002604 ultrasonography Methods 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 description 4
- 238000012423 maintenance Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000010248 power generation Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02S—GENERATION OF ELECTRIC POWER BY CONVERSION OF INFRARED RADIATION, VISIBLE LIGHT OR ULTRAVIOLET LIGHT, e.g. USING PHOTOVOLTAIC [PV] MODULES
- H02S40/00—Components or accessories in combination with PV modules, not provided for in groups H02S10/00 - H02S30/00
- H02S40/10—Cleaning arrangements
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4002—Installations of electric equipment
- A47L11/4005—Arrangements of batteries or cells; Electric power supply arrangements
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4036—Parts or details of the surface treating tools
- A47L11/4041—Roll shaped surface treating tools
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
- A47L2201/04—Automatic control of the travelling movement; Automatic obstacle detection
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02E—REDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
- Y02E10/00—Energy generation through renewable energy sources
- Y02E10/50—Photovoltaic [PV] energy
Abstract
Description
본 발명은 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템 및 방법에 관한 것으로서, 더욱 상세하게는 태양광 패널을 모바일 로봇과 청소 로봇이 협업하여 청소하기 위한 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템 및 방법에 관한 것이다. BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a solar panel cleaning robot tracking system and method, and more particularly, to a solar panel cleaning robot tracking system and method of a mobile robot for cleaning a solar panel by a mobile robot and a cleaning robot, .
태양광 발전 패널을 청소하기 위한 두 로봇의 협업 시스템에서 모바일 로봇은 청소 로봇에 전원 공급과 도킹을 위해서 청소 로봇을 추종해야 한다. 모바일 로봇이 청소 로봇을 추종하기 위해서는 두 로봇의 상대 위치 정보가 필요하다. 대규모 태양광 발전소에 적용하기 위한 위치 추정 시스템은 정확도 뿐만 아니라 저렴하며 유지 보수가 용이해야 한다.In a collaborative system of two robots for cleaning a PV panel, a mobile robot must follow a cleaning robot for power supply and docking of the cleaning robot. In order for the mobile robot to follow the cleaning robot, the relative position information of the two robots is needed. The position estimation system for large-scale solar power plants is not only accurate, but also inexpensive and easy to maintain.
야외 환경에서 위치 정보 획득에는 GPS를 이용한 방법과 레이저 스캐너 또는 비콘을 이용한 방법이 주를 이룬다. In the outdoor environment, GPS acquisition method and laser scanner or beacon method are used to acquire location information.
GPS를 이용한 방법은 태양광 발전 패널에 의한 다중 경로(Multipath) 오차를 야기하며 이를 극복한 RTK GPS의 경우 다수의 로봇에 적용하기는 고가이다. The method using GPS causes multi-path error caused by the solar power generation panel, and RTK GPS that overcomes it is expensive to apply to many robots.
레이저 스캐너는 주위 환경에 대한 사전 모델링과 위치 추정에 필요한 많은 연산량 및 가격이 문제가 된다. The laser scanner is problematic in the amount of computation and price required for pre-modeling and localization of the environment.
비콘을 이용한 방법은 로봇의 주위 환경에 위치 정보를 제공하는 다수의 비콘을 설치하여 로봇의 위치 정보를 획득하는 방법이다. 이 방법의 경우 로봇의 경로에 해당하는 모든 장소에 비콘을 설치해야 하므로 대규모 태양광 발전소에 적용하는 것에 유지 보수 문제가 발생한다.A method using a beacon is a method of acquiring position information of a robot by installing a plurality of beacons that provide position information to the environment of the robot. In this method, the beacon must be installed at every place corresponding to the path of the robot, so that there is a maintenance problem in applying to a large-scale solar power plant.
상기와 같은 문제점을 해결하기 위한 본 발명의 목적은 청소 로봇과 모바일 로봇에 설치된 초음파 비콘을 기반으로 두 로봇의 상대 위치를 추정하고 추정된 정보로 모바일 로봇이 청소 로봇을 추종하도록 하는 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템 및 방법을 제공하는 데 있다.According to an aspect of the present invention, there is provided a mobile robot for estimating a relative position of two robots based on an ultrasonic beacon installed on a cleaning robot and a mobile robot, And an optical panel cleaning robot tracking system and method.
상기와 같은 목적을 달성하기 위한 본 발명의 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템은, 태양광 패널을 주행하며 청소를 수행하는 청소 로봇(10); 및 상기 청소 로봇(10)을 추종하고 다른 태양광 패널로 이동시켜주는 모바일 로봇(20);을 포함하고, 상기 청소 로봇(10) 일측에 부착된 초음파 송신부(15)로부터 상기 모바일 로봇(20)의 일측에 부착된 초음파 수신부(23)의 측정된 거리를 이용하여 위치를 추종하여 모바일 로봇(20)에서 청소 로봇(10)에 전원 공급과 도킹을 수행하는 것을 특징으로 한다.According to another aspect of the present invention, there is provided a solar panel cleaning robot tracking system comprising: a cleaning robot (10) for traveling and cleaning a solar panel; And a
상기 청소 로봇(10)은, 양측에 태양광 패널(100) 상에서 이동하는 경로를 제한하는 가이드 롤러(11); 상기 태양광 패널(100) 표면에 부착된 이물질을 제거하는 회전형 브러쉬(12); 및 상기 청소 로봇(10)을 구동시키는 구동부(13);를 포함하는 것을 특징으로 한다.The
상기 모바일 로봇(20)은, 상기 청소 로봇(10)을 탑재하는 탑재부(21); 상기 탑재부(21)의 경사와 높이를 조절하는 조절부(22); 및 상기 청소 로봇(10)을 이동시키는 구동부(23);를 포함하는 것을 특징으로 한다.The mobile robot (20) includes a mounting part (21) for mounting the cleaning robot (10); An
상기 송신부(15)는 초음파 송신 범위 확대를 위해 초음파 송신기(16) 6개가 2열로 배열되는 것을 특징으로 한다.The
상기 수신부(23)는, 상하 4개씩 8개로 구성된 초음파 수신기(26); 및 상기 모바일 로봇(20)의 자세 측정과 위치 추정 결과를 보정하는 자세 추정 시스템(27);를 포함하는 것을 특징으로 한다.The
상기 자세 추정 시스템(27)은 3축 가속도, 3축 각속도, 3축 지자기 센서로 구성되며 필터를 통해 오일러 각도(Yaw, Roll, Pitch)를 획득하는 것을 특징으로 한다.The
또한, 본 발명의 모바일 로봇의 태양광 패널 청소 로봇 추종 방법은, 청소 로봇(10)에 부착된 송신부(15)에서 초음파를 발사하여 모바일 로봇(20)에 부착된 수신부(25)에서 초음파를 수신하는 단계; 상기 송신부(15)와 수신부(25) 사이의 거리를 계산하는 단계; 상기 모바일 로봇(20)에 설치된 자세 추정 시스템(27)으로부터 모바일 로봇(20)의 3축 회전각도 정보를 획득하여 모바일 로봇(20)의 자세를 계산하는 단계; 상기 송수신부(15,25) 사이의 거리 정보를 기반으로 비선형 최소 자승 삼변측량을 수행하여 청소 로봇(10)의 위치를 기준으로 하는 모바일 로봇(20)의 초기 위치를 계산하고 자세 추정 시스템(27)으로 결과를 보정하는 단계; 상기 초기 계산된 위치를 기반으로 파티클 필터를 적용하여 청소 로봇(10)의 위치를 추정하는 단계; 및 상기 추정된 모바일 로봇(20)의 위치를 기반으로 모바일 로봇(20)을 목표된 위치로 제어하기 위해 이동 경로와 자세 변화를 최소화하는 모션을 결정하고 수행하는 단계;를 포함하는 것을 특징으로 한다.The cleaning method of the solar panel cleaning robot of the mobile robot according to the present invention is characterized in that the ultrasonic wave is emitted from the transmitting
상기 송신부(15)와 수신부(25) 사이의 거리는 음의 전파 속도로 계산하는 것을 특징으로 한다.And the distance between the
이상과 같이 본 발명에 따르면, 초음파를 이용하므로 높은 추정 추종 정확도를 가지며 연산량이 적고 가격이 저렴하다.As described above, according to the present invention, since the ultrasonic wave is used, it has a high estimated tracking accuracy, a small amount of calculation, and a low cost.
또한, 본 발명에 따르면 초음파 비콘의 설치는 청소 로봇과 모바일 로봇에만 요구되며 그 개수가 적으므로 유지 보수가 용이하다. In addition, according to the present invention, the installation of the ultrasonic beacon is required only for the cleaning robot and the mobile robot, and the maintenance is easy since the number of the beacon is small.
도 1은 본 발명에 따른 모바일 로봇의 태양광 패널 태양광 패널 청소 로봇 추종 시스템의 추종 개략도이다.
도 2는 본 발명에 따른 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템의 도킹 개략도이다.
도 3은 본 발명에 따른 청소 로봇의 사시도이다.
도 4는 본 발명에 따른 모바일 로봇의 사시도이다.
도 5는 본 발명에 따른 청소 로봇에 부착된 송신부를 나타낸 도면이다.
도 6은 본 발명에 따른 모바일 로봇에 부착된 수신부를 나타낸 도면이다.
도 7은 본 발명에 따른 모바일 로봇의 태양광 패널 청소 로봇 추종 방법을 나타낸 흐름도이다. 1 is a schematic view of a solar panel solar panel cleaning robot following system of a mobile robot according to the present invention.
2 is a schematic diagram of a docking of a solar panel cleaning robot tracking system of a mobile robot according to the present invention.
3 is a perspective view of a cleaning robot according to the present invention.
4 is a perspective view of a mobile robot according to the present invention.
5 is a view showing a transmitter attached to the cleaning robot according to the present invention.
6 is a view illustrating a receiving unit attached to a mobile robot according to the present invention.
FIG. 7 is a flowchart illustrating a method of tracking a solar panel cleaning robot of a mobile robot according to the present invention.
아래에서는 첨부한 도면을 참고로 하여 본 발명의 실시예에 대하여 본 발명이 속하는 기술 분야에서 통상의 지식을 가진 자가 용이하게 실시할 수 있도록 상세히 설명한다. 그러나 본 발명은 여러 가지 상이한 형태로 구현될 수 있으며 여기에서 설명하는 실시예에 한정되지 않는다. Hereinafter, embodiments of the present invention will be described in detail with reference to the accompanying drawings so that those skilled in the art can easily carry out the present invention. The present invention may, however, be embodied in many different forms and should not be construed as limited to the embodiments set forth herein.
먼저 본 발명의 일실시예에 따른 협업 청소 로봇 시스템에 대하여 설명한다.First, a cooperative cleaning robot system according to an embodiment of the present invention will be described.
도 1은 본 발명에 따른 모바일 로봇의 태양광 패널 태양광 패널 청소 로봇 추종 시스템의 추종 개략도이고, 도 2는 본 발명에 따른 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템의 도킹 개략도이고, 도 3은 본 발명에 따른 청소 로봇의 사시도이고, 도 4는 본 발명에 따른 모바일 로봇의 사시도이고, 도 5는 본 발명에 따른 청소 로봇에 부착된 송신부를 나타낸 도면이고. 도 6은 본 발명에 따른 모바일 로봇에 부착된 수신부를 나타낸 도면이다.2 is a schematic view of a docking system of a solar panel cleaning robot tracking system of a mobile robot according to the present invention, and Fig. 3 is a schematic view of a solar panel cleaning robot following system of the mobile robot according to the present invention. FIG. 4 is a perspective view of a mobile robot according to the present invention, and FIG. 5 is a view showing a transmitter attached to the cleaning robot according to the present invention. 6 is a view illustrating a receiving unit attached to a mobile robot according to the present invention.
도 1 내지 도 6을 참조하면, 본 발명의 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템은 태양광 패널을 탑승하여 청소를 수행하는 청소 로봇(10)과, 상기 청소 로봇(10)을 추종하고 다른 태양광 패널로 이동시켜주는 모바일 로봇(20)로 구성된다. 즉, 협업 청소 로봇 시스템은 제1 태양광 패널(100) 상부에서 주행하며 청소를 수행하는 청소 로봇(10)과, 상기 청소 로봇(10)을 추종하면서 제1 태양광 패널(100)의 청소를 끝낸 후 제2 태양광 패널(200)로 이동시켜주는 모바일 로봇(20)로 구성된다.1 to 6, a solar panel cleaning robot tracking system of a mobile robot according to the present invention includes a
상기 청소 로봇(10)은 양측에 제1 태양광 패널(100) 상에서 청소 로봇(10)이 이동하는 경로를 제한하는 가이드 롤러(11), 상기 제1 태양광 패널(100) 표면에 부착된 이물질을 제거하는 회전형 브러쉬(12), 및 상기 청소 로봇(10)을 구동시키는 구동부(13)로 구성되어 있다. 이미 널리 공지된 기술이므로 자세한 설명은 생략하기로 한다. 여기서. 상기 구동부(13)는 한 쌍의 바퀴를 연결하는 바퀴 축이 회전하면서 청소 로봇(10)이 이동하게 된다.The
상기 모바일 로봇(20)은 청소 로봇(10)을 탑재하는 탑재부(21), 상기 탑재부(21)의 경사(각도)와 높이를 조절하는 조절부(22), 및 상기 청소 로봇(10)의 움직임을 추종하는 동시에 독립적으로 이동이 가능한 구동부(23)로 구성된다. The
여기서, 상기 조절부(22)는 지면과의 높이 및 각도를 조절하여 제2 태양광 패널(200) 상에 청소 로봇(10) 탑승이 가능케 한다. 즉, 모바일 로봇(20)이 청소 로봇(10)을 추종하여 제1 태양광 패널(100)에 접근한 후 탑재부(21)를 조절부(22)를 통하여 제1 태양광 패널(100) 높이와 각도를 일치시켜 도킹한다, 이후에 청소 로봇(10)을 탑재부(21)에서 이탈시켜 제2 태양광 패널(200)에 탑승시킨다.Here, the
한편, 상기 청소 로봇(10) 일측에는 송신부(15)가 지면과 수직으로 부착되어 초음파 신호를 송신한다. 이때, 상기 송신부(15)는 초음파 송신 범위 확대를 위해 초음파 송신기(16) 6개가 2열로 배열되어 있다. On the other hand, a
그리고, 상기 모바일 로봇(20)의 일측에는 수신부(23)가 지면과 수평으로 부착되어 초음파 신호를 수신한다. 여기서, 상기 수신부(23)는 초음파 수신기(26)가 상하 4개씩 8개로 구성되며 정확도가 높은 3차원 삼변측량을 수행하기 위해 육면체 모양으로 배열될 수 있다. 또한, 상기 모바일 로봇(20)의 자세 측정과 이를 이용한 위치 추정 결과 보정을 위해 자세 추정 시스템(AHRS; Attitude Heading Reference System, 27)이 초음파 수신기(26) 배열의 중심에 위치한다. 여기서, 상기 자세 추정 시스템(27)은 3축 가속도, 3축 각속도, 3축 지자기 센서로 구성되어 있으며 필터를 통해 오일러 각도(Yaw, Roll, Pitch)를 획득할 수 있다.A receiving
그리고, 상기 모바일 로봇(20)은 캐터필러 타입으로 상부에 6-DOF 브릿지가 부착되어 지면에서 태양광 패널 청소 로봇(10)을 추종하고, 이를 통해 청소 로봇(10)에 전원을 공급하고, 청소 로봇(10)을 상부의 6-DOF 브릿지에 도킹을 수행한다.The
여기서, 상기 송신부(15) 및 수신부(25)는 지면으로부터 높은 모바일 로봇(20)의 탑재부(21) 및 청소 로봇(10) 일측에 각각 부착되는 것이 바람직하다.It is preferable that the transmitting
이어서, 본 발명의 일실시예에 따른 모바일 로봇의 태양광 패널 청소 로봇 추종 방법에 대하여 설명한다.Next, a method of following a solar panel cleaning robot of a mobile robot according to an embodiment of the present invention will be described.
도 7은 본 발명에 따른 모바일 로봇의 태양광 패널 청소 로봇 추종 방법을 나타낸 흐름도이다. FIG. 7 is a flowchart illustrating a method of tracking a solar panel cleaning robot of a mobile robot according to the present invention.
도 7을 참조하면, 본 발명의 모바일 로봇의 태양광 패널 청소 로봇 추종 방법은, 우선 초음파 신호를 송수신 한다(S100). 즉, 청소 로봇(10)에 부착된 송신부(15)에서 초음파를 발사하면 모바일 로봇(20)에 부착된 수신부(25)에서 초음파를 수신한다.Referring to FIG. 7, in the method for tracking a solar panel cleaning robot of a mobile robot according to the present invention, ultrasonic signals are first transmitted and received (S100). That is, when the ultrasonic wave is emitted from the transmitting
이어서, 상기 송수신기 거리를 계산한다(S110). 즉, 상기 송신부(15)와 수신부(25) 사이의 거리를 계산하고, 상기 송수신기(15,25) 사이의 거리 계산에는 음의 전파 속도(소리의 속도)를 이용할 수 있다.Then, the transceiver distance is calculated (S110). That is, the distance between the transmitting
이어서, 상기 모바일 로봇(20)의 자세를 계산한다(S120). 즉, 상기 모바일 로봇(20)에 설치된 자세 추정 시스템(27)으로부터 모바일 로봇(20)의 현재 3축 회전각도 정보를 획득한다.Then, the posture of the
다음으로, 초기 위치를 계산한다(S130). 즉, 상기 초기 위치 계산에는 송수신부(15,25) 사이의 거리 정보를 기반으로 비선형 최소 자승 삼변측량(Non-linear Least Square Trilateration)을 수행하여 청소 로봇(10)의 위치를 기준으로 하는 모바일 로봇(20)의 위치를 계산하고 자세 추정 시스템으로 결과를 보정한다. 여기서, 상기 초기 위치 계산은 알고리즘의 첫 실행과 위치 추정 단계에서 위치 추정 정확도가 부정확해지는 경우에만 수행된다.Next, an initial position is calculated (S130). That is, in the calculation of the initial position, a non-linear least square trilateration is performed based on the distance information between the transmitting and receiving
다음에, 위치를 추정한다(S140). 즉, 초기 계산된 위치를 기반으로 예측 기술 중 하나인 파티클 필터를 적용하여 청소 로봇(10)의 위치를 추정한다. 이때, 이후 추정된 위치를 기반으로 내부에서 시뮬레이션을 수행하고 추정 정확도가 부정확해지는 경우 초기 위치 계산 단계를 재수행한다.Next, the position is estimated (S140). That is, the position of the cleaning
다음에, 모바일 로봇(20)의 위치를 제어한다(S150). 즉, 추정된 모바일 로봇(20)의 위치를 기반으로 모바일 로봇(20)을 목표된 위치로 제어하기 위해 이동 경로와 자세 변화를 최소화하는 모션을 결정하고 수행한다.Next, the position of the
이상에서 본 발명의 실시예에 대하여 상세하게 설명하였지만 본 발명의 권리범위는 이에 한정되는 것은 아니고 다음의 청구범위에서 정의하고 있는 본 발명의 기본 개념을 이용한 당업자의 여러 변형 및 개량 형태 또한 본 발명의 권리범위에 속하는 것이다.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, It belongs to the scope of right.
10: 청소 로봇
11: 가이드 롤러
12: 브러쉬
13, 23: 구동부
15: 송신부
20: 모바일 로봇
21: 탑재부
22: 조절부
25: 수신부
100, 200: 태양광 패널10: Cleaning robot 11: Guide roller
12: brushes 13 and 23:
15: transmitter 20: mobile robot
21: mounting part 22: regulating part
25:
Claims (8)
상기 청소 로봇(10)을 추종하고 다른 태양광 패널로 이동시켜주는 모바일 로봇(20);을 포함하고,
상기 청소 로봇(10) 일측에 부착된 초음파 송신부(15)로부터 상기 모바일 로봇(20)의 일측에 부착된 초음파 수신부(23)의 측정된 거리를 이용하여 위치를 추종하여 모바일 로봇(20)에서 청소 로봇(10)에 전원 공급과 도킹을 수행하는 것을 특징으로 하는 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템.A cleaning robot (10) for running and cleaning the solar panel; And
And a mobile robot (20) for following the cleaning robot (10) and moving the cleaning robot to another solar panel,
The position of the ultrasonic wave receiver 23 attached to one side of the mobile robot 20 is followed from the ultrasonic wave transmitter 15 attached to one side of the cleaning robot 10 to be cleaned by the mobile robot 20 Wherein the power supply and the docking are performed to the robot (10).
상기 청소 로봇(10)은,
양측에 태양광 패널(100) 상에서 이동하는 경로를 제한하는 가이드 롤러(11);
상기 태양광 패널(100) 표면에 부착된 이물질을 제거하는 회전형 브러쉬(12); 및
상기 청소 로봇(10)을 구동시키는 구동부(13);를 포함하는 것을 특징으로 하는 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템.The method according to claim 1,
The cleaning robot (10)
A guide roller 11 for limiting the path on both sides of the solar panel 100;
A rotatable brush 12 for removing foreign matter adhering to the surface of the solar panel 100; And
And a driving unit (13) for driving the cleaning robot (10).
상기 모바일 로봇(20)은,
상기 청소 로봇(10)을 탑재하는 탑재부(21);
상기 탑재부(21)의 경사와 높이를 조절하는 조절부(22); 및
상기 청소 로봇(10)을 이동시키는 구동부(23);를 포함하는 것을 특징으로 하는 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템.The method according to claim 1,
The mobile robot (20)
A mounting part (21) for mounting the cleaning robot (10);
An adjuster 22 for adjusting the inclination and height of the mount 21; And
And a driving unit (23) for moving the cleaning robot (10).
상기 송신부(15)는 초음파 송신 범위 확대를 위해 초음파 송신기(16) 6개가 2열로 배열되는 것을 특징으로 하는 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템.The method according to claim 1,
Wherein the transmitting unit (15) is arranged in two rows of six ultrasonic transmitters (16) in order to expand the transmission range of the ultrasonic wave.
상기 수신부(23)는,
상하 4개씩 8개로 구성된 초음파 수신기(26); 및
상기 모바일 로봇(20)의 자세 측정과 위치 추정 결과를 보정하는 자세 추정 시스템(27);를 포함하는 것을 특징으로 하는 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템.The method according to claim 1,
The receiving unit 23,
An ultrasound receiver 26 consisting of 8 units of 4 up and 4 down; And
And a posture estimation system (27) for correcting posture and position estimation results of the mobile robot (20).
상기 자세 추정 시스템(27)은 3축 가속도, 3축 각속도, 3축 지자기 센서로 구성되며 필터를 통해 오일러 각도(Yaw, Roll, Pitch)를 획득하는 것을 특징으로 하는 모바일 로봇의 태양광 패널 청소 로봇 추종 시스템.6. The method of claim 5,
The attitude estimation system 27 is composed of a three-axis acceleration, a three-axis angular velocity, and a three-axis geomagnetic sensor and acquires an Euler angle (Yaw, Roll, Pitch) through a filter. Following system.
상기 송신부(15)와 수신부(25) 사이의 거리를 계산하는 단계;
상기 모바일 로봇(20)에 설치된 자세 추정 시스템(27)으로부터 모바일 로봇(20)의 3축 회전각도 정보를 획득하여 모바일 로봇(20)의 자세를 계산하는 단계;
상기 송수신부(15,25) 사이의 거리 정보를 기반으로 비선형 최소 자승 삼변측량을 수행하여 청소 로봇(10)의 위치를 기준으로 하는 모바일 로봇(20)의 초기 위치를 계산하고 자세 추정 시스템(27)으로 결과를 보정하는 단계;
상기 초기 계산된 위치를 기반으로 파티클 필터를 적용하여 청소 로봇(10)의 위치를 추정하는 단계; 및
상기 추정된 모바일 로봇(20)의 위치를 기반으로 모바일 로봇(20)을 목표된 위치로 제어하기 위해 이동 경로와 자세 변화를 최소화하는 모션을 결정하고 수행하는 단계;를 포함하는 것을 특징으로 하는 모바일 로봇의 태양광 패널 청소 로봇 추종 방법.Receiving ultrasonic waves from the receiving unit 25 attached to the mobile robot 20 by emitting ultrasonic waves from the transmitting unit 15 attached to the cleaning robot 10;
Calculating a distance between the transmitter (15) and the receiver (25);
Calculating a posture of the mobile robot (20) by obtaining three-axis rotation angle information of the mobile robot (20) from an attitude estimation system (27) installed in the mobile robot (20)
Linear least squares triangulation is performed based on the distance information between the transceiver units 15 and 25 to calculate an initial position of the mobile robot 20 based on the position of the cleaning robot 10, ≪ / RTI >
Estimating a position of the cleaning robot (10) by applying a particle filter based on the initial calculated position; And
And determining and performing a motion that minimizes a movement path and a posture change to control the mobile robot 20 to a target position based on the estimated position of the mobile robot 20 How to Follow a Robot 's Solar Panel Cleaning Robot.
상기 송신부(15)와 수신부(25) 사이의 거리는 음의 전파 속도로 계산하는 것을 특징으로 하는 모바일 로봇의 태양광 패널 청소 로봇 추종 방법.8. The method of claim 7,
Wherein the distance between the transmitter (15) and the receiver (25) is calculated as a negative propagation velocity.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR1020170155520A KR102051046B1 (en) | 2017-11-21 | 2017-11-21 | Following system for solar panel cleaning robot of mobile robot and method thereof |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR1020170155520A KR102051046B1 (en) | 2017-11-21 | 2017-11-21 | Following system for solar panel cleaning robot of mobile robot and method thereof |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| KR20190057978A true KR20190057978A (en) | 2019-05-29 |
| KR102051046B1 KR102051046B1 (en) | 2019-12-02 |
Family
ID=66672511
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| KR1020170155520A KR102051046B1 (en) | 2017-11-21 | 2017-11-21 | Following system for solar panel cleaning robot of mobile robot and method thereof |
Country Status (1)
| Country | Link |
|---|---|
| KR (1) | KR102051046B1 (en) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR102181438B1 (en) | 2019-09-30 | 2020-11-23 | 주식회사 더블유피 | Portable solar panel cleaning apparatus |
| CN111993421A (en) * | 2020-08-11 | 2020-11-27 | 苏州瑞得恩光能科技有限公司 | Connection system and connection method |
| KR20210025881A (en) * | 2019-08-28 | 2021-03-10 | 한국기계연구원 | Solar panel cleaning device having cleaning module |
| CN112974325A (en) * | 2021-03-05 | 2021-06-18 | 上海凯畦实业发展有限公司 | Movable rotary integrated water pump cleaning device of photovoltaic power station |
| CN115140141A (en) * | 2022-06-22 | 2022-10-04 | 国网天津市电力公司建设分公司 | Electric power iron tower climbing robot connects soon and transports butt joint car |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004212400A (en) * | 2002-12-30 | 2004-07-29 | Samsung Electronics Co Ltd | Position and direction predicting system for robot |
| KR101623460B1 (en) * | 2015-02-13 | 2016-05-23 | 재단법인한국조선해양기자재연구원 | Solar Panel Auto Cleaning Robot Apparatus |
| KR20170061373A (en) * | 2015-11-26 | 2017-06-05 | 삼성전자주식회사 | Mobile Robot And Method Thereof |
-
2017
- 2017-11-21 KR KR1020170155520A patent/KR102051046B1/en active IP Right Grant
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004212400A (en) * | 2002-12-30 | 2004-07-29 | Samsung Electronics Co Ltd | Position and direction predicting system for robot |
| KR101623460B1 (en) * | 2015-02-13 | 2016-05-23 | 재단법인한국조선해양기자재연구원 | Solar Panel Auto Cleaning Robot Apparatus |
| KR20170061373A (en) * | 2015-11-26 | 2017-06-05 | 삼성전자주식회사 | Mobile Robot And Method Thereof |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20210025881A (en) * | 2019-08-28 | 2021-03-10 | 한국기계연구원 | Solar panel cleaning device having cleaning module |
| KR102181438B1 (en) | 2019-09-30 | 2020-11-23 | 주식회사 더블유피 | Portable solar panel cleaning apparatus |
| CN111993421A (en) * | 2020-08-11 | 2020-11-27 | 苏州瑞得恩光能科技有限公司 | Connection system and connection method |
| CN112974325A (en) * | 2021-03-05 | 2021-06-18 | 上海凯畦实业发展有限公司 | Movable rotary integrated water pump cleaning device of photovoltaic power station |
| CN115140141A (en) * | 2022-06-22 | 2022-10-04 | 国网天津市电力公司建设分公司 | Electric power iron tower climbing robot connects soon and transports butt joint car |
| CN115140141B (en) * | 2022-06-22 | 2023-10-03 | 国网天津市电力公司建设分公司 | Electric power iron tower climbing robot connects fortune butt joint car soon |
Also Published As
| Publication number | Publication date |
|---|---|
| KR102051046B1 (en) | 2019-12-02 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR20190057978A (en) | Following system for solar panel cleaning robot of mobile robot and method thereof | |
| US10520223B2 (en) | Robotic heliostat calibration system and method | |
| CN108646215B (en) | Automatic following rapid positioning method based on ultra wide band | |
| Fan et al. | Data fusion for indoor mobile robot positioning based on tightly coupled INS/UWB | |
| Prorok et al. | Indoor navigation research with the Khepera III mobile robot: An experimental baseline with a case-study on ultra-wideband positioning | |
| US8930023B2 (en) | Localization by learning of wave-signal distributions | |
| CN101916915B (en) | Antenna beam tracking device and method of moving communication satellite communication system | |
| CN108958250A (en) | Multisensor mobile platform and navigation and barrier-avoiding method based on known map | |
| CN105319449B (en) | Antenna damnification method based on unmanned plane | |
| Zhang et al. | Localization and tracking control using hybrid acoustic–optical communication for autonomous underwater vehicles | |
| Liu et al. | Suave: Swarm underwater autonomous vehicle localization | |
| CN108663032B (en) | Working face hydraulic support posture and straightness detection device and method based on robot | |
| Hentschel et al. | A GPS and laser-based localization for urban and non-urban outdoor environments | |
| CN107992035A (en) | A kind of Multi Mobile Robots Formation's control method based on indoor Global localization | |
| Famili et al. | Rolatin: Robust localization and tracking for indoor navigation of drones | |
| CN113311388B (en) | Ultra-short baseline positioning system of underwater robot | |
| CN103472434B (en) | Robot sound positioning method | |
| CN113534184B (en) | Laser-perceived agricultural robot space positioning method | |
| CN109828580A (en) | A kind of Mobile Robot Formation's tracking and controlling method based on separate type ultrasonic wave | |
| Chen et al. | Team formation and steering algorithms for underwater gliders using acoustic communications | |
| CN110837257A (en) | AGV composite positioning navigation system based on iGPS and vision | |
| CN114396955A (en) | Quantum ranging and inter-satellite angle measurement combined double-satellite orbit determination method, system and computer equipment | |
| Xu et al. | Accurate two-step filtering for AUV navigation in large deep-sea environment | |
| KR101303650B1 (en) | Method for building spatial map, method for searching optimum traveling path using spatial map and robot control device using the same | |
| AU2011336375B2 (en) | Robotic heliostat and calibration system and method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A201 | Request for examination | ||
| E902 | Notification of reason for refusal | ||
| AMND | Amendment | ||
| E601 | Decision to refuse application | ||
| X091 | Application refused [patent] | ||
| AMND | Amendment | ||
| X701 | Decision to grant (after re-examination) | ||
| GRNT | Written decision to grant |