JP2022039648A - Control device and control method for work robot - Google Patents

Control device and control method for work robot Download PDF

Info

Publication number
JP2022039648A
JP2022039648A JP2020144783A JP2020144783A JP2022039648A JP 2022039648 A JP2022039648 A JP 2022039648A JP 2020144783 A JP2020144783 A JP 2020144783A JP 2020144783 A JP2020144783 A JP 2020144783A JP 2022039648 A JP2022039648 A JP 2022039648A
Authority
JP
Japan
Prior art keywords
work
robot
section
work robot
unit
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.)
Pending
Application number
JP2020144783A
Other languages
Japanese (ja)
Inventor
遥 山本
Haruka Yamamoto
陽一 布施
Yoichi Fuse
和弘 金子
Kazuhiro Kaneko
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yamabiko Corp
Original Assignee
Yamabiko Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Yamabiko Corp filed Critical Yamabiko Corp
Priority to JP2020144783A priority Critical patent/JP2022039648A/en
Publication of JP2022039648A publication Critical patent/JP2022039648A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Guiding Agricultural Machines (AREA)
  • Harvester Elements (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

To easily improve work efficiency without affecting work quality by preventing interference and collision of a plurality of work robots by eliminating the need for adjustment as to a work speed when allowing the plurality of work robot to work in one work area Wa.SOLUTION: A control device for a work robot 1 has, in the work robot that forms a work track along a travel route for autonomous traveling, a setting unit that sets a virtual work section Ws for the work robot to work. When setting a first work section Ws(1) for a first work robot 1A to work and a second work section Ws(2) for a second work robot 1B to work, the setting unit sets the second work section so as not to be adjacent to the perimeter of the first work section.SELECTED DRAWING: Figure 5

Description

本発明は、作業ロボットの制御装置及び制御方法に関するものである。 The present invention relates to a control device and a control method for a work robot.

従来、作業領域内を自律走行しながら走行経路に沿って草刈りなどの作業を行う作業ロボットが知られている(例えば、下記特許文献1参照)。作業ロボットは、GPSなどの衛星測位システムを活用するか、或いは作業現場に設置された電子タグやワイヤなどの基準位置を検知して、設定された作業領域内にて自律走行を行う。 Conventionally, a work robot that autonomously travels in a work area and performs work such as mowing along a travel path is known (see, for example, Patent Document 1 below). The work robot utilizes a satellite positioning system such as GPS, or detects a reference position such as an electronic tag or a wire installed at the work site and autonomously travels within the set work area.

特許第5973608号公報Japanese Patent No. 5973608

前述した作業ロボットは、無人化することで、夜間作業や長時間作業が可能になるが、作業幅の拡大や作業速度を高めることに限界があるため、単体の作業ロボットでは高い作業能率(単位面積当たりの作業時間)を得ることが難しい。これに対しては、1つの作業領域で複数台の作業ロボットを動作させて、トータルの作業能率を向上させることが検討されている。 By unmanning the above-mentioned work robot, it is possible to work at night or for a long time, but there is a limit to expanding the work width and increasing the work speed, so a single work robot has high work efficiency (unit). It is difficult to obtain (working time per area). To this end, it is being studied to operate multiple work robots in one work area to improve the total work efficiency.

この際、1つの作業領域内で作業する複数の作業ロボットが干渉し合ったり、衝突してしまったりすると、効果的に作業能率を高めることができなくなる。複数の作業ロボットの干渉や衝突を避けるには、互いに近接した作業ロボットの状態を検知して、一方又は両方の作業ロボットの作業速度を調節又は停止させることが考えられる。しかしながら、作業ロボットの作業速度を調整又は停止させてしまうと、作業能率に悪影響を及ぼすだけでなく、一定の作業速度で高品質の仕上がりを得たい草刈り作業などでは、作業品質の低下を招くという問題が生じる。 At this time, if a plurality of work robots working in one work area interfere with each other or collide with each other, the work efficiency cannot be effectively improved. In order to avoid interference or collision of a plurality of working robots, it is conceivable to detect the state of the working robots close to each other and adjust or stop the working speed of one or both working robots. However, if the work speed of the work robot is adjusted or stopped, not only the work efficiency is adversely affected, but also the work quality is deteriorated in mowing work that wants to obtain a high quality finish at a constant work speed. Problems arise.

本発明は、このような事情に対処するために提案されたものである。すなわち、1つの作業領域にて、複数の作業ロボットの作業を行わせるに際して、作業速度などの調節を不要にして複数の作業ロボットの干渉や衝突を回避し、作業品質に影響を与えることなく、簡易に作業能率の向上を図ること、などが、本発明の課題である。 The present invention has been proposed to deal with such circumstances. That is, when the work of a plurality of work robots is performed in one work area, it is not necessary to adjust the work speed and the like to avoid interference and collision of the plurality of work robots, and the work quality is not affected. It is an object of the present invention to easily improve work efficiency.

このような課題を解決するために、本発明は、以下の構成を具備するものである。 In order to solve such a problem, the present invention has the following configurations.

自律走行する走行経路に沿って作業軌跡を形成する作業ロボットの制御装置であって、前記作業ロボットが作業を行う仮想の作業区画を設定する設定部を備え、前記設定部は、第1の作業ロボットが作業を行う第1の作業区画と第2の作業ロボットが作業を行う第2の作業区画を設定するに際して、前記第1の作業区画の周りに隣接しないように、前記第2の作業区画を設定することを特徴とする作業ロボットの制御装置。 It is a control device of a work robot that forms a work locus along a travel path that autonomously travels, and includes a setting unit for setting a virtual work area in which the work robot performs work, and the setting unit is the first work. When setting the first work area in which the robot works and the second work area in which the second work robot works, the second work area is set so as not to be adjacent to the first work area. A control device for a working robot characterized by setting.

このような特徴を有する本発明によると、1つの作業領域にて、作業ロボットの作業を行わせるに際して、作業速度などの調節を不要にして作業ロボット相互の干渉や衝突を回避し、作業品質に影響を与えることなく、簡易に作業能率の向上を図ることができる。 According to the present invention having such a feature, when the work of the work robot is performed in one work area, it is not necessary to adjust the work speed and the like to avoid interference and collision between the work robots, and the work quality is improved. Work efficiency can be easily improved without affecting the work efficiency.

作業ロボットシステムの説明図。Explanatory drawing of the work robot system. 作業ロボット単体の説明図((a)が側面視の説明図、(b)が平面視の説明図)。Explanatory drawing of a single working robot ((a) is an explanatory view of a side view, (b) is an explanatory view of a plan view). 作業ロボットシステムの構成を示す説明図。Explanatory drawing which shows the structure of a work robot system. 制御装置の機能を説明する説明図。Explanatory drawing explaining the function of a control device. 作業区画の設定例を示した説明図((a)が作業区画単位での隣接区画設定例を示し、(b)が作業区画の周囲に隣接区画を設定した例を示す。)。Explanatory drawing showing a setting example of a work section ((a) shows an example of setting an adjacent section for each work section, and (b) shows an example of setting an adjacent section around the work section). 作業モードの説明図((a)がラインストライプ状軌跡、(b)が旋回ストライプ状軌跡、(c)がランダム軌跡)。Explanatory drawing of work mode ((a) is a line stripe locus, (b) is a swirl striped locus, (c) is a random locus). 作業区画の他の設定例を示す説明図。Explanatory drawing which shows other setting example of a work area.

以下、図面を参照して本発明の実施形態の一例を説明する。以下の説明で、異なる図における同一符号は同一機能の部位を示しており、各図における重複説明は適宜省略する。 Hereinafter, an example of an embodiment of the present invention will be described with reference to the drawings. In the following description, the same reference numerals in different figures indicate parts having the same function, and duplicate description in each figure will be omitted as appropriate.

図1に示すように、作業ロボットシステム1Sは、複数の作業ロボット1(1A,1B,1C)とこの作業ロボット1(1A,1B,1C)を管理する管理設備によって構成されている。管理設備としては、サーバー101、ユーザーが所持する携帯情報端末102、充電基地103などがあり、各設備は、ネットワークNTを介して作業ロボット1(1A,1B,1C)との信号送受信が可能になっている。また、複数の作業ロボット1(1A,1B,1C)は、ネットワークNTを介することなく、相互に信号の送受信が可能になっていても良い。 As shown in FIG. 1, the work robot system 1S is composed of a plurality of work robots 1 (1A, 1B, 1C) and management equipment for managing the work robots 1 (1A, 1B, 1C). The management equipment includes a server 101, a mobile information terminal 102 owned by the user, a charging base 103, and the like, and each equipment can transmit and receive signals to and from the work robot 1 (1A, 1B, 1C) via the network NT. It has become. Further, the plurality of working robots 1 (1A, 1B, 1C) may be capable of transmitting and receiving signals to and from each other without going through the network NT.

作業ロボット1を制御する制御装置は、前述した作業ロボットシステム1S内で各作業ロボット1を制御するものであり、制御信号の発信源は、各作業ロボット1内、サーバー101内、携帯情報端末102内、充電基地103内などのいずれであってもよい。 The control device for controlling the work robot 1 controls each work robot 1 in the work robot system 1S described above, and the source of the control signal is in each work robot 1, the server 101, and the portable information terminal 102. It may be in any of the charging base 103 and the like.

各作業ロボット1は、機体10と自律走行可能な走行部2を備えており、機体10には、機体10の走行経路に沿って作業を行う作業部3が設けられている。また、各作業ロボット1は、走行部2や作業部3を制御する制御部5を備えている。制御部5には、ネットワークNTを介して前述した管理設備と信号送受信を行うための通信部5Aが接続されている。 Each work robot 1 includes a machine body 10 and a traveling unit 2 capable of autonomously traveling, and the machine body 10 is provided with a working unit 3 that performs work along the traveling path of the machine body 10. Further, each work robot 1 includes a control unit 5 that controls a traveling unit 2 and a working unit 3. A communication unit 5A for transmitting and receiving signals is connected to the control unit 5 with the above-mentioned management equipment via the network NT.

制御部5には、一例として、GPSなどの衛星測位システム(GNSS;Global Navigation Satellite System)を活用して、機体10の現在位置を検知するために、GNSS衛星100から発信される電波信号を受信するGNSSセンサ6Aが接続されている。この場合に、RTK-GPSシステムを採用して、固定された充電基地103のような場所で電波信号を受信し、各作業ロボット1の位置を決定すれば、移動する作業ロボット1の位置がより正確に測定可能である。 As an example, the control unit 5 receives a radio signal transmitted from the GNSS satellite 100 in order to detect the current position of the aircraft 10 by utilizing a satellite positioning system (GNSS; Global Navigation Satellite System) such as GPS. GNSS sensor 6A is connected. In this case, if the RTK-GPS system is adopted, a radio signal is received at a place such as a fixed charging base 103, and the position of each work robot 1 is determined, the position of the moving work robot 1 can be adjusted. It can be measured accurately.

図2に各作業ロボット1の一構成例を示す。図示の作業ロボット1の走行部2は、前輪走行部2Aと後輪走行部2Bを備えており、図1に示すように、作業現場内に設定される作業領域Waにおける任意の方向に向けて機体10を自律走行させることができるようになっている。図1における作業領域Waは、作業境界線Wbによって区画されており、作業境界線Wbは、各作業ロボット1が地図情報上で認識することができる仮想線或いは作業ロボット1が物理的にセンシング可能なワイヤ線などで形成されている。 FIG. 2 shows a configuration example of each work robot 1. The traveling unit 2 of the illustrated work robot 1 includes a front wheel traveling unit 2A and a rear wheel traveling unit 2B, and as shown in FIG. 1, is directed toward an arbitrary direction in a work area Wa set in the work site. The aircraft 10 can be autonomously driven. The work area Wa in FIG. 1 is partitioned by a work boundary line Wb, and the work boundary line Wb can be physically sensed by a virtual line or a work robot 1 that can be recognized by each work robot 1 on map information. It is made of various wires.

各作業ロボット1の機体10には、走行部2と作業部3を駆動する駆動部4が設けられている。図2に示した例では、駆動部4は、前輪駆動部4Aと後輪駆動部4Bをそれぞれ左右一対備えており、更に、作業部3を駆動する作業駆動部4Cを備えている。また、各作業ロボット1は、駆動部4と制御部5などの電源となるバッテリー11を備えている。 The machine body 10 of each work robot 1 is provided with a traveling unit 2 and a driving unit 4 for driving the working unit 3. In the example shown in FIG. 2, the drive unit 4 includes a front wheel drive unit 4A and a rear wheel drive unit 4B, respectively, on the left and right sides, and further includes a work drive unit 4C for driving the work unit 3. Further, each work robot 1 includes a battery 11 that serves as a power source for the drive unit 4, the control unit 5, and the like.

各作業ロボット1の作業部3は、機体10の走行経路に沿って作業軌跡を形成するように、草刈り作業や散布作業や回収作業などの作業を行うものである。以下、草刈り作業を行う作業部3を例にして説明する。図2に示した例では、作業部3は、平面視で円形の作業範囲を有しており、図示省略した草刈り刃を鉛直軸周りに回転することで、作業部3の直下の草を刈払う。これにより、機体10を走行させながら作業部3を駆動すると、作業ロボット1の走行経路に沿って、作業部3における平面視の円形作業範囲の直径を横幅とする刈払い作業済みの作業軌跡が形成される。 The work unit 3 of each work robot 1 performs work such as mowing work, spraying work, and collection work so as to form a work locus along the traveling path of the machine body 10. Hereinafter, the working unit 3 for mowing the grass will be described as an example. In the example shown in FIG. 2, the working unit 3 has a circular working area in a plan view, and the mowing blade (not shown) is rotated around a vertical axis to mow the grass directly under the working unit 3. pay. As a result, when the work unit 3 is driven while the machine body 10 is traveling, a work locus that has been mowed with the diameter of the circular work range in a plan view in the work unit 3 along the travel path of the work robot 1 is created. It is formed.

作業ロボット1の機体10には、センサ部6が設けられている。センサ部6には、走行部2を自律走行させるため、或いは作業部3の駆動を制御するために、前述したGNSSセンサ6A等、各種の検出手段が設けられている。センサ部6は機体10の前方に設けられており、センサ部6の検出信号は制御部5に送信される。 The body 10 of the work robot 1 is provided with a sensor unit 6. The sensor unit 6 is provided with various detection means such as the GNSS sensor 6A described above in order to autonomously drive the traveling unit 2 or control the driving of the working unit 3. The sensor unit 6 is provided in front of the machine body 10, and the detection signal of the sensor unit 6 is transmitted to the control unit 5.

作業ロボットシステム1Sの構成例(ブロック図)を図3に示す。各作業ロボット1(1A,1B,1C)の制御部5には、前述した駆動部4とセンサ部6とバッテリー11が接続されていると共に、前述した通信部5A、制御部5に情報を入力する入力部5B、制御部5に入力された情報を記憶する記憶部5Cなどが接続されている。 FIG. 3 shows a configuration example (block diagram) of the work robot system 1S. The drive unit 4, the sensor unit 6, and the battery 11 are connected to the control unit 5 of each work robot 1 (1A, 1B, 1C), and information is input to the communication unit 5A and the control unit 5 described above. The input unit 5B, the storage unit 5C for storing the information input to the control unit 5, and the like are connected.

センサ部6には、前述したGNSSセンサ6Aが設けられると共に、機体10の進む方向を検出するための方位センサ6Bや、作業境界位置に設置された電子タグやワイヤを物理的に検知する境界検知センサ6Cなどが設けられている。 The sensor unit 6 is provided with the above-mentioned GNSS sensor 6A, an orientation sensor 6B for detecting the traveling direction of the machine body 10, and a boundary detection for physically detecting an electronic tag or a wire installed at a work boundary position. A sensor 6C or the like is provided.

サーバー101には、制御部50が設けられており、制御部50には、サーバー101をネットワークNTに接続するための通信部51と、制御部50に情報を入力するための入力部54、制御部50に入力された情報を記憶する記憶部52、制御部50或いは制御部5の制御状況等を表示する表示部53などが接続されている。なお、ユーザーが所持する携帯情報端末102は、サーバー101と同等の機能を有している。 The server 101 is provided with a control unit 50, and the control unit 50 includes a communication unit 51 for connecting the server 101 to the network NT, an input unit 54 for inputting information to the control unit 50, and control. A storage unit 52 that stores information input to the unit 50, a display unit 53 that displays the control status of the control unit 50 or the control unit 5, and the like are connected. The mobile information terminal 102 possessed by the user has the same function as the server 101.

充電基地103は、バッテリー11に接続される充電装置103Aを備えている。充電装置103Aは、例えば、商用交流電力103Bを直流電力に変換してバッテリー11を充電する。また、充電基地103にも制御部60とこれに接続される通信部61を設けることができる。 The charging base 103 includes a charging device 103A connected to the battery 11. The charging device 103A, for example, converts the commercial AC power 103B into DC power to charge the battery 11. Further, the charging base 103 can also be provided with a control unit 60 and a communication unit 61 connected to the control unit 60.

作業ロボット1の通信部5Aとサーバー101や携帯情報端末102の通信部51と充電基地103の通信部61がネットワークNTを介して接続されていることで、作業ロボット1に設けた制御部5とサーバー101や携帯情報端末102の制御部50と充電基地103に設けた制御部60は、互いに信号(情報)の送受信が可能な状態になっており、1つの統合された制御装置5Uを構成している。 The communication unit 5A of the work robot 1, the communication unit 51 of the server 101 or the mobile information terminal 102, and the communication unit 61 of the charging base 103 are connected to each other via the network NT, so that the control unit 5 provided in the work robot 1 is connected. The control unit 50 of the server 101 or the mobile information terminal 102 and the control unit 60 provided in the charging base 103 are in a state of being able to transmit and receive signals (information) to each other, and constitute one integrated control device 5U. ing.

作業ロボットシステム1Sの制御は、制御装置5Uに、図4に示す機能のプログラムを組み込むことで実行される。制御装置5Uが実行するプログラムは、各作業ロボット1に搭載した制御部5にその一部又は全部を組み込むことができ、また、サーバー101や携帯情報端末102の制御部50にその一部又は全部を組み込むことができ、また、充電基地103に設けた制御部60にその一部又は全部を組み込むことができる。なお、サーバー101、携帯情報端末102、充電基地103などの管理設備において、作業ロボットシステム1Sに必須のプログラムが組み込まれていない設備は、適宜省略することができる。 The control of the work robot system 1S is executed by incorporating the program of the function shown in FIG. 4 into the control device 5U. A part or all of the program executed by the control device 5U can be incorporated in the control unit 5 mounted on each work robot 1, and a part or all of the program is incorporated in the control unit 50 of the server 101 or the mobile information terminal 102. Can be incorporated, and a part or all thereof can be incorporated into the control unit 60 provided in the charging base 103. In the management equipment such as the server 101, the portable information terminal 102, and the charging base 103, the equipment in which the essential program is not incorporated in the work robot system 1S can be omitted as appropriate.

制御装置5Uにおける走行制御部P1は、各作業ロボット1の前輪駆動部4Aと後輪行動部4Bを制御することで、設定部P3にて設定された走行経路に沿って、作業ロボット1を自律走行させる。また、走行制御部P1は、前輪駆動部4Aと後輪行動部4Bを制御することで、各作業ロボット1の作業速度(走行速度)を制御する。 The travel control unit P1 in the control device 5U controls the front wheel drive unit 4A and the rear wheel action unit 4B of each work robot 1 to autonomously control the work robot 1 along the travel path set by the setting unit P3. Let it run. Further, the travel control unit P1 controls the work speed (travel speed) of each work robot 1 by controlling the front wheel drive unit 4A and the rear wheel action unit 4B.

制御装置5Uにおける作業制御部P2は、作業ロボット1の作業駆動部4Cを制御することで、入力部5B(54)からの入力で初期設定されている作業条件で作業部3を制御する。また、作業制御部P2は、入力部5B(54)で入力された作業条件の変更指示、或いは設定部P3の設定に応じて変更される作業条件に応じて、作業部3を制御する。作業部3が草刈り作業部の場合には、刈り速度や刈り高さなどが、前述した作業条件になる。 The work control unit P2 in the control device 5U controls the work unit 3 under the work conditions initially set by the input from the input unit 5B (54) by controlling the work drive unit 4C of the work robot 1. Further, the work control unit P2 controls the work unit 3 according to the work condition change instruction input by the input unit 5B (54) or the work condition changed according to the setting of the setting unit P3. When the working unit 3 is a mowing working unit, the mowing speed, mowing height, and the like are the above-mentioned working conditions.

制御装置5Uにおける設定部P3は、作業区画設定手段P30と、走行経路設定手段P31を少なくとも備えている。 The setting unit P3 in the control device 5U includes at least a work area setting means P30 and a traveling route setting means P31.

作業区画設定手段P30によって設定される作業区画Wsは、作業領域Wa内に仮想的に区画される小区画であって、1つの作業区画Wsは、1つの作業ロボット1により連続した(途切れのない)作業軌跡が形成される区画になっている。 The work area Ws set by the work area setting means P30 is a small area virtually partitioned in the work area Wa, and one work area Ws is continuous by one work robot 1 (uninterrupted). ) It is a section where a work track is formed.

作業区画設定手段P30は、例えば、作業領域Wa内の何処に作業区画を設定するかの位置情報である設定位置情報に基づいて、複数の作業ロボット1(1A,1B,1C)毎の作業区画Wsを設定する。作業区画Wsの設定は、作業開始毎に1つの区画を設定してもよいし、作業開始に先立って、複数の作業区画を、例えば作業領域Waを複数の作業区画に区分するように、設定してもよい。 The work area setting means P30 is, for example, a work area for each of a plurality of work robots 1 (1A, 1B, 1C) based on the set position information which is the position information of the place where the work area is set in the work area Wa. Set Ws. The work area Ws may be set to one area for each work start, or a plurality of work areas, for example, a work area Wa may be divided into a plurality of work areas prior to the start of work. You may.

設定部P3の作業区画設定手段P30が複数の作業ロボット1(1A,1B,1C)毎に作業区画Wsを設定するに際して、1つの作業領域Waにて、複数の作業ロボット1(1A,1B,1C)が干渉や衝突を回避して円滑な作業を行うことができるように、各作業区画Wsの設定位置を互いの区画の周りに隣接しないように設定している。 When the work area setting means P30 of the setting unit P3 sets the work area Ws for each of the plurality of work robots 1 (1A, 1B, 1C), the plurality of work robots 1 (1A, 1B, The set positions of the work compartments Ws are set so as not to be adjacent to each other so that 1C) can avoid interference and collision and perform smooth work.

図5及び図6は、その設定例を示している。図5(a)に示した例では、第1の作業ロボット1(1A)が作業を行う第1の作業区画Ws(1)と第2の作業ロボット1(1B)が作業を行う第2の作業区画Ws(2)を設定するに際して、第1の作業区画Ws(1)の周りに隣接区画Asを設定し、隣接区画Asと重ならないように、第2の作業区画Ws(2)を設定している。 5 and 6 show an example of the setting. In the example shown in FIG. 5A, the first work section Ws (1) on which the first work robot 1 (1A) works and the second work robot 1 (1B) perform the work. When setting the work section Ws (2), the adjacent section As is set around the first work section Ws (1), and the second work section Ws (2) is set so as not to overlap with the adjacent section As. is doing.

図5(a)に示した例では、作業領域Waに対して予め区分された複数の区画を設定しており、その複数の区画の中から、前述した第1の作業区画Ws(1)と第2の作業区画Ws(2)と隣接区画Asを設定している。図5(a)に示した例の隣接区画Asは、矩形状に設定された第1の作業区画Ws(1)の各辺に隣接する区画が選択されている。この例に限らず、第1の作業区画Ws(1)と第2の作業区画Ws(2)を作業領域Wa内に個別に設定するに際して、図5(b)に示すように、第1の作業区画Ws(1)の周りに任意に隣接区画Asを設定し、その隣接区画Asに重ならないように、第2の作業区画Ws(2)を設定するようにしてもよい。 In the example shown in FIG. 5A, a plurality of divisions previously divided with respect to the work area Wa are set, and among the plurality of divisions, the above-mentioned first work division Ws (1) and The second work section Ws (2) and the adjacent section As are set. As the adjacent section As of the example shown in FIG. 5A, a section adjacent to each side of the first work section Ws (1) set in a rectangular shape is selected. Not limited to this example, when the first work area Ws (1) and the second work area Ws (2) are individually set in the work area Wa, as shown in FIG. 5 (b), the first work area Ws (2) is set. An adjacent section As may be arbitrarily set around the work section Ws (1), and a second work section Ws (2) may be set so as not to overlap the adjacent section As.

また、図5(a)に示した例では、第3の作業ロボット1(1C)が作業領域Waで作業する場合に、第3の作業ロボット1(1C)は、第1の作業ロボット1(1A)と第2の作業ロボット1(1B)の作業中には、作業を行わないように設定されている。具体的には、第1の作業区画Ws(1)と第2の作業区画Ws(2)が作業領域Waにて設定されている場合には、第3の作業ロボット1(1C)は、充電基地103にて充電を行いながら待機するように設定されている。 Further, in the example shown in FIG. 5A, when the third work robot 1 (1C) works in the work area Wa, the third work robot 1 (1C) is the first work robot 1 (1C). It is set not to perform the work during the work of the 1A) and the second work robot 1 (1B). Specifically, when the first work section Ws (1) and the second work section Ws (2) are set in the work area Wa, the third work robot 1 (1C) is charged. It is set to stand by while charging at the base 103.

これによると、作業区画Wsと隣接区画Asの設定のみで、複数の作業ロボット1が1つの作業領域Waにて作業を行う際の作業ロボット1同士の干渉や衝突を回避することができる。これによって、各作業ロボット1の作業時間や作業速度の調整を行うことなく、複数の作業ロボット1を用いて簡易に作業能率の向上を図ることができる。 According to this, it is possible to avoid interference or collision between the work robots 1 when the plurality of work robots 1 work in one work area Wa only by setting the work section Ws and the adjacent section As. As a result, it is possible to easily improve the work efficiency by using the plurality of work robots 1 without adjusting the work time and the work speed of each work robot 1.

また、第3の作業ロボット1を用いる場合には、複数の作業ロボット1同士の干渉や衝突を回避しながら、2台の作業ロボット1が作業を行っている間に1台の作業ロボット1の充電を行うことができるので、効率的に作業中の充電時間を確保することができる。 Further, when the third work robot 1 is used, one work robot 1 can be used while the two work robots 1 are working while avoiding interference or collision between the plurality of work robots 1. Since charging can be performed, it is possible to efficiently secure the charging time during work.

設定部P3における走行経路設定手段P31は、各作業ロボット1を自律走行させるための走行経路を設定するものであり、作業区画設定手段30が前述したように作業区画Wsの設定を行った後に、作業区画Wsにおける走行経路Rrを例えば図6に示すように設定する。 The travel route setting means P31 in the setting unit P3 sets a travel route for autonomously traveling each work robot 1, and after the work zone setting means 30 sets the work zone Ws as described above, The travel path Rr in the work section Ws is set as shown in FIG. 6, for example.

走行経路設定手段P31は、図6に示すように、走行経路Rrを設定することで、作業区画Wsには走行経路Rrに沿って作業軌跡Wtが形成される。走行経路設定手段P31は、走行経路Rrを各種設定することで、作業区画Ws毎に、複数の作業モードを設定することができる。作業モードとしては、例えば、図6(a)に示すように、隣接する直線経路の進行方向を交互に変えたラインストライプ状軌跡、図6(b)に示すように、直線経路の進行方向を90°変えて旋回しながら進む旋回ストライプ状(旋回の方向は、図示のように外から内に向けた旋回と内から外に向けた旋回が選択可能)軌跡、図6(c)に示すように、直線経路の進行方向を作業区画Ws端でランダムに変えて進行するランダム軌跡などがある。 As shown in FIG. 6, the travel route setting means P31 sets the travel route Rr, so that the work locus Wt is formed in the work section Ws along the travel route Rr. The travel route setting means P31 can set a plurality of work modes for each work section Ws by setting various travel routes Rr. As the working mode, for example, as shown in FIG. 6A, a line-striped locus in which the traveling directions of adjacent linear paths are alternately changed, and as shown in FIG. 6B, the traveling direction of the linear path is set. A swivel stripe-like locus that advances while turning by changing 90 ° (the direction of swirl can be selected from outside to inside as shown and from inside to outside), as shown in FIG. 6 (c). In addition, there is a random locus that travels by randomly changing the traveling direction of the straight path at the end of the work section Ws.

作業ロボット1を草刈り作業に用いる場合には、作業モードの選択で、作業区画Ws毎にユーザーが望むように草刈りの模様を付けることができ、図6(c)に示すランダム軌跡を選択した場合には、模様を付けないように刈ることができる。特に、ゴルフ場やゴルフ練習場などでは、草(芝)の刈り方向がボールの転がり方に影響するので、オーナーなどの好むように、適宜作業モードの選択がなされる。 When the work robot 1 is used for mowing work, the mowing pattern can be added to each work section Ws as desired by the user by selecting the work mode, and the random locus shown in FIG. 6 (c) is selected. Can be mowed without a pattern. In particular, in golf courses and driving ranges, the mowing direction of grass (turf) affects how the ball rolls, so the work mode is appropriately selected as the owner likes.

設定部P3の走行経路設定手段P31が作業区画Wsにおける走行経路Rrを設定する際に、図7に示すように、設定された走行経路Rrによって、作業区画Wsの外側に作業軌跡Wtの外郭線OLが形成される場合がある。ここでは、作業部3が草刈り作業を行う際、作業部3が作業区画Wsの境界線を越えるように走行経路Rrの設定がなされ、作業区画Wsの境界線付近で刈り残しが発生することを抑止している。 When the travel route setting means P31 of the setting unit P3 sets the travel route Rr in the work section Ws, as shown in FIG. 7, the outer line of the work locus Wt is outside the work section Ws by the set travel path Rr. OL may be formed. Here, when the working unit 3 performs the mowing work, the traveling route Rr is set so that the working unit 3 crosses the boundary line of the working area Ws, and uncut parts are generated near the boundary line of the working area Ws. It is deterring.

このような場合に、作業区画設定手段P30が前述した隣接区画Asを設定する際に、作業軌跡Wtの外郭線OLを含むように隣接区画Asの設定がなされる。図7に示す例では、矩形状をなす第1の作業区画Ws(1)の境界線の外側に作業軌跡Wtの外郭線OLが形成されているが、第1の作業区画Ws(1)の隣接区画Asは、この外郭線OLを含むように、第1の作業区画Ws(1)の各辺に隣接する隣接区画Asと、第1の作業区画Wsの各角に隣接する隣接区画Asが設定されている。そして、この隣接区画Asに重ならないように、第2の作業区画Ws(2)が設定されている。 In such a case, when the work section setting means P30 sets the adjacent section As described above, the adjacent section As is set so as to include the outer line OL of the work locus Wt. In the example shown in FIG. 7, the outer line OL of the work locus Wt is formed outside the boundary line of the first work section Ws (1) having a rectangular shape, but the outer line OL of the first work section Ws (1) is formed. The adjacent section As includes the adjacent section As adjacent to each side of the first work section Ws (1) and the adjacent section As adjacent to each corner of the first work section Ws so as to include the outline OL. It is set. Then, the second work section Ws (2) is set so as not to overlap with the adjacent section As.

図7に示すように、作業軌跡Wtの外郭線OLを含むように隣接線Asを設定することで、外郭線OLが作業区画Wsの境界線の外側に形成される場合であっても、複数の作業ロボット1同士の干渉や衝突を回避することができ、各作業ロボット1の作業時間や作業速度の調整を行うことなく、複数の作業ロボット1を用いて簡易に作業能率の向上を図ることができる。 As shown in FIG. 7, by setting the adjacent line As so as to include the outer line OL of the work locus Wt, even if the outer line OL is formed outside the boundary line of the work section Ws, a plurality of lines are formed. It is possible to avoid interference and collision between the work robots 1 and easily improve the work efficiency by using a plurality of work robots 1 without adjusting the work time and work speed of each work robot 1. Can be done.

作業を実行するために必要な作業区画Wsのマップデータは、例えば、作業ロボット1の記憶部(データ記憶部)5Cに記憶されている。このマップデータは、作業が行える分のマップデータを作業毎に記憶部5Cに記憶させており、例えば、1つの作業区画Wsのマップデータは、作業区画Wsの作業が完了されて作業ロボット1が充電基地103に戻った後に、記憶部5Cのマップデータが次の作業区画Wsのものに書き換えられる。このようにすることで、作業ロボット1が備える記憶部5Cのメモリ容量を小さくすることができる。この際、マップデータは、サーバー101や充電基地103などの基地局から送信されて、作業ロボット1内の記憶部5Cに記憶される。 The map data of the work area Ws required to execute the work is stored in, for example, the storage unit (data storage unit) 5C of the work robot 1. As for this map data, the map data for which the work can be performed is stored in the storage unit 5C for each work. For example, the map data of one work area Ws is used by the work robot 1 after the work of the work area Ws is completed. After returning to the charging base 103, the map data of the storage unit 5C is rewritten to that of the next work area Ws. By doing so, the memory capacity of the storage unit 5C included in the work robot 1 can be reduced. At this time, the map data is transmitted from a base station such as the server 101 or the charging base 103 and stored in the storage unit 5C in the working robot 1.

以上説明したように、本発明の実施形態にかかる作業ロボット1の制御装置5U或いはこれによる制御方法によると、自律走行する走行経路Rrに沿って作業軌跡Wtを形成する作業ロボット1の動作制御であって、作業ロボット1が作業を行う仮想の作業区画Wsを設定し、第1の作業ロボット1(1A)が作業を行う第1の作業区画Ws(1)と第2の作業ロボット1(1B)が作業を行う第2の作業区画Ws(2)を設定するに際して、第1の作業区画Ws(1)の周りに隣接区画Asを設定し、隣接区画Asと重ならないように、第2の作業区画Ws(2)を設定するなどして、第1の作業区画Ws(1)の周りに隣接しないように、第2の作業区画Ws(2)を設定している。これによって、1つの作業領域Waにて、複数の作業ロボット1の作業を行わせるに際して、作業速度などの調節を不要にして複数の作業ロボット1の干渉や衝突を回避し、作業品質に影響を与えることなく、簡易に作業能率の向上を図ることができる。 As described above, according to the control device 5U of the work robot 1 according to the embodiment of the present invention or the control method by the control device 5U, the operation control of the work robot 1 that forms the work locus Wt along the traveling path Rr that autonomously travels. Therefore, a virtual work area Ws in which the work robot 1 performs work is set, and a first work area Ws (1) and a second work robot 1 (1B) in which the first work robot 1 (1A) performs work are set. ) Sets the second work section Ws (2) on which the work is performed, the adjacent section As is set around the first work section Ws (1), and the second work section As does not overlap with the adjacent section As. The second work section Ws (2) is set so as not to be adjacent to the first work section Ws (1) by setting the work section Ws (2) or the like. As a result, when the work of a plurality of work robots 1 is performed in one work area Wa, it is not necessary to adjust the work speed and the like, interference and collision of the plurality of work robots 1 are avoided, and the work quality is affected. Work efficiency can be easily improved without giving.

以上、本発明の実施の形態について図面を参照して詳述してきたが、具体的な構成はこれらの実施の形態に限られるものではなく、本発明の要旨を逸脱しない範囲の設計の変更等があっても本発明に含まれる。また、上述の各実施の形態は、その目的及び構成等に特に矛盾や問題がない限り、互いの技術を流用して組み合わせることが可能である。 Although the embodiments of the present invention have been described in detail with reference to the drawings, the specific configuration is not limited to these embodiments, and the design changes, etc. within the range not deviating from the gist of the present invention, etc. Even if there is, it is included in the present invention. Further, each of the above-described embodiments can be combined by diverting the technologies of each other as long as there is no particular contradiction or problem in the purpose and configuration thereof.

1(1A,1B,1C):作業ロボット,1S:作業ロボットシステム,
10:機体,11:バッテリー,
100:GNSS衛星,101:サーバー,102:携帯情報端末,
103:充電基地,103A:充電装置,103B:商用交流電力,
2:走行部,2A:前輪走行部,2B:後輪走行部,3:作業部,
4:駆動部,4A:前輪駆動部,4B:後輪駆動部,4C:作業駆動部,
5,50,60:制御部,5A,51,61:通信部,
5B,54:入力部,5C,52:記憶部,6:センサ部,
6A:GNSSセンサ,6B:方位センサ,6C:境界検知センサ,
53:表示部,5U:制御装置,
P1:走行制御部,P2:作業制御部,P3:設定部,
P30:作業区画設定手段,P31:走行経路設定手段,
Wa:作業領域,Ws:作業区画,Wt:作業軌跡,Rr:走行経路,
As:隣接区画,NT:ネットワーク,OL:外郭線
1 (1A, 1B, 1C): work robot, 1S: work robot system,
10: Airframe, 11: Battery,
100: GNSS satellite, 101: server, 102: mobile information terminal,
103: Charging base, 103A: Charging device, 103B: Commercial AC power,
2: Running part, 2A: Front wheel running part, 2B: Rear wheel running part, 3: Working part,
4: Drive unit, 4A: Front wheel drive unit, 4B: Rear wheel drive unit, 4C: Work drive unit,
5,50,60: Control unit, 5A, 51,61: Communication unit,
5B, 54: Input unit, 5C, 52: Storage unit, 6: Sensor unit,
6A: GNSS sensor, 6B: directional sensor, 6C: boundary detection sensor,
53: Display unit, 5U: Control device,
P1: Travel control unit, P2: Work control unit, P3: Setting unit,
P30: Work area setting means, P31: Travel route setting means,
Wa: work area, Ws: work area, Wt: work locus, Rr: travel route,
As: Adjacent section, NT: Network, OL: Outer line

Claims (10)

自律走行する走行経路に沿って作業軌跡を形成する作業ロボットの制御装置であって、
前記作業ロボットが作業を行う仮想の作業区画を設定する設定部を備え、
前記設定部は、
第1の作業ロボットが作業を行う第1の作業区画と第2の作業ロボットが作業を行う第2の作業区画を設定するに際して、
前記第1の作業区画の周りに隣接しないように、前記第2の作業区画を設定することを特徴とする作業ロボットの制御装置。
It is a control device for a work robot that forms a work locus along a travel path that travels autonomously.
A setting unit for setting a virtual work area in which the work robot performs work is provided.
The setting unit is
When setting the first work area where the first work robot works and the second work area where the second work robot works.
A control device for a work robot, characterized in that the second work section is set so as not to be adjacent to the periphery of the first work section.
前記設定部は、
前記第1の作業区画の周りに隣接区画を設定し、前記隣接区画と重ならないように、前記第2の作業区画を設定することを特徴とする請求項1に記載の作業ロボットの制御装置。
The setting unit is
The control device for a work robot according to claim 1, wherein an adjacent section is set around the first work section, and the second work section is set so as not to overlap the adjacent section.
前記設定部は、
予め区分された複数の区画の中から、前記第1の作業区画と前記第2の作業区画と前記隣接区画を設定することを特徴とする請求項2に記載された作業ロボットの制御装置。
The setting unit is
The control device for a work robot according to claim 2, wherein the first work section, the second work section, and the adjacent section are set from a plurality of sections previously divided.
前記設定部は、
前記作業区画における走行経路を設定し、
設定された走行経路によって、前記作業区画における境界線の外側に作業軌跡の外郭線が形成される場合に、前記外郭線を含むように前記隣接区画を設定することを特徴とする請求項2又は3に記載された作業ロボットの制御装置。
The setting unit is
Set the travel route in the work section,
2. The control device for the work robot according to 3.
前記第1の作業ロボットと前記第2の作業ロボットの作業中には、第3の作業ロボットの作業は行わないことを特徴とする請求項1~4のいずれか1項に記載された作業ロボットの制御装置。 The work robot according to any one of claims 1 to 4, wherein the work of the third work robot is not performed during the work of the first work robot and the second work robot. Control device. 作業を実行するために必要な前記作業区画のマップデータを記憶するデータ記憶部を備え、
前記マップデータは、作業を実行する前記作業区画の作業が完了された後に書き換えられることを特徴とする請求項1~5のいずれか1項に記載された作業ロボットの制御装置。
It is equipped with a data storage unit that stores the map data of the work area required to execute the work.
The control device for a work robot according to any one of claims 1 to 5, wherein the map data is rewritten after the work of the work area for executing the work is completed.
前記マップデータは、基地局から送信されて、前記作業ロボット内の前記データ記憶部に記憶されることを特徴とする請求項6に記載された作業ロボットの制御装置。 The control device for a work robot according to claim 6, wherein the map data is transmitted from a base station and stored in the data storage unit in the work robot. 自律走行する走行経路に沿って作業軌跡を形成する作業ロボットの制御方法であって、
前記作業ロボットが作業を行う仮想の作業区画を設定し、
第1の作業ロボットが作業を行う第1の作業区画と第2の作業ロボットが作業を行う第2の作業区画を設定するに際して、
第1の作業区画の周りに隣接区画を設定し、前記隣接区画と重ならないように、前記第2の作業区画を設定することを特徴とする作業ロボットの制御方法。
It is a control method of a work robot that forms a work locus along a travel path that travels autonomously.
Set up a virtual work area where the work robot works,
When setting the first work area where the first work robot works and the second work area where the second work robot works.
A method for controlling a work robot, which comprises setting an adjacent section around the first work section and setting the second work section so as not to overlap the adjacent section.
前記作業ロボットは、草刈り作業を行うこと特徴とする請求項8に記載された作業ロボットの制御方法。 The control method for a work robot according to claim 8, wherein the work robot performs mowing work. 前記作業ロボットは、草刈り作業を行うことを特徴とする請求項1~7のいずれか1項に記載された作業ロボットの制御装置。 The control device for a work robot according to any one of claims 1 to 7, wherein the work robot performs a mowing operation.
JP2020144783A 2020-08-28 2020-08-28 Control device and control method for work robot Pending JP2022039648A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2020144783A JP2022039648A (en) 2020-08-28 2020-08-28 Control device and control method for work robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020144783A JP2022039648A (en) 2020-08-28 2020-08-28 Control device and control method for work robot

Publications (1)

Publication Number Publication Date
JP2022039648A true JP2022039648A (en) 2022-03-10

Family

ID=80498572

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020144783A Pending JP2022039648A (en) 2020-08-28 2020-08-28 Control device and control method for work robot

Country Status (1)

Country Link
JP (1) JP2022039648A (en)

Similar Documents

Publication Publication Date Title
CN108227705B (en) Regression method for self-moving device, storage medium, and server
US9740204B2 (en) Control apparatus for autonomously navigating utility vehicle
WO2019124217A1 (en) Work vehicle, travel path selection system for work vehicle, and travel path calculation system
US9817398B2 (en) Control apparatus for autonomously navigating utility vehicle
CN105911981A (en) Automatic work system, and automatic walking device and steering method thereof
CN114353801B (en) Self-mobile device and navigation method thereof
JPWO2020110247A1 (en) Control system, control device, autonomous work machine, operation method of control device, control method and program of autonomous work machine
JP2016207158A (en) Autonomous work vehicle
JP2019110762A (en) Work vehicle and travelling route selection system for work vehicle
WO2019167199A1 (en) Control device, mobile body, and program
US20240085919A1 (en) Traversal Method and System, Robot, and Readable Storage Medium
JP2022039648A (en) Control device and control method for work robot
CN112731934A (en) Method for intelligent mower to quickly return to charging station based on region segmentation
US20220374017A1 (en) Working robot system
WO2022044527A1 (en) Control device and control method for work robot
CN115413471B (en) Method and system for guiding mower to preset position and mower
WO2020105101A1 (en) Control device for autonomous movement work machine
EP4246275A1 (en) Method for controlling autonomous mobile device, autonomous mobile device, and computer storage medium
US20230359221A1 (en) Navigation for a robotic work tool system
JP2021197067A (en) Operation robot
US20220129007A1 (en) Autonomous work system
EP4030255A1 (en) Automatic work system and turning method therefor, and self-moving device
WO2023121535A1 (en) Improved navigation for a robotic work tool system
SE2151612A1 (en) Improved navigation for a robotic work tool system
WO2021014586A1 (en) Autonomous work machine, autonomous work machine control method and program

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230607

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20240206

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20240214

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20240401