JP2017111771A - 自律走行車両、自律走行システム及び自律走行車両の制御方法 - Google Patents
自律走行車両、自律走行システム及び自律走行車両の制御方法 Download PDFInfo
- Publication number
- JP2017111771A JP2017111771A JP2015248011A JP2015248011A JP2017111771A JP 2017111771 A JP2017111771 A JP 2017111771A JP 2015248011 A JP2015248011 A JP 2015248011A JP 2015248011 A JP2015248011 A JP 2015248011A JP 2017111771 A JP2017111771 A JP 2017111771A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- control
- unit
- terrain
- autonomous traveling
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims description 27
- 238000005259 measurement Methods 0.000 claims abstract description 27
- 230000007423 decrease Effects 0.000 claims description 10
- 238000001514 detection method Methods 0.000 claims description 7
- 238000012937 correction Methods 0.000 claims description 3
- 230000006866 deterioration Effects 0.000 abstract 1
- 238000012876 topography Methods 0.000 description 23
- 238000010586 diagram Methods 0.000 description 8
- 239000007921 spray Substances 0.000 description 7
- 238000012986 modification Methods 0.000 description 6
- 230000004048 modification Effects 0.000 description 6
- 238000005507 spraying Methods 0.000 description 4
- 239000003905 agrochemical Substances 0.000 description 3
- 238000004891 communication Methods 0.000 description 3
- 230000003247 decreasing effect Effects 0.000 description 3
- 230000010365 information processing Effects 0.000 description 3
- 239000000126 substance Substances 0.000 description 3
- 239000000725 suspension Substances 0.000 description 3
- 230000002542 deteriorative effect Effects 0.000 description 2
- 235000013399 edible fruits Nutrition 0.000 description 2
- 239000002420 orchard Substances 0.000 description 2
- 238000002485 combustion reaction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
Images
Abstract
【課題】自律走行制御における制御特性を悪化させることなく、凹凸のある路面を走行する際にも制御安定性を保つ自律走行車両を提供すること。【解決手段】自律走行車両1を、自律走行を行うよう車両を制御する車両制御部61と、前記車両の前方の地形の少なくとも高さを計測する地高計測部と、前記地高計測部により計測された計測結果を蓄積し記憶する記憶部7と、記憶部7に記憶された地形に基いて、車両制御部61の制御パラメータ及び制御入力の少なくともいずれかを変更する制御変更部64と、を有するものとする。【選択図】図3
Description
本発明は、自律走行車両、自律走行システム及び自律走行車両の制御方法に関する。
省力化・省人化や、人体にとって過酷な環境下での作業を可能とするべく、無人にて自律的に走行する車両が研究されている。自律走行車両が必要となる局面には種々のものがあるが、例えば果樹園等の圃場内を走行する農作業車のように、自律走行車両が凹凸のある未舗装を走行する場合も想定され得る。
特許文献1には、車体の走行位置を認識するGPS受信装置を備え、認識した圃場領域内を認識した経路で走行する自律走行手段を設けた農業用作業車が記載されている。
特許文献2には、車両に搭載したプレビューセンサの検出値に基いて路面凹凸にのみ応じた路面推定値を求め、路面推定値と補正制御ゲインから算出した各輪の予見制御値に基いて求めた予見制御力により、車両の前後輪のアクティブサスペンションのアクチュエータを制御するサスペンション予見制御装置が記載されている。
路面に凹凸がある場合、車両がかかる凹凸を乗り越える際に姿勢が大きく変化して大きな外乱を受け、その自律走行制御が不安定となりやすい。一般に外乱に対して制御系を安定化させるための制御としてロバスト制御が知られているが、路面の凹凸による大きな外乱に対して安定となる制御器を設計すると、制御が保守的となり、制御入力に対する応答が遅くなったり、追従精度が低下したりするなど実用性に問題を生じる可能性がある。
特許文献2に記載の技術は路面の凹凸に対する抵抗を付与するものではあるが、全ての装輪にアクティブサスペンションを設け、その制御器を設置する必要があり、コスト高を招来するものである。
本発明はかかる観点に鑑みてなされたものであり、その目的は、自律走行制御における制御特性を悪化させることなく、凹凸のある路面を走行する際にも制御安定性を保つ自律走行車両を提供することである。
本出願において開示される発明は種々の側面を有しており、それら側面の代表的なものの概要は以下のとおりである。
(1)自律走行を行うよう車両を制御する車両制御部と、前記車両の前方の地形の少なくとも高さを計測する地高計測部と、前記地高計測部により計測された計測結果を蓄積し記憶する記憶部と、前記記憶部に記憶された地形に基いて、前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する制御変更部と、を有する自律走行車両。
(2)(1)において、前記制御変更部は、前記記憶部に記憶された地形の分散に応じて前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する自律走行車両。
(3)(1)又は(2)において、前記制御変更部は、前記記憶部に記憶された地形が凹形状である場合に、前記車両の出力の減少及び操舵角ゲインの減少の少なくともいずれかをもたらすように前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する自律走行車両。
(4)(3)において、前記制御変更部は、前記車両の前輪が前記凹形状に到達するより以前に前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する自律走行車両。
(5)(3)において、前記制御変更部は、前記記憶部に記憶された地形が凹形状である場合に、前記車両の前輪が前記凹形状に到達する以前に前記車両の出力及び操舵角ゲインの少なくともいずれかを減少させ、前記車両の前輪が前記凹形状に到達後は当該車両の出力又は操舵角ゲインを増加させる自律走行車両。
(6)(1)〜(5)のいずれかにおいて、前記制御変更部は、前記記憶部に記憶された地形が凸形状である場合に、前記車両の出力の増加及び操舵角ゲインの増加の少なくともいずれかをもたらすように前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する自律走行車両。
(7)(6)において、前記制御変更部は、前記車両の少なくとも前輪が前記凸形状に到達するより以前に前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する自律走行車両。
(8)(6)において、前記制御変更部は、前記記憶部に記憶された地形が凸形状である場合に、前記車両の前輪が前記凸形状に到達する以前に前記車両の出力及び操舵角ゲインの少なくともいずれかを減少させ、前記車両の前輪が前記凸形状に到達後は当該車両の出力又は操舵角ゲインを増加させる自律走行車両。
(9)(1)〜(8)のいずれかにおいて、さらに、前記車両の少なくともピッチ角を検出する姿勢検出部を有し、前記地高計測部は、前記姿勢検出部により検出されたピッチ角による補正を行い地形の高さを計測する自律走行車両。
(10)自律走行を行うよう車両を制御する車両制御部と、前記車両の前方の地形の少なくとも高さを計測する地高計測部を備えた車両と、前記地高計測部により計測された計測結果を蓄積し記憶する記憶部と、前記記憶部に記憶された地形に基いて、前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する制御変更部と、を有する車両の自律走行システム。
(11)自律走行を行うよう車両を制御するステップと、前記車両の前方の地形の少なくとも高さを計測するステップと、前記車両の前方の地形の少なくとも高さについて計測された計測結果を蓄積し記憶するステップと、記憶された地形に基いて、前記車両を制御する際の制御パラメータ及び制御入力の少なくともいずれかを変更するステップと、を有する自律走行車両の制御方法。
上記本発明によれば、自律走行制御における制御特性を悪化させることなく、凹凸のある路面を走行する際にも制御安定性を保つ自律走行車両が提供される。
以下に、本発明の一実施形態を図面を参照しつつ説明する。
図1は、本発明の一実施形態に係る自律走行車両1の外観図である。本発明における自律走行車両とは、自動運転として、あらかじめ設定した経路又は自動生成した経路上をあらかじめ与えられ、又は自動生成された速度プロファイルに追従するように自律走行を行う車両を指している。したがって、自律走行車両1がそれ以外の走行時、例えば自動運転の状態にない場合の有人/無人運転の別は問わない。また、図1に示した自律走行車両1は4輪自動車であるが、装輪数は3輪であっても、4輪であっても、或いは6輪以上の多装輪であっても、無限軌道車であってもよい。さらに、以降説明する本実施形態における自律走行車両1の制御は不整地走行に特に適したものであるため、自律走行車両1は不整地走行に適したATV(All Terrain Vehicle)を改修したものとして示しているが、自律走行車両1が舗装面等の整地を走行しても差し支えない。
本実施形態では、自律走行車両1は、果樹園等の農園を走行しつつ、果樹等の作物に対して農薬等の薬液を散布する農業用車両として示されており、車両本体2の後部に農薬散布用のスプレーノズル3と、薬液を貯蔵するタンクが装備されている。しかしながら、これは単に自律走行車両1の実用上の役割の一例を示すものであり、自律走行車両1は農業用車両に限定されない。車両本体2は、作業者による有人運転と、後述するコントローラ6による無人運転の両方が可能であり、作業者による操作または指示により有人/無人運転が切り替えられる。
また、自律走行車両1には、車両の前方の地形、特に、高さを計測する地形計測部として、LRF(レーザレンジファインダ)5が設けられている。LRF5は、図示のように、車両の前方の地形の高さを計測できるよう、前方斜め下向きに側距レーザを照射するよう、車両の前面に傾けて設置される。地形計測部として用いるセンサの種類や数に特に限定はないが、少なくとも車両の各装輪が辿ると予測される、車両前方のある範囲の地形の高さを計測できることが望ましい。本実施形態では、LRF5の測定範囲は車幅方向に90°以上あり、車両の幅方向の長さ全体について、その前方の地形の高さが計測できるようになっており、当然に全ての車輪の前方の地形の高さが計測可能となっている。
なお、本実施形態では、コントローラ6は車両本体2に搭載されているものとして以降の説明を行うが、コントローラ6を車両本体の外部に設置し、無線通信により車両本体2の制御を行うものとしてもよい。かかる場合には、コントローラ6と、車両本体2を含む車両の自律制御システムとして本発明が把握され得ることとなる。無線通信は、例えば、車両本体2に設けられたアンテナ4を用いて行われる。
図2は、自律走行車両1の構成を示す模式図である。自律走行車両1の車両本体2は、前輪である操舵輪21と、操舵輪21の操舵角を変更するためのステアリングアクチュエータ22、後輪である駆動輪23に回転駆動力を与えるエンジン又は電動機である駆動力源24を備えており、ステアリングアクチュエータ22と駆動力源24を情報処理装置であるコントローラ6により電子的に制御するようになっている。なお、図示のものでは駆動力源24は単一のものとして示しているが、駆動力源24として内燃機関と電動機を併設するいわゆるハイブリッドシステムを用いてもよいし、電動機を駆動輪23内に設置するいわゆるインホイールモータとしてもよい。
操作部25は、自律走行車両1を有人運転する際の各種操作用部材であり、具体的には、ハンドルや、アクセル/ブレーキ等のペダル、各種スイッチ類である。本実施形態では、自律走行車両1は、搭乗員による有人運転を行う場合には、この操作部25に入力された操作量がコントローラ6に伝えられ、その操作量に応じてステアリングアクチュエータ22や駆動力源24が駆動されるようになっている。これに対し、自律走行車両1が無人運転となっている場合には、操作部25からの入力は自律走行車両1の走行には反映されない。自律走行車両1の有人運転/無人運転の切り替えは、この操作部25に設けられた適宜のスイッチ、例えば、キースイッチのポジションを変更することにより行われてよい。
インタフェース26は、コントローラ6に対し、自律走行車両1を無人運転する際に必要となる各種情報を入力するためのマンマシンインタフェースである。このインタフェース26の形式は特に限定されず、どのようなものであってもよい。例えば、無線又は有線により通信可能に接続された任意のコンピュータ又はティーチングペンダント等の操作ボックスをインタフェース26として用いてよい。あるいは、自律走行車両1の適宜の場所、例えば運転席にタッチパネル式ディスプレイ等の入力デバイスを設け、かかる入力デバイスをインタフェース26としてもよい。いずれにせよ、オペレータは、インタフェース26を用いて、自律走行車両1を自動走行させる際に必要となるパラメータや地図等の必要な情報をコントローラ6に入力する。
記憶部7は、情報記憶であり、好ましくは不揮発性のメモリである。そして、記憶部7には、自律走行車両1が自律走行を行う際に必要となるパラメータや、地図、さらにLRF5により計測された、ある一定期間以上(本実施形態では、例えば数百ミリ秒〜数秒間分)の地形等の情報が記憶される。コントローラ6は、記憶部7に適宜アクセスし、必要な情報を参照する。
また、自己位置推定部8は、車両の現在位置と姿勢(方位角)を推定し、コントローラ6に通知する。自己位置推定部8は、適宜の位置計測システム、例えば、GPS(Global Positioning System)やLPS(Local Posisioning System)、INS(Inertial Navigation System等のいずれかまたは複数を用いてよい。
さらに、コントローラ6からは、適宜、スプレーノズル3に対し、噴霧の有無を制御する信号が送られ、スプレーノズル3は、コントローラ6からの指示に従って噴霧を行う。
以上の構成により、自律走行車両1はコントローラ6により制御され、自律走行を行う。ここで、コントローラ6は、物理的には、CPU(Central Processing Unit)とメモリ等からなるコンピュータであっても、いわゆるマイクロコントローラや、DSP(Digital Signal Processor)、FPGA(Field Programmable Gate Array)等であってもよく、任意の情報処理装置を使用してよい。また、コントローラ6は単一の部品により構成しても、複数の部品を結合させて構成してもよい。自律走行車両1におけるステアリングアクチュエータ22に対する制御、すなわち、操舵角制御と、駆動力源24に対する制御、すなわち、速度制御の2つの制御は、コントローラ6による情報処理により行われる。
操舵角制御は、前述したように、あらかじめ設定した経路又は自動生成した経路を追従するよう操舵輪21を駆動する制御である。本実施形態では、自己位置推定部8により推定された自律走行車両1の現在位置及び姿勢と、追従すべき経路上を走行する仮想的な車両の位置及び姿勢との位置及び姿勢差を解消するよう制御入力を与えることにより、操舵輪21の操舵角が制御され、自律走行車両1が追従すべき経路上を走行するというものである。この制御は、古典的なPID制御等の制御手法によってもよいし、その他の制御手法、例えば、H∞制御等の制御手法によってもよい。操舵角制御における制御の鋭敏性、すなわち、自律走行車両1の推定された現在位置及び姿勢と追従すべき車両位置及び姿勢との誤差に対する制御出力の大きさは、パラメータである操舵角ゲインに反映される。操舵角ゲインは、記憶部7に記憶される。
速度制御は、あらかじめ与えられ、又は自動生成された速度プロファイルに車両速度を追従させるよう駆動力源24を駆動する制御であり、自律走行車両1の現在速度が追従すべき速度に合致するようにするというものである。速度プロファイルは、一定速度であってもよいし、追従すべき経路に応じて、例えば曲率に応じて定めても、自律走行車両1の作業内容に応じて定めてもよい。作業内容に応じる場合とは、例えば、本実施形態のように自律走行車両1が果樹等の作物に対して農薬等の薬液を散布する農業用車両である場合には、スプレーノズル3による薬液の噴霧中は、作物への噴霧量が規定量となるよう定められた速度で走行し、そうでない場合は作業効率向上のためできる限り高速で走行するなどが考えられる。この制御もまた古典的な制御手法によっても、H∞制御等の他の制御手法によってもよい。速度制御における制御の鋭敏性はパラメータである速度ゲインに反映される。速度ゲインもまた、記憶部7に記憶される。
図3は、自律走行車両1の機能的構成を示す機能ブロック図である。コントローラ6内には、自律走行車両1を設定された走行経路に追従して走行するよう制御する車両制御部61が含まれる。本実施形態では、車両制御部61には、操舵角制御を行う操舵角制御部62と速度制御を行う速度制御部63の2つの制御部が含まれており、操舵角制御部62は、自己位置推定部8により推定された車両の現在位置及び姿勢、現在の操舵角θ及び制御入力uの入力を受けてステアリングアクチュエータ22への制御出力を行う部分である。また、速度制御部63は、現在の車両速度v及び制御入力uの入力を受けて駆動力源24への制御出力を行う部分である。操舵角制御部62及び速度制御部63のいずれか又は両方は、後述する制御変更部64からの入力により、使用するパラメータ及び制御入力のいずれかまたは両方が変更される。
以上説明したコントローラ6内部の機能ブロックは、必ずしもこれらブロックが物理的に存在している必要はなく、コントローラ6上で実行されるソフトウェアにより機能的に実現されるものである。したがって、コントローラ6上で実行されるソフトウェアを記述するプログラムにおいても、これらブロックが必ずしも明確に分離できるとは限らない。
続いて、LRF5による地高計測と、それにより記憶部7に蓄積される地形を図4を参照して説明する。図4は自律走行車両1がその前方の地形を計測している状態を示す模式図である。自律走行車両1が図中右方向に向かって走行している際に、太線で示した地表面の前方に窪みPが存在する場合を考える。座標として、LRF5原点を0として車両前方への距離をx軸とし、自律走行車両1が水平面上にあるとした時の地面高さを0としたときの垂直方向の高さをy軸とする。また、LRF5の設置高さをh、水平面に対するLRF5の取り付け角度をφとする。
このとき、LRF5により、角度φ方向における斜め前方の地面までの距離rが測定される。このとき、x座標がrcosφにおける地面高さdは(h−rsinφ)として測定できることになる。このような計測を、自律走行車両1の進行につれて、例えば一定時間毎、例えば25ミリ秒毎におこない、その結果を記憶部7に一定期間(例えば数百ミリ秒〜数秒間)蓄積し記憶させることにより、車両前方の地形が把握される。なお、記憶部7に記憶される地形は測定時のノイズを平滑化するため、適当なローパスフィルタ、たとえば移動平均を適用したものとしてよい。
そして、制御変更部64は、記憶部7に記憶された地形に基いて車両制御部61の制御パラメータ及び制御入力の少なくともいずれかを変更する。ここではまず、制御変更部64が速度制御部63の制御入力である目標速度を変更する場合を例にとって説明する。
図5は、制御変更部64が実行する制御のアルゴリズムを示すフロー図である。まず、制御変更部64は、ステップST1−1にて、次式であらわされる車両前方を含む所定の区間の地形の分散σ2が閾値σ2 thより大きいか否かを判定する。ここで、座標xにおける地面高さdをy(x)と記述すると、分散σ2は次式で求められる。
ここで、区間はb<x<aであり、少なくとも車両の前方を含む任意の区間としてよい。例えば、図4において、車両前方の任意の点であるA点から操舵輪21の接地点であるB点までの区間としてよい。また、yaveは、区間b<x<aにおけるy(x)の平均値である。制御変更部64は、σ2>σ2 thでなければ制御を終了し、車両制御部61の制御パラメータ及び制御入力を変更しない。これは、これから車両が進行する先の地面がなだらかであれば、特に自律走行車両1に対する制御を変更する必要がないからである。
σ2>2σthであれば、ステップST1−2へと進み、制御変更部64は記憶部7に記憶された地形が凹形状であるか否かを判定する。そして、凹形状である場合にはステップST1−3へ進み、車両の出力を減少させ、車速を落とすように速度制御部63に入力される目標速度を減じる。例えば、目標速度を1/2とする。これは、凹形状の地形に車両が高速で進入すると大きな衝撃を受けて姿勢を崩したり、操舵輪がとられたりして自律走行に対する制御が不安定となりやすいためである。
なお、ここで地形が凹形状であるか否かの判定には種々の方法が考えられる。例えば、操舵輪21の前方の任意の地点、例えば図4のA点における地形高が平均高さyaveより小さければ凹形状であると判定する。又は、操舵輪21の前方の任意の区間、例えば、次式であらわされる区間a<x<b(図4でA点からB点までの区間)における平均高さyaveに対する地形高の積分値Sが負又は所定の閾値以下であれば凹形状であると判定するとよい。
或いは、次式であらわされる区間a<x<bにおける地形高の傾きの平均値maveが負又は所定の閾値以下であれば凹形状であると判定するとよい。
なお、この判定は操舵輪21である車両の前輪が凹形状に到達するより前に車両の出力を減少させることができなければならない。車両の姿勢を安定に保つためには、前輪が凹形状に到達するより前に車速を落としておく必要があるためである。したがって、本実施形態では、少なくとも車両の前輪の前方に存在する凹形状を検出することができるような判定方法が選択される。
一方、ステップST1−2にて凹形状でないと判定された場合には、ステップST1−4へと進み、制御変更部64は記憶部7に記憶された地形が凸形状であるか否かを判定する。この判定は、図4のA点における地形高が平均高さyaveより大きいか、上述の積分値Sが正又は所定の閾値以上、或いは、上述の平均値maveが正又は所定の閾値以上である場合に凸形状であると判定するものであってよい。この判定は、車両前方の地形が、自律走行車両1が水平面上にあるとした時の地面高さ(y=0となる高さ)に対して凸形状である場合のみならず、操舵輪21が図4の窪みPに入っている場合において、操舵輪21が窪みPから脱出する際に登ることとなる窪みPの登り斜面をも凸形状と判定し得るものとなっている。
そして、ステップST1−4にて凸形状と判定された場合にはステップST1−5へ進み、車両の出力を増加させ、車速を上げるように速度制御部63に入力される目標速度を増加する。この車両の出力の増加は、単純に目標速度を増加させる、例えば目標速度を1.5倍にするものであってもよいし、ステップST1−3により目標速度が減じられていた場合には、これを元の目標速度に戻すものであってもよい。これは、車両、特に車両の前輪が凹形状の地形から脱出する際や、凸形状を乗り越える際には大きな出力が必要となるためである。車両の操舵輪が前輪である場合において、操舵輪が凹形状の地形に入っている場合は、先のステップST1−3により出力が減じられていると考えられるところ、当該地形からの脱出には少なくとも出力を当初のものに戻すか、さらに増加させる必要があると考えられる。
なお、以上の説明では、地形が凸形状であるか否かの判定は、前輪である操舵輪21の前方の地形について行っているが、これに加えて、駆動輪23の前方の地形が凸形状である場合にも車両の出力を増加させるようにしてもよい。この判定方法は、操舵輪21に対してしたと同様の手法を駆動輪23に適用してよく、例えば、駆動輪23前方の任意の地点である図4のC点における地形高が平均高さyaveより大きいか、駆動輪23の前方の任意の区間、例えば、駆動輪23前方の任意の点であるC点から駆動輪23の接地点であるD点までの区間における平均高さyaveに対する地形高の積分値S又は地形高の傾きの平均値maveが正又は所定の閾値以上であれば凸形状であると判定するとよい。いずれにせよ、この判定は、対象となる装輪が凸形状に到達するより前に車両の出力を増加させるため、少なくとも当該装輪の前方に存在する凸形状を検出することができるような判定方法が選択される。
なお、目標速度を変化させる度合として示した上述の数値は一例であって、その数値をどのように定めるかは任意である。さらに、どのように目標速度を変化させるかもまた任意である。例えば、計測された地形の凹凸の度合いに応じて目標速度を段階的或いは連続的に変化させてもよい。
また、以上の説明では、制御変更部64は地形が凹形状であることを検出した場合に車両出力を減少させ、地形が凸形状であることを検出した場合に車両出力を増加させるものとして説明したが、これに換えて、又は加えて、地形が凹形状であることを検出した場合に操舵角制御部62の制御パラメータである操舵角ゲインを減少させ、地形が凸形状であることを検出した場合に操舵角ゲインを増加させるようにしてもよい。これは、凹形状の地形に車両が進入した際に制御が不安定となるのを抑えるため、操舵角の変化を緩やかにし、また車両が凹形状の地形から脱出する際には制御の追従性を良くするため操舵角ゲインを元の値に戻す、というものである。さらに、車両制御部61の他の制御パラメータまたは制御入力を変更してもよい。
さらに、以上の説明ではLRF5により計測され、記憶部7に蓄積される地形と、同じく記憶部7に記憶される地図との関係については何ら特定するものではないが、両者を関連付けて、地図上の座標に対し計測された地高を記憶するようにしてもよい。このようにすれば、一度通過した場所については既に計測結果が存在することになり、新たな計測が不要となるか、或いは繰り返し計測することにより誤差の少ない正確な地形データが得られることになるからである。
なお、LRF5による地高計測の際に、車両のピッチ角による補正を行い、より正確に地形の高さを計測するようにしてもよい。図6は、自律走行車両1がピッチ方向に傾斜している際にその前方の地形を計測している状態を示す模式図である。図のように、自律走行車両1の装輪が地形の凸部に乗り上げていたり、凹部にはまり込んでいる場合や、斜面を走行している場合には、車両自体が傾くために、水平面に対するLRF5の角度がその取り付け角度φと異なるものとなる。この場合、車両のピッチ角をθとすると、LRF5により計測された斜め前方の地面までの距離rを用いて、x座標がrcos(φ−θ)における地面高さdが[hcosθ+lsinθ−rsin(φ−θ)]として測定できることになる。なお、ここでLRF5の高さは、駆動輪23の接地位置を基準とし(すなわち、駆動輪23の接地位置を高さ0として)、駆動輪23の直径を無視して計算している。高さの基準をどこに置くかは任意であり、操舵輪21の接地位置としたり、操舵輪21と駆動輪23の中間位置としたりしてもよい。
なお、自律走行車両1は、車両のピッチ角を検出するため、少なくともピッチ角を検出する姿勢検出部を有することになるが、本実施形態では、自己位置推定部8が備えるINSにより重力方向を検出することでピッチ角を得ている。したがって、自己位置推定部8が姿勢検出部を兼ねていることになるが、姿勢検出部として任意の傾きセンサを別途備えるようにすることは差し支えない。
以上説明した実施形態では、制御変更部64は車両前方の地形が凹形状であれば車両出力を減少させ、地形が凸形状であることを検出した場合に車両出力を増加させるものであったが、これをさらに次のように変形してもよい。
すなわち、以下に説明する本発明の実施形態の変形例では、制御変更部64は、車両前方の地形が凸形状であることを検出した場合には、その前輪が当該凸形状に到達する以前に車両の出力(又は操舵角ゲイン)を減少させ、その前輪が当該凸形状に到達後は車両の出力(又は操舵角ゲイン)を増加させる。この制御は、車両の前輪が勢いよく凸形状の地形に進入してぶつかることによる衝撃力を抑制し、より滑らかで衝撃の小さい走行を実現しようとするものである。
図7は、本変形例に係る制御変更部64が実行する制御のアルゴリズムを示すフロー図である。ここでは、制御変更部64はまず、図5に示したアルゴリズムと同様に、ステップST2−1にて、車両前方を含む所定の区間の地形の分散σ2が閾値σ2 thより大きいか否かを判定する。制御変更部64は、σ2>σ2 thでなければステップST2−7へと進み、車両の出力を通常のものにする。σ2>σ2 thの場合には続くステップST2−2へと進む。
ステップST2−2は、図5のステップST1−2と同様であり、車両前方の地形が凹形状である場合にステップST2−3へと進み車両の出力を減少させる。この判断の手法は先の実施形態で説明したと同様のものであってよい。車両前方の地形が凹形状でない場合には、ステップST2−4へと進む。
ステップST2−4では、車両前方の地形が凸形状であるか否かを判定する。凸形状でなければステップST2−7へと進み車両の出力を通常のものとする。そうでなければ、さらにステップST2−5へと進む。
ステップST2−5では、車両の前輪が凸形状に到達したか否かを判定する。この判定は任意の方法で行ってよいが、例えば、凸形状の判定を図4のA点における地形高により行っている場合であれば、凸形状の判定がなされた時のA点の座標を記憶しておき、その後車両が走行して、前輪が記憶されたA点に到達していれば車両の前輪が凸形状に到達したと判定すればよい。凸形状の判定を上述の積分値S又は平均値maveにより行っている場合には、例えば、凸形状の判定がなされた時のLRF5の測定点のx座標を記憶しておき、同様にその後車両が走行して、前輪が記憶されたx座標に到達しているか否かにより判定することができる。
ステップST2−5の判定が否定、すなわち、車両前方の地形が凸形状であるが、前輪は当該凸形状に到達していない場合は、ステップST2−3へと進み、車両の出力を減少させる。一方、ステップST2−5の判定が肯定、すなわち、車両前方の地形が凸形状であり、前輪が当該凸形状に到達している場合は、ステップST2−6へと進み、車両の出力を増加させる。これにより、本変形例では、車両前方の凸形状を滑らかに、大きな衝撃を発生させることなく乗り越えて走行することが可能である。
なお、車両の前輪が凸形状に到達して増加された車両の出力は、凸形状を通過することにより通常の出力に戻される。すなわち、車両が凸形状を通過すると、路面がなだらかとなるためステップST2−1でσ2>σ2 thでないと判断されるか、又は、ステップST2−4で車両前方の地形が凸形状でないと判断されることになるため、ステップST2−7が実行されることとなる。
さらに、同様の制御を、地形が凹形状であることを検出した場合にも適用してよい。すなわち、上述の実施形態の変形例と同様に、制御変更部64は、車両前方の地形が凹形状であることを検出した場合には、その前輪が当該凹形状に到達する以前に車両の出力(又は操舵角ゲイン)を減少させ、その前輪が当該凹形状に到達後は車両の出力(又は操舵角ゲイン)を増加させるようにしてもよい。この制御は、車両の前輪が勢いよく凹形状の地形に進入して落下することによる衝撃力を抑制し、より滑らかで衝撃の小さい走行を実現できると考えられる。
以上具体的な実施形態及びその変形例を例として本発明について説明したが、本発明はこれら例示された具体例における具体的構成に限定されるものではない。実施形態において示した各部材の具体的な配置、形状、数等や制御のアルゴリズムは一例として示されたものであり、ここで説明したと同様の技術的効果を有する限り、諸事情に鑑みて当業者が適宜設計し、変更してよい。
1 自律走行車両、2 車両本体、3 スプレーノズル、4 アンテナ、5 LRF、
6 コントローラ、7 記憶部、8 自己位置推定部、21 操舵輪、22 ステアリングアクチュエータ、23 駆動輪、24 駆動力源、25 操作部、26 インタフェース、61 車両制御部、62 操舵角制御部、63 速度制御部、64 制御変更部。
6 コントローラ、7 記憶部、8 自己位置推定部、21 操舵輪、22 ステアリングアクチュエータ、23 駆動輪、24 駆動力源、25 操作部、26 インタフェース、61 車両制御部、62 操舵角制御部、63 速度制御部、64 制御変更部。
Claims (11)
- 自律走行を行うよう車両を制御する車両制御部と、
前記車両の前方の地形の少なくとも高さを計測する地高計測部と、
前記地高計測部により計測された計測結果を蓄積し記憶する記憶部と、
前記記憶部に記憶された地形に基いて、前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する制御変更部と、
を有する自律走行車両。 - 前記制御変更部は、前記記憶部に記憶された地形の分散に応じて前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する
請求項1に記載の自律走行車両。 - 前記制御変更部は、前記記憶部に記憶された地形が凹形状である場合に、前記車両の出力の減少及び操舵角ゲインの減少の少なくともいずれかをもたらすように前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する
請求項1又は2に記載の自律走行車両。 - 前記制御変更部は、前記車両の前輪が前記凹形状に到達するより以前に前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する
請求項3に記載の自律走行車両。 - 前記制御変更部は、前記記憶部に記憶された地形が凹形状である場合に、前記車両の前輪が前記凹形状に到達する以前に前記車両の出力及び操舵角ゲインの少なくともいずれかを減少させ、前記車両の前輪が前記凹形状に到達後は当該車両の出力又は操舵角ゲインを増加させる
請求項3に記載の自律走行車両。 - 前記制御変更部は、前記記憶部に記憶された地形が凸形状である場合に、前記車両の出力の増加及び操舵角ゲインの増加の少なくともいずれかをもたらすように前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する
請求項1〜5のいずれかに記載の自律走行車両。 - 前記制御変更部は、前記車両の少なくとも前輪が前記凸形状に到達するより以前に前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する
請求項6に記載の自律走行車両。 - 前記制御変更部は、前記記憶部に記憶された地形が凸形状である場合に、前記車両の前輪が前記凸形状に到達する以前に前記車両の出力及び操舵角ゲインの少なくともいずれかを減少させ、前記車両の前輪が前記凸形状に到達後は当該車両の出力又は操舵角ゲインを増加させる
請求項6に記載の自律走行車両。 - さらに、前記車両の少なくともピッチ角を検出する姿勢検出部を有し、
前記地高計測部は、前記姿勢検出部により検出されたピッチ角による補正を行い地形の高さを計測する
請求項1〜8のいずれかに記載の自律走行車両。 - 自律走行を行うよう車両を制御する車両制御部と、
前記車両の前方の地形の少なくとも高さを計測する地高計測部を備えた車両と、
前記地高計測部により計測された計測結果を蓄積し記憶する記憶部と、
前記記憶部に記憶された地形に基いて、前記車両制御部の制御パラメータ及び制御入力の少なくともいずれかを変更する制御変更部と、
を有する車両の自律走行システム。 - 自律走行を行うよう車両を制御するステップと、
前記車両の前方の地形の少なくとも高さを計測するステップと、
前記車両の前方の地形の少なくとも高さについて計測された計測結果を蓄積し記憶するステップと、
記憶された地形に基いて、前記車両を制御する際の制御パラメータ及び制御入力の少なくともいずれかを変更するステップと、
を有する自律走行車両の制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015248011A JP2017111771A (ja) | 2015-12-18 | 2015-12-18 | 自律走行車両、自律走行システム及び自律走行車両の制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015248011A JP2017111771A (ja) | 2015-12-18 | 2015-12-18 | 自律走行車両、自律走行システム及び自律走行車両の制御方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2017111771A true JP2017111771A (ja) | 2017-06-22 |
Family
ID=59079744
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015248011A Pending JP2017111771A (ja) | 2015-12-18 | 2015-12-18 | 自律走行車両、自律走行システム及び自律走行車両の制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2017111771A (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPWO2019054438A1 (ja) * | 2017-09-15 | 2019-11-14 | ヤマハ発動機株式会社 | 既定ルートトレース車両 |
CN112218518A (zh) * | 2018-05-25 | 2021-01-12 | 托罗公司 | 具有困境避免和障碍物避开路径计划的自主地面维护机器 |
WO2022085078A1 (ja) * | 2020-10-20 | 2022-04-28 | 株式会社Fuji | 自動移動装置及び自動移動装置の制御方法 |
WO2023026395A1 (ja) * | 2021-08-25 | 2023-03-02 | 株式会社やまびこ | 自律走行式芝刈機 |
-
2015
- 2015-12-18 JP JP2015248011A patent/JP2017111771A/ja active Pending
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPWO2019054438A1 (ja) * | 2017-09-15 | 2019-11-14 | ヤマハ発動機株式会社 | 既定ルートトレース車両 |
CN112218518A (zh) * | 2018-05-25 | 2021-01-12 | 托罗公司 | 具有困境避免和障碍物避开路径计划的自主地面维护机器 |
CN112218518B (zh) * | 2018-05-25 | 2022-12-13 | 托罗公司 | 具有困境避免和障碍物避开路径计划的自主地面维护机器 |
WO2022085078A1 (ja) * | 2020-10-20 | 2022-04-28 | 株式会社Fuji | 自動移動装置及び自動移動装置の制御方法 |
WO2023026395A1 (ja) * | 2021-08-25 | 2023-03-02 | 株式会社やまびこ | 自律走行式芝刈機 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5837902B2 (ja) | 自律走行車両、自律走行車両の制御システム及び自律走行車両の制御方法 | |
US20230365136A1 (en) | Road friction and wheel slippage assessment for autonomous vehicles | |
US10106167B2 (en) | Control system and method for determining an irregularity of a road surface | |
CN110036353A (zh) | 用于跟踪路线的地面车辆中的自适应控制方法和系统,尤其是在自动驾驶场景中 | |
JP6418332B2 (ja) | 車両位置推定装置、車両位置推定方法 | |
KR101927038B1 (ko) | 차량 위치 추정 장치, 차량 위치 추정 방법 | |
US10386840B2 (en) | Cruise control system and method | |
US20140172225A1 (en) | Speed control in agricultural vehicle guidance systems | |
US20140172222A1 (en) | Speed control in agricultural vehicle guidance systems | |
JP2017111771A (ja) | 自律走行車両、自律走行システム及び自律走行車両の制御方法 | |
CN111806433B (zh) | 一种自动驾驶车辆避障方法、装置及设备 | |
KR20170055161A (ko) | 자율 주행 차량의 조향 제어 방법 및 장치 | |
JP2019113926A (ja) | モデル予測制御装置 | |
KR102057428B1 (ko) | 차량의 주행 제어 방법 및 주행 제어 장치 | |
US20200317188A1 (en) | Systems and methods for monitoring a vehicle during auto-parking | |
US20210001850A1 (en) | Vehicle control method and apparatus | |
JPWO2015015939A1 (ja) | 車両位置姿勢角推定装置及び車両位置姿勢角推定方法 | |
JP5781126B2 (ja) | 障害物判定装置、自律移動装置および障害物判定方法 | |
JP6216545B2 (ja) | 自律走行車両、車両の自律走行システム及び自律走行車両の制御方法 | |
KR101245754B1 (ko) | 자율주행 로봇 및 경로설정 방법 | |
GB2571590A (en) | Vehicle control method and apparatus | |
JP6704061B2 (ja) | 移動装置、および、移動装置管理システム | |
US11345343B2 (en) | Controller and method for controlling the driving direction of a vehicle | |
JP6413919B2 (ja) | 車両姿勢制御装置 | |
US11059480B2 (en) | Collision avoidance system with elevation compensation |