WO2018078880A1 - 自律走行車両 - Google Patents
自律走行車両 Download PDFInfo
- Publication number
- WO2018078880A1 WO2018078880A1 PCT/JP2016/082344 JP2016082344W WO2018078880A1 WO 2018078880 A1 WO2018078880 A1 WO 2018078880A1 JP 2016082344 W JP2016082344 W JP 2016082344W WO 2018078880 A1 WO2018078880 A1 WO 2018078880A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- chassis
- vehicle
- sensor
- time
- cover
- 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.)
- Ceased
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0055—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots with safety arrangements
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0227—Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/006—Control or measuring arrangements
- A01D34/008—Control or measuring arrangements for automated or remotely controlled operation
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/01—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus
- A01D34/412—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus having rotating cutters
- A01D34/63—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus having rotating cutters having cutters rotating about a vertical axis
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D2101/00—Lawn-mowers
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
- G05D1/0265—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using buried wires
Definitions
- This invention relates to an autonomous vehicle.
- a vehicle that includes a chassis and a cover that is displaceably mounted on the chassis and a sensor that generates an output that is proportional to the displacement between the chassis and a vehicle that autonomously travels with drive wheels attached to the chassis is known. Examples thereof include the technique described in Patent Document 1.
- This type of autonomous vehicle typically includes a contact sensor that detects contact with obstacles such as buildings, paving stones, animals, and humans, and a lift sensor that detects an upward lift of a cover from a chassis by a user, etc. It is comprised so that it may comprise.
- Patent Document 1 The technology described in Patent Document 1 is configured to reliably detect contact with an obstacle and a lift of a cover by providing two types of sensors as described above, but to provide two types of sensors. There is a disadvantage that the configuration becomes complicated.
- an object of the present invention is to provide an autonomously traveling vehicle that solves the above-mentioned inconveniences and detects contact with an obstacle and lift of a cover with a single sensor.
- the present invention includes a chassis, a cover that is displaceably attached to the chassis, a sensor that generates an output proportional to a displacement between the chassis and the cover, and a control that inputs the output of the sensor.
- the control unit determines whether or not the amount of change per predetermined time of the output of the sensor is equal to or greater than a threshold value.
- a time integration unit that integrates the time when the amount of change is determined to be greater than or equal to a threshold by the sensor output determination unit, and the time integrated by the time integration unit is compared with a predetermined time and compared with the predetermined time
- a determination unit that determines whether the vehicle has come into contact with an obstacle based on the result, or whether the cover has been lifted from the chassis.
- the autonomous traveling vehicle includes a chassis, a cover that is detachably attached to the chassis, a sensor that generates an output proportional to the displacement between the chassis and the cover, and a control unit that inputs the output of the sensor.
- the control unit is integrated with a sensor output determination unit that determines whether or not the amount of change of the sensor output per specified time is equal to or greater than a threshold value, and a time integration unit that integrates the time when the amount of change is determined to be equal to or greater than the threshold value.
- a determination unit that determines whether the vehicle has come into contact with an obstacle or whether the cover has been lifted from the chassis based on the comparison result.
- FIG. 1 It is a conceptual diagram which shows the autonomous traveling vehicle which concerns on embodiment of this invention generally. It is a top view of the autonomous traveling vehicle of FIG. It is explanatory drawing, such as a work area of the autonomous vehicle of FIG. It is typical sectional drawing of the attachment position vicinity of the contact / lift sensor of FIG. It is a flowchart which shows operation
- FIG. 1 is a conceptual diagram generally showing an autonomous traveling vehicle according to an embodiment of the present invention
- FIG. 2 is a top view of the autonomous traveling vehicle of FIG. 1
- FIG. 3 is a work area where the autonomous traveling vehicle of FIG. It is a top view.
- reference numeral 10 denotes an autonomous vehicle (hereinafter referred to as “vehicle”).
- vehicle 10 is specifically a lawnmower.
- the vehicle body 12 of the vehicle 10 includes a chassis (body frame) 12a and a cover 12b attached to the chassis so as to be displaceable.
- the vehicle 10 includes two relatively small left and right front wheels 14 fixed to the front side of the chassis 12a via a stay 12c in the front-rear direction, and a relatively large-diameter left and right side mounted directly on the chassis 12a on the rear side.
- a rear wheel 16 is provided.
- a working portion (blade, specifically, a rotary blade) 20 for lawn mowing work is attached near the central position of the chassis 12a of the vehicle 10, and an electric motor (prime motor; hereinafter referred to as "working motor") is mounted on the upper part. 22 is arranged.
- the working unit 20 is connected to the work motor 22 and is rotationally driven by the work motor 22.
- the working unit 20 is connected to a working unit height adjusting mechanism 24 that can be manually operated by the user.
- the working unit height adjusting mechanism 24 includes a handle that can be operated by the user, and is configured such that the vertical height of the working unit 20 from the ground contact surface GR can be adjusted by turning the handle by hand.
- the chassis 12a of the vehicle 10 is provided with two electric motors (prime movers; hereinafter referred to as “traveling motors”) 26L and 26R on the rear end side of the working unit 20.
- the travel motors 26L and 26R are connected to the left and right rear wheels 16, and are rotated forward (rotation in the forward direction) or reverse (rotation in the reverse direction) independently from each other with the front wheel 14 as the driven wheel and the rear wheel 16 as the drive wheel.
- the working unit 20, the work motor 22, the traveling motor 26, and the like are covered with a cover 12b.
- the vehicle 10 has a weight and dimensions that can be carried by the user, for example, a total length (front-rear direction length) of about 71 cm, a total width of about 55 cm, and a height of about 30 cm.
- An on-board charging unit 30 and an on-board battery (battery) 32 connected to the on-board charging unit 30 are stored in the rear portion of the vehicle 10, and a pair of battery charging terminals 34 are attached to the chassis 12a so as to protrude forward of the front end position. .
- the battery charging terminal 34 is connected to the on-board charging unit 30.
- the work motor 22 and the travel motor 26 are also connected to the on-board battery 32 and are energized from the on-board battery 32.
- two left and right magnetic sensors 36L and 36R are disposed on the front side of the vehicle body 12, and one magnetic sensor 36C is disposed on the rear side, and each indicates a magnetic field magnitude (magnetic field strength). Is output.
- the vehicle body 12 has a contact / lift for detecting that the vehicle 10 has come into contact with an obstacle such as a building, a paving stone, an animal, or a human, and that the cover 12b has been lifted upward from the chassis 12a by a user or the like.
- a sensor 40 is attached. The contact / lift sensor 40 will be described later.
- a storage box is provided near the central position of the chassis 12a.
- a microcomputer including a CPU, an I / O, a memory (ROM, EEPROM, RAM) and the like is provided on the circuit board 42 stored in the storage box.
- ECU Electronic Control Unit
- an angular velocity sensor 46 that generates an output indicating an angular velocity (yaw rate) around the z axis (gravity axis) of the center of gravity of the vehicle 10 in the vicinity of the ECU 44, and x, y acting on the vehicle 10.
- An acceleration sensor 50 that generates an output indicating the acceleration in the three orthogonal directions of the z axis
- an azimuth sensor 52 that generates an output indicating the absolute direction according to the geomagnetism
- a GPS sensor 54 is provided that produces an output indicative of
- wheel speed sensors 56 that generate outputs indicating the wheel speeds of the left and right rear wheels 16 are arranged.
- the on-board battery 32 is provided with a current sensor 62 that generates an output indicating the current consumption of the on-board battery 32.
- the vehicle 10 is provided with a main switch 64 that commands the start of work operation and an emergency stop switch 66 that commands an emergency stop so that the user can operate.
- the cover 12b is largely cut off on the upper surface, and an input device 68 such as a keyboard and a touch panel for inputting user commands and the like is provided there, and a display 70 is provided adjacent thereto.
- the input device 68 and the display 70 are connected to the ECU 44, and various information such as a work mode is displayed on the display 70 in accordance with an instruction from the ECU 44.
- the outputs of sensors such as the magnetic sensor 36, the contact / lift sensor 40, and the angular velocity sensor 46 and the outputs of switches such as the main switch 64 are sent to the ECU 44.
- the ECU 44 inputs these outputs, energizes the travel motor 26 from the mounted battery 32, and outputs a control value to control the operation of the travel motor 26 to control the travel of the vehicle 10.
- the ECU 44 detects (recognizes) a work area (work area) AR from the output of the magnetic sensor 36, and based on this, the work motor 22 is energized to work in the work area AR.
- the work area AR is partitioned by area wires (electric wires) 72 arranged at the periphery thereof.
- a charging station 74 for charging the on-board battery 32 of the vehicle 10 is arranged in the work area AR (the size of the vehicle 10 etc. is exaggerated in FIG. 3).
- a feature of the present invention is that the ECU 44 that receives the output of the contact / lift sensor 40 detects (determines) whether the vehicle 10 has come into contact with an obstacle or whether the cover 12b has been lifted from the chassis 12a. Will be described with reference to FIG.
- FIG. 4 is a schematic cross-sectional view of the vicinity of the attachment position of the contact / lift sensor 40.
- the contact / lift sensor 40 is disposed between a chassis 12a and a cover 12b attached to the chassis 12a via a locking member 12b1 so as to be displaceable.
- the contact / lift sensor 40 includes a magnetic body 40a disposed in the vicinity of the cover 12b,. And a detection unit 40b having a magnetically sensitive element such as a Hall effect element disposed in the chassis 12a. In the contact / lift sensor 40, the detection unit 40b generates an output proportional to the distance from the magnetic body 40a, in other words, the displacement between the chassis 12a and the cover 12b.
- the magnetic body 40a is made of a ferromagnetic material such as an iron material, and is disposed immediately below the cover 12b as shown in FIG.
- the detection unit 40b is housed and arranged in a case 40b2 that is fixed via a screw 40b1 at a position spaced apart from the magnetic body 40a by a predetermined distance.
- the chassis 12a and the cover 12b are made of a synthetic resin material.
- one contact / lift sensor 40 is arranged on each side of the axle line CL ⁇ b> 1 parallel to the traveling direction of the vehicle 10.
- the ECU 44 receives the output of the contact / lift sensor 40 and detects (determines) the contact with the obstacle or the lift of the cover 12b from the output of one type (one) of the contact / lift sensor 40 (that is, the ECU 44 It operates as an output determination unit, a time integration unit, and a determination unit described later).
- FIG. 5 is a flowchart showing the operation.
- the illustrated program is executed in the ECU 44 at a predetermined time, for example, every ⁇ 0.
- the mode (MODE) is set as the work mode in S10 (S: processing step).
- the vehicle 10 includes a work mode in which the mowing work is recognized in the work area AR recognized by detecting the magnetic field generated by energizing the area wire 72 by the magnetic sensor 36, and the charging disposed there The operation is performed in one of the feedback modes in which the battery pack 32 is charged by returning to the station 74.
- a work mode in which the mowing work is recognized in the work area AR recognized by detecting the magnetic field generated by energizing the area wire 72 by the magnetic sensor 36, and the charging disposed there The operation is performed in one of the feedback modes in which the battery pack 32 is charged by returning to the station 74.
- the process proceeds to S12, where it is confirmed again that the mode is the work mode.
- the “sensor ON time” means that the amount of change per specified time in the output of the contact / lift sensor 40 is equal to or greater than a threshold value.
- the sensor ON time means a time during which the cover 12b in the vehicle 10 continues to receive (continues to receive) a displacement greater than a threshold per prescribed time with respect to the chassis 12a.
- the process proceeds to S24, and it is determined whether the sensor ON time is equal to or longer than ⁇ 1 (first predetermined time) and less than ⁇ 2 (second predetermined time, ⁇ 0 ⁇ 1 ⁇ ⁇ 2). To do.
- the program proceeds to S26, in which it is determined that the vehicle 10 has come into contact with an obstacle.
- the external force acting on the cover 12b when the vehicle 10 comes into contact with an obstacle is expected to be a relatively short time.
- the cover 12b is lifted from the chassis 12a, it is lifted artificially and is relatively long. Expected time.
- the contact with the obstacle and the lift of the cover can be effectively determined (detected) by one type (one) of the sensors 40. it can.
- the vehicle 10 includes a work machine (blade) 20 connected to an output shaft of a work motor (prime mover) 22 mounted on the chassis 12a.
- a work machine blade
- a work motor primary mover
- the chassis 12a the cover 12b that is displaceably attached to the chassis 12a, and a sensor (contact / lift sensor) that generates an output proportional to the displacement between the chassis 12a and the cover 12b.
- a sensor contact / lift sensor
- the control unit determines whether or not the change amount per specified time of the output of the sensor is equal to or greater than a threshold value, and the change amount is equal to or greater than the threshold value by the sensor output determination unit.
- the predetermined time includes a first predetermined time and a second predetermined time that is longer than the first predetermined time, and the determination unit determines that the accumulated time is greater than or equal to the first predetermined time and the second predetermined time.
- the time is less than the time, it is determined that the vehicle has contacted the obstacle (S24, S26), and when the accumulated time is equal to or longer than the second predetermined time, it is determined that the cover is lifted from the chassis ( (S28, S30), the contact with the obstacle and the lift of the cover 16b can be detected with high accuracy by one type of sensor 40.
- a work unit (blade) 20 connected to an output shaft of a prime mover (work motor) 22 mounted on the chassis 12a is provided, and the determination unit determines that the vehicle 10 has come into contact with an obstacle.
- the avoidance operation can be quickly performed because the avoidance operation with the obstacle is performed without stopping the prime mover.
- a working unit (blade) 20 connected to an output shaft of a prime mover (working motor) 22 mounted on the chassis 12a is provided, and the determination unit determines that the cover 12b is lifted from the chassis 12a. At this time, since the prime mover is configured to stop, energy consumption can be saved in addition to the effects described above.
- the sensor 40 includes a magnetic body 40a disposed in the vicinity of the cover 12b and a detection unit 40b having a magnetic sensitive element disposed in the chassis 12a, and an axle line parallel to the traveling direction of the vehicle 10 Since it is configured to be arranged on both sides of CL1, in addition to the above-described effects, the configuration can be simplified as one type (one) sensor.
- the autonomous traveling vehicle that autonomously travels while detecting the magnetic field of the area wire 72 arranged at the periphery of the work area AR as the vehicle 10 is exemplified, but the vehicle 10 is limited to such an autonomous traveling vehicle. It is not a thing.
- vehicle 10 is applied to a lawn mowing vehicle
- present invention is not limited to this, and can be applied to other autonomous traveling vehicles capable of autonomous traveling.
- a magnetoelectric conversion element for example, a Hall effect element is used as the detection element of the detection unit 40b
- the present invention is not limited thereto, and any element can be used as long as it can detect a physical displacement with respect to the magnetic body 40a. It may be.
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental Sciences (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
シャシとカバーの間の変位に比例する出力を生じるセンサ(接触・リフトセンサ)とそのセンサの出力を入力する制御部とを備える自律走行車両において、制御部が、センサの出力の規定時間当たりの変化量が閾値以上か否か判断し(S14)、変化量が閾値以上と判断された時間を積算すると共に(S16)、算された時間を所定時間(第1所定時間、第2所定時間)と比較し、所定時間との比較結果に基づいて車両が障害物と接触したか、あるいはカバーが前記シャシからリフトされたかを判定する(S22からS30)ように構成される。
Description
この発明は自律走行車両に関する。
自律走行車両として、シャシとシャシに変位可能に取り付けられるカバーと、シャシとカバーの間の変位に比例する出力を生じるセンサとを備え、シャシに取り付けられた駆動輪で自律走行する車両は知られており、その例として特許文献1記載の技術を挙げることができる。
この種の自律走行車両は、通例、建造物、敷石、動物、人間などの障害物との接触を検出する接触センサと、ユーザなどによるカバーのシャシからの上方へのリフトを検出するリフトセンサとを備えるように構成される。
特許文献1記載の技術は上記のように2種のセンサを備えることで障害物との接触とカバーのリフトとを確実に検出するように構成しているが、2種のセンサを備えるために構成が複雑となる不都合があった。
従って、この発明の課題は上記した不都合を解消し、1種のセンサで障害物との接触とカバーのリフトとを検出するようにした自律走行車両を提供することにある。
上記した課題を解決するため、この発明は、シャシと前記シャシに変位可能に取り付けられるカバーと、前記シャシとカバーの間の変位に比例する出力を生じるセンサと、前記センサの出力を入力する制御部とを備えると共に、前記シャシに取り付けられた駆動輪で自律走行する自律走行車両において、前記制御部が、前記センサの出力の規定時間当たりの変化量が閾値以上か否か判断するセンサ出力判断部と、前記センサ出力判断部によって前記変化量が閾値以上と判断された時間を積算する時間積算部と、前記時間積算部で積算された時間を所定時間と比較し、前記所定時間との比較結果に基づいて前記車両が障害物と接触したか、あるいは前記カバーが前記シャシからリフトされたかを判定する判定部とを備える如く構成した。
この発明に係る自律走行車両にあっては、シャシとそれに変位可能に取り付けられるカバーと、シャシとカバーの間の変位に比例する出力を生じるセンサと、センサの出力を入力する制御部とを備えると共に、制御部が、センサの出力の規定時間当たりの変化量が閾値以上か否か判断するセンサ出力判断部と、変化量が閾値以上と判断された時間を積算する時間積算部と、積算された時間を所定時間と比較し、その比較結果に基づいて車両が障害物と接触したか、あるいはカバーが前記シャシからリフトされたかを判定する判定部とを備える如く構成したので、1種のセンサで障害物との接触とカバーのリフトとを検出することができ、2種のセンサを必要とする場合に比し、構成を簡易にすることができる。
図1はこの発明の実施形態に係る自律走行車両を全体的に示す概念図、図2は図1の自律走行車両の上面図、図3は図1の自律走行車両が自律走行する作業エリアの平面図である。
図1などにおいて符号10は自律走行車両(以下「車両」という)を示す。車両10は具体的には芝刈り機からなる。車両10の車体12はシャシ(車体フレーム)12aとシャシに変位可能に取り付けられるカバー12bとからなる。
車両10は、前後方向においてシャシ12aの前側にステー12cを介して固定される比較的小径の左右2個の前輪14を備えると共に、後側にシャシ12aに直接取り付けられる比較的大径の左右の後輪16を備える。
車両10のシャシ12aの中央位置付近には芝刈り作業用の作業部(ブレード、具体的にはロータリブレード)20が取り付けられると共に、その上部には電動モータ(原動機。以下「作業モータ」という)22が配置される。作業部20は作業モータ22に接続され、作業モータ22によって回転駆動される。
作業部20にはユーザの手動操作自在な作業部高さ調節機構24が連結される。作業部高さ調節機構24はユーザの操作可能なハンドルを備え、ユーザがそのハンドルを手で廻すことで作業部20の接地面GRからの上下方向の高さが調節可能に構成される。
車両10のシャシ12aには、作業部20の後端側で2個の電動モータ(原動機。以下「走行モータ」という)26L,26Rが取り付けられる。走行モータ26L,26Rは左右の後輪16に接続され、前輪14を従動輪、後輪16を駆動輪として左右独立に正転(前進方向への回転)あるいは逆転(後進方向への回転)させる。作業部20と作業モータ22と走行モータ26などはカバー12bで被覆される。
この実施形態において、車両10はユーザが運搬可能な重量と寸法を有し、例えば全長(前後方向長さ)71cm程度、全幅55cm程度、高さ30cm程度の寸法を有する。
車両10の後部には搭載充電ユニット30とそれに接続される搭載電池(バッテリ)32とが格納されると共に、シャシ12aには一対の電池充電端子34が前端位置の前方に突出するように取り付けられる。電池充電端子34は搭載充電ユニット30に接続される。作業モータ22と走行モータ26も搭載電池32に接続され、搭載電池32から通電される。
車両10において車体12の前側には左右2個の磁気センサ36L,36Rが配置されると共に、後側には1個の磁気センサ36Cが配置され、それぞれ磁界の大きさ(磁界強度)を示す信号を出力する。
また、車体12には、車両10が建造物、敷石、動物、人間などの障害物と接触したことと、ユーザなどによってカバー12bがシャシ12aから上方にリフトされたこととを検出する接触・リフトセンサ40が取り付けられる。接触・リフトセンサ40については後述する。
シャシ12aの中央位置付近には収納ボックスが設けられると共に、その内部に収納された回路基板42上にはCPUと、I/Oと、メモリ(ROM,EEPROM,RAM)などを備えたマイクロコンピュータからなる電子制御ユニット(Electronic Control Unit。制御部。以下「ECU」という)44が搭載される。
また、回路基板42上には、ECU44に近接して車両10の重心位置のz軸(重力軸)回りの角速度(ヨーレート)を示す出力を生じる角速度センサ46と、車両10に作用するx,y,z軸の直交3軸方向の加速度を示す出力を生じる加速度センサ50と、地磁気に応じた絶対方位を示す出力を生じる方位センサ52と、GPS衛星からの電波を受信して車両10の現在位置を示す出力を生じるGPSセンサ54が設けられる。
また、車両10の左右の後輪16の付近には左右の後輪16の車輪速を示す出力を生じる車輪速センサ56が配置される。搭載電池32には搭載電池32の消費電流を示す出力を生じる電流センサ62が配置される。
また、車両10には、作業の動作開始などを指令するメインスイッチ64と非常停止を指令する非常停止スイッチ66がユーザの操作自在に設けられる。さらに、カバー12bは上面で大きく切り欠かれてそこにユーザの指令などの入力のためのキーボードやタッチパネルなどの入力機器68が設けられると共に、それに隣接してディスプレイ70が設けられる。入力機器68とディスプレイ70はECU44に接続され、ディスプレイ70にはECU44の指令に応じて作業モードなどの各種の情報が表示される。
磁気センサ36、接触・リフトセンサ40、角速度センサ46などのセンサ類の出力とメインスイッチ64などのスイッチ類の出力はECU44に送られる。ECU44は、それらの出力を入力し、搭載電池32から走行モータ26に通電すると共に、制御値を出力して走行モータ26の動作を制御することで車両10の走行を制御する。
また、ECU44は磁気センサ36の出力から作業エリア(作業領域)ARを検出(認識)し、それに基づいて作業モータ22に通電して作業エリアARで作業する。
図3に示す如く、作業エリアARは、その周縁の配置されるエリアワイヤ(電線)72によって区画される。作業エリアARには車両10の搭載電池32を充電するための充電ステーション74が配置される(図3では車両10などの大きさを誇張して示す)。
この発明の特徴は接触・リフトセンサ40の出力を入力するECU44において車両10が障害物と接触したか、あるいはカバー12bがシャシ12aからリフトされたかを検出(判定)することにあるので、以下それについて図4以降を参照して説明する。
最初に接触・リフトセンサ40について説明する。図4は接触・リフトセンサ40の取り付け位置付近の模式的な断面図である。
図示の如く、この実施形態に係る接触・リフトセンサ40は、シャシ12aとシャシ12aに係止部材12b1を介して変位可能に取り付けられるカバー12bの間に配置される。
より具体的には、接触・リフトセンサ40は、カバー12bの付近に配置される磁性体40aと.シャシ12aに配置されるホール効果素子などの磁気感応素子を有する検出部40bとからなる。接触・リフトセンサ40において検出部40bは、磁性体40aとの距離、換言すればシャシ12aとカバー12bの間の変位に比例する出力を生じる。
磁性体40aは鉄材などの強磁性の素材からなると共に、図1に示す如く、カバー12bの直下に配置される。検出部40bは磁性体40aから所定距離離間した位置にねじ40b1を介して固定されるケース40b2に収納されて配置される。尚、シャシ12aとカバー12bは合成樹脂材からなる。
図2に示す如く、接触・リフトセンサ40は車両10の進行方向に平行な車軸線CL1の両側に1個ずつ配置される。
ECU44は接触・リフトセンサ40の出力を入力し、1種(1個)の接触・リフトセンサ40の出力から障害物との接触あるいはカバー12bのリフトを検出(判定)する(即ち、ECU44は、後述する出力判断部、時間積算部、判定部として動作する)。
図5はその動作を示すフロー・チャートである。図示のプログラムはECU44において所定時間、例えばτ0ごとに実行される。
以下説明すると、S10(S:処理ステップ)においてモード(MODE)を作業モードとする。
この実施形態に係る車両10は、エリアワイヤ72への通電で発生される磁界を磁気センサ36で検出することで認識される作業エリアARにおいて芝刈り作業する作業モードと、そこに配置される充電ステーション74に帰還して搭載電池32を充電する帰還モードのいずれかで動作する。尚、それ以外に後述する障害物と接触したと判定されたときの障害物回避モードとカバー12bがリフトされたと判定されたときのリフト検出モードも有する。
次いでS12に進み、モードが作業モードであることを再び確認し、S14に進み、センサON時間か否か判断する。ここで「センサON時間」は接触・リフトセンサ40の出力の規定時間当たりの変化量が閾値以上の状態にあることを意味する。
即ち、車両10は芝生などの不整地を走行することから、接地面から常に振動を受けるため、カバー12bとシャシ12aの間には変位させようとする外力が定常的に作用する。そこで、予め実験を通じてセンサ出力の規定時間当たりの変化量の閾値を求めておき、それと比較することで、そのような定常的な外力を排除するようにした。
S14で肯定されるときはS16に進み、センサON時間をカウントアップ(積算)する一方、否定されるときはS18に進んでセンサON時間を0にリセットし、S20に進んでモードを作業モードとし、以降の処理をスキップする。
次回以降のプログラムループにおいてもS14で肯定されてS16と進んだ後、S22に進み、カウントアップされたセンサON時間がτ1(第1所定時間。τ0<τ1)未満か否か判断する。図示のプログラムはτ0ごとにループすることから、S16をループ度にτ0ずつ時間がカウントアップされるが、最初のループでは当然に肯定されて以降の処理を終了する。
尚、S14で一旦肯定されてS16に進み、センサON時間がカウントアップされた後も、次回以降のプログラムループでS14において否定されるときはS18においてそれまでにカウントアップされたセンサON時間は全てキャンセルされる。
このように、センサON時間は、車両10においてカバー12bがシャシ12aに対して規定時間当たり閾値以上の変位を継続して受けている(受け続けている)時間を意味する。
S22で肯定されるときは以降の処理をスキップし、τ0ごとにプログラムをループする。
何回目かのプログラムループにおいてS22で否定されるときはS24に進み、センサON時間がτ1(第1所定時間)以上で、τ2(第2所定時間。τ0<τ1≦τ2)未満か否か判断する。S24で肯定されるときはS26に進み、車両10が障害物と接触したと判定する。
他方、S24で否定されるときはS28に進み、センサON時間がτ2(第2所定時間)以上か否か判断する。
S28で否定されるときは以降の処理をスキップし、τ0ごとにプログラムをループする一方、何回目かのプログラムループにおいてS28で肯定されるときはS30に進み、カバー12bがシャシ12aからユーザなどによってリフトされたと判定する。
即ち、車両10が障害物と接触した場合にカバー12bに作用する外力は比較的短時間と予想される反面、カバー12bがシャシ12aからリフトされたときは人為的に持ち上げられることから比較的長時間と予想される。
従って、第1、第2所定時間τ1,τ2を適宜設定することで、1種(1個)のセンサ40によって障害物との接触とカバーのリフトとを効果的に判定(検出)することができる。
尚、車両10はシャシ12aに搭載される作業モータ(原動機)22の出力軸に連結される作業機(ブレード)20を備えるが、S26において車両10が障害物と接触したと判定されるとき、作業モータ22が動作しているときは、障害物回避モードにおいて、それを停止させずに障害物との回避動作を行う障害物回避モードを実行する。
これは障害物と接触しただけでは車両10は横転したり、逆さになったりする恐れは少なく、車両10を後退させるなどしてそれ以上の接触を回避させる方が急務と考えられるからである。従って、障害物回避モードにおいては、迅速に回避動作に移行させるため、作業モータ22が動作しているときはその動作を継続させつつ、回避動作を実行する。
他方、S30においてカバー12bがシャシ12aからリフトされたと判定されるとき、リフト検出モードにおいて作業モータ22を停止させる動作を実行する。即ち、カバー12bがリフトされたときは、ユーザなどが車両10を運搬するためと予想されるので作業モータ22を停止させる。
上記した如く、この実施形態にあっては、シャシ12aと前記シャシ12aに変位可能に取り付けられるカバー12bと、前記シャシ12aとカバー12bの間の変位に比例する出力を生じるセンサ(接触・リフトセンサ)40と、前記センサ40の出力を入力する制御部(ECU)44とを備えると共に、前記シャシ12aに取り付けられた駆動輪(走行モータ26で駆動される後輪16)で自律走行する自律走行車両10において、前記制御部が、前記センサの出力の規定時間当たりの変化量が閾値以上か否か判断するセンサ出力判断部(S14)と、前記センサ出力判断部によって前記変化量が閾値以上と判断された時間を積算する時間積算部(S16)と、前記時間積算部で積算された時間を所定時間(第1所定時間、第2所定時間)と比較し、前記所定時間との比較結果に基づいて前記車両10が障害物と接触したか、あるいは前記カバー12bが前記シャシ12aからリフトされたかを判定する判定部(S22からS30)とを備える如く構成したので、1種のセンサ40で障害物との接触とカバー16bのリフトとを検出することができ、2種のセンサを必要とする場合に比し、構成を簡易にすることができる。
また、前記所定時間が第1所定時間と前記第1所定時間より長い第2所定時間とからなると共に、前記判定部は、前記積算された時間が前記第1所定時間以上で前記第2所定時間未満のとき、前記車両が前記障害物と接触したと判定する一方(S24,S26)、前記積算された時間が前記第2所定時間以上のとき、前記カバーが前記シャシからリフトされたと判定する(S28,S30)如く構成したので、1種のセンサ40で障害物との接触とカバー16bのリフトとを精度良く検出することができる。
また、前記シャシ12aに搭載される原動機(作業モータ)22の出力軸に連結される作業部(ブレード)20を備えると共に、前記判定部は、前記車両10が障害物と接触したと判定するとき、前記原動機を停止させずに前記障害物との回避動作を行う如く構成したので、上記した効果に加え、回避動作を迅速に行うことができる。
また、前記シャシ12aに搭載される原動機(作業モータ)22の出力軸に連結される作業部(ブレード)20を備えると共に、前記判定部は、前記カバー12bが前記シャシ12aからリフトされたと判定するとき、前記原動機を停止させる如く構成したので、上記した効果に加え、消費エネルギを節約することができる。
また、前記センサ40が前記カバー12bの付近に配置される磁性体40aと前記シャシ12aに配置される磁気感応素子を有する検出部40bとからなると共に、前記車両10の進行方向に平行な車軸線CL1の両側に配置される如く構成したので、上記した効果に加え、1種(1個)のセンサとしても構成を簡易にすることができる。
尚、上記において、車両10として作業エリアARの周縁に配置されるエリアワイヤ72の磁界を検出しながら自律走行する自律走行車両を例示したが、車両10は、その種の自律走行車両に限られるものではない。
また、車両10を芝刈り車両に適用したが、この発明はそれに限られるものではなく、他の自律走行可能な自律走行車両に適用可能である。
また、検出部40bの検出素子として磁電変換素子、例えばホール効果素子を用いたが、それに限られるものではなく、磁性体40aとの物理的な変位を検出できるものであれば、どのようなものであっても良い。
10 自律走行車両(車両)、12 車体、12a シャシ、12b カバー、12b1 係止部材、14 前輪、16 後輪、20 作業部(ブレード)、22 電動モータ(作業モータ)、24 作業部高さ調節機構、26 電動モータ(走行モータ)、30 搭載充電ユニット、32 搭載電池、34 電池充電端子、36 磁気センサ、40 接触・リフトセンサ、40a 磁性体、40b 検出部、40b1 ねじ、40b2 ケース、44 電子制御ユニット(ECU)、46 角速度センサ、50 加速度センサ、52 方位センサ、54 GPSセンサ、56 車輪速センサ、62 電流センサ、68 入力機器、70 ディスプレイ、72 エリアワイヤ、74 充電ステーション、AR 作業エリア
Claims (5)
- シャシと前記シャシに変位可能に取り付けられるカバーと、前記シャシとカバーの間の変位に比例する出力を生じるセンサとを備え、前記センサの出力を入力する制御部を備えると共に、前記シャシに取り付けられた駆動輪で自律走行する自律走行車両において、前記制御部が、
前記センサの出力の規定時間当たりの変化量が閾値以上か否か判断するセンサ出力判断部と、
前記センサ出力判断部によって前記変化量が閾値以上と判断された時間を積算する時間積算部と、
前記時間積算部で積算された時間を所定時間と比較し、前記所定時間との比較結果に基づいて前記車両が障害物と接触したか、あるいは前記カバーが前記シャシからリフトされたかを判定する判定部と、
を備えることを特徴とする自律走行車両。 - 前記所定時間が第1所定時間と前記第1所定時間より長い第2所定時間とからなると共に、前記判定部は、前記積算された時間が前記第1所定時間以上で前記第2所定時間未満のとき、前記車両が前記障害物と接触したと判定する一方、前記積算された時間が前記第2所定時間以上のとき、前記カバーが前記シャシからリフトされたと判定することを特徴とする請求項1記載の自律走行車両。
- 前記シャシに搭載される原動機の出力軸に連結される作業部を備えると共に、前記判定部は、前記車両が障害物と接触したと判定するとき、前記原動機を停止させずに前記障害物との回避動作を行うことを特徴とする請求項1または2記載の自律走行車両。
- 前記シャシに搭載される原動機の出力軸に連結される作業部を備えると共に、前記判定部は、前記カバーが前記シャシからリフトされたと判定するとき、前記原動機を停止させることを特徴とする請求項1から3のいずれかに記載の自律走行車両。
- 前記センサが前記カバーの付近に配置される磁性体と前記シャシに配置される磁気感応素子を有する検出部とからなると共に、前記車両の進行方向に平行な車軸線の両側に配置されることを特徴とする請求項1から4のいずれかに記載の自律走行車両。
Priority Applications (5)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| EP16919830.6A EP3470946B1 (en) | 2016-10-31 | 2016-10-31 | Autonomous vehicle |
| JP2018547098A JPWO2018078880A1 (ja) | 2016-10-31 | 2016-10-31 | 自律走行車両 |
| PCT/JP2016/082344 WO2018078880A1 (ja) | 2016-10-31 | 2016-10-31 | 自律走行車両 |
| CN201680085253.0A CN109074070A (zh) | 2016-10-31 | 2016-10-31 | 自主行驶车辆 |
| US16/317,310 US11009869B2 (en) | 2016-10-31 | 2016-10-31 | Autonomously navigating vehicle |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| PCT/JP2016/082344 WO2018078880A1 (ja) | 2016-10-31 | 2016-10-31 | 自律走行車両 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2018078880A1 true WO2018078880A1 (ja) | 2018-05-03 |
Family
ID=62024661
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/JP2016/082344 Ceased WO2018078880A1 (ja) | 2016-10-31 | 2016-10-31 | 自律走行車両 |
Country Status (5)
| Country | Link |
|---|---|
| US (1) | US11009869B2 (ja) |
| EP (1) | EP3470946B1 (ja) |
| JP (1) | JPWO2018078880A1 (ja) |
| CN (1) | CN109074070A (ja) |
| WO (1) | WO2018078880A1 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| SE544283C2 (en) * | 2019-02-20 | 2022-03-22 | Husqvarna Ab | Robotic work tool and method for collision handling |
Families Citing this family (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| SE540585C2 (en) * | 2017-03-23 | 2018-10-02 | Husqvarna Ab | A robotic work tool and a method for use in a robotic work tool comprising a lift/collision detection device |
| WO2018174777A1 (en) | 2017-03-23 | 2018-09-27 | Husqvarna Ab | A robotic work tool and a method for use in a robotic work tool comprising a lift and collision detection |
| CN111279872A (zh) * | 2020-02-28 | 2020-06-16 | 苏州科瓴精密机械科技有限公司 | 一种割草机控制方法、装置和割草机 |
| SE2050454A1 (en) * | 2020-04-21 | 2021-09-28 | Husqvarna Ab | Automower fender and robotic work tool including a fender |
| US12296694B2 (en) | 2021-03-10 | 2025-05-13 | Techtronic Cordless Gp | Lawnmowers |
| CA3181601A1 (en) | 2021-11-10 | 2023-05-10 | Techtronic Cordless Gp | Robotic lawn mowers |
| US12472611B2 (en) | 2022-05-31 | 2025-11-18 | Techtronic Cordless Gp | Peg driver |
| AU2023204696A1 (en) | 2022-07-19 | 2024-02-08 | Techtronic Cordless Gp | Display for controlling robotic tool |
| AU2023206123A1 (en) | 2022-07-29 | 2024-02-15 | Techtronic Cordless Gp | Generation of a cryptography key for a robotic garden tool |
| SE547166C2 (en) * | 2023-11-17 | 2025-05-06 | Husqvarna Ab | Self-Propelled Robotic Lawnmower |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20150185733A1 (en) * | 2012-07-05 | 2015-07-02 | Husqvarna Ab | Displacement Sensor for a Robotic Vehicle Detecting a Lift Event and a Collision Event |
| WO2015115954A1 (en) * | 2014-02-03 | 2015-08-06 | Husqvarna Ab | Obstacle detection for a robotic working tool |
| JP2016081434A (ja) | 2014-10-21 | 2016-05-16 | 本田技研工業株式会社 | 自律走行作業車の制御装置 |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005211462A (ja) | 2004-01-30 | 2005-08-11 | Funai Electric Co Ltd | 自走式掃除機 |
| JP4525473B2 (ja) | 2005-06-06 | 2010-08-18 | トヨタ自動車株式会社 | 移動ロボットの位置制御システムと位置制御方法 |
| WO2013125995A1 (en) * | 2012-02-22 | 2013-08-29 | Husqvarna Ab | Robotic lawnmower |
| CN107404839B (zh) * | 2015-03-26 | 2020-05-01 | 胡斯华纳有限公司 | 改进的提升/碰撞检测 |
-
2016
- 2016-10-31 EP EP16919830.6A patent/EP3470946B1/en active Active
- 2016-10-31 WO PCT/JP2016/082344 patent/WO2018078880A1/ja not_active Ceased
- 2016-10-31 JP JP2018547098A patent/JPWO2018078880A1/ja active Pending
- 2016-10-31 CN CN201680085253.0A patent/CN109074070A/zh active Pending
- 2016-10-31 US US16/317,310 patent/US11009869B2/en active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20150185733A1 (en) * | 2012-07-05 | 2015-07-02 | Husqvarna Ab | Displacement Sensor for a Robotic Vehicle Detecting a Lift Event and a Collision Event |
| WO2015115954A1 (en) * | 2014-02-03 | 2015-08-06 | Husqvarna Ab | Obstacle detection for a robotic working tool |
| JP2016081434A (ja) | 2014-10-21 | 2016-05-16 | 本田技研工業株式会社 | 自律走行作業車の制御装置 |
Non-Patent Citations (1)
| Title |
|---|
| See also references of EP3470946A4 |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| SE544283C2 (en) * | 2019-02-20 | 2022-03-22 | Husqvarna Ab | Robotic work tool and method for collision handling |
| US12279549B2 (en) | 2019-02-20 | 2025-04-22 | Husqvarna Ab | Robotic work tool and method for improved collision handling |
Also Published As
| Publication number | Publication date |
|---|---|
| EP3470946A1 (en) | 2019-04-17 |
| CN109074070A (zh) | 2018-12-21 |
| US20190235495A1 (en) | 2019-08-01 |
| US11009869B2 (en) | 2021-05-18 |
| EP3470946A4 (en) | 2019-08-28 |
| JPWO2018078880A1 (ja) | 2019-09-12 |
| EP3470946B1 (en) | 2021-03-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| WO2018078880A1 (ja) | 自律走行車両 | |
| US9874876B2 (en) | Control apparatus for autonomously navigating utility vehicle | |
| JP6373930B2 (ja) | 自律走行車両 | |
| US10869424B2 (en) | Power tool, lawn mower, and control method thereof | |
| JP6263567B2 (ja) | 自律走行作業車の制御装置 | |
| JP5420511B2 (ja) | 自律走行作業車の制御装置 | |
| JP5420510B2 (ja) | 自律走行作業車の制御装置 | |
| US9876370B2 (en) | Charging station and charging station guide for autonomously navigating utility vehicle | |
| EP3056960B1 (en) | Control apparatus for autonomously navigating utility vehicle | |
| JP6498627B2 (ja) | 自律走行作業車の制御装置 | |
| JP5973609B1 (ja) | 無人作業車の制御装置 | |
| JP6038990B2 (ja) | 無人作業車の制御装置 | |
| EP3470311B1 (en) | Autonomously travelling vehicle | |
| JP6214496B2 (ja) | 自律走行作業車の制御装置 | |
| US9745004B2 (en) | Inverted vehicle and control method thereof | |
| JP2016186751A (ja) | 無人作業車の制御装置 | |
| JP2017033450A (ja) | 移動ロボット | |
| JP6710145B2 (ja) | 自律走行車両 | |
| WO2017164911A1 (en) | Transportation device | |
| JP2007168602A (ja) | 二輪移動台車 | |
| EP3779631B1 (en) | Moving body | |
| US12110059B2 (en) | Autonomously navigating vehicle | |
| JP2021149125A (ja) | 自律移動装置および自律移動装置の制御方法 | |
| KR20190031078A (ko) | 소유자 추종 캐리어 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 16919830 Country of ref document: EP Kind code of ref document: A1 |
|
| ENP | Entry into the national phase |
Ref document number: 2018547098 Country of ref document: JP Kind code of ref document: A |
|
| ENP | Entry into the national phase |
Ref document number: 2016919830 Country of ref document: EP Effective date: 20190114 |
|
| NENP | Non-entry into the national phase |
Ref country code: DE |