JP7471931B2 - Agricultural robots - Google Patents

Agricultural robots Download PDF

Info

Publication number
JP7471931B2
JP7471931B2 JP2020109080A JP2020109080A JP7471931B2 JP 7471931 B2 JP7471931 B2 JP 7471931B2 JP 2020109080 A JP2020109080 A JP 2020109080A JP 2020109080 A JP2020109080 A JP 2020109080A JP 7471931 B2 JP7471931 B2 JP 7471931B2
Authority
JP
Japan
Prior art keywords
crop
data
estimation unit
partial data
obstacle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2020109080A
Other languages
Japanese (ja)
Other versions
JP2022006699A (en
Inventor
俊介 江戸
拓也 玉井
惇平 宮本
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kubota Corp
Original Assignee
Kubota 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 Kubota Corp filed Critical Kubota Corp
Priority to JP2020109080A priority Critical patent/JP7471931B2/en
Priority to PCT/JP2021/022292 priority patent/WO2021261294A1/en
Priority to EP21829595.4A priority patent/EP4173467A1/en
Publication of JP2022006699A publication Critical patent/JP2022006699A/en
Priority to US17/990,825 priority patent/US20230078003A1/en
Application granted granted Critical
Publication of JP7471931B2 publication Critical patent/JP7471931B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Description

本発明は、農業用ロボットに関する。 The present invention relates to an agricultural robot.

従来、特許文献1に開示された農業用ロボットが知られている。
特許文献1に開示された農業用ロボットは、走行体に作物の収穫を行うことが可能なマニピュレータが設けられている。
2. Description of the Related Art Conventionally, an agricultural robot is known, as disclosed in Japanese Patent Application Laid-Open No. 2003-233696.
The agricultural robot disclosed in Patent Document 1 is provided with a manipulator on a running body that is capable of harvesting crops.

特開2011-229406号公報JP 2011-229406 A

さて、スイカ、メロン、カボチャ等の作物は様々なところで栽培(作付け)されるのが一般的である。農業用ロボットで作業を行うにあたって、適正に作物を把握することが必要であるものの、様々な要因で適正に作物を把握することが難しいのが実情である。
本発明は、センシングデータから簡単に作物を推定することができる農業用ロボットを提供することを目的とする。
Now, crops such as watermelons, melons, and pumpkins are generally cultivated (planted) in various places. When using agricultural robots to operate, it is necessary to accurately grasp the crops, but the reality is that it is difficult to accurately grasp the crops due to various factors.
An object of the present invention is to provide an agricultural robot that can easily estimate crops from sensing data.

農業用ロボットは、走行体と、前記走行体に設けられ、作物に関する作業を行う作業部と、前記走行体に設けられた光学式センサと、前記光学式センサで得られたセンシングデータに基づいて、前記作物を推定する作物推定部と、を備え、前記作物推定部は、前記センシングデータに基づいて前記推定する作物を特定し且つ前記センシングデータのうち前記特定した作物及び前記作物の表面を隠す障害物を含むデータを部分データとして抽出するデータ抽出部と、前記データ抽出部によって抽出した前記部分データにおいて前記障害物を除いて得られた前記作物の表面状態から作物を推定する推定部と、を有し、前記推定部は、前記作物の種類を推定し且つ、前記部分データで得られた前記作物の周囲に関して前記推定した作物の表面を隠す前記障害物を推定する The agricultural robot comprises a running body, a working unit provided on the running body for performing work related to crops, an optical sensor provided on the running body, and a crop estimation unit for estimating the crop based on sensing data obtained by the optical sensor, the crop estimation unit having a data extraction unit that identifies the crop to be estimated based on the sensing data and extracts data from the sensing data that includes the identified crop and obstacles concealing the surface of the crop as partial data, and an estimation unit that estimates the crop from the surface condition of the crop obtained excluding the obstacles in the partial data extracted by the data extraction unit, and the estimation unit estimates the type of crop and estimates the obstacles concealing the surface of the estimated crop in relation to the surroundings of the crop obtained in the partial data .

前記推定部は、前記作物の表面において当該作物の表面の模様と判断した以外の部分を抽出し、当該部分において、前記作物の輪郭と重複する部分が、前記障害物の一部であると判断し、前記障害物の輪郭を画像処理により抽出する。
前記推定部は、前記部分データで示された作物に関し、前記作物の種類と、前記障害物を除いて得られた前記作物の表面状態とに基づいて、前記作物を推定する。
前記推定部は、前記障害物を除いて得られた前記作物の表面状態として前記作物の模様と、前記作物の種類とに基づいて、前記作物を推定する。
前記推定部は、前記推定した作物の推定結果に基づいて、前記部分データに含まれる前記作物の輪郭を演算する。
The estimation unit extracts parts of the surface of the crop other than what has been determined to be the pattern on the surface of the crop, determines that parts of the surface that overlap with the contour of the crop are part of the obstacle, and extracts the contour of the obstacle through image processing.
The estimation unit estimates the crop indicated by the partial data based on the type of the crop and the surface condition of the crop obtained by excluding the obstacle.
The estimation unit estimates the crop based on the pattern of the crop as the surface condition of the crop obtained by removing the obstacle, and the type of the crop.
The estimation unit calculates an outline of the crop included in the partial data based on the estimated crop outline.

記作業部は、前記推定部で推定した前記障害物を、前記作物から遠ざける作業を行う。
農業用ロボットは、前記作物と前記作物の表面状態との関係を、深層学習することで表面状態モデルを生成するモデル生成部を備えている。
農業用ロボットは、走行体と、前記走行体に設けられ、作物に関する作業を行う作業部と、前記走行体に設けられた光学式センサと、前記光学式センサで得られたセンシングデータに基づいて、前記作物を推定する作物推定部と、を備え、前記作物推定部は、前記センシングデータに基づいて前記推定する作物を特定し且つ前記センシングデータのうち前記特定した作物及び前記作物の表面を隠す障害物を含むデータを部分データとして抽出するデータ抽出部と、前記データ抽出部によって抽出した前記部分データにおいて前記障害物を除いて得られた前記作物の表面状態から作物を推定する推定部と、を有し、前記推定部は、前記推定した作物の推定結果に基づいて、前記部分データに含まれる前記作物の輪郭を演算し、前記推定部は、前記作物の種類を推定した推定結果に基づいて、前記部分データに含まれる前記作物の輪郭を、以下の(i)~(iii)のいずれかを用いて、(i)前記作物の模様を構成する線のうち、前記作物の外縁にそれぞれ至る線の両端部を前記部分データから得ることができた場合、前記両端部を通る円形状又は楕円形状の線を、前記作物の輪郭とし、(ii)前記両端部のうちの一方の端部だけを抽出した場合、当該一方の端部から前記作物の基準サイズの1/2の位置を、前記作物の中心とし、前記中心から前記基準サイズの1/2を前記作物の半径として、前記一方の端部を通り且つ半径の円形状の線を、前記作物の輪郭とし、(iii)前記線が前記部分データの抽出画像枠に達している場合、前記抽出画像枠の前記作物の模様から前記作物の中心を推定し、前記作物の基準サイズの1/2を前記作物の半径とし、当該推定した前記中心から前記半径の円形状の線を、前記作物の輪郭とする演算を行う。
前記推定部は、前記作物の種類を推定した推定結果に基づいて、前記部分データに含まれる前記作物の輪郭を、以下の(i)~(iii)のいずれかを用いて、(i)前記作物の模様を構成する線のうち、前記作物の外縁にそれぞれ至る線の両端部を前記部分データから得ることができた場合、前記両端部を通る円形状又は楕円形状の線を、前記作物の輪郭とし、(ii)前記両端部のうちの一方の端部だけを抽出した場合、当該一方の端部から前記作物の基準サイズの1/2の位置を、前記作物の中心とし、前記中心から前記基準サイズの1/2を前記作物の半径として、前記一方の端部を通り且つ半径の円形状の線を、前記作物の輪郭とし、(iii)前記線が前記部分データの抽出画像枠に達している場合、前記抽出画像枠の前記作物の模様から前記作物の中心を推定し、前記作物の基準サイズの1/2を前記作物の半径とし、当該推定した前記中心から前記半径の円形状の線を、前記作物の輪郭とする演算を行う。
前記データ抽出部は、予め用意された作物の表面の模様を示す基準プロファイリングと、前記センシングデータの所定範囲内の画像プロファイリングとが一致した場合は、前記センシングデータの所定範囲内に前記作物が含まれていると判断し、当該作物を前記推定する作物として特定し且つ前記センシングデータのうち前記特定した作物及び前記作物の表面を隠す障害物を含むデータを前記部分データとして抽出する。
The working unit performs a task of moving the obstacle estimated by the estimation unit away from the crop.
The agricultural robot is equipped with a model generation unit that generates a surface condition model by deep learning the relationship between the crop and the surface condition of the crop.
The agricultural robot includes a traveling body, a working unit provided on the traveling body and performing work related to crops, an optical sensor provided on the traveling body, and a crop estimation unit that estimates the crop based on sensing data obtained by the optical sensor, the crop estimation unit having a data extraction unit that identifies the crop to be estimated based on the sensing data and extracts data from the sensing data that includes the identified crop and an obstacle concealing a surface of the crop as partial data, and an estimation unit that estimates the crop from a surface condition of the crop obtained by excluding the obstacle in the partial data extracted by the data extraction unit, the estimation unit calculates an outline of the crop included in the partial data based on an estimation result of the estimated crop, and the estimation unit calculates a contour of the crop included in the partial data based on an estimation result of the type of the crop. The contour of the crop is determined by using any of the following (i) to (iii): (i) if both ends of the lines that constitute the crop pattern and that each reach the outer edge of the crop can be obtained from the partial data, a circular or elliptical line passing through both ends is determined to be the contour of the crop; (ii) if only one of the ends is extracted, a position that is 1/2 the standard size of the crop from the one end is determined to be the center of the crop, and a circular line that passes through the one end and has a radius of 1/2 the standard size from the center is determined to be the contour of the crop; and (iii) if the line reaches the extracted image frame of the partial data, a calculation is performed to estimate the center of the crop from the crop pattern in the extracted image frame, set the radius of the crop to 1/2 the standard size of the crop, and determine the contour of the crop to be a circular line with the radius from the estimated center.
The estimation unit performs a calculation based on the estimation result of the type of crop to determine the contour of the crop included in the partial data using any of the following (i) to (iii): (i) if both ends of the lines constituting the crop pattern that each reach the outer edge of the crop can be obtained from the partial data, a circular or elliptical line passing through both ends is determined to be the contour of the crop; (ii) if only one of the ends is extracted, a position that is 1/2 of the standard size of the crop from the one end is determined to be the center of the crop, and a circular line that passes through the one end and has a radius of 1/2 of the standard size from the center is determined to be the contour of the crop; and (iii) if the line reaches an extracted image frame of the partial data, a center of the crop is estimated from the crop pattern in the extracted image frame, and a circular line that is 1/2 of the standard size of the crop is determined to be the contour of the crop .
When a pre-prepared reference profiling indicating the surface pattern of a crop matches an image profiling within a specified range of the sensing data, the data extraction unit determines that the crop is included within the specified range of the sensing data, identifies the crop as the estimated crop, and extracts data from the sensing data that includes the identified crop and any obstacles obscuring the surface of the crop as the partial data.

本発明によれば、センシングデータから簡単に作物を推定することができる。 According to the present invention, crops can be easily estimated from sensing data.

農業用ロボットの側面図である。FIG. 2 is a side view of the agricultural robot. 作業姿勢の状態の農業用ロボットの側面図である。FIG. 2 is a side view of the agricultural robot in a working posture. 機体及びマニピュレータの斜視図である。FIG. 2 is a perspective view of the fuselage and the manipulator. 機体及びマニピュレータの側面図である。FIG. 2 is a side view of the aircraft body and the manipulator. 走行装置の平面図である。FIG. 走行装置の側面図である。FIG. ロボットハンドの一部拡大図である。FIG. 2 is an enlarged view of a portion of the robot hand. 農業用ロボットの支援システムの全体図である。FIG. 1 is an overall view of an agricultural robot support system. 農業用ロボットを施設で走行させたルートを示す図である。音データ(波形H10)の一例を示す図である。Fig. 1 is a diagram showing a route that an agricultural robot traveled in a facility Fig. 2 is a diagram showing an example of sound data (waveform H10). 農業用ロボットにて作物に対して作業を行う様子を示す図である。FIG. 1 is a diagram showing a state in which an agricultural robot performs work on crops. センシングデータH11と部分データH13との関係を示す図である。FIG. 11 is a diagram showing the relationship between sensing data H11 and partial data H13. 部分データH13の一例を示す図である。FIG. 13 is a diagram showing an example of partial data H13. 表面状態モデルとデータとの関係を示す図である。FIG. 13 is a diagram showing the relationship between a surface state model and data. 部分画像H16において作物の輪郭の一部が見えている状態を示す図である。FIG. 13 is a diagram showing a state in which part of the outline of the crop is visible in a partial image H16. 部分画像H16において作物の輪郭の一部が見えている状態を示す図であって、図14Aとは異なる図である。FIG. 14B is a diagram showing a state in which part of the outline of the crop is visible in a partial image H16, and is different from FIG. 14A. 部分画像H16において作物の輪郭が見えていない状態を示す図である。FIG. 13 is a diagram showing a state in which the outline of the crop is not visible in a partial image H16. 障害物を作物から遠ざける作業を説明する説明図である。FIG. 13 is an explanatory diagram illustrating an operation of moving an obstacle away from a crop. 施設園芸の施設の内部の概略図である。FIG. 1 is a schematic diagram of the interior of a greenhouse facility. 施設園芸の施設の平面の概略図である。FIG. 1 is a schematic diagram of a floor plan of a greenhouse facility. 作物の栽培初期の施設園芸の施設の内部の斜視図である。FIG. 2 is a perspective view of the inside of a greenhouse horticulture facility in the early stage of crop cultivation. 作物の栽培中期又は後期の施設園芸の施設の内部の斜視図である。FIG. 2 is a perspective view of the inside of a greenhouse horticulture facility in the middle or late stages of crop cultivation.

以下、本発明の一実施形態について、図面を適宜参照しつつ説明する。
図1、図2は、農業用ロボット1を例示している。農業用ロボット1は、図16~図19に示すようなハウス等の施設園芸、植物工場等の施設において、栽培される作物2に対して作業(農作業)を行うロボットである。農業用ロボット1は、例えば、スイカ、メロン、カボチャ等の比較的重量のある作物2である重量野菜、果実等に対して作業を行う。
Hereinafter, an embodiment of the present invention will be described with reference to the drawings.
1 and 2 show an example of an agricultural robot 1. The agricultural robot 1 is a robot that performs work (farming work) on crops 2 grown in facilities such as greenhouses and plant factories as shown in Figs. 16 to 19. The agricultural robot 1 performs work on heavy vegetables, fruits, etc., which are relatively heavy crops 2, such as watermelons, melons, pumpkins, etc.

まず、施設園芸の施設(施設園芸施設)を例にとり、施設について説明する。
図16~図19に示すように、施設100は、当該施設100を構成する構造物として、ハウス101と、ハウス101の内部に設置された機器102とを備えている。
ハウス101は、フレーム110と、被覆材111とを含んでいる。フレーム110は、例えば、I形鋼、H形鋼、C形鋼、角形鋼、丸形鋼等の様々な鋼材を組み合わせて、施設100の躯体を構成していて、複数の支柱部材110Aと、複数の連結部材110Bとを含んでいる。図16~図18に示すように、複数の支柱部材110Aは、地面等から起立した部材であって、横方向X1に所定の間隔で設置され且つ縦方向Y1に所定の間隔で設置されている。
First, we will explain facilities using greenhouse horticulture facilities (greenhouse horticulture facilities) as an example.
As shown in FIGS. 16 to 19, a facility 100 includes, as structures constituting the facility 100, a house 101 and equipment 102 installed inside the house 101.
The house 101 includes a frame 110 and a covering material 111. The frame 110 is made up of various steel materials, such as I-beam, H-beam, C-beam, square steel, and round steel, to form the framework of the facility 100, and includes a plurality of support members 110A and a plurality of connecting members 110B. As shown in Figures 16 to 18, the plurality of support members 110A are members that stand upright from the ground or the like, and are installed at predetermined intervals in the horizontal direction X1 and at predetermined intervals in the vertical direction Y1.

連結部材110Bは、横方向X1に離れた複数の支柱部材110Aの上端を互いに連結する。また、連結部材110Bは、縦方向Y1に離れた複数の支柱部材110Aを互いに連結する。
被覆材111は、少なくとも太陽光を取り入れ可能な透光性を有する部材であって、合成樹脂、ガラス等で構成されている。被覆材111は、例えば、フレーム110の外側から当該フレーム110の全体を覆っている。言い換えれば、被覆材111は、支柱部材110Aの外側、連結部材110Bの外側に配置されている。
The connecting members 110B connect the upper ends of the plurality of support members 110A spaced apart in the horizontal direction X1 to one another, and also connect the plurality of support members 110A spaced apart in the vertical direction Y1 to one another.
The covering material 111 is a translucent material that can at least take in sunlight, and is made of synthetic resin, glass, etc. The covering material 111 covers, for example, the entire frame 110 from the outside of the frame 110. In other words, the covering material 111 is disposed outside the support members 110A and outside the connecting members 110B.

機器102は、作物2を栽培する際に使用する様々な機器であって、ハウス101内の温度、湿度、空気流動等を調整することができる機器である。詳しくは、機器102は、換気扇102A、循環扇102B、熱交換装置102C等である。図16、図17に示すように、換気扇102Aは、ハウス101の出入口130側に設置され、外部の空気をハウス101内の空気を外部に排出したり、外部の空気をハウス101内に取り入れる。

循環扇102Bは、ハウス101内に設置されていて、ハウス101内の空気を所定の方向に循環させる。熱交換装置102Cはハウス101の温度を変更可能な装置であり、例えば、ヒートポンプ構成されている。上述した機器102は、一例であり、灌水機器、照明機器、噴霧機器などであってもよいし限定されない。
The equipment 102 is various equipment used when cultivating the crop 2, and is equipment capable of adjusting the temperature, humidity, air flow, etc., inside the greenhouse 101. More specifically, the equipment 102 is a ventilation fan 102A, a circulation fan 102B, a heat exchanger 102C, etc. As shown in Figures 16 and 17, the ventilation fan 102A is installed on the entrance/exit 130 side of the greenhouse 101, and exhausts the air inside the greenhouse 101 to the outside and takes in the outside air into the greenhouse 101.

The circulation fan 102B is installed in the house 101 and circulates the air in the house 101 in a predetermined direction. The heat exchange device 102C is a device capable of changing the temperature of the house 101, and is configured as, for example, a heat pump. The above-mentioned device 102 is an example, and may be, but is not limited to, an irrigation device, a lighting device, a spray device, or the like.

農業用ロボット1は、施設100内において、栽培場所105で栽培された作物2に対して様々な農作業、例えば、作物2の収穫、肥料散布、農薬散布などの農作業を行う。農
業用ロボット1は、自立型のロボットである。
図1~図8は、農業用ロボット1を示している。図8は、農業用ロボットの支援システムを示している。
The agricultural robot 1 performs various agricultural tasks, such as harvesting the crops 2, spraying fertilizer, and spraying pesticides, on the crops 2 cultivated in a cultivation area 105 within the facility 100. The agricultural robot 1 is an autonomous robot.
1 to 8 show an agricultural robot 1. Fig. 8 shows a support system for the agricultural robot.

以下、農業用ロボット1及び農業用ロボットの支援システムについて詳しく説明する。以下の説明において、図1、図2に矢印A1で示す方向を前方、矢印A2で示す方向を後方、矢印A3で示す方向を前後方向として説明する。したがって、図2に矢印B1で示す方向(図1の手前側)が左方であり、図2に矢印B2で示す方向(図1の奥側)が右方である。また、前後方向A3に直交する水平方向を機体幅方向(図2の矢印B3方向)として説明する。 The agricultural robot 1 and the agricultural robot support system will be described in detail below. In the following description, the direction indicated by arrow A1 in Figures 1 and 2 will be described as the forward direction, the direction indicated by arrow A2 as the rearward direction, and the direction indicated by arrow A3 as the front-to-rear direction. Therefore, the direction indicated by arrow B1 in Figure 2 (the front side of Figure 1) is the left, and the direction indicated by arrow B2 in Figure 2 (the back side of Figure 1) is the right. In addition, the horizontal direction perpendicular to the front-to-rear direction A3 will be described as the body width direction (the direction of arrow B3 in Figure 2).

図1に示すように、農業用ロボット1は、自律走行する走行体3を有している。走行体3は、機体6と、機体6を走行可能に支持する走行装置7とを有している。
図3、図4に示すように、機体6は、メインフレーム6Aと、原動機フレーム6Bとを有している。メインフレーム6Aは、機体幅方向B3で間隔をあけて配置された一対の第1フレーム6Aaと、各第1フレーム6Aaの下方に間隔をあけて配置された一対の第2フレーム6Abとを有している。第1フレーム6Aaと第2フレーム6Abとは、複数の縦フレーム6Acによって連結されている。縦フレーム6Acは、左の第1フレーム6Aaと左の第2フレーム6Abとの前部間、右の第1フレーム6Aaと右の第2フレーム6Abとの前部間、左の第1フレーム6Aaと左の第2フレーム6Abとの後部間、右の第1フレーム6Aaと右の第2フレーム6Abとの後部間に設けられている。
1, the agricultural robot 1 has an autonomously traveling vehicle 3. The vehicle 3 has a machine body 6 and a traveling device 7 that supports the machine body 6 so that it can travel.
As shown in Figures 3 and 4, the machine body 6 has a main frame 6A and a prime mover frame 6B. The main frame 6A has a pair of first frames 6Aa spaced apart in the machine body width direction B3, and a pair of second frames 6Ab spaced apart below each of the first frames 6Aa. The first frames 6Aa and the second frames 6Ab are connected by a plurality of vertical frames 6Ac. The vertical frames 6Ac are provided between the front parts of the left first frame 6Aa and the left second frame 6Ab, between the front parts of the right first frame 6Aa and the right second frame 6Ab, between the rear parts of the left first frame 6Aa and the left second frame 6Ab, and between the rear parts of the right first frame 6Aa and the right second frame 6Ab.

左の第1フレーム6Aaと右の第1フレーム6Aaとは、第1フレーム6Aa間に配置された第1横フレーム6Ad~第5横フレーム6Ahによって連結されている。第1横フレーム6Ad~第5横フレーム6Ahは、第1フレーム6Aaの前端から後端にわたって前後方向A3で間隔をあけて並行状に配置されている。
第2フレーム6Abの前部同士は、第6横フレーム6Ajによって連結され、第2フレーム6Abの後部同士は、第7横フレーム6Akによって連結されている。
The left first frame 6Aa and the right first frame 6Aa are connected by a first horizontal frame 6Ad to a fifth horizontal frame 6Ah that are arranged between the first frames 6Aa. The first horizontal frames 6Ad to the fifth horizontal frames 6Ah are arranged in parallel and spaced apart from each other in the front-to-rear direction A3 from the front end to the rear end of the first frame 6Aa.
The front portions of the second frames 6Ab are connected to each other by a sixth horizontal frame 6Aj, and the rear portions of the second frames 6Ab are connected to each other by a seventh horizontal frame 6Ak.

原動機フレーム6Bは、メインフレーム6Aの下方側に配置されている。原動機フレーム6Bは、前フレーム6Baと、後フレーム6Bbと、複数の連結フレーム6Bcと、複数の取付フレーム6Bdとを有している。前フレーム6Baは、上部が、左及び右の第2フレーム6Abの前部に取り付けられている。後フレーム6Bbは、上部が、左及び右の第2フレーム6Abの前部に取り付けられている。複数の連結フレーム6Bcは、前フレーム6Baと後フレーム6Bbの下部間を連結している。複数の取付フレーム6Bdは、連結フレーム6Bcの前後方向A3中央部に固定されている。 The prime mover frame 6B is disposed below the main frame 6A. The prime mover frame 6B has a front frame 6Ba, a rear frame 6Bb, multiple connecting frames 6Bc, and multiple mounting frames 6Bd. The upper part of the front frame 6Ba is attached to the front parts of the left and right second frames 6Ab. The upper part of the rear frame 6Bb is attached to the front parts of the left and right second frames 6Ab. The multiple connecting frames 6Bc connect the lower parts of the front frame 6Ba and the rear frame 6Bb. The multiple mounting frames 6Bd are fixed to the center of the connecting frame 6Bc in the fore-and-aft direction A3.

図4に示すように、取付フレーム6Bdには、原動機(エンジン)E1が取り付けられている。原動機E1には、油圧ポンプP1が取り付けられている。油圧ポンプP1は、原動機E1で駆動される。また、原動機フレーム6Bには、油圧ポンプP1から吐出する作動油を貯留する作動油タンク(図示省略)が搭載されている。
図5に示すように、メインフレーム6A(機体6)には、走行装置7を制御する複数のコントロールバルブ(第1コントロールバルブCV1~第4コントロールバルブCV4)が搭載されている。
As shown in Fig. 4, a prime mover (engine) E1 is attached to the mounting frame 6Bd. A hydraulic pump P1 is attached to the prime mover E1. The hydraulic pump P1 is driven by the prime mover E1. In addition, a hydraulic oil tank (not shown) that stores hydraulic oil discharged from the hydraulic pump P1 is mounted on the prime mover frame 6B.
As shown in FIG. 5, a plurality of control valves (first control valve CV1 to fourth control valve CV4) that control the traveling device 7 are mounted on the main frame 6A (machine body 6).

図1、図2、図5に示すように、走行装置7は、4輪の車輪8を有する車輪型(4輪型)の走行装置7で構成されている。詳しくは、走行装置7は、機体6前部の左側に配置された第1車輪8La(左前輪)と、機体6前部の右側に配置された第2車輪8Ra(右前輪)と、機体6後部の左側に配置された第3車輪8Lb(左後輪)と、機体6後部の右側に配置された第4車輪8Rb(右後輪)とを備えている。なお、走行装置7は、少なくとも3輪の車輪8を有する車輪型走行装置で構成されていてもよい。また、走行装置7は、クローラ型の走行装置であってもよい。 As shown in Figures 1, 2 and 5, the traveling device 7 is configured as a wheel type (four-wheel type) traveling device 7 having four wheels 8. In detail, the traveling device 7 is equipped with a first wheel 8La (left front wheel) arranged on the left side of the front of the body 6, a second wheel 8Ra (right front wheel) arranged on the right side of the front of the body 6, a third wheel 8Lb (left rear wheel) arranged on the left side of the rear of the body 6, and a fourth wheel 8Rb (right rear wheel) arranged on the right side of the rear of the body 6. The traveling device 7 may be configured as a wheel type traveling device having at least three wheels 8. The traveling device 7 may also be a crawler type traveling device.

走行装置7は、車輪8を支持する車輪支持体9を有している。車輪支持体9は、車輪8に対応する数設けられている。つまり、走行装置7は、第1車輪8Laを支持する第1車輪支持体9La、第2車輪8Raを支持する第2車輪支持体9Ra、第3車輪8Lbを支持する第3車輪支持体9Lb及び第4車輪8Rbを支持する第4車輪支持体9Rbを有し
ている。
The traveling device 7 has wheel supports 9 that support the wheels 8. The number of wheel supports 9 provided corresponds to the number of wheels 8. That is, the traveling device 7 has a first wheel support 9La that supports the first wheel 8La, a second wheel support 9Ra that supports the second wheel 8Ra, a third wheel support 9Lb that supports the third wheel 8Lb, and a fourth wheel support 9Rb that supports the fourth wheel 8Rb.

図5、図6に示すように、車輪支持体9は、走行フレーム10と、操向シリンダC1と、第1昇降シリンダC2と、第2昇降シリンダC3と、走行モータM1とを有している。
走行フレーム10は、主支持体10Aと、揺動フレーム10Bと、車輪フレーム10Cとを有している。主支持体10Aは、機体6に縦軸(上下方向に延伸する軸心)回りに可能に支持されている。詳しくは、主支持体10Aは機体6に固定された支持ブラケット11に上下方向に延伸する軸心を有する第1支軸12Aを介して回動可能に支持されている。
As shown in FIGS. 5 and 6, the wheel support 9 has a traveling frame 10, a steering cylinder C1, a first lifting cylinder C2, a second lifting cylinder C3, and a traveling motor M1.
The traveling frame 10 has a main support 10A, a swing frame 10B, and a wheel frame 10C. The main support 10A is supported on the machine body 6 so as to be rotatable around a vertical axis (an axis extending in the up-down direction). More specifically, the main support 10A is supported on a support bracket 11 fixed to the machine body 6 so as to be rotatable via a first support shaft 12A having an axis extending in the up-down direction.

図5に示すように、第1車輪支持体9Laを枢支する支持ブラケット11は機体6の前部左側に設けられ、第2車輪支持体9Raを枢支する支持ブラケット11は機体6の前部右側に設けられ、第3車輪支持体9Lbを枢支する支持ブラケット11は機体6の後部左側に設けられ、第4車輪支持体9Rbを枢支する支持ブラケット11は機体6の後部右側に設けられている。 As shown in FIG. 5, the support bracket 11 that pivots the first wheel support 9La is provided on the front left side of the aircraft body 6, the support bracket 11 that pivots the second wheel support 9Ra is provided on the front right side of the aircraft body 6, the support bracket 11 that pivots the third wheel support 9Lb is provided on the rear left side of the aircraft body 6, and the support bracket 11 that pivots the fourth wheel support 9Rb is provided on the rear right side of the aircraft body 6.

揺動フレーム10Bは、主支持体10Aに上下揺動可能に支持されている。詳しくは、揺動フレーム10Bは、上部が主支持体10Aに第2支軸12Bを介して横軸(機体幅方向B3に延伸する軸心)回りに回動可能に支持されている。
第1車輪支持体9La及び第2車輪支持体9Raの揺動フレーム10Bは前上部が主支持体10Aに枢支され、第3車輪支持体9Lb及び第4車輪支持体9Rbの揺動フレーム10Bは後上部が主支持体10Aに枢支されている。
The oscillating frame 10B is supported by the main support 10A so as to be able to oscillate up and down. More specifically, the upper part of the oscillating frame 10B is supported by the main support 10A via a second support shaft 12B so as to be able to rotate about a horizontal axis (an axis extending in the machine body width direction B3).
The swaying frames 10B of the first wheel support 9La and the second wheel support 9Ra are pivotally supported at their front upper portions to the main support 10A, and the swaying frames 10B of the third wheel support 9Lb and the fourth wheel support 9Rb are pivotally supported at their rear upper portions to the main support 10A.

車輪フレーム10Cは、揺動フレーム10Bに上下揺動可能に支持されている。詳しくは、車輪フレーム10Cは、揺動フレーム10Bに第3支軸12Cを介して横軸回りに回動可能に支持されている。
第1車輪支持体9La及び第2車輪支持体9Raの車輪フレーム10Cは後部が揺動フレーム10Bの後部に枢支され、第3車輪支持体9Lb及び第4車輪支持体9Rbの車輪フレーム10Cは前部が揺動フレーム10Bの前部に枢支されている。
The wheel frame 10C is supported by the swing frame 10B so as to be vertically swingable. More specifically, the wheel frame 10C is supported by the swing frame 10B so as to be rotatable about a horizontal axis via a third support shaft 12C.
The wheel frames 10C of the first wheel support 9La and the second wheel support 9Ra are pivotally supported at their rear portions to the rear portion of the oscillating frame 10B, and the wheel frames 10C of the third wheel support 9Lb and the fourth wheel support 9Rb are pivotally supported at their front portions to the front portion of the oscillating frame 10B.

操向シリンダC1、第1昇降シリンダC2及び第2昇降シリンダC3は、油圧シリンダによって構成されている。
操向シリンダC1は、機体6と主支持体10Aとの間に設けられている。詳しくは、操向シリンダC1の一端は、第1フレーム6Aaの前後方向A3中央部に固定されたシリンダブラケット14Aに枢支され、操向シリンダC1の他端は、主支持体10Aに固定されたシリンダブラケット14Bに枢支されている。操向シリンダC1を伸縮することにより走行フレーム10が第1支軸12A回りに揺動し、車輪8(第1車輪8La~第4車輪8Rb)の向きを変更する(操向する)ことができる。本実施形態の走行装置7にあっては、各車輪8を独立して操向可能である。
The steering cylinder C1, the first lift cylinder C2 and the second lift cylinder C3 are constituted by hydraulic cylinders.
The steering cylinder C1 is provided between the machine body 6 and the main support 10A. In detail, one end of the steering cylinder C1 is pivotally supported by a cylinder bracket 14A fixed to the center of the first frame 6Aa in the front-rear direction A3, and the other end of the steering cylinder C1 is pivotally supported by a cylinder bracket 14B fixed to the main support 10A. By extending and retracting the steering cylinder C1, the traveling frame 10 swings around the first support shaft 12A, and the direction of the wheels 8 (first wheel 8La to fourth wheel 8Rb) can be changed (steered). In the traveling device 7 of this embodiment, each wheel 8 can be steered independently.

第1昇降シリンダC2は、一端が揺動フレーム10Bに枢支され、他端が第1リンク機構15Aに枢支されている。第1リンク機構15Aは、第1リンク15aと第2リンク15bとを有している。第1リンク15aの一端は、主支持体10Aに枢支され、第2リンク15bの一端は揺動フレーム10Bに枢支されている。第1リンク15aと第2リンク15bとの他端は、第1昇降シリンダC2の他端に枢支されている。第1昇降シリンダC2を伸縮することにより揺動フレーム10Bが第2支軸12B回りに上下揺動する。 One end of the first lifting cylinder C2 is pivotally supported to the oscillating frame 10B, and the other end is pivotally supported to the first link mechanism 15A. The first link mechanism 15A has a first link 15a and a second link 15b. One end of the first link 15a is pivotally supported to the main support 10A, and one end of the second link 15b is pivotally supported to the oscillating frame 10B. The other ends of the first link 15a and the second link 15b are pivotally supported to the other end of the first lifting cylinder C2. By extending and retracting the first lifting cylinder C2, the oscillating frame 10B swings up and down around the second support shaft 12B.

第2昇降シリンダC3は、一端が揺動フレーム10Bの前部に枢支され、他端が第2リンク機構15Bに枢支されている。第2リンク機構15Bは、第1リンク15cと第2リンク15dとを有している。第1リンク15cの一端は、揺動フレーム10Bに枢支され、第2リンク15dの一端は車輪フレーム10Cに枢支されている。第1リンク15cと第2リンク15dとの他端は、第2昇降シリンダC3の他端に枢支されている。第2昇降シリンダC3を伸縮することにより車輪フレーム10Cが第3支軸12C回りに上下揺動する。 One end of the second lifting cylinder C3 is pivotally supported to the front of the oscillating frame 10B, and the other end is pivotally supported to the second link mechanism 15B. The second link mechanism 15B has a first link 15c and a second link 15d. One end of the first link 15c is pivotally supported to the oscillating frame 10B, and one end of the second link 15d is pivotally supported to the wheel frame 10C. The other ends of the first link 15c and the second link 15d are pivotally supported to the other end of the second lifting cylinder C3. By extending and retracting the second lifting cylinder C3, the wheel frame 10C swings up and down around the third support shaft 12C.

第1昇降シリンダC2による揺動フレーム10Bの上下揺動と、第2昇降シリンダC3による車輪フレーム10Cの上下揺動とを組み合わせることによって車輪8を平行状に昇降させることができる。
走行モータM1は、油圧モータによって形成されている。走行モータM1は、各車輪8に対応して設けられている。即ち、走行装置7は、第1車輪8Laを駆動する走行モータM1と、第2車輪8Raを駆動する走行モータM1と、第3車輪8Lbを駆動する走行モータM1と、第4車輪8Rbを駆動する走行モータM1とを有している。走行モータM1は、車輪8の機体幅方向B3の内方に配置され、車輪フレーム10Cに取り付けられている。走行モータM1は、油圧ポンプP1から吐出される作動油によって駆動され、正逆転可能である。走行モータM1を正逆転させることにより、車輪8の回転を正転方向と逆転方向とに切り換えることができる。
By combining the up and down swinging of the oscillating frame 10B by the first lifting cylinder C2 and the up and down swinging of the wheel frame 10C by the second lifting cylinder C3, the wheels 8 can be raised and lowered in a parallel manner.
The travel motor M1 is formed by a hydraulic motor. The travel motor M1 is provided corresponding to each wheel 8. That is, the travel device 7 has a travel motor M1 that drives the first wheel 8La, a travel motor M1 that drives the second wheel 8Ra, a travel motor M1 that drives the third wheel 8Lb, and a travel motor M1 that drives the fourth wheel 8Rb. The travel motor M1 is disposed inside the wheels 8 in the vehicle body width direction B3 and is attached to the wheel frame 10C. The travel motor M1 is driven by hydraulic oil discharged from the hydraulic pump P1 and can rotate forward and backward. By rotating the travel motor M1 forward and backward, the rotation of the wheels 8 can be switched between a forward direction and a reverse direction.

第2車輪支持体9Ra、第3車輪支持体9Lb及び第4車輪支持体9Rbは、第1車輪支持体9Laを構成する構成部品と同様の構成部品を有している。第2車輪支持体9Raは、第1車輪支持体9Laと左右対称に構成されている。第3車輪支持体9Lbは、第2車輪支持体9Raを機体6の中心を通る上下方向のセンタ軸心回りに180°回転させた形態を呈している。第4車輪支持体9Rbは、第1車輪支持体9Laをセンタ軸心回りに180°回転させた形態を呈している。 The second wheel support 9Ra, the third wheel support 9Lb, and the fourth wheel support 9Rb have components similar to those constituting the first wheel support 9La. The second wheel support 9Ra is configured symmetrically to the first wheel support 9La. The third wheel support 9Lb has a shape in which the second wheel support 9Ra is rotated 180° around a vertical central axis that passes through the center of the aircraft body 6. The fourth wheel support 9Rb has a shape in which the first wheel support 9La is rotated 180° around a central axis.

第1車輪支持体9Laに装備された油圧アクチュエータは、第1コントロールバルブCV1によって制御される。第2車輪支持体9Raに装備された油圧アクチュエータは、第2コントロールバルブCV2によって制御される。第3車輪支持体9Lbに装備された油圧アクチュエータは、第3コントロールバルブCV3によって制御される。第4車輪支持体9Rbに装備された油圧アクチュエータは、第4コントロールバルブCV4によって制御される。 The hydraulic actuator mounted on the first wheel support 9La is controlled by the first control valve CV1. The hydraulic actuator mounted on the second wheel support 9Ra is controlled by the second control valve CV2. The hydraulic actuator mounted on the third wheel support 9Lb is controlled by the third control valve CV3. The hydraulic actuator mounted on the fourth wheel support 9Rb is controlled by the fourth control valve CV4.

したがって、第1車輪8La~第4車輪8Rbは、それぞれ独立的に操向可能である。また、第1車輪8La~第4車輪8Rbは、それぞれ独立的に昇降可能である。
上記走行装置7にあっては、第1車輪8La~第4車輪8Rbを操向操作することで走行体3を操向することができる。第1車輪8La~第4車輪8Rbを正転させることで走行体3を前進させることができ、逆転させることにより走行体3を後進させることができる。第1車輪8La~第4車輪8Rbを昇降することにより走行体3を昇降することができる。第1車輪8La及び第2車輪8Raを第3車輪8Lb及び第4車輪8Rbに対して昇降することにより、或いは、第3車輪8Lb及び第4車輪8Rbを第1車輪8La及び第2車輪8Raに対して昇降することにより、機体6を前傾または後傾させることができる。第1車輪8La及び第3車輪8Lbを第2車輪8Ra及び第4車輪8Rbに対して昇降することにより、或いは、第2車輪8Ra及び第4車輪8Rbを第1車輪8La及び第3車輪8Lbに対して昇降することにより、機体6を、機体幅方向B3の一側が他側よりも高い傾斜状にすることができる。
Therefore, the first wheel 8La to the fourth wheel 8Rb can be steered independently of each other. Also, the first wheel 8La to the fourth wheel 8Rb can be raised and lowered independently of each other.
In the traveling device 7, the traveling body 3 can be steered by steering the first wheel 8La to the fourth wheel 8Rb. The traveling body 3 can be moved forward by rotating the first wheel 8La to the fourth wheel 8Rb in the normal direction, and can be moved backward by rotating the first wheel 8La to the fourth wheel 8Rb in the reverse direction. The traveling body 3 can be raised and lowered by raising and lowering the first wheel 8La to the fourth wheel 8Rb. The vehicle body 6 can be tilted forward or backward by raising and lowering the first wheel 8La and the second wheel 8Ra relative to the third wheel 8Lb and the fourth wheel 8Rb, or by raising and lowering the third wheel 8Lb and the fourth wheel 8Rb relative to the first wheel 8La and the second wheel 8Ra. By raising and lowering the first wheel 8La and the third wheel 8Lb relative to the second wheel 8Ra and the fourth wheel 8Rb, or by raising and lowering the second wheel 8Ra and the fourth wheel 8Rb relative to the first wheel 8La and the third wheel 8Lb, the body 6 can be inclined so that one side of the body width direction B3 is higher than the other side.

農業用ロボット1は、走行体3に装着されたマニピュレータ(作業部)4を備えている。マニピュレータ(作業部)4は、作業を行う部分であって、例えば、本実施形態では、少なくとも作物2の収穫を行うことが可能な装置である。
図3、図4に示すように、マニピュレータ4は、走行体3(機体6)に着脱可能に装着された装着体16と、装着体16に取り付けられたアーム17と、アーム17に設けられていて作物(対象物)2を把持可能なロボットハンド18とを備えている。
The agricultural robot 1 includes a manipulator (working unit) 4 attached to a traveling body 3. The manipulator (working unit) 4 is a part that performs work, and in this embodiment, for example, is a device that is capable of at least harvesting the crops 2.
As shown in Figures 3 and 4, the manipulator 4 comprises a mounting body 16 that is detachably attached to the running body 3 (machine body 6), an arm 17 attached to the mounting body 16, and a robot hand 18 provided on the arm 17 and capable of grasping a crop (target object) 2.

図1に示すように、装着体16は、本実施形態では、走行体3の後部に設けられている。なお、装着体16は、走行体3の前部に設けられていてもよい。つまり、走行体3における前後方向A3の中央部から一方側に偏倚して設けられていればよい。また、本実施形態では、農業用ロボット1は、走行体3を前方に進行させて収穫作業を行うので、装着体16は、進行方向とは反対側の方向である進行逆方向側に偏倚して設けられている。装着体16は、箱型に形成されていて走行体3に対して着脱可能である。 As shown in FIG. 1, in this embodiment, the attachment 16 is provided at the rear of the running body 3. The attachment 16 may also be provided at the front of the running body 3. In other words, it is sufficient that the attachment 16 is provided offset to one side from the center of the running body 3 in the front-to-rear direction A3. In this embodiment, the agricultural robot 1 performs harvesting work by moving the running body 3 forward, so the attachment 16 is provided offset to the reverse direction of travel, which is the direction opposite to the direction of travel. The attachment 16 is formed in a box shape and is detachable from the running body 3.

装着体16には、回動フレーム21が立設されている。回動フレーム21は、装着体16の内部に設けられた回動モータM2によって回動軸心J1の周囲を回動可能である。回動フレーム21を回動させることにより、ロボットハンド18を回動軸心J1を中心とする円周方向に移動(位置変更)させることができる。
図3、図4に示すように、アーム17は、回動フレーム21に上下揺動可能に支持され
ると共に長手方向の中途部で屈伸可能である。アーム17は、メインアーム29とサブアーム30とを有している。
A rotating frame 21 is provided upright on the mounting body 16. The rotating frame 21 can be rotated around a rotation axis J1 by a rotation motor M2 provided inside the mounting body 16. By rotating the rotating frame 21, the robot hand 18 can be moved (changed in position) in a circumferential direction around the rotation axis J1.
3 and 4, the arm 17 is supported by the rotating frame 21 so as to be able to swing up and down, and is also able to bend and stretch at a midpoint in the longitudinal direction.

メインアーム29は、回動フレーム21に上下揺動可能に枢支され、屈伸可能である。詳しくは、メインアーム29は、回動フレーム21に上下揺動可能に枢支された第1アーム部31と、第1アーム部31に揺動可能に枢支された第2アーム部32とを有し、第1アーム部31に対して第2アーム部32が揺動することで屈伸可能とされている。
第1アーム部31は、基部側31aがアームブラケット26に枢支されている。第1アーム部31は、図3に示すように、第1アームフレーム31L及び第2アームフレーム31Rを有している。第1アームフレーム31L及び第2アームフレーム31Rは、機体幅方向B3で並べて配置され且つ連結パイプ31A等で相互に連結されている。第1アームフレーム31Lと第2アームフレーム31Rとの基部側31a間にアームブラケット26の上部が挿入され、機体幅方向B3に延伸する軸心を有するアーム枢軸33A(第1アーム枢軸という)を介して第1アームフレーム31L及び第2アームフレーム31Rの基部側31aがアームブラケット26に第1アーム枢軸33Aの軸心回りに回動可能に支持されている。
The main arm 29 is pivotally supported on the rotating frame 21 so as to be swingable up and down, and is bendable and stretchable. In detail, the main arm 29 has a first arm portion 31 pivotally supported on the rotating frame 21 so as to be swingable up and down, and a second arm portion 32 pivotally supported on the first arm portion 31 so as to be swingable, and is bendable and stretchable as a result of the second arm portion 32 swinging relative to the first arm portion 31.
The base side 31a of the first arm portion 31 is pivotally supported by the arm bracket 26. As shown in Fig. 3, the first arm portion 31 has a first arm frame 31L and a second arm frame 31R. The first arm frame 31L and the second arm frame 31R are arranged side by side in the machine body width direction B3 and are connected to each other by a connecting pipe 31A or the like. The upper part of the arm bracket 26 is inserted between the base sides 31a of the first arm frame 31L and the second arm frame 31R, and the base sides 31a of the first arm frame 31L and the second arm frame 31R are supported by the arm bracket 26 to be rotatable around the axis of the first arm pivot 33A (referred to as the first arm pivot) having an axis extending in the machine body width direction B3.

第1アームフレーム31L及び第2アームフレーム31Rは中空部材で形成されている。第1アーム部31の長さは、走行体3(機体6)の前後方向A3の長さよりも短く形成されている。
図4に示すように、第1アーム部31は、基部側31aであって且つ第1アーム枢軸33Aよりも先端側31c寄りに、シリンダ取付部31bを有している。このシリンダ取付部31bとシリンダブラケット27のシリンダ取付部27aとにわたって第1アームシリンダ(第1油圧シリンダ)C4が設けられている。第1アームシリンダC4は、走行体3に設けた油圧ポンプP1から吐出される作動油によって駆動されて伸縮する。第1アームシリンダC4を伸縮させることで第1アーム部31が上下揺動する。第1アーム部31(アーム17)を上下揺動させることにより、ロボットハンド18を昇降させることができる。第1アームシリンダC4には、第1アームシリンダC4のストロークを検出する第1ストロークセンサが設けられている。
The first arm frame 31L and the second arm frame 31R are formed of hollow members. The length of the first arm portion 31 is shorter than the length of the traveling body 3 (machine body 6) in the front-rear direction A3.
As shown in Fig. 4, the first arm section 31 has a cylinder attachment section 31b on the base side 31a and closer to the tip side 31c than the first arm pivot 33A. A first arm cylinder (first hydraulic cylinder) C4 is provided between the cylinder attachment section 31b and the cylinder attachment section 27a of the cylinder bracket 27. The first arm cylinder C4 is driven by hydraulic oil discharged from a hydraulic pump P1 provided on the traveling body 3 to expand and contract. The first arm section 31 swings up and down by expanding and contracting the first arm cylinder C4. The robot hand 18 can be raised and lowered by swinging the first arm section 31 (arm 17) up and down. The first arm cylinder C4 is provided with a first stroke sensor that detects the stroke of the first arm cylinder C4.

図4に示すように、第1アーム部31の先端側31cには、枢支部材31Bが固定されている。詳しくは、枢支部材31Bは、基部31Baが第1アームフレーム31Lと第2アームフレーム31Rとの間に挿入されて第1アームフレーム31L及び第2アームフレーム31Rに固定されている。枢支部材31Bの基部31Baの下面側には、シリンダステー34が取り付けられている。枢支部材31Bの先端側31Bbは、第1アームフレーム31L及び第2アームフレーム31Rから前方に突出している。 As shown in FIG. 4, a pivot member 31B is fixed to the tip side 31c of the first arm portion 31. More specifically, the pivot member 31B is fixed to the first arm frame 31L and the second arm frame 31R with the base 31Ba inserted between them. A cylinder stay 34 is attached to the underside of the base 31Ba of the pivot member 31B. The tip side 31Bb of the pivot member 31B protrudes forward from the first arm frame 31L and the second arm frame 31R.

図3に示すように、第2アーム部32の長さは、第1アーム部31の長さよりも長く形成されている。第2アーム部32は、基部側32aが枢支部材31Bの先端側31Bbに枢支されている。第2アーム部32は、第3アームフレーム32L及び第4アームフレーム32Rを有している。第3アームフレーム32L及び第4アームフレーム32Rは、機体幅方向B3で並べて配置され且つ複数の連結プレート35によって相互に連結されている。第3アームフレーム32L及び第4アームフレーム32Rは中空部材で形成されている。第3アームフレーム32Lと第4アームフレーム32Rとの基部側32a間に枢支部材31Bの先端側31Bbが挿入されている。第3アームフレーム32L及び第4アームフレーム32R(第2アーム部32)は、機体幅方向B3に延伸する軸心を有するアーム枢軸(第2アーム枢軸という)33Bによって枢支部材31Bに枢支されている。 As shown in FIG. 3, the length of the second arm portion 32 is longer than the length of the first arm portion 31. The base side 32a of the second arm portion 32 is pivotally supported by the tip side 31Bb of the pivot member 31B. The second arm portion 32 has a third arm frame 32L and a fourth arm frame 32R. The third arm frame 32L and the fourth arm frame 32R are arranged side by side in the machine body width direction B3 and are connected to each other by a plurality of connecting plates 35. The third arm frame 32L and the fourth arm frame 32R are formed of hollow members. The tip side 31Bb of the pivot member 31B is inserted between the base side 32a of the third arm frame 32L and the fourth arm frame 32R. The third arm frame 32L and the fourth arm frame 32R (second arm portion 32) are pivotally supported by the pivot member 31B by an arm pivot (referred to as the second arm pivot) 33B having an axis extending in the machine body width direction B3.

第2アーム部32の基部側32aであって第2アーム枢軸33Bよりも先端側32b寄りには、シリンダ取付部32cが設けられている。このシリンダ取付部32cとシリンダステー34とにわたって第2アームシリンダ(第2油圧シリンダ)C5が設けられている。第2アームシリンダC5は、走行体3に設けた油圧ポンプP1から吐出される作動油によって駆動されて伸縮する。第2アームシリンダC5を伸縮させることで第1アーム部31に対して第2アーム部32が揺動し、メインアーム29(アーム17)が屈伸(曲げたり伸ばしたりすること)する。なお、本実施形態では、メインアーム29は、最も伸びた
状態で直線状となるが、最も伸びた状態で若干曲がっていてもよい。
A cylinder attachment portion 32c is provided on the base side 32a of the second arm portion 32, closer to the tip side 32b than the second arm pivot 33B. A second arm cylinder (second hydraulic cylinder) C5 is provided between the cylinder attachment portion 32c and the cylinder stay 34. The second arm cylinder C5 is driven by hydraulic oil discharged from a hydraulic pump P1 provided on the traveling body 3 to expand and contract. By expanding and contracting the second arm cylinder C5, the second arm portion 32 swings relative to the first arm portion 31, and the main arm 29 (arm 17) is bent and stretched (bended and stretched). In this embodiment, the main arm 29 is straight when fully extended, but may be slightly bent when fully extended.

また、第2アームシリンダC5を伸縮させることで走行体3に対してロボットハンド18を遠近方向に移動させることができる。詳しくは、第2アームシリンダC5を伸長させることでロボットハンド18を走行体3から遠ざける方向に移動させることができ、第2アームシリンダC5を収縮させることでロボットハンド18を走行体3に近づける方向に移動させることができる。 In addition, by extending and contracting the second arm cylinder C5, the robot hand 18 can be moved toward or away from the running body 3. In particular, by extending the second arm cylinder C5, the robot hand 18 can be moved away from the running body 3, and by contracting the second arm cylinder C5, the robot hand 18 can be moved toward the running body 3.

図4に示すように、第2アームシリンダC5には、第2アームシリンダC5のストロークを検出する第2ストロークセンサが設けられている。
サブアーム30は、第2アーム部32に突出及び後退可能に設けられている。したがって、サブアーム30を突出及び後退させることにより、アーム17の長さが伸縮可能である。サブアーム30は、角パイプによって直線状に形成されている。サブアーム30は、第3アームフレーム32Lと第4アームフレーム32Rとの先端側(前部)間に長手方向移動可能に支持されている。また、サブアーム30は、対向する連結プレート35の間に配置されていて連結プレート35にボルト等の固定具によって固定可能とされている。サブアーム30の一側面には、第3アームフレーム32Lに当接する突起30aが設けられ、他側面には、第4アームフレーム32Rに当接する突起30aが設けられている。突起30aによってサブアーム30のがたつきを抑制することができる。
As shown in FIG. 4, the second arm cylinder C5 is provided with a second stroke sensor that detects the stroke of the second arm cylinder C5.
The sub-arm 30 is provided on the second arm portion 32 so as to be capable of projecting and retracting. Therefore, the length of the arm 17 can be extended or contracted by projecting and retracting the sub-arm 30. The sub-arm 30 is formed in a straight line by a square pipe. The sub-arm 30 is supported between the tip side (front part) of the third arm frame 32L and the fourth arm frame 32R so as to be capable of moving in the longitudinal direction. The sub-arm 30 is also disposed between the opposing connecting plates 35 and can be fixed to the connecting plates 35 by a fastener such as a bolt. A protrusion 30a that abuts against the third arm frame 32L is provided on one side of the sub-arm 30, and a protrusion 30a that abuts against the fourth arm frame 32R is provided on the other side. The protrusion 30a can suppress rattling of the sub-arm 30.

サブアーム30は、最も後退させた位置(最後退位置)では、第3アームフレーム32Lと第4アームフレーム32Rとの間に没入する。なお、サブアーム30は、最後退位置で第2アーム部32から若干突出していてもよい。
図4に示すように、サブアーム30の先端側には、吊りプレート37が固定されている。吊りプレート37にロボットハンド18が枢支され、吊り下げられる(図1参照)。つまり、ロボットハンド18は、サブアーム30の先端側に揺動可能に取り付けられる。第2アーム部32の先端側には、サブアーム30の第2アーム部32からの突出量を測定(検出)する第3ストロークセンサが設けられている。
The sub-arm 30 is retracted between the third arm frame 32L and the fourth arm frame 32R at the most retracted position (rearmost retracted position). The sub-arm 30 may slightly protrude from the second arm portion 32 at the rearmost retracted position.
As shown in Fig. 4, a hanging plate 37 is fixed to the tip side of the sub-arm 30. The robot hand 18 is pivotally supported and suspended from the hanging plate 37 (see Fig. 1). In other words, the robot hand 18 is attached to the tip side of the sub-arm 30 so as to be able to swing. A third stroke sensor that measures (detects) the amount of protrusion of the sub-arm 30 from the second arm portion 32 is provided on the tip side of the second arm portion 32.

図1、図2に示すように、ロボットハンド18は、ベース部材18Aと、複数の把持ツメ18Bとを有している。ベース部材18Aの上面側には連結片63が設けられている。連結片63は吊りプレート37に枢支されている。つまり、ロボットハンド18はアーム17に吊り下げられている。複数の把持ツメ18Bは、ベース部材18Aの下面側に揺動可能に取り付けられている。ロボットハンド18は、複数の把持ツメ18Bが揺動することにより、把持ツメ18Bと把持ツメ18Bとの間で作物2を把持することが可能(図2参照)であると共に、把持した作物2を解放することが可能である。 As shown in Figures 1 and 2, the robot hand 18 has a base member 18A and multiple gripping claws 18B. A connecting piece 63 is provided on the upper surface side of the base member 18A. The connecting piece 63 is pivotally supported on the hanging plate 37. In other words, the robot hand 18 is suspended from the arm 17. The multiple gripping claws 18B are attached to the lower surface side of the base member 18A so as to be able to swing. By swinging the multiple gripping claws 18B, the robot hand 18 is able to grip the crop 2 between the gripping claws 18B and the gripping claws 18B (see Figure 2) and is also able to release the gripped crop 2.

図1、図2に示すように、農業用ロボット1は、光学式センサ5A、5Bを備えている。光学式センサ5A、5Bは、CCD(Charge Coupled Devices:電荷結合素子)イメージセンサを搭載したCCDカメラ、CMOS(Complementary Metal Oxide Semiconductor:相補性金属酸化膜半導体)イメージセンサを搭載したCMOSカメラ、赤外線カメラである。この実施形態では、光学式センサ5A、5Bは、撮像装置(CCDカメラ、CMOSカメラ、赤外線カメラ)である。光学式センサ5A、5Bは、レーザセンサ、即ち、ライダー(LiDAR: Light Detection And Ranging)であってもよい。レーザセンサ(ライダー)は、1秒間に何百万回ものパルス状の赤外線等を照射し、跳ね返って戻ってくるまでの時間を測定することで、走行体3周辺の3Dマップを構築することができるセンサである。この実施形態では、光学式センサ5A、5Bは、撮像装置(CCDカメラ、CMOSカメラ、赤外線カメラ)である。 1 and 2, the agricultural robot 1 is equipped with optical sensors 5A and 5B. The optical sensors 5A and 5B are a CCD camera equipped with a CCD (Charge Coupled Devices) image sensor, a CMOS camera equipped with a CMOS (Complementary Metal Oxide Semiconductor) image sensor, and an infrared camera. In this embodiment, the optical sensors 5A and 5B are imaging devices (CCD camera, CMOS camera, infrared camera). The optical sensors 5A and 5B may be laser sensors, that is, LiDAR (Light Detection And Ranging). The laser sensor (LIDAR) is a sensor that can construct a 3D map around the traveling object 3 by irradiating pulsed infrared rays or the like millions of times per second and measuring the time it takes for the rays to bounce back. In this embodiment, the optical sensors 5A and 5B are imaging devices (CCD camera, CMOS camera, infrared camera).

光学式センサ5Aは、回動フレーム21に取り付けられている。詳しくは、アームブラケット26の上部に支柱40を介して取り付けられている。これに限定されることはなく、光学式センサ5Aは、走行体3等に取り付けてもよい。また、光学式センサ5Aは複数箇所に設けられていてもよい。つまり、農業用ロボット1は、光学式センサ5Aを複数有していてもよい。光学式センサ5Aは、走行体3の周囲を撮影可能であって、走行体3の周囲の情報を撮影によって取得する。 The optical sensor 5A is attached to the rotating frame 21. More specifically, it is attached to the upper part of the arm bracket 26 via a support 40. Without being limited to this, the optical sensor 5A may be attached to the running body 3 or the like. The optical sensor 5A may also be provided in multiple locations. In other words, the agricultural robot 1 may have multiple optical sensors 5A. The optical sensor 5A is capable of photographing the surroundings of the running body 3, and acquires information about the surroundings of the running body 3 by photographing them.

光学式センサ5Bは、第2アーム部32の先端側に取り付けられている。光学式センサ
5Bは、作物2を撮像することによって、例えば、作物2の大きさ、形、色、模様(スイカにあっては縞模様)、傷などの品質情報を取得することができる。
図1、図2に示すように、農業用ロボット1は、打音センサ50Cを備えている。打音センサ50Cは、作物2に打撃を与えた(作物2を叩いた)ときの打音を取得するセンサである。図7に示すように、打音センサ50Cは、ロボットハンド18(ベース部材18A)に設けられている。
The optical sensor 5B is attached to the tip side of the second arm portion 32. The optical sensor 5B captures an image of the crop 2, thereby obtaining quality information such as the size, shape, color, pattern (striped pattern in the case of a watermelon), and scratches of the crop 2.
1 and 2, the agricultural robot 1 is equipped with a hitting sound sensor 50C. The hitting sound sensor 50C is a sensor that acquires a hitting sound when a hit is given to the crop 2 (the crop 2 is hit). As shown in Fig. 7, the hitting sound sensor 50C is provided on the robot hand 18 (base member 18A).

打音センサ50Cは、打撃機構51と、録音機構52とを有している。打撃機構51は、把持ツメ18Bで把持された作物2に対して進退可能な打撃部材51Aを有している。打撃部材51Aは、当該打撃部材51Aを軸方向に移動させるアクチュエータ51Bに連結されている。アクチュエータ51Bは、例えば、電動であって、制御信号に応じて打撃部材51Aを軸方向に移動させることで、作物2に打撃を与えて打音を発生させる。録音機構52は、マイク(高指向性マイク)を有し、打撃部材51Aで作物2を打撃することによって発生した打音を録音(記録)する。 The impact sound sensor 50C has an impact mechanism 51 and a recording mechanism 52. The impact mechanism 51 has an impact member 51A that can move forward and backward with respect to the crop 2 gripped by the gripping claws 18B. The impact member 51A is connected to an actuator 51B that moves the impact member 51A in the axial direction. The actuator 51B is, for example, electrically powered, and moves the impact member 51A axially in response to a control signal to strike the crop 2 and generate an impact sound. The recording mechanism 52 has a microphone (highly directional microphone) and records (records) the impact sound generated by striking the crop 2 with the impact member 51A.

図8に示すように、農業用ロボット1は、制御装置41を有している。制御装置41は、例えば、CPU(Central Processing Unit)、EEPROM(Electrically Erasable
Programmable Read-Only Memory)などを備えたマイクロコンピュータ等である。
制御装置41には、光学式センサ5A、5B、打音センサ50C、走行モータM1、回動モータM2が接続されている。また、制御装置41には、複数の制御弁42が接続されている。制御弁42は、第1制御弁42A、第2制御弁42B、第3制御弁42C、第4制御弁42D、第5制御弁42Eを含んでいる。
As shown in Fig. 8, the agricultural robot 1 has a control device 41. The control device 41 includes, for example, a CPU (Central Processing Unit), an EEPROM (Electrically Erasable Programmable Read Only Memory),
Examples of such devices include microcomputers equipped with a programmable read-only memory (PRAM).
The optical sensors 5A and 5B, the hammering sound sensor 50C, the travel motor M1, and the rotation motor M2 are connected to the control device 41. In addition, a plurality of control valves 42 are connected to the control device 41. The control valves 42 include a first control valve 42A, a second control valve 42B, a third control valve 42C, a fourth control valve 42D, and a fifth control valve 42E.

第1制御弁42Aは、操向シリンダC1を制御する弁、第2制御弁42Bは、第1昇降シリンダC2を制御する弁、第3制御弁42Cは、第2昇降シリンダC3を制御する弁、第4制御弁42Dは、第1アームシリンダC4を制御する弁、第5制御弁42Eは、第2アームシリンダC5を制御する弁である。
第1制御弁42A、第2制御弁42B、第3制御弁42C、第4制御弁42D及び第5制御弁42Eは、例えば、制御装置41からの制御信号に基づいて作動する電磁弁である。より詳しくは、第1制御弁42A、第2制御弁42B、第3制御弁42C、第4制御弁42D及び第5制御弁42Eは、制御信号によって複数の位置に切り換わる電磁弁(3位置切換電磁弁)である。
The first control valve 42A is a valve that controls the steering cylinder C1, the second control valve 42B is a valve that controls the first lifting cylinder C2, the third control valve 42C is a valve that controls the second lifting cylinder C3, the fourth control valve 42D is a valve that controls the first arm cylinder C4, and the fifth control valve 42E is a valve that controls the second arm cylinder C5.
The first control valve 42A, the second control valve 42B, the third control valve 42C, the fourth control valve 42D, and the fifth control valve 42E are, for example, solenoid valves that operate based on a control signal from the control device 41. More specifically, the first control valve 42A, the second control valve 42B, the third control valve 42C, the fourth control valve 42D, and the fifth control valve 42E are solenoid valves (three-position switching solenoid valves) that are switched to a plurality of positions by a control signal.

制御装置41が第1制御弁42Aに制御信号を出力すると、制御信号に応じて第1制御弁42Aが所定位置に切り換わる。制御装置41が第2制御弁42Bに制御信号を出力すると、制御信号に応じて第2制御弁42Bが所定位置に切り換わる。
また、制御装置41が第3制御弁42Cに制御信号を出力すると、制御信号に応じて第3制御弁42Cが所定位置に切り換わる。制御装置41が第4制御弁42Dに制御信号を出力すると、制御信号に応じて第4制御弁42Dが所定位置に切り換わる。制御装置41が第5制御弁42Eに制御信号を出力すると、制御信号に応じて第5制御弁42Eが所定位置に切り換わる。
When the control device 41 outputs a control signal to the first control valve 42A, the first control valve 42A switches to a predetermined position in response to the control signal. When the control device 41 outputs a control signal to the second control valve 42B, the second control valve 42B switches to a predetermined position in response to the control signal.
When the control device 41 outputs a control signal to the third control valve 42C, the third control valve 42C switches to a predetermined position in response to the control signal. When the control device 41 outputs a control signal to the fourth control valve 42D, the fourth control valve 42D switches to a predetermined position in response to the control signal. When the control device 41 outputs a control signal to the fifth control valve 42E, the fifth control valve 42E switches to a predetermined position in response to the control signal.

第1制御弁42A、第2制御弁42B、第3制御弁42C、第4制御弁42D及び第5制御弁42Eには、油路46が接続され、当該油路46には、作動油を吐出する油圧ポンプP1が接続されている。
以上によれば、第1制御弁42Aの切り換わりによって、操向シリンダC1のボトム側又はロッド側への作動油の供給が切り換わり、操向シリンダC1が伸縮する。第2制御弁42Bの切り換わりによって、第1昇降シリンダC2のボトム側又はロッド側への作動油の供給が切り換わり、第1昇降シリンダC2が伸縮する。第3制御弁42Cの切り換わりによって、第2昇降シリンダC3のボトム側又はロッド側への作動油の供給が切り換わり、第2昇降シリンダC3が伸縮する。
An oil passage 46 is connected to the first control valve 42A, the second control valve 42B, the third control valve 42C, the fourth control valve 42D, and the fifth control valve 42E, and a hydraulic pump P1 that discharges hydraulic oil is connected to the oil passage 46.
According to the above, the first control valve 42A switches the supply of hydraulic oil to the bottom side or the rod side of the steering cylinder C1, causing the steering cylinder C1 to expand and contract. The second control valve 42B switches the supply of hydraulic oil to the bottom side or the rod side of the first lift cylinder C2, causing the first lift cylinder C2 to expand and contract. The third control valve 42C switches the supply of hydraulic oil to the bottom side or the rod side of the second lift cylinder C3, causing the second lift cylinder C3 to expand and contract.

また、第4制御弁42Dの切り換わりによって、第1アームシリンダC4のボトム側又はロッド側への作動油の供給が切り換わり、第1アームシリンダC4が伸縮する。第5制御弁42Eの切り換わりによって、第2アームシリンダC5のボトム側又はロッド側への作動油の供給が切り換わり、第2アームシリンダC5が伸縮する。
農業用ロボット1は、走行制御部41Aを有している。走行制御部41Aは、制御装置41に設けられた電気電子回路、当該制御装置41に格納されたプログラム等である。
Furthermore, the fourth control valve 42D switches the supply of hydraulic oil to either the bottom side or the rod side of the first arm cylinder C4, causing the first arm cylinder C4 to expand and contract. The fifth control valve 42E switches the supply of hydraulic oil to either the bottom side or the rod side of the second arm cylinder C5, causing the second arm cylinder C5 to expand and contract.
The agricultural robot 1 has a travel control unit 41A. The travel control unit 41A is an electric/electronic circuit provided in the control device 41, a program stored in the control device 41, and the like.

走行制御部41Aは、走行装置7を制御する。即ち、走行制御部41Aは、操向シリンダC1(第1制御弁42A)、走行モータM1を制御する。走行制御部41Aは、第1制御弁42Aに制御信号を出力して、操向シリンダC1を伸縮させることによって、走行装置7(機体6)の操舵方向の変更を行う。走行制御部41Aは、走行モータM1に制御信号を出力して、走行モータM1の回転数又は回転方向を変更することにより、走行装置7(機体6)の速度の変更、走行装置7(機体6)の進行方向の変更を行う。 The travel control unit 41A controls the travel device 7. That is, the travel control unit 41A controls the steering cylinder C1 (first control valve 42A) and the travel motor M1. The travel control unit 41A outputs a control signal to the first control valve 42A to expand and contract the steering cylinder C1, thereby changing the steering direction of the travel device 7 (machine 6). The travel control unit 41A outputs a control signal to the travel motor M1 to change the rotation speed or rotation direction of the travel motor M1, thereby changing the speed of the travel device 7 (machine 6) and changing the direction of travel of the travel device 7 (machine 6).

また、走行制御部41Aは、機体6の昇降、傾き等の制御を行ってもよい。例えば、走行制御部41Aは、第2制御弁42Bに制御信号を出力して、第1昇降シリンダC2を伸縮することによって、機体6の昇降、傾きの変更を行う。また、走行制御部41Aは、第3制御弁42Cに制御信号を出力して、第2昇降シリンダC3を伸縮することによって、機体6の昇降、傾きの変更を行う。 The travel control unit 41A may also control the elevation and inclination of the machine body 6. For example, the travel control unit 41A outputs a control signal to the second control valve 42B to extend and retract the first lifting cylinder C2, thereby elevating and lowering the machine body 6 and changing its inclination. The travel control unit 41A also outputs a control signal to the third control valve 42C to extend and retract the second lifting cylinder C3, thereby elevating and lowering the machine body 6 and changing its inclination.

以上のように、走行制御部41Aの制御によって、農業用ロボット1は、施設100など自立走行することができる。
農業用ロボット1は、作業制御部41Bを有している。作業制御部41Bは、制御装置41に設けられた電気電子回路、当該制御装置41に格納されたプログラム等である。
作業制御部41Bは、マニピュレータ(作業部)4を制御する。即ち、作業制御部41Bは、第1アームシリンダC4、第2アームシリンダC5、回動モータM2を制御する。作業制御部41Bは、第4制御弁42Dに制御信号を出力して、第1アームシリンダC4を伸縮させることによって、第1アーム部31の揺動を行う。作業制御部41Bは、第5制御弁42Eに制御信号を出力して、第2アームシリンダC5を伸縮させることによって、第2アーム部32の揺動を行う。また、作業制御部41Bは、回動モータM2に制御信号を出力することによって、回動モータM2の回転方向を変更することにより、マニピュレータ(作業部)4の回動を行う。
As described above, the agricultural robot 1 can travel independently within the facility 100 or the like by the control of the travel control unit 41A.
The agricultural robot 1 has a work control unit 41B. The work control unit 41B is an electric/electronic circuit provided in the control device 41, a program stored in the control device 41, and the like.
The work control unit 41B controls the manipulator (working unit) 4. That is, the work control unit 41B controls the first arm cylinder C4, the second arm cylinder C5, and the rotation motor M2. The work control unit 41B outputs a control signal to the fourth control valve 42D to extend and retract the first arm cylinder C4, thereby swinging the first arm unit 31. The work control unit 41B outputs a control signal to the fifth control valve 42E to extend and retract the second arm cylinder C5, thereby swinging the second arm unit 32. The work control unit 41B also outputs a control signal to the rotation motor M2 to change the rotation direction of the rotation motor M2, thereby rotating the manipulator (working unit) 4.

以上のように、作業制御部41Bは、ロボットハンド18を任意(所望)の位置に移動させることができる。詳しくは、回動フレーム21の回動による回動軸心J1を中心とする円周方向のロボットハンド18の移動、第1アーム部31の上下揺動によるロボットハンド18の昇降、第2アーム部32の揺動によるロボットハンド18の走行体3に対する遠近方向の移動によって、ロボットハンド18を目的の位置に移動させることができる。 As described above, the work control unit 41B can move the robot hand 18 to any (desired) position. In detail, the robot hand 18 can be moved to a desired position by moving the robot hand 18 in a circumferential direction around the rotation axis J1 by rotating the rotating frame 21, raising and lowering the robot hand 18 by swinging the first arm unit 31 up and down, and moving the robot hand 18 toward or away from the running body 3 by swinging the second arm unit 32.

作業制御部41Bは、アクチュエータ51B(打撃部材51A)を制御する。例えば、アクチュエータ51Bに制御信号を出力することで、アクチュエータ51Bを作動させ、打撃部材51Aによって作物2に対して打撃を与える制御(打撃制御)を行う。
図8に示すように、農業用ロボット1は、作物推定部41Iを備えている。作物推定部41Iは、制御装置41に設けられた電気電子回路、当該制御装置41に格納されたプログラム等である。
The work control unit 41B controls the actuator 51B (the hitting member 51A). For example, the work control unit 41B outputs a control signal to the actuator 51B to operate the actuator 51B and perform control (impact control) to hit the crop 2 with the hitting member 51A.
8, the agricultural robot 1 includes a crop estimation unit 41I. The crop estimation unit 41I is an electric/electronic circuit provided in the control device 41, a program stored in the control device 41, and the like.

作物推定部41Iは、光学式センサ5A又は光学式センサ5Bで得られたセンシングデータに基づいて、作物2を推定する。光学式センサ5A又は光学式センサ5Bが撮像装置である場合、センシングデータは、撮像した撮像画像(画像データ)である。光学式センサ5A又は光学式センサ5Bがレーザセンサ(ライダー)である場合、センシングデータは、光学式センサ5A又は光学式センサ5Bからセンシングした対象物(物体)までの距離、方向を含むスキャンデータである。 The crop estimation unit 41I estimates the crop 2 based on the sensing data obtained by the optical sensor 5A or the optical sensor 5B. If the optical sensor 5A or the optical sensor 5B is an imaging device, the sensing data is the captured image (image data). If the optical sensor 5A or the optical sensor 5B is a laser sensor (lidar), the sensing data is scan data that includes the distance and direction from the optical sensor 5A or the optical sensor 5B to the sensed target object (object).

さて、図9に示すように、農業用ロボット1によって収穫などの作業を行う場合、施設100内において、農業用ロボット1を栽培場所105の間の通路106を走行させる。例えば、作業時において、農業用ロボット1を作業開始点P11から作業終了点P12まで栽培場所105(通路106)に沿って農業用ロボット1を走行させる。
図11に示すように、農業用ロボット1を走行させる際、作物推定部41Iは、光学式センサ5A又は光学式センサ5Bで得られたセンシングデータ(撮像画像、スキャンデータ)H11を参照して、作物2を推定する。
9 , when the agricultural robot 1 performs work such as harvesting, the agricultural robot 1 travels along a passage 106 between cultivation areas 105 in a facility 100. For example, during work, the agricultural robot 1 travels along the cultivation areas 105 (passage 106) from a work start point P11 to a work end point P12.
As shown in FIG. 11, when the agricultural robot 1 is traveling, the crop estimation unit 41I estimates the crop 2 by referring to the sensing data (captured image, scan data) H11 obtained by the optical sensor 5A or the optical sensor 5B.

以下、作物推定部41Iについて詳しく説明する。
図8に示すように、作物推定部41Iは、データ抽出部85と、推定部86とを有している。データ抽出部85は、センシングデータ(撮像画像、スキャンデータ)H11に基づいて推定する作物2を特定し且つセンシングデータ(撮像画像、スキャンデータ)H11のうち特定した作物2の周囲のデータを部分データH13として抽出する。
The crop estimation unit 41I will be described in detail below.
8, the crop estimation unit 41I has a data extraction unit 85 and an estimation unit 86. The data extraction unit 85 identifies a crop 2 to be estimated based on sensing data (captured image, scan data) H11, and extracts data around the identified crop 2 from the sensing data (captured image, scan data) H11 as partial data H13.

具体的には、まず、図10に示すように、栽培場所105で栽培している作物2に対して作業を行うために、農業用ロボット1を進行方向に向けて自立走行をさせると、データ抽出部85は、センシングデータH11を参照し、推定する作物2の特定を行う。図11に示すように、データ抽出部85は、参照したセンシングデータH11に作物2の一部が含まれているか否かを判断する。センシングデータH11が撮像画像である場合、撮像画像の特徴量のマッチング、パターンマッチング等により、撮像画像内において、推定する作物2を特定する。 Specifically, first, as shown in FIG. 10, when the agricultural robot 1 is caused to travel independently in the direction of travel to perform work on the crop 2 being cultivated in the cultivation site 105, the data extraction unit 85 refers to the sensing data H11 and identifies the crop 2 to be estimated. As shown in FIG. 11, the data extraction unit 85 determines whether the referenced sensing data H11 includes a part of the crop 2. If the sensing data H11 is a captured image, the crop 2 to be estimated is identified within the captured image by matching the feature amounts of the captured image, pattern matching, etc.

例えば、データ抽出部85は、撮像画像の所定範囲内の特徴量と予め用意された作物の画像における特徴量とを比較し、両者の特徴量が一致した場合、撮像画像の所定範囲内に作物2があると判断し、両者の特徴量が一致しない場合は、撮像画像の所定範囲内に作物2があると判断しない。
或いは、データ抽出部85は、予め用意された作物2の表面の模様、凸凹などを示す基準プロファイリングと、撮像画像の所定範囲内の画像プロファイリングとを比較し、基準プロファイリングと画像プロファイリングとが一致した場合は、撮像画像の所定範囲内に作物2等が含まれている判断し、基準プロファイリングと画像プロファイリングとが一致しなかった場合は、撮像画像の所定範囲内に作物2が含まれていないと判断する。
For example, the data extraction unit 85 compares the feature amounts within a specified range of the captured image with the feature amounts in a pre-prepared image of a crop, and if the two feature amounts match, it determines that a crop 2 is present within the specified range of the captured image, and if the two feature amounts do not match, it does not determine that a crop 2 is present within the specified range of the captured image.
Alternatively, the data extraction unit 85 compares a previously prepared reference profiling indicating the surface pattern, unevenness, etc. of the crop 2 with image profiling within a specified range of the captured image, and if the reference profiling and the image profiling match, it determines that the crop 2, etc. is included within the specified range of the captured image, and if the reference profiling and the image profiling do not match, it determines that the crop 2 is not included within the specified range of the captured image.

なお、センシングデータH11がスキャンデータである場合、データ抽出部85は、スキャンデータで描写した描写体が、作物2であるか否かを判断する。この場合、データ抽出部85は、描写体の所定範囲内のデータプロファイリングと、基準プロファイリングとを比較し、基準プロファイリングとデータプロファイリングとが一致した場合は、スキャンデータ内に作物2が含まれていると判断し、基準プロファイリングとデータプロファイリングとが一致しなかった場合は、スキャンデータ内に作物2が含まれていないと判断する。 When the sensing data H11 is scan data, the data extraction unit 85 determines whether the depicted object depicted in the scan data is crop 2. In this case, the data extraction unit 85 compares data profiling within a specified range of the depicted object with reference profiling, and if the reference profiling and the data profiling match, it determines that crop 2 is included in the scan data, and if the reference profiling and the data profiling do not match, it determines that crop 2 is not included in the scan data.

つまり、データ抽出部85は、撮像画像の特徴量のマッチング、パターンマッチング、描写体のパターンマッチングなどによって、センシングデータH11に作物2が存在するか否かを判断し、作物2が存在すると判断した場合に、存在すると判断した作物2を特定する。
図11、図12に示すように、データ抽出部85は、センシングデータH11のうち特定した作物2(特定作物2a)の周囲を、部分データH13として抽出する。言い換えれば、センシングされた対象物(センシングデータH11から得られた撮像画像、描写体)において、特定した作物2(特定作物2a)の周囲に対応する部分(部分画像)H16を抽出する。
In other words, the data extraction unit 85 determines whether or not a crop 2 is present in the sensing data H11 by matching the features of the captured image, pattern matching, pattern matching of the depicted object, etc., and if it determines that a crop 2 is present, identifies the crop 2 that is determined to be present.
11 and 12, the data extraction unit 85 extracts the periphery of the specified crop 2 (specific crop 2a) from the sensing data H11 as partial data H13. In other words, a portion (partial image) H16 corresponding to the periphery of the specified crop 2 (specific crop 2a) is extracted from the sensed object (captured image, depicted object obtained from the sensing data H11).

次に、推定部86は、データ抽出部85によって抽出した部分データH13(部分画像H16)から得られた特定作物2aの表面状態から特定作物2aの種類などを推定する。
具体的には、図13に示すように、推定部86は、作物2の種類と、作物2の表面状態とを学習したモデル(表面状態モデル)を用いて、部分データH13の特定作物2の種類を推定する。表面状態モデルは、数多くの作物2の表面状態と作物2の種類とが関連付けられた作物表面情報を、コンピュータに入力し、当該コンピュータにおいて、人工知能(AI)による深層学習を実行し、学習済みモデルを構築したものである。
Next, the estimation unit 86 estimates the type of the specific crop 2 a from the surface condition of the specific crop 2 a obtained from the partial data H 13 (partial image H 16 ) extracted by the data extraction unit 85 .
13, the estimation unit 86 estimates the type of the specific crop 2 of the partial data H13 using a model (surface condition model) that has learned the type of crop 2 and the surface condition of the crop 2. The surface condition model is constructed by inputting crop surface information, in which the surface conditions of many crops 2 are associated with the type of crop 2, into a computer and executing deep learning using artificial intelligence (AI) in the computer.

表面状態モデルでは、特定作物2aの表面状態として、部分データH13(部分画像H16)から得られた特定作物2aの模様から作物2の種類を推定する。例えば、図14A~図14Cに示すように、表面状態モデルは、特定作物2aの表面において、模様(図柄)を構成する線W11の間隔、線W11の角度、線W11の繋がり、線W11の形状、線W11の配列パターンから、特定作物2の種類を推定する。 The surface condition model estimates the type of crop 2 from the pattern of the specific crop 2a obtained from the partial data H13 (partial image H16) as the surface condition of the specific crop 2a. For example, as shown in Figures 14A to 14C, the surface condition model estimates the type of specific crop 2 from the spacing of the lines W11 that make up the pattern (design) on the surface of the specific crop 2a, the angle of the lines W11, the connections between the lines W11, the shape of the lines W11, and the arrangement pattern of the lines W11.

また、推定部86は、特定作物2の種類を推定した推定結果に基づいて、部分データH13(部分画像H16)に含まれる特定作物2の輪郭R10を演算する。例えば、特定作
物2の推定結果(例えば、作物2の種類)から、推定部86は、作物2の輪郭R10の基本形状(円形、四角、楕円形)、基準サイズL10を参照する。また、図14Aに示すように、推定部86は、例えば、部分データH13(部分画像H16)において、特定作物2の模様を構成する線W11のうち、直線状の線W11aを抽出する。ここで、推定部86は、線W11aの両端部W11bを部分データH13(部分画像H16)から得ることができた場合、線W11aの両端部W11bを通る円形状又は楕円形状の線を、特定作物2の輪郭R10とする。
The estimation unit 86 also calculates the contour R10 of the specific crop 2 included in the partial data H13 (partial image H16) based on the estimation result of the type of the specific crop 2. For example, the estimation unit 86 refers to the basic shape (circle, square, ellipse) and reference size L10 of the contour R10 of the crop 2 from the estimation result of the specific crop 2 (e.g., the type of crop 2). Also, as shown in FIG. 14A , the estimation unit 86 extracts, for example, a straight line W11a from the lines W11 constituting the pattern of the specific crop 2 in the partial data H13 (partial image H16). Here, when the estimation unit 86 can obtain both ends W11b of the line W11a from the partial data H13 (partial image H16), the estimation unit 86 determines the circular or elliptical line passing through both ends W11b of the line W11a as the contour R10 of the specific crop 2.

図14Bに示すように、推定部86は、線W11aの一方の端部W11bを抽出した場合、一方の端部W11bから基準サイズの1/2の位置を、特定作物2の中心O10とし、中心O10から基準サイズの1/2を特定作物2の半径R1として、一方の端部W11aを通り且つ半径R1の円形状の線を、特定作物2の輪郭R10とする。
図14Cに示すように、推定部86は、線W11の端部W11bが部分データH13(部分画像H16)で構成する抽出画像枠に達している場合、抽出画像枠の特定作物2の模様から特定作物2の中心O10を推定し、半径R1の円形状の線を、特定作物2の輪郭R10とする。
As shown in FIG. 14B , when the estimation unit 86 extracts one end W11b of the line W11a, it determines the position 1/2 of the reference size from the one end W11b to be the center O10 of the specific crop 2, and determines the radius R1 of the specific crop 2 to be 1/2 of the reference size from the center O10, and determines the circular line that passes through the one end W11a and has a radius R1 to be the contour R10 of the specific crop 2.
As shown in FIG. 14C , when the end W11b of the line W11 reaches the extracted image frame formed by the partial data H13 (partial image H16), the estimation unit 86 estimates the center O10 of the specific crop 2 from the pattern of the specific crop 2 in the extracted image frame, and regards the circular line of radius R1 as the contour R10 of the specific crop 2.

なお、図14A~図14Cは一例であり、表面状態モデルが作物2の模様等から作物の種類だけでなく、作物の大きさを推定してもよい。
さらに、図14A~図14Cに示すように、推定部86は、部分データH13(部分画像H16)で得られた作物2の周囲に関して推定した作物2の表面を隠す障害物W20を推定してもよい。図14A~図14Cに示すように、例えば、推定部86は、作物2の表面において表面状態モデルが作物2の表面の模様と判断した以外の部分W21を抽出し、部分W21において、特定作物2の輪郭R10と重複する部分が、障害物W20の一部であると判断し、障害物W20の全体の輪郭W22を画像処理等により抽出する。
14A to 14C are merely examples, and the surface condition model may estimate not only the type of crop but also the size of the crop from the pattern of the crop 2, etc.
14A to 14C, the estimation unit 86 may estimate an obstacle W20 that hides the surface of the crop 2 estimated with respect to the periphery of the crop 2 obtained from the partial data H13 (partial image H16). As shown in Fig. 14A to 14C, for example, the estimation unit 86 extracts a portion W21 on the surface of the crop 2 other than the portion determined by the surface condition model to be the pattern on the surface of the crop 2, determines that a portion of the portion W21 that overlaps with the contour R10 of the specific crop 2 is part of the obstacle W20, and extracts an entire contour W22 of the obstacle W20 by image processing or the like.

上述したように、推定部86が障害物W20の全体の輪郭W22を抽出、即ち、障害物W20を推定した場合、農業用ロボット1は、作物2の収穫時などに、障害物W20を作物2から遠ざける作業を行う。図15に示すように、作業制御部41Bは、マニピュレータ(作業部)4(ロボットハンド18)の収穫時の制御において、ロボットハンド18の先端を障害物W20に近づけ、ロボットハンド18の一部を障害物W20に当接し、先端部を当接させた状態でロボットハンド18を、障害物W20が作物2の表面から遠ざかる方向に移動させる。つまり、ロボットハンド18は、作物2の収穫時に、障害物W20を遠ざける動作する。 As described above, when the estimation unit 86 extracts the entire contour W22 of the obstacle W20, i.e., estimates the obstacle W20, the agricultural robot 1 performs an operation to move the obstacle W20 away from the crop 2 when harvesting the crop 2, etc. As shown in FIG. 15, in controlling the manipulator (working unit) 4 (robot hand 18) during harvesting, the operation control unit 41B brings the tip of the robot hand 18 close to the obstacle W20, abuts a part of the robot hand 18 against the obstacle W20, and, with the tip abutted, moves the robot hand 18 in a direction in which the obstacle W20 moves away from the surface of the crop 2. In other words, the robot hand 18 operates to move the obstacle W20 away when harvesting the crop 2.

上述した実施形態では、農業用ロボット1が学習済みモデル(表面状態モデル)を有していることについて説明したが、図8に示すように、農業用ロボット1は、表面状態モデルを生成するモデル生成部41Jを備えていてもよい。モデル生成部41Jは、制御装置41に設けられた電気電子回路、当該制御装置41に格納されたプログラム等である。 In the above embodiment, the agricultural robot 1 has been described as having a trained model (surface condition model), but the agricultural robot 1 may also be provided with a model generation unit 41J that generates a surface condition model, as shown in Fig . 8. The model generation unit 41J is an electric/electronic circuit provided in the control device 41, a program stored in the control device 41, etc.

まず、農業用ロボット1が作物2の収穫を行う際、制御装置41は、光学式センサ5A又は光学式センサ5Bにて、作物2の表面をセンシングしたセンシングデータ(作物2の表面のデータ)を取得する。制御装置41は、作物2の収穫を行う毎に、作物2の表面のデータを取得し、データベース化して記憶する。モデル生成部41Jは、制御装置41が取得した数多くの作物2の表面のデータを、深層学習することによって、表面状態モデルを構築する。なお、モデル生成部41Jは、表面状態モデルの構築後も作物2の収穫を行う毎に、制御装置41から作物2の表面のデータを取得して、強化学習を続ける。 First, when the agricultural robot 1 harvests the crop 2, the control device 41 acquires sensing data (surface data of the crop 2) obtained by sensing the surface of the crop 2 with the optical sensor 5A or the optical sensor 5B. The control device 41 acquires surface data of the crop 2 each time the crop 2 is harvested, and stores the data in a database. The model generation unit 41J constructs a surface condition model by deep learning the numerous surface data of the crop 2 acquired by the control device 41. Note that even after the construction of the surface condition model, the model generation unit 41J continues reinforcement learning by acquiring surface data of the crop 2 from the control device 41 each time the crop 2 is harvested.

農業用ロボット1は、走行体3と、走行体3に設けられ、作物2に関する作業を行う作業部4と、走行体3に設けられた光学式センサ5A、5Bと、光学式センサ5A、5Bで得られたセンシングデータに基づいて、作物2を推定する作物推定部41Iと、を備え、作物推定部41Iは、センシングデータに基づいて推定する作物2を特定し且つセンシングデータのうち特定した作物2に対応するデータを部分データH13として抽出するデータ抽出部85と、データ抽出部85によって抽出した部分データH13から得られた作物2の表面状態から作物2を推定する推定部86と、を有している。これによれば、センシ
ングデータから作物2を特定した後に、特定した作物2に対応するデータを部分データH13として抽出後、さらに、抽出した部分データH13の表面状態から作物2を推定するようにすることで、より効率良く精密に作物2を推定することができる。即ち、センシングデータから簡単に作物を推定することができる。
The agricultural robot 1 includes a traveling body 3, a working unit 4 provided on the traveling body 3 and performing work on the crop 2, optical sensors 5A and 5B provided on the traveling body 3, and a crop estimation unit 41I that estimates the crop 2 based on sensing data obtained by the optical sensors 5A and 5B, and the crop estimation unit 41I includes a data extraction unit 85 that identifies the crop 2 to be estimated based on the sensing data and extracts data corresponding to the identified crop 2 from the sensing data as partial data H13, and an estimation unit 86 that estimates the crop 2 from the surface condition of the crop 2 obtained from the partial data H13 extracted by the data extraction unit 85. According to this, after identifying the crop 2 from the sensing data, data corresponding to the identified crop 2 is extracted as partial data H13, and the crop 2 is further estimated from the surface condition of the extracted partial data H13, so that the crop 2 can be estimated more efficiently and accurately. That is, the crop can be easily estimated from the sensing data.

推定部86は、部分データH13で示された作物2に関し、作物2の種類と作物2の表面状態とに基づいて、作物2を推定する。これによれば、作物2の種類によって表面状態が異なることから、当該作物2の種類と表面状態とによって作物2を推定するようにすることで、より正確に作物2について推定することができる。特に、作物2の表面が障害物W20に覆い隠されていて、作物2の一部しか表面状態が分からない場合であっても、作物2の種類と表面状態との関係に基づいて、作物2が何であるかを簡単に推定することができる。 The estimation unit 86 estimates the crop 2 indicated by the partial data H13 based on the type of crop 2 and the surface condition of the crop 2. Since the surface condition differs depending on the type of crop 2, by estimating the crop 2 based on the type and surface condition of the crop 2, it is possible to more accurately estimate the type of crop 2. In particular, even if the surface of the crop 2 is obscured by an obstacle W20 and only part of the surface condition of the crop 2 is known, it is possible to easily estimate what the crop 2 is based on the relationship between the type of crop 2 and the surface condition.

推定部86は、作物2の表面状態として作物2の模様と、作物2の種類とに基づいて、作物2を推定する。これによれば、作物2の種類によって模様が異なることを用いて、作物2を簡単に推定することができる。
推定部86は、推定した作物2の推定結果に基づいて、部分データH13に含まれる作物2の輪郭W22を演算する。これによれば、例えば、作物2の推定結果が作物2の種類である場合、作物2の種類に対応した大きさと、部分データH13とによって、簡単に作物2の輪郭W22を求めることができる。
The estimation unit 86 estimates the crop 2 based on the pattern of the crop 2 as the surface state of the crop 2 and the type of the crop 2. In this way, the crop 2 can be easily estimated by utilizing the fact that the pattern differs depending on the type of the crop 2.
The estimation unit 86 calculates a contour W22 of the crop 2 included in the partial data H13 based on the estimated result of the crop 2. According to this, for example, when the estimated result of the crop 2 is the type of the crop 2, the contour W22 of the crop 2 can be easily obtained from the size corresponding to the type of the crop 2 and the partial data H13.

推定部86は、作物2の種類を推定し且つ、部分データH13で得られた作物2の周囲に関して推定した作物2の表面を隠す障害物W20を推定する。これによれば、簡単に障害物W20の輪郭を推定することができ、どれくらいの大きさの障害物W20によって作物2の表面が覆われていたかを把握することができる。
作業部4は、推定部86で推定した障害物W20を、作物2から遠ざける作業を行う。これによれば、農業用ロボット1によって作物2に対して作業を行う場合に、作業に邪魔な障害物W20を作物2から遠ざけることができ、作業を効率よく行うことができる。例えば、作業が収穫である場合には、障害物W20を除いたうえで、作業部4によって収穫を行うことができる。また、作業が作物2に打撃を加える場合、打撃時の音を収集する場合なども、障害物W20を除いたうえで、作物2に打撃を加える等の作業を行うことができる。
The estimation unit 86 estimates the type of the crop 2, and estimates an obstacle W20 that conceals the surface of the crop 2 estimated with respect to the periphery of the crop 2 obtained from the partial data H13. This makes it possible to easily estimate the contour of the obstacle W20, and to grasp the size of the obstacle W20 that is covering the surface of the crop 2.
The working unit 4 performs an operation to move the obstacle W20 estimated by the estimation unit 86 away from the crop 2. As a result, when the agricultural robot 1 performs an operation on the crop 2, the obstacle W20 that gets in the way of the operation can be moved away from the crop 2, and the operation can be performed efficiently. For example, when the operation is harvesting, the obstacle W20 can be removed before harvesting is performed by the working unit 4. Also, when the operation is striking the crop 2 and collecting the sound of the striking, the obstacle W20 can be removed before striking the crop 2, or the like.

農業用ロボット1は、作物2と作物2の表面状態との関係を、深層学習することで表面状態モデルを生成するモデル生成部41Jを備えている。これによれば、作物2と作物2の表面状態との関係を推定するモデルを簡単に作成することができる。
以上、本発明の一実施形態について説明したが、今回開示された実施の形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれることが意図される。
The agricultural robot 1 includes a model generation unit 41J that generates a surface condition model by deep learning of the relationship between the crop 2 and the surface condition of the crop 2. This makes it possible to easily create a model that estimates the relationship between the crop 2 and the surface condition of the crop 2.
Although one embodiment of the present invention has been described above, the embodiment disclosed herein should be considered as illustrative and not restrictive in all respects. The scope of the present invention is indicated by the claims, not the above description, and is intended to include all modifications within the meaning and scope of the claims.

1 :農業用ロボット
2 :作物
3 :走行体
4 :作業部
5A :光学式センサ
5B :光学式センサ
41I :作物推定部
41J :モデル生成部
85 :データ抽出部
86 :推定部
H11 :センシングデータ
H13 :部分データ
R10 :輪郭
W20 :障害物
W21 :部分
W22 :輪郭
1: Agricultural robot 2: Crop 3: Traveling body 4: Working unit 5A: Optical sensor 5B: Optical sensor 41I: Crop estimation unit 41J: Model generation unit 85: Data extraction unit 86: Estimation unit H11: Sensing data H13: Part data R10: Contour W20: Obstacle W21: Part W22: Contour

Claims (10)

走行体と、
前記走行体に設けられ、作物に関する作業を行う作業部と、
前記走行体に設けられた光学式センサと、
前記光学式センサで得られたセンシングデータに基づいて、前記作物を推定する作物推定部と、
を備え、
前記作物推定部は、前記センシングデータに基づいて前記推定する作物を特定し且つ前記センシングデータのうち前記特定した作物及び前記作物の表面を隠す障害物を含むデータを部分データとして抽出するデータ抽出部と、前記データ抽出部によって抽出した前記部分データにおいて前記障害物を除いて得られた前記作物の表面状態から作物を推定する推定部と、を有し
前記推定部は、前記作物の種類を推定し且つ、前記部分データで得られた前記作物の周囲に関して前記推定した作物の表面を隠す前記障害物を推定する農業用ロボット。
A running body,
A working unit provided on the traveling body and performing work on crops;
An optical sensor provided on the traveling body;
a crop estimation unit that estimates the crop based on sensing data obtained by the optical sensor;
Equipped with
The crop estimation unit includes a data extraction unit that identifies the crop to be estimated based on the sensing data and extracts data from the sensing data that includes the identified crop and an obstacle hiding a surface of the crop as partial data, and an estimation unit that estimates the crop from a surface state of the crop obtained by excluding the obstacle in the partial data extracted by the data extraction unit ,
The agricultural robot , wherein the estimation unit estimates the type of the crop and estimates the obstacles that hide the estimated surface of the crop in relation to the surroundings of the crop obtained from the partial data.
前記推定部は、前記作物の表面において当該作物の表面の模様と判断した以外の部分を抽出し、当該部分において、前記作物の輪郭と重複する部分が、前記障害物の一部であると判断し、前記障害物の輪郭を画像処理により抽出する請求項1に記載の農業用ロボット。2. The agricultural robot according to claim 1, wherein the estimation unit extracts a portion of the surface of the crop other than the portion determined to be the pattern of the surface of the crop, determines that a portion of the extracted portion that overlaps with an outline of the crop is part of the obstacle, and extracts the outline of the obstacle by image processing. 前記推定部は、前記部分データで示された作物に関し、前記作物の種類と、前記障害物を除いて得られた前記作物の表面状態とに基づいて、前記作物を推定する請求項1又は2に記載の農業用ロボット。 3. The agricultural robot according to claim 1, wherein the estimation unit estimates the type of the crop indicated by the partial data based on the type of the crop and a surface condition of the crop obtained by removing the obstacle. 前記推定部は、前記障害物を除いて得られた前記作物の表面状態として前記作物の模様と、前記作物の種類とに基づいて、前記作物を推定する請求項に記載の農業用ロボット。 The agricultural robot according to claim 3 , wherein the estimation unit estimates the crop based on a pattern of the crop as a surface state of the crop obtained by removing the obstacle, and a type of the crop. 前記推定部は、前記推定した作物の推定結果に基づいて、前記部分データに含まれる前記作物の輪郭を演算する請求項又はに記載の農業用ロボット。 5. The agricultural robot according to claim 3 , wherein the estimation unit calculates an outline of the crop included in the partial data based on the estimated crop. 前記作業部は、前記推定部で推定した前記障害物を、前記作物から遠ざける作業を行う請求項1~5のいずれかに記載の農業用ロボット。 6. The agricultural robot according to claim 1, wherein the working unit performs a task of moving the obstacle estimated by the estimation unit away from the crop. 前記作物と前記作物の表面状態との関係を、深層学習することで表面状態モデルを生成するモデル生成部を備えている請求項2~6のいずれかに記載の農業用ロボット。 The agricultural robot according to any one of claims 2 to 6, further comprising a model generation unit that generates a surface condition model by deep learning of the relationship between the crop and the surface condition of the crop. 走行体と、A running body,
前記走行体に設けられ、作物に関する作業を行う作業部と、A working unit provided on the traveling body and performing work on crops;
前記走行体に設けられた光学式センサと、An optical sensor provided on the traveling body;
前記光学式センサで得られたセンシングデータに基づいて、前記作物を推定する作物推定部と、a crop estimation unit that estimates the crop based on sensing data obtained by the optical sensor;
を備え、Equipped with
前記作物推定部は、前記センシングデータに基づいて前記推定する作物を特定し且つ前記センシングデータのうち前記特定した作物及び前記作物の表面を隠す障害物を含むデータを部分データとして抽出するデータ抽出部と、前記データ抽出部によって抽出した前記部分データにおいて前記障害物を除いて得られた前記作物の表面状態から作物を推定する推定部と、を有し、The crop estimation unit includes a data extraction unit that identifies the crop to be estimated based on the sensing data and extracts data from the sensing data that includes the identified crop and an obstacle hiding a surface of the crop as partial data, and an estimation unit that estimates the crop from a surface state of the crop obtained by excluding the obstacle in the partial data extracted by the data extraction unit,
前記推定部は、前記推定した作物の推定結果に基づいて、前記部分データに含まれる前記作物の輪郭を演算し、The estimation unit calculates an outline of the crop included in the partial data based on the estimated crop outline,
前記推定部は、前記作物の種類を推定した推定結果に基づいて、前記部分データに含まれる前記作物の輪郭を、以下の(i)~(iii)のいずれかを用いて、The estimation unit estimates the outline of the crop included in the partial data based on an estimation result of the type of the crop, by using any one of the following (i) to (iii):
(i)前記作物の模様を構成する線のうち、前記作物の外縁にそれぞれ至る線の両端部を前記部分データから得ることができた場合、前記両端部を通る円形状又は楕円形状の線を、前記作物の輪郭とし、(i) when both ends of a line that constitutes the pattern of the crop and that reaches the outer edge of the crop can be obtained from the partial data, a circular or elliptical line that passes through both ends is determined to be the outline of the crop;
(ii)前記両端部のうちの一方の端部だけを抽出した場合、当該一方の端部から前記作物の基準サイズの1/2の位置を、前記作物の中心とし、前記中心から前記基準サイズの1/2を前記作物の半径として、前記一方の端部を通り且つ半径の円形状の線を、前記作物の輪郭とし、(ii) when only one of the two ends is extracted, a position that is 1/2 the reference size of the crop from the one end is set as the center of the crop, and a circular line that passes through the one end and has a radius of the crop that is 1/2 the reference size from the center is set as the contour of the crop;
(iii)前記線が前記部分データの抽出画像枠に達している場合、前記抽出画像枠の前記作物の模様から前記作物の中心を推定し、前記作物の基準サイズの1/2を前記作物の半径とし、当該推定した前記中心から前記半径の円形状の線を、前記作物の輪郭とする(iii) if the line reaches the extracted image frame of the partial data, the center of the crop is estimated from the pattern of the crop in the extracted image frame, half of the reference size of the crop is set as the radius of the crop, and a circular line of the estimated center and radius is set as the outline of the crop.
演算を行う農業用ロボット。An agricultural robot that performs calculations.
前記推定部は、前記作物の種類を推定した推定結果に基づいて、前記部分データに含まれる前記作物の輪郭を、以下の(i)~(iii)のいずれかを用いて、
(i)前記作物の模様を構成する線のうち、前記作物の外縁にそれぞれ至る線の両端部を前記部分データから得ることができた場合、前記両端部を通る円形状又は楕円形状の線を、前記作物の輪郭とし、
(ii)前記両端部のうちの一方の端部だけを抽出した場合、当該一方の端部から前記作物の基準サイズの1/2の位置を、前記作物の中心とし、前記中心から前記基準サイズの1/2を前記作物の半径として、前記一方の端部を通り且つ半径の円形状の線を、前記作物の輪郭とし、
(iii)前記線が前記部分データの抽出画像枠に達している場合、前記抽出画像枠の前記作物の模様から前記作物の中心を推定し、前記作物の基準サイズの1/2を前記作物の半径とし、当該推定した前記中心から前記半径の円形状の線を、前記作物の輪郭とする
演算を行う請求項に記載の農業用ロボット。
The estimation unit estimates the outline of the crop included in the partial data based on an estimation result of the type of the crop, by using any one of the following (i) to (iii):
(i) when both ends of a line that constitutes the pattern of the crop and that reaches the outer edge of the crop can be obtained from the partial data, a circular or elliptical line that passes through both ends is determined to be the outline of the crop;
(ii) when only one of the two ends is extracted, a position that is 1/2 the reference size of the crop from the one end is set as the center of the crop, and a circular line that passes through the one end and has a radius of the crop that is 1/2 the reference size from the center is set as the outline of the crop;
The agricultural robot according to claim 5, wherein the agricultural robot performs a calculation such that (iii) if the line reaches an extracted image frame of the partial data, a center of the crop is estimated from the pattern of the crop in the extracted image frame, a radius of the crop is set to half the reference size of the crop , and a circular line of the estimated center and radius is set to the outline of the crop.
前記データ抽出部は、予め用意された作物の表面の模様を示す基準プロファイリングと、前記センシングデータの所定範囲内の画像プロファイリングとが一致した場合は、前記センシングデータの所定範囲内に前記作物が含まれていると判断し、当該作物を前記推定する作物として特定し且つ前記センシングデータのうち前記特定した作物及び前記作物の表面を隠す障害物を含むデータを前記部分データとして抽出する請求項1~のいずれかに記載の農業用ロボット。 The agricultural robot of any one of claims 1 to 9, wherein the data extraction unit, when a previously prepared reference profiling indicating a surface pattern of a crop matches an image profiling within a specified range of the sensing data, determines that the crop is included within the specified range of the sensing data, identifies the crop as the estimated crop, and extracts data from the sensing data that includes the identified crop and an obstacle hiding the surface of the crop as the partial data.
JP2020109080A 2020-06-24 2020-06-24 Agricultural robots Active JP7471931B2 (en)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2020109080A JP7471931B2 (en) 2020-06-24 2020-06-24 Agricultural robots
PCT/JP2021/022292 WO2021261294A1 (en) 2020-06-24 2021-06-11 Agricultural robot
EP21829595.4A EP4173467A1 (en) 2020-06-24 2021-06-11 Agricultural robot
US17/990,825 US20230078003A1 (en) 2020-06-24 2022-11-21 Agricultural robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020109080A JP7471931B2 (en) 2020-06-24 2020-06-24 Agricultural robots

Publications (2)

Publication Number Publication Date
JP2022006699A JP2022006699A (en) 2022-01-13
JP7471931B2 true JP7471931B2 (en) 2024-04-22

Family

ID=80110784

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020109080A Active JP7471931B2 (en) 2020-06-24 2020-06-24 Agricultural robots

Country Status (1)

Country Link
JP (1) JP7471931B2 (en)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2000057129A1 (en) 1999-03-19 2000-09-28 Matsushita Electric Works, Ltd. Three-dimensional object recognition method and pin picking system using the method
WO2018211621A1 (en) 2017-05-17 2018-11-22 inaho株式会社 Agricultural work machine, agricultural work management system, and program

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2000057129A1 (en) 1999-03-19 2000-09-28 Matsushita Electric Works, Ltd. Three-dimensional object recognition method and pin picking system using the method
WO2018211621A1 (en) 2017-05-17 2018-11-22 inaho株式会社 Agricultural work machine, agricultural work management system, and program

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Inkyu Sa, Zongyuan Ge, Feras Dayoub, Ben Upcroft, Tristan Perez and Chris McCool,DeepFruits: A Fruit Detection System Using Deep Neural Networks,Sensors,2016年08月03日,Vol. 16, No. 8,1222
Yang-Yang Zheng, Jianlei Kong, Xue-bo Jin, Tingli Su, Ming-Jun Nie, and Yuting Bai,Real-Time Vegetables Recognition System based on Deep Learning Network for Agricultural Robots,2018 Chinese Automation Congress (CAC),2018年11月30日,pp. 2223 - 2228
佐藤治、高橋伸弥、横道政裕、福嶋浩紀,機械学習を用いたスイカ果実検出,第38回計測自動制御学会九州支部学術講演会予稿集,日本,公益社団法人計測自動制御学会九州支部,2019年11月30日,pp. 17 - 20

Also Published As

Publication number Publication date
JP2022006699A (en) 2022-01-13

Similar Documents

Publication Publication Date Title
Radcliffe et al. Machine vision for orchard navigation
JP6737535B2 (en) Robot vehicles and methods of using robots for automated processing of plant organisms
JP7321910B2 (en) agricultural robot
CN102239756B (en) Intelligent farming robot in greenhouse
WO2021261246A1 (en) Agricultural robot and assistance system for agricultural robot
EP3815510A1 (en) Plant removal apparatus and method
JP7191808B2 (en) Robot hands and agricultural robots
Yang et al. A review of core agricultural robot technologies for crop productions
KR20200095225A (en) An weed removal robot using image processor
JP7214612B2 (en) agricultural robot
JP7471931B2 (en) Agricultural robots
JP7408496B2 (en) agricultural robot
WO2021261294A1 (en) Agricultural robot
JP7494023B2 (en) Agricultural robots
JP7404169B2 (en) Agricultural robots and agricultural robot support systems
JP7225081B2 (en) agricultural robot
US20230292644A1 (en) Mobile autonomous agricultural system
JP2022006697A (en) Agricultural robot and support system of agricultural robot
JP7278931B2 (en) agricultural robot
Aasted et al. Autonomous mechanical thinning using scanning LIDAR
Vedula et al. Computer vision assisted autonomous intra-row weeder
JP7254687B2 (en) Robot hands and agricultural robots
CA3233366A1 (en) Autonomous robot platform for pest identification and control
CN218588066U (en) Agricultural robot
Pant et al. Agricultural Robots: The Needs And Limitations In Large Scale Commercialization

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220622

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230725

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230911

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20231121

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20240109

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

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20240312

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20240410

R150 Certificate of patent or registration of utility model

Ref document number: 7471931

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150