(57)【要約】  牽引車両（１００）を自律的に操縦するための方法。本方法は、牽引車両（１００）の後部位置に配置されている１つまたは複数のカメラ（１４２）から、画像（１４３）を受信することと、牽引車両（１００）によって支持されている慣性測定ユニット（１４４）から、センサデータを受信することとを含む。本方法は、現在受信した画像と、以前に受信した画像との間のピクセル単位の強度差を決定することも含む。本方法は、世界座標系に対するカメラ姿勢およびトレーラ姿勢を特定することを含む。カメラ姿勢およびトレーラ姿勢は、画像（１４３）と、センサデータ（１４５）と、ピクセル単位の強度差とに基づいている。本方法は、カメラ姿勢およびトレーラ姿勢に基づいて牽引車両経路を決定することを含む。本方法は、牽引車両（１００）がトレーラ（２００）とヒッチングされるように牽引車両（１００）を牽引車両経路に沿って後退方向に自律的に操縦させるように、牽引車両（１００）によって支持されている運転システム（１１０）に命令することも含む。
2021520000.tif 000002
【特許請求の範囲】
【請求項１】
トレーラと牽引車両との間の自律的なヒッチングのために、前記トレーラに向かって前記牽引車両を自律的に操縦するための方法であって、
当該方法は、
データ処理ハードウェアにおいて、前記牽引車両の後部位置に配置されていて、かつ前記データ処理ハードウェアと通信する１つまたは複数のカメラから、画像を受信することと、
前記データ処理ハードウェアにおいて、当該データ処理ハードウェアと通信していて、かつ前記牽引車両によって支持されている慣性測定ユニットから、センサデータを受信することと、
前記データ処理ハードウェアにおいて、現在受信した画像と、以前に受信した画像との間のピクセル単位の強度差を求めることと、
前記データ処理ハードウェアにおいて、前記画像と、前記センサデータと、前記ピクセル単位の強度差とに基づいて、世界座標系に対するカメラ姿勢およびトレーラ姿勢を特定することと、
前記データ処理ハードウェアにおいて、前記カメラ姿勢および前記トレーラ姿勢に基づいて牽引車両経路を決定することと、
前記牽引車両が前記トレーラとヒッチングされるように前記牽引車両を前記牽引車両経路に沿って後退方向に自律的に操縦させるための命令を、前記データ処理ハードウェアから、前記牽引車両によって支持されている運転システムに送信することと
を含む、方法。
【請求項２】
前記１つまたは複数のカメラは、超広角レンズを含む魚眼レンズを含む、
請求項１記載の方法。
【請求項３】
前記カメラ姿勢は、前記世界座標系におけるカメラ位置およびカメラ角度を含み、
前記トレーラ姿勢は、前記世界座標系におけるトレーラ位置およびトレーラ角度を含む、
請求項１記載の方法。
【請求項４】
前記画像の内部における、前記トレーラに関連付けられた１つまたは複数の特徴点を識別することと、
前記１つまたは複数の特徴点に基づいて、前記トレーラの正面を示す平面を特定することと、
前記平面に対する法線を求めることと、
前記法線に基づいて前記トレーラ角度を特定することと
をさらに含む、請求項３記載の方法。
【請求項５】
前記画像の内部における、前記トレーラの表現を取り囲む関心領域を決定することをさらに含み、
前記現在受信した画像と、前記以前に受信した画像との間のピクセル単位の強度差を求めることは、
前記現在受信した画像の関心領域と、前記以前に受信した画像の関心領域との間のピクセル単位の強度差を求めること
を含む、請求項１記載の方法。
【請求項６】
前記関心領域の内部における、前記トレーラに関連付けられた１つまたは複数の特徴点を識別することと、
前記車両が前記経路に沿って自律的に操縦される際に、前記１つまたは複数の特徴点を追跡することと
をさらに含む、請求項５記載の方法。
【請求項７】
前記牽引車両が追従する、前記経路に関連付けられた点のシーケンスを決定することと、
前記点のシーケンス内におけるそれぞれの点に関連付けられたステアリングホイール角度を決定することと、
決定された前記ステアリングホイール角度に基づいて現在のステアリングホイール角度を調整するための命令を、前記運転システムに送信することと
をさらに含む、請求項１記載の方法。
【請求項８】
前記車両が前記経路に沿って自律的に操縦される際に、前記牽引車両のそれぞれの前輪の操舵角度間の差を求めることと、
それぞれの前輪のステアリングホイール角度間の差に基づいてそれぞれの車輪のステアリングホイール角度を調整するための命令を、前記運転システムに送信することと
をさらに含む、請求項１記載の方法。
【請求項９】
トレーラと牽引車両との間の自律的なヒッチングのために、前記トレーラに向かって前記牽引車両を自律的に操縦するためのシステムであって、
当該システムは、
データ処理ハードウェアと、
前記データ処理ハードウェアと通信するメモリハードウェアと
を含み、
前記メモリハードウェアは、前記データ処理ハードウェア上で実行された場合に、前記データ処理ハードウェアに所定の動作を実行させる命令を格納しており、
前記動作は、
前記牽引車両の後部位置に配置されていて、かつ前記データ処理ハードウェアと通信する１つまたは複数のカメラから、画像を受信することと、
前記データ処理ハードウェアと通信していて、かつ前記牽引車両によって支持されている慣性測定ユニットから、センサデータを受信することと、
現在受信した画像と、以前に受信した画像との間のピクセル単位の強度差を求めることと、
前記画像と、前記センサデータと、前記ピクセル単位の強度差とに基づいて、世界座標系に対するカメラ姿勢およびトレーラ姿勢を特定することと、
前記カメラ姿勢および前記トレーラ姿勢に基づいて牽引車両経路を決定することと、
前記牽引車両が前記トレーラとヒッチングされるように前記牽引車両を前記牽引車両経路に沿って後退方向に自律的に操縦させるための命令を、前記牽引車両によって支持されている運転システムに送信することと
を含む、
システム。
【請求項１０】
前記１つまたは複数のカメラは、超広角レンズを含む魚眼レンズを含む、
請求項９記載のシステム。
【請求項１１】
前記カメラ姿勢は、前記世界座標系におけるカメラ位置およびカメラ角度を含み、
前記トレーラ姿勢は、前記世界座標系におけるトレーラ位置およびトレーラ角度を含む、
請求項９記載のシステム。
【請求項１２】
前記動作は、
前記画像の内部における、前記トレーラに関連付けられた１つまたは複数の特徴点を識別することと、
前記１つまたは複数の特徴点に基づいて、前記トレーラの正面を示す平面を特定することと、
前記平面に対する法線を求めることと、
前記法線に基づいて前記トレーラ角度を特定することと
をさらに含む、請求項１１記載のシステム。
【請求項１３】
前記動作は、
前記画像の内部における、前記トレーラの表現を取り囲む関心領域を決定すること
をさらに含み、
前記現在受信した画像と、前記以前に受信した画像との間のピクセル単位の強度差を求めることは、
前記現在受信した画像の関心領域と、前記以前に受信した画像の関心領域との間のピクセル単位の強度差を求めること
を含む、請求項９記載のシステム。
【請求項１４】
前記動作は、
前記関心領域の内部における、前記トレーラに関連付けられた１つまたは複数の特徴点を識別することと、
前記車両が前記経路に沿って自律的に操縦される際に、前記１つまたは複数の特徴点を追跡することと
をさらに含む、請求項１３記載のシステム。
【請求項１５】
前記動作は、
前記牽引車両が追従する、前記経路に関連付けられた点のシーケンスを決定することと、
前記点のシーケンス内におけるそれぞれの点に関連付けられたステアリングホイール角度を決定することと、
決定された前記ステアリングホイール角度に基づいて現在のステアリングホイール角度を調整するための命令を、前記運転システムに送信することと
をさらに含む、請求項９記載のシステム。
【請求項１６】
前記動作は、
前記車両が前記経路に沿って自律的に操縦される際に、前記牽引車両のそれぞれの前輪の操舵角度間の差を求めることと、
それぞれの前輪のステアリングホイール角度間の差に基づいてそれぞれの車輪のステアリングホイール角度を調整するための命令を、前記運転システムに送信することと
をさらに含む、請求項９記載のシステム。
【発明の詳細な説明】
【技術分野】
【０００１】
技術分野
本開示は、車両の後ろに配置されたトレーラを検出し、トレーラに向かって車両を自律的に操縦するための方法および装置に関する。
【０００２】
背景
トレーラは、通常、動力付きの牽引車両によって牽引される動力なしの車両である。トレーラは、とりわけユーティリティトレーラ、ポップアップキャンピングカー、旅行用トレーラ、家畜用トレーラ、フラットベッドトレーラ、密閉型自動車運搬車、およびボートトレーラであり得る。牽引車両は、自動車、クロスオーバー、トラック、バン、多目的スポーツ車（ＳＵＶ）、レクリエーション用車両（ＲＶ）、またはトレーラに取り付けられてトレーラを牽引するように構成された他の任意の車両であり得る。トレーラは、トレーラヒッチを使用して動力車に取り付け可能である。レシーバーヒッチは、牽引車両に据え付けられており、トレーラヒッチに接続されて連結部を形成する。トレーラヒッチは、ボールおよびソケット、第５輪およびグースネック、またはトレーラジャッキであり得る。他の取り付け機構を使用してもよい。トレーラと動力車との間の機械的な接続に加えて、いくつかの例では、トレーラは、牽引車両に電気的に接続されている。したがって、この電気的な接続によって、トレーラは、動力車のリアランプ回路から給電を受けることが可能となり、これによって、トレーラは、動力車のランプと同期するテールランプ、方向指示器、およびブレーキランプを有することが可能となる。
【０００３】
センサ技術の最近の進歩により、車両のための安全性システムが改善されてきた。したがって、牽引車両に対して相対的なトレーラの位置を特定し、これによって牽引車両がトレーラに向かって自律的に操縦され、トレーラと自律的にヒッチングされることを可能にするようなシステムを提供することが望まれている。
【０００４】
概要
本開示の１つの態様は、トレーラと牽引車両との間の自律的なヒッチングのために、トレーラに向かって牽引車両を自律的に操縦するための方法を提供する。本方法は、データ処理ハードウェアにおいて、牽引車両の後部位置に配置されていて、かつデータ処理ハードウェアと通信する１つまたは複数のカメラから、画像を受信することを含む。本方法は、データ処理ハードウェアにおいて、当該データ処理ハードウェアと通信していて、かつ牽引車両によって支持されている(supported)慣性測定ユニット(inertial measurement unit)から、センサデータを受信することも含む。本方法は、データ処理ハードウェアにおいて、現在受信した画像と、以前に受信した画像との間のピクセル単位（pixel-wise）の強度差を求めることも含む。本方法は、データ処理ハードウェアにおいて、世界座標系(world coordinate system)に対するカメラ姿勢およびトレーラ姿勢を特定することを含む。カメラ姿勢およびトレーラ姿勢は、画像と、センサデータと、ピクセル単位の強度差とに基づいている。本方法は、データ処理ハードウェアにおいて、カメラ姿勢およびトレーラ姿勢に基づいて牽引車両経路を決定することも含む。本方法は、命令を、データ処理ハードウェアから、牽引車両によって支持されている(supported)運転システムに送信することも含む。命令は、牽引車両がトレーラとヒッチングされるように牽引車両を牽引車両経路に沿って後退方向に自律的に操縦させるものである。
【０００５】
本開示の実装形態は、以下のオプションの特徴のうちの１つまたは複数を含むことができる。いくつかの実装形態では、１つまたは複数のカメラは、超広角レンズを含む魚眼レンズを含む。カメラ姿勢は、世界座標系におけるカメラ位置およびカメラ角度を含むことができる。トレーラ姿勢は、世界座標系におけるトレーラ位置およびトレーラ角度を含むことができる。
【０００６】
いくつかの例では、本方法は、画像の内部における、１つまたは複数の特徴点を識別することをさらに含む。特徴点は、トレーラに関連付けられている。本方法は、１つまたは複数の特徴点に基づいて、平面を特定することを含むこともできる。平面は、トレーラの正面を示す。本方法は、平面に対する法線を求めることを含むこともできる。いくつかの例では、本方法は、法線に基づいてトレーラ角度を特定することも含む。
【０００７】
いくつかの実装形態では、本方法は、画像の内部における、トレーラの表現を取り囲む関心領域を決定することを含むことができる。現在受信した画像と、以前に受信した画像との間のピクセル単位の強度差を求めることは、現在受信した画像の関心領域と、以前に受信した画像の関心領域との間のピクセル単位の強度差を求めることを含む。本方法は、関心領域の内部における、１つまたは複数の特徴点を識別することをさらに含むことができる。特徴点は、トレーラに関連付けられている。本方法は、車両が経路に沿って自律的に操縦される際に、１つまたは複数の特徴点を追跡することを含むこともできる。
【０００８】
いくつかの例では、本方法は、経路に関連付けられた点のシーケンス(sequence of points)を決定することをさらに含む。牽引車両は、点のシーケンスに追従する。本方法は、点のシーケンスの内部におけるそれぞれの点に関連付けられたステアリングホイール角度を決定することを含むこともできる。本方法は、決定されたステアリングホイール角度に基づいて現在のステアリングホイール角度を調整するための命令を、運転システムに送信することを含むこともできる。いくつかの例では、本方法は、車両が経路に沿って自律的に操縦される際に、牽引車両のそれぞれの前輪の操舵角度間の差を決定することをさらに含む。本方法は、それぞれの前輪のステアリングホイール角度間の差に基づいてそれぞれの車輪のステアリングホイール角度を調整するための命令を、運転システムに送信することを含むこともできる。
【０００９】
本開示の別の態様は、トレーラと牽引車両との間の自律的なヒッチングのために、トレーラに向かって牽引車両を自律的に操縦するためのシステムを提供する。本システムは、データ処理ハードウェアと、データ処理ハードウェアと通信するメモリハードウェアとを含む。メモリハードウェアは、データ処理ハードウェア上で実行された場合に、データ処理ハードウェアに上記の方法を含む所定の動作を実行させる命令を格納している。
【００１０】
本開示の１つまたは複数の実装形態の詳細は、添付の図面および以下の説明に記載されている。他の態様、特徴、および利点は、明細書および図面、ならびに特許請求の範囲から明らかになるであろう。
【図面の簡単な説明】
【００１１】
【図１Ａ】牽引車両の後ろに配置されたトレーラから離間されている例示的な牽引車両の概略上面図である。
【図１Ｂ】車両の後方部分に配置されたカメラによって捕捉された例示的な画像の概略図であり、この画像は、車両の後ろに配置されたトレーラを捕捉する。
【図１Ｃ】世界座標に対する例示的なトレーラ姿勢および例示的なカメラ姿勢の概略図である。
【図２】ユーザインターフェースおよびセンサシステムを有する例示的な牽引車両の概略図である。
【図３】図２に示されている例示的な位置推定システムの概略図である。
【図４】図２に示されている例示的な経路計画システムの概略図である。
【図５】図５Ａ〜Ｃは、図４に示されているＤｕｂｉｎｓ経路生成モジュールによって生成される例示的な経路の概略図である。
【図６】牽引車両をトレーラに向かって自律的に操縦するための各動作の例示的な構成の概略図である。
【００１２】
複数の異なる図面における同様の参照符号は、同様の要素を指す。
【００１３】
詳細な説明
限定するわけではないが、自動車、クロスオーバー、トラック、バン、多目的スポーツ車（ＳＵＶ）、レクリエーション用車両（ＲＶ）のような牽引車両は、トレーラを牽引するように構成可能である。牽引車両は、トレーラヒッチを介してトレーラに接続される。ユーザディスプレイのようなユーザインターフェース上に表示される、トレーラの１つまたは複数のトレーラ表現から識別されるトレーラに向かって自律的に後退することができる牽引車両を有することが望まれている。さらに、牽引車両の後方部分に配置されたカメラから受信した１つまたは複数の画像に基づいて、トレーラ位置、例えば、牽引車両に対して相対的なトレーラ角度およびトレーラ位置を推定することができる牽引車両を有することも望まれている。牽引車両に対するトレーラの角度および位置は、例えば、受信した画像からの視覚情報と、ＩＭＵ（慣性測定ユニット）センサデータとを融合することによって特定可能である。さらに、トレーラに向かって計画された経路に沿って自律的に操縦することができる牽引車両を有することと、牽引車両の車両ヒッチボールとトレーラヒッチカプラとの間で自律的にヒッチングするために、トレーラのトレーラヒッチカプラとの位置合わせを行うことが望まれている。
【００１４】
図１Ａ〜図２を参照すると、いくつかの実装形態では、牽引車両１００の運転者は、牽引車両１００の後ろに配置されたトレーラ２００を牽引することを希望する。牽引車両１００は、選択されたトレーラ２００，２００ａ〜ｃに関連付けられた、運転者によるトレーラ選択１３４の指示を受信するように構成可能である。いくつかの例では、運転者が、選択されたトレーラ２００，２００ａ〜ｃに向かって牽引車両１００を操縦し、その一方で、他の例では、牽引車両１００が、選択されたトレーラ２００，２００ａ〜ｃに向かって自律的に運転される。牽引車両１００は、例えば、ｘ，ｙ，およびｚ成分を有する運転コマンドに基づいて路面にわたって牽引車両１００を操縦する運転システム１１０を含むことができる。図示のように、運転システム１１０は、右前輪１１２，１１２ａと、左前輪１１２，１１２ｂと、右後輪１１２，１１２ｃと、左後輪１１２，１１２ｄとを含む。運転システム１１０は、他の車輪構成を含むこともできる。運転システム１１０は、それぞれの車輪１１２，１１２ａ〜ｄに関連付けられたブレーキを含む制動システム１１４と、牽引車両１００の速度および方向を調整するように構成された加速システム１１６とを含むこともできる。さらに、運転システム１１０は、サスペンションシステム１１８を含むことができ、このサスペンションシステム１１８は、それぞれの車輪１１２，１１２ａ〜ｄに関連付けられたタイヤ、タイヤ空気、スプリング、ショックアブソーバ、およびリンク機構を含み、このリンク機構は、牽引車両１００を牽引車両１００の車輪１１２，１１２ａ〜ｄに接続し、かつ牽引車両１００と車輪１１２，１１２ａ〜ｄとの間の相対運動を可能にする。サスペンションシステム１１８は、牽引車両１００の高さを調整して、牽引車両ヒッチ１２０（例えば、車両ヒッチボール１２２）を、トレーラヒッチ２１０（例えば、トレーラヒッチカプラまたはトレーラヒッチカップ２１２）と位置合わせすることができるように構成可能であり、これにより、牽引車両１００とトレーラ２００との間の自律的な接続が可能になる。
【００１５】
牽引車両１００は、牽引車両１００によって定義される３つの相互に垂直な軸、すなわち横軸Ｘ、前後軸Ｙ、および中心垂直軸Ｚに対して相対的な、複数の異なる運動を組み合わせることによって、路面にわたって移動することができる。横軸Ｘは、牽引車両１００の右側と左側との間に延在している。前後軸Ｙに沿った前進運転方向は、Ｆとして指定され、前進運動とも称される。さらに、前後方向Ｙに沿った後進運転方向または後退運転方向は、Ｒとして指定され、後退運動とも称される。サスペンションシステム１１８が牽引車両１００のサスペンションを調整する際には、牽引車両１００を、Ｘ軸および／またはＹ軸を中心にして傾斜させるか、または中心垂直軸Ｚに沿って移動させることができる。
【００１６】
牽引車両１００は、ユーザインターフェース１３０を含むことができる。いくつかの例では、ユーザインターフェース１３０は、タッチスクリーンディスプレイ１３２であり、このタッチスクリーンディスプレイ１３２によって運転者は、ディスプレイを介して選択を行うことができる。他の例では、ユーザインターフェース１３０は、タッチスクリーンではなく、運転者は、限定するわけではないが、回転ノブまたはマウスのような入力デバイスを使用して選択を行うことができる。ユーザインターフェース１３０は、１つまたは複数の入力機構またはタッチスクリーンディスプレイ１３２を介して運転者から１つまたは複数のユーザコマンドを受信し、かつ／または運転者への１つまたは複数の通知を表示する。ユーザインターフェース１３０は、車両制御装置１５０と通信しており、車両制御装置１５０自体は、センサシステム１４０と通信する。いくつかの例では、ユーザインターフェース１３０は、牽引車両１００の周囲環境の画像１４３を表示して、１つまたは複数の挙動の実行を開始する１つまたは複数のコマンドが（運転者から）ユーザインターフェース１３０によって受信されるようにする。いくつかの例では、ユーザディスプレイ１３２は、牽引車両１００の後ろに配置されたトレーラ２００の１つまたは複数のトレーラ表現１３６，１３６ａ〜ｃを表示する。この場合、運転者は、トレーラ２００のトレーラ表現１３６，１３６ａ〜ｃのトレーラ選択１３４を行う。次に、制御装置１５０は、牽引車両１００に対するトレーラ選択１３４に関連付けられたトレーラ２００の位置ＬＴを特定することができる。他の例では、制御装置１５０は、１つまたは複数のトレーラ２００を検出し、牽引車両１００に対する、トレーラ表現１３６，１３６ａ〜ｃの各々に関連付けられたこれらのトレーラの各々の位置ＬＴを特定する。車両制御装置１５０は、コンピューティングプロセッサ１５２上で実行可能な命令を格納することができる非一時的メモリ１５４（例えば、ハードディスク、フラッシュメモリ、ランダムアクセスメモリ、メモリハードウェア）と通信するコンピューティングデバイス（プロセッサ）１５２（例えば、１つまたは複数のコンピューティングプロセッサを有する中央処理装置）を含む。
【００１７】
車両制御装置１５０は、運転支援システム１８０を実行し、運転支援システム１８０自体は、経路追従挙動１８２を含む。運転支援システム１８０は、経路計画システム４００から計画された経路５００を受信し、運転システム１１０にコマンド１８４を送信する挙動１８２ａ〜１８２ｃを実行して、計画された経路５００に関して後退方向Ｒに牽引車両１００を自律的に運転させ、かつトレーラ２００と自律的にヒッチングさせる。
【００１８】
経路追従挙動１８２は、制動挙動１８２ａと、速度挙動１８２ｂと、操舵挙動１８２ｃとを含む。いくつかの例では、経路追従挙動１８２は、ヒッチ接続挙動（車両ヒッチボール１２２とトレーラヒッチカップ２１２との接続を可能にする）と、サスペンション調整挙動（車両ヒッチボール１２２とトレーラヒッチカプラ２１２とのヒッチングを可能にするために、車両サスペンションを調整する）も含む。それぞれの挙動１８２ａ〜１８２ｃは、牽引車両１００に、とりわけ後退運転、特定の角度での旋回、制動、加速、減速のような行動をとらせる。車両制御装置１５０は、運転システム１１０を制御することによって、より具体的には、運転システム１１０にコマンド１８４を発行することによって、牽引車両１００を路面にわたって任意の方向に操縦することができる。
【００１９】
牽引車両１００は、高信頼性かつロバストな運転を提供するためのセンサシステム１４０を含むことができる。センサシステム１４０は、種々異なる種類のセンサを含むことができ、これらの種々異なる種類のセンサは、牽引車両１００の周囲環境の知覚情報を作成するために別々にまたは他のセンサと一緒に使用可能であり、牽引車両１００の周囲環境の知覚情報は、センサシステム１４０によって検出された物体および障害物に基づいて、牽引車両１００を運転するため、かつ運転者がインテリジェントな決定を行うことを支援するために使用される。センサシステム１４０は、１つまたは複数のカメラ１４２，１４２ａ〜ｄを含むことができる。いくつかの実装形態では、牽引車両１００は、牽引車両１００の後方運転経路のビューを提供するために据え付けられた後方カメラ１４２，１４２ａを含む。後方カメラ１４２ａは、広範囲のパノラマ画像または半球画像を作成するために意図された強力な視覚的歪みを生成する超広角レンズを含む魚眼レンズを含むことができる。魚眼カメラは、非常に広い画角を有する画像を捕捉する。さらに、魚眼カメラ１４２ａによって捕捉された画像１４３は、凸状の非直線的な外観を有する。牽引車両１００の後方環境の画像１４３を捕捉するために、他の種類のカメラ１４２を使用してもよい。
【００２０】
いくつかの実装形態では、センサシステム１４０は、車両の線形加速度（１つまたは複数の加速度計を使用して）および回転速度（１つまたは複数のジャイロスコープを使用して）を測定するように構成されたＩＭＵ（慣性測定ユニット）１４４を含むこともできる。いくつかの例では、ＩＭＵ１４４は、牽引車両１００の方位基準も決定する。したがって、ＩＭＵ１４４は、牽引車両１００のピッチ、ロール、およびヨーを決定する。
【００２１】
センサシステム１４０は、限定するわけではないが、レーダー、ソナー、ＬＩＤＡＲ（Light Detection and Rangingであり、散乱光の特性を測定して、遠方の目標の距離および／または他の情報を検出する光学リモートセンシングを伴うことが可能）、ＬＡＤＡＲ（Laser Detection and Ranging）、超音波センサ等のような、他のセンサを含むことができる。追加的なセンサを使用してもよい。
【００２２】
車両制御装置１５０は、位置推定および経路計画システム１６０を実行し、この位置推定および経路計画システム１６０は、カメラ１４２からの画像１４３と、ＩＭＵ１４４からのＩＭＵデータ１４５とを受信し、これらの受信した画像１４３に基づいて、牽引車両１００に対するトレーラ２００の位置ＬＴを特定する。
【００２３】
制御装置１５０は、後方カメラ１４２ａからの画像データ１４３と、ＩＭＵ１４４からのＩＭＵセンサデータ１４５とを受信し、これらの受信したデータ１４３，１４５に基づいて、世界座標の原点に対するカメラ姿勢３３２（すなわち、カメラ位置ＬＣおよびカメラ角度αＣ）およびトレーラ姿勢３４８（すなわち、トレーラ位置ＬＴおよびトレーラ角度αＴ）を推定する。世界座標の原点は、車両１００の開始姿勢において定義される。制御装置１５０は、位置推定および経路計画システム１６０を含み、この位置推定および経路計画システム１６０は、位置推定システム３００を含む。位置推定システム３００は、カメラデータ１４３（例えば、単眼カメラデータ）と、ＩＭＵセンサデータ１４５とを融合して、世界座標の原点に対するトレーラ姿勢３４８、すなわちトレーラ位置ＬＴおよびトレーラ角度αＴと、世界座標の原点に対するカメラ位置ＬＣおよびカメラ角度αＣとを推定する。トレーラ角度αＴは、世界座標の前後軸Ｙと、トレーラ２００の中心線との間の角度である。カメラ角度αＣは、世界座標の前後軸Ｙと、カメラの光軸との間の角度である。位置推定システム３００が、世界座標に対するトレーラ２００ａの位置ＬＴおよびトレーラ２００ａの角度αＴと、世界座標に対するカメラ位置ＬＣおよびカメラ角度αＣとを特定すると、経路計画システム４００が、牽引車両１００をトレーラ２００ａと位置合わせするための軌道または経路５００を決定する。
【００２４】
位置推定および経路計画システム１６０は、位置推定システム３００と、経路計画システム４００とを含む。図３を参照すると、位置推定システム３００は、画像化モジュール３１０を含み、この画像化モジュール３１０は、トレーラＲＯＩ検出モジュール３１２と、特徴検出および追跡モジュール３１４とを含む。さらに、位置推定システム３００は、繰り返し拡張カルマンフィルタ３２０と、カメラ姿勢モジュール３３０と、トレーラ姿勢推定モジュール３４０とを含む。
【００２５】
トレーラＲＯＩ検出モジュール３１２は、トレーラ表現１３６が含まれた後方カメラ１４２ａからの画像１４３を受信する。前述したように、いくつかの例では、画像１４３は、牽引車両１００の後ろに配置された１つまたは複数のトレーラ２００，２００ａ〜ｃに関連付けられた１つまたは複数のトレーラ表現１３６，１３６ａ〜ｃを含む。いくつかの例では、画像１４３に２つ以上のトレーラ表現１３６が含まれている場合には、位置推定および経路計画システム１６０は、これらのトレーラ２００のうちの１つの表現に関連付けられたトレーラ選択１３４を要求するように、ディスプレイ１３２に命令する。運転者は、画像１４３からトレーラ２００ａ（すなわち、トレーラ２００ａの表現１３６ａ）を選択する。トレーラ表現１３６が選択または識別されると、いくつかの例では、トレーラＲＯＩ検出モジュール３１２は、この識別されたトレーラ表現１３６を、図１Ｂに示されている関心領域（ＲＯＩ）２００とも称される境界枠によって境界付ける。他の例では、トレーラＲＯＩ検出モジュール３１２は、識別されたトレーラ表現１３６ａを境界枠によって、すなわちＲＯＩ２３０によって境界付けることにより、トレーラ２００ａ（すなわち、トレーラ２００ａの表現１３６ａ）を選択することを運転者に要求するように、ディスプレイ１３２に命令する。運転者は、画像１４３の内部においてトレーラ表現１３６を取り巻くように境界枠２００を選択するために、ユーザインターフェース１３０を介して、例えばタッチスクリーンディスプレイ１３２を介して、または回転ノブもしくはマウスを介して境界枠２００を入力することができる。
【００２６】
トレーラＲＯＩ検出モジュール３１２が、トレーラ表現１３６が含まれたＲＯＩ２３０を検出および識別すると、特徴検出および追跡モジュール３１４は、ＲＯＩ２３０の内側にある視覚的特徴点３１６を識別する。視覚的特徴点３１６は、例えば、トレーラの車輪、カプラ２１２、トレーラの縁部、またはトレーラ２００に関連付けられた任意の他の特徴であり得る。ＲＯＩ２３０の内側にある特徴点３１６が検出されると、特徴検出および追跡モジュール３１４は、牽引車両１００がトレーラ２００に向かって移動している間、これらの検出された特徴３１６を追跡する。
【００２７】
前述したように、位置推定システム３００は、繰り返し拡張カルマンフィルタ３２０を含み、この繰り返し拡張カルマンフィルタ３２０は、ＲＯＩ２３０の内側にある識別された特徴点３１６と、ＩＭＵセンサデータ１４５とを受信し、これらの受信したデータ１４５，３１６を分析する。繰り返し拡張カルマンフィルタ３２０は、識別された特徴点３１６と、ＩＭＵデータ１４５とを融合する。繰り返し拡張カルマンフィルタ３２０は、システムの動的モデルと、このシステムへの既知の制御入力と、（センサからの）複数の連続的な測定値とを使用して、システムの変化する量を推定する。
【００２８】
拡張カルマンフィルタは、現在の平均および共分散の推定値に関して線形化するカルマンフィルタの非線形バージョンである。カルマンフィルタは、統計的ノイズおよびその他の不正確性を含む、経時的に観察された一連の測定値を使用するアルゴリズムであり、１つの測定値に基づいたものよりもより正確な、未知の変数の推定値を出力する。なぜなら、カルマンフィルタ３２０は、それぞれの時間枠ごとに複数の変数にわたって同時確率分布を推定するからである。カルマンフィルタ３２０は、２つのステップのプロセスで計算を実行する。予測ステップとも呼ばれる第１のステップの間に、カルマンフィルタ３２０は、それぞれの現在の状態変数３２４ａ〜ｊに関連付けられた不確実性とともに、現在の状態３２２ｃ（状態３２４，３２４ａｃ〜３２４ｊｃ）を決定する。目下の測定値の結果が観察されると、更新ステップとも呼ばれる第２のステップにおいて、これらの現在の状態３２２ｃ（状態３２４，３２４ａｃ〜ｊｃ）が、加重平均を使用して更新され、この際、より高い確実性を有するほう（現在の状態３２２ｃ（状態３２４，３２４ａｃ〜３２４ｊｃ）または目下の測定値のいずれか）により重い重みが付けられる。このアルゴリズムは、再帰的であり、入力された目下の測定値と、現在のフィルタ状態３２２ｃ（状態３２４，３２４ａｃ〜ｊｃ）とを使用してリアルタイムで実行されて、更新されたフィルタ状態３２２ｕ（状態３２４，３２４ａｕ〜３２４ｊｕ）を決定するので、追加的な過去の情報は必要とされない。繰り返し拡張カルマンフィルタ３２０は、所要計算量の増加を犠牲にして線形化誤差を低減することにより、拡張カルマンフィルタの線形化を改善する。
【００２９】
繰り返し拡張カルマンフィルタは、ＩＭＵ１４４からのＩＭＵセンサデータ１４５と、ＲＯＩ２３０の内側にある視覚的特徴点３１６とを受信する。いくつかの実装形態では、繰り返し拡張カルマンフィルタ３２０は、フィルタ状態３２２，３２２ｃ，３２２ｕを決定し、これらのフィルタ状態３２２，３２２ｃ，３２２ｕは、受信したＩＭＵセンサデータ１４５と、視覚的特徴点３１６とに基づいて継続的に更新される。フィルタ状態３２２，３２２ｃ，３２２ｕは、ＩＭＵ１４４と後方カメラ１４２ａとの間の距離３２４ｆのような較正値を含むことができる。なぜなら、牽引車両１００の内部におけるこれらの両方の位置は、既知だからである。いくつかの例では、フィルタ状態３２２，３２２ｃ，３２２ｕは、ＩＭＵ位置状態３２４ａと、ＩＭＵ速度状態３２４ｂと、ＩＭＵ高度状態３２４ｃとを含み、これらの状態は、繰り返し拡張カルマンフィルタ３２０によって、ＩＭＵセンサデータ１４５（牽引車両１００の加速度データおよび角速度データを含む）、ＩＭＵ１４４と後方カメラ１４２ａとの間の較正距離３２４ｆ、および座標系、例えば世界座標系におけるカメラ１４２ａの位置に基づいて決定される。世界座標系は、世界の原点（座標が［０，０，０］である点）を定義し、互いに直交する３つの単位軸を定義する。世界空間内のあらゆる点の座標は、世界の原点を基準にして定義される。世界座標系が定義されると、世界空間内の位置によってカメラ１４２ａの位置を定義することができ、互いに直交する３単位ベクトルによってカメラ１４２ａの向きを定義することができる。いくつかの例では、世界の原点は、カメラの初期位置によって定義され、３単位軸は、カメラの初期向きによって定義される。カメラ１４２ａの位置は、以下に説明するようにカメラ姿勢モジュール３３０によって特定または把握される。前述したように、ＩＭＵ１４４は、牽引車両の線形加速度を決定するための加速度計と、車輪の回転速度を決定するためのジャイロスコープとを含む。さらに、いくつかの例では、フィルタ状態３２２，３２２ｃ，３２２ｕは、加速度計バイアス状態３２４ｄと、ジャイロスコープバイアス状態３２４ｅとを含む。加速度計およびジャイロスコープのような慣性センサは、動きが存在しない場合でも、平均信号出力に小さなオフセットを含むことがよくある。加速度計バイアス状態３２４ｄは、平均信号出力における加速度計センサの小さなオフセットを推定し、ジャイロスコープバイアス状態３２４ｅは、平均信号出力におけるジャイロスコープセンサの小さなオフセットを推定する。
【００３０】
いくつかの例では、フィルタ状態３２２，３２２ｃ，３２２ｕは、ＲＯＩ特徴点に対するカメラ向き状態３２４ｇを含み、このＲＯＩ特徴点に対するカメラ向き状態３２４ｇは、特徴検出および追跡モジュール３１４によって識別された１つまたは複数のＲＯＩ特徴点３１６に対するカメラ１４２ａの向きである。フィルタ状態３２４は、ＲＯＩ特徴点に対するカメラ距離状態３２４ｈを含むこともでき、このＲＯＩ特徴点に対するカメラ距離状態３２４ｈは、特徴検出および追跡モジュール３１４によって識別された１つまたは複数のＲＯＩ特徴点３１６と、カメラ１４２ａとの間の距離である。
【００３１】
繰り返し拡張カルマンフィルタ３２０は、現在の画像１４３の視覚的特徴点３１６と、以前に追跡された画像１４３の視覚的特徴点３１６との間のピクセル単位の強度差３２６を生成する。繰り返し拡張カルマンフィルタ３２０は、現在の画像１４３と、以前に追跡された画像１４３との１つのピクセル位置に対してルーチンを実行することにより、ピクセル単位の強度差３２６を求めてその結果を返し、次いで、次のピクセル位置に移動し、現在の画像１４３と、以前に追跡された画像１４３とのすべてのピクセルが処理されてピクセル単位の強度差３２６が求められるまで、同じルーチンを繰り返す。
【００３２】
第１のステップにおいて、繰り返し拡張カルマンフィルタ３２０は、受信したＩＭＵセンサデータ１４５（すなわち、加速度および角速度データ）に基づいて、現在のフィルタ状態３２２ｃ，３２４ａｃ〜３２４ｊｃを予測する。第２のステップにおいて、繰り返し拡張カルマンフィルタ３２０は、現在の画像１４３における追跡された特徴点３１６と、以前に追跡された画像１４３における以前の対応する特徴点３１６との間のピクセル単位の強度差３２６に基づいて、現在のフィルタ状態３２２ｃ，３２４ａｃ〜３２４ｊｃを更新して、更新されたフィルタ状態３２２ｕ，３２４ａｕ〜３２４ｉｕに更新および修正する。したがって、上述した状態３２２ｃの各々の、現在の状態３２４ａｃ〜３２４ｉｃは、繰り返し拡張カルマンフィルタ３２０がＩＭＵ１４４および後方カメラ１４２ａからデータを受信するたびに更新される。
【００３３】
位置推定システム３００は、カメラ姿勢モジュール３３０も含み、このカメラ姿勢モジュール３３０は、更新されたフィルタ状態３２２ｕに基づいて、世界座標系におけるカメラ１４２ａの位置ＬＣと、向きまたは角度αＣとを計算する。例えば、カメラ姿勢モジュール３３０は、図１Ｃに示されているようなカメラ位置ＬＣおよびカメラ角度αＣを計算し、カメラ角度αＣは、世界座標の前後軸Ｙと、カメラの位置との間における世界座標の原点での角度である。
【００３４】
トレーラ姿勢推定モジュール３４０は、更新されたフィルタ状態３２２ｕに基づいて、世界座標系における特徴点３１６の位置３４２を計算する。次に、トレーラ姿勢推定モジュール３４０、例えば、平面抽出モジュール３４４は、特徴点の位置３４２に基づいて平面Ｐを特定する。平面Ｐは、図１Ａに示されているようなトレーラ２００の正面である。平面Ｐが識別されると、トレーラ姿勢推定モジュール３４０は、平面Ｐに対する法線３４６を計算して、世界座標系に対するトレーラ角度αＴを識別する。
【００３５】
前述したように、位置推定システム３００は、カメラ画像データ１４３とＩＭＵセンサデータ１４５とを融合するための繰り返し拡張カルマンフィルタ３２０を活用して、世界座標系におけるトレーラ位置ＬＴおよびトレーラ角度αＴと、世界座標系におけるカメラ位置ＬＣおよびカメラ角度αＣとを推定および特定する。位置推定システム３００は、密結合された融合技術を使用することによって高精度を提供し、繰り返し拡張カルマンフィルタ３２０において現在のフィルタ状態３２２ｃを更新するために、特徴検出および追跡モジュール３１４を活用することによってロバスト性を向上させる。上述したように、位置推定システム３００は、少ない計算リソースを利用して、低コストのハードウェアを使用してリアルタイムのパフォーマンスを達成する。さらに、位置推定システム３００は、フィルタ状態の更新３２２ｕのために特徴検出および追跡モジュール３１４による画像１４３の分析に依存していることに起因して、トレーラ位置を特定する際のロバスト性を向上させる。
【００３６】
図４を参照すると、経路計画システム４００は、軌道計画モジュール４１０と、軌道制御モジュール４２０とを含む。軌道計画モジュール４１０は、カメラ姿勢モジュール３３０からカメラ姿勢３３２（すなわち、カメラ位置ＬＣおよびカメラ角度αＣ）を受信し、トレーラ姿勢推定モジュール３４０からトレーラ姿勢３４８（すなわち、トレーラ位置ＬＴおよびトレーラ角度αＴ）を受信する。軌道計画モジュール４１０は、Ｄｕｂｉｎｓ経路生成モジュール４１２と、キーポイント生成モジュール４１４とを含む。Ｄｕｂｉｎｓ経路生成モジュール４１２は、カメラ姿勢３３２およびトレーラ姿勢３４８を受信し、Ｄｕｂｉｎｓ経路５００を生成する。Ｄｕｂｉｎｓ経路とは、経路の曲率に関する制約の下で、また、経路に対する初期接線および終端接線が指定されている状態で、さらに、走行車両が経路を一方向にしか移動できないという仮定の下で、２次元のユークリッド平面（すなわち、ｘｙ平面）における２つの点を接続する最短の曲線のことを指す。Ｄｕｂｉｎｓ経路５００は、最大曲率の円弧と直線とを結ぶことによって生成される。図５Ａ〜図５Ｃは、Ｄｕｂｉｎｓ経路を示す。図５Ａは、牽引車両１００とトレーラ２００との間の距離が特定のしきい値にあるが、牽引車両１００に対するトレーラ２００の方向ではない場合に使用されるＣＬＣ構成、すなわち円線円（circle line circle）構成を示す。図５Ｂは、牽引車両１００とトレーラ２００との間の距離が最小であって、かつ牽引車両１００とトレーラ２００とを位置合わせするために１回の旋回しか必要でない場合に使用されるＣＬ構成、すなわち円線（circle line）構成を示す。図５Ｃは、牽引車両１００がトレーラ２００と位置合わせされているが、横方向の距離を有している場合に使用される別のＣＬＣ構成を示す。Ｄｕｂｉｎｓ経路生成モジュール４１２が経路５００を生成すると、キーポイント生成モジュール４１４は、牽引車両１００が追従するための経路５００に沿った点のシーケンス４１５を識別する。
【００３７】
続いて、軌道制御モジュール４２０は、経路５００に追従するための、後退方向Ｒにおける牽引車両１００のステアリングホイール角度を決定する。さらに、軌道制御モジュール４２０は、キーポイント生成モジュール４１４から受信した点のシーケンス４１５に基づいて、アッカーマン角度計算４２２を実行する。アッカーマンステアリングジオメトリとは、旋回の内側と外側とでそれぞれ異なる半径の円を追跡しなければならない車輪１１２の問題を解決する、牽引車両１００の操舵に関するリンク機構の幾何学的配置のことである。したがって、アッカーマン角度計算４２２は、すべての車輪１１２のそれぞれの軸が、１つの共通の中心点を有する各円の半径として配置されていることを仮定している。後輪は固定されているので、この中心点は、後車軸から延長している線上になければならない。また、この線上で前輪の軸を交差させるためには、操舵時に内側の前輪を外側の車輪よりも大きな角度で回転させる必要がある。したがって、アッカーマン角度計算４２２は、それぞれの前輪の操舵角度間の差を決定する。軌道制御モジュール４２０は、アッカーマン角度計算４２２に基づいてステアリングホイール角度を更新し、前輪１１２ａ，１１２ｂの各々が経路５００に追従するための、更新されたステアリングホイール角度４２４を決定する。
【００３８】
牽引車両１００は、計画された経路５００に沿って自律的に操縦しているので、経路計画システム４００は、センサデータの継続的な受信に基づいて継続的に経路を更新する。いくつかの例では、物体検出システムが、計画された経路に沿って１つまたは複数の物体を識別し、１つまたは複数の物体の位置に関係している経路計画システム４００のデータを送信する。この場合、経路計画システム４００は、１つまたは複数の物体を回避する一方で、所定の操縦も実行するように、計画された経路５００を再計算する。いくつかの例では、経路計画システムは、衝突の確率を決定し、衝突の確率が所定のしきい値を超えている場合には、経路計画システム４００が、経路５００を調整して、この経路５００を運転支援システム１８０に送信する。
【００３９】
経路計画システム４００が、計画された経路５００を決定すると、車両制御装置１５０は、運転支援システム１８０を実行する。運転支援システム１８０自体は、経路追従挙動１８２を含む。経路追従挙動１８２は、計画された経路を受信し、この計画された経路に沿って牽引車両１００を自律的に運転させるコマンド１８４を運転システム１１０に送信する１つまたは複数の挙動１８２ａ〜ｂを実行し、これにより、計画された経路に沿って牽引車両１００を自律的に運転させる。
【００４０】
経路追従挙動１８２ａ〜ｃは、限定するわけではないが、制動挙動１８２ａ、速度挙動１８２ｂ、および操舵挙動１８２ｃのような１つまたは複数の挙動を含むことができる。それぞれの挙動１８２ａ〜ｃは、牽引車両１００に、とりわけ後退運転、特定の角度での旋回、制動、加速、減速のような行動をとらせる。車両制御装置１５０は、運転システム１１０を制御することによって、より具体的には、運転システム１１０にコマンド１８４を発行することによって、牽引車両１００を路面にわたって任意の方向に操縦することができる。
【００４１】
制動挙動１８２ａは、計画された経路に基づいて牽引車両１００を停止または減速させるために実行可能である。制動挙動１８２ａは、運転システム１１０に、例えば制動システム（図示せず）に、信号またはコマンド１８４を送信して、牽引車両１００を停止させるか、または牽引車両１００の速度を低下させる。
【００４２】
速度挙動１８２ｂは、計画された経路に基づいて加速または減速を行うことによって牽引車両１００の速度を変更するために実行可能である。速度挙動１８２ｂは、減速させる場合には制動システム１１４に、または加速させる場合には加速システム１１６に、信号またはコマンド１８４を送信する。
【００４３】
操舵挙動１８２ｃは、計画された経路に基づいて牽引車両１００の方向を変更するために実行可能である。したがって、操舵挙動１８２ｃは、操舵角度を示す信号またはコマンド１８４を加速システム１１６に送信して、運転システム１１０に方向を変更させる。
【００４４】
前述したように、位置推定および経路計画システム１６０は、トレーラ２００上に配置された１つまたは複数のマーカーを使用することなく、世界座標系における選択されたトレーラ２００の位置を提供する。さらに、位置推定および経路計画システム１６０は、必要とされる計算リソースが少なく、低コストのハードウェア上でリアルタイムのパフォーマンスを達成することができる密結合された融合技術を使用することによって高精度を提供する。トレーラ２００上のマーカーが不要であるので、動作および計算の複雑さが軽減され、したがって、システムの製造コストも削減される。
【００４５】
図６は、図１〜図５に記載されているシステムを使用して、トレーラ２００と牽引車両１００との間の自律的なヒッチングのために、トレーラ２００に向かって牽引車両１００を自律的に操縦する方法６００のための各動作の例示的な構成を提供する。ブロック６０２において、方法６００は、データ処理ハードウェア１５２において、牽引車両１００の後部位置に配置されていて、かつデータ処理ハードウェア１５２と通信する１つまたは複数のカメラ１４２ａから、画像を受信することを含む。カメラは、超広角レンズを含む魚眼レンズを含むことができる。ブロック６０４において、方法６００は、データ処理ハードウェア１５２において、データ処理ハードウェア１５２と通信していて、かつ牽引車両１００によって支持されている慣性測定ユニット１４４から、センサデータ１４５を受信することを含む。ブロック６０６において、方法６００は、データ処理ハードウェア１５２において、現在受信した画像１４３と、以前に受信した画像１４３との間のピクセル単位の強度差３２６を求めることを含む。ブロック６０８において、方法６００は、データ処理ハードウェア１５２において、世界座標系に対するカメラ姿勢３３２およびトレーラ姿勢３４８を特定することを含む。カメラ姿勢３３２およびトレーラ姿勢３４８は、画像１４３と、センサデータ１４５と、ピクセル単位の強度差３２６とに基づいている。ブロック６１０において、方法６００は、データ処理ハードウェア１５２において、カメラ姿勢３３２およびトレーラ姿勢３４８に基づいて牽引車両経路５００を決定することを含む。ブロック６１２において、方法６００は、命令１８４を、データ処理ハードウェア１５２から、牽引車両１００によって支持されている運転システム１１０に送信することを含む。命令１８４は、牽引車両１００がトレーラ２００とヒッチングされるように牽引車両１００を牽引車両経路５００に沿って後退方向Ｒに自律的に操縦させるものである。
【００４６】
いくつかの例では、カメラ姿勢は、世界座標系におけるカメラ位置ＬＣおよびカメラ角度αＣを含む。トレーラ姿勢は、世界座標系におけるトレーラ位置ＬＴおよびトレーラ角度αＴを含むことができる。方法６００は、画像の内部における、トレーラ２００に関連付けられた１つまたは複数の特徴点３１６を識別することを含むことができる。方法６００は、１つまたは複数の特徴点３１６に基づいて平面Ｐを特定することを含むこともできる。平面Ｐは、トレーラ２００の正面を示す。本方法は、平面Ｐに対する法線を求めることと、法線に基づいてトレーラ角度αＴを特定することとを含むことができる。
【００４７】
いくつかの例では、本方法は、画像１４３の内部における、トレーラ２００の表現１３６を取り囲む関心領域２３０を決定することを含む。現在受信した画像１４３と、以前に受信した画像１４３との間のピクセル単位の強度差３２６を求めることは、現在受信した画像１４３の関心領域２３０と、以前に受信した画像１４３の関心領域２３０との間のピクセル単位の強度差３２６を求めることを含む。方法６００は、関心領域２３０の内部における１つまたは複数の特徴点３１６を識別することをさらに含むことができる。特徴点３１６は、トレーラ２００に関連付けられている。方法６００は、車両１００が経路５００に沿って自律的に操縦される際に、１つまたは複数の特徴点３１６を追跡することを含むこともできる。
【００４８】
いくつかの実装形態では、方法６００は、経路５００に関連付けられた点のシーケンスを決定することを含む。牽引車両１００は、経路５００に沿った点のシーケンスに追従する。方法６００は、点のシーケンスの内部におけるそれぞれの点に関連付けられたステアリングホイール角度を決定することと、決定されたステアリングホイール角度に基づいて現在のステアリングホイール角度を調整するための命令を、運転システム１１０に送信することも含む。
【００４９】
方法６００は、牽引車両１００が経路５００に沿って自律的に操縦される際に、牽引車両１００のそれぞれの前輪１１２の操舵角度間の差を決定することを含むこともできる。方法６００は、それぞれの前輪１１２のステアリングホイール角度間の差に基づいてそれぞれの車輪１１２のステアリングホイール角度を調整するための命令１８４を、運転システム１１０に送信することを含むこともできる。
【００５０】
本明細書に記載されているシステムおよび技術の種々の実装形態は、デジタル電子回路、集積回路、特別に設計されたＡＳＩＣ（特定用途向け集積回路）、コンピュータハードウェア、ファームウェア、ソフトウェア、および／またはそれらの組み合わせの形態で実現可能である。これらの種々の実装形態は、プログラマブルシステム上で実行可能および／または解釈可能な１つまたは複数のコンピュータプログラムの形態での実装を含むことができ、このプログラマブルシステムは、ストレージシステムからデータおよび命令を受信し、かつストレージシステムにデータおよび命令を送信するために結合された、特別であってもよいし汎用であってもよい少なくとも１つのプログラマブルプロセッサと、少なくとも１つの入力デバイスと、少なくとも１つの出力デバイスとを含む。
【００５１】
（プログラム、ソフトウェア、ソフトウェアアプリケーション、またはコードとしても知られる）これらのコンピュータプログラムは、プログラマブルプロセッサのための機械命令を含み、ハイレベルの手続き型プログラミング言語および／またはオブジェクト指向型プログラミング言語、および／またはアセンブリ言語／機械語の形態で実装可能である。本明細書で使用される場合、「機械可読媒体」および「コンピュータ可読媒体」という用語は、機械命令を機械可読信号として受信する機械可読媒体を含む、プログラマブルプロセッサに機械命令および／またはデータを提供するために使用される任意のコンピュータプログラム製品、装置、および／またはデバイス（例えば、磁気ディスク、光ディスク、メモリ、プログラマブルロジックデバイス（ＰＬＤ））を指す。「機械可読信号」という用語は、プログラマブルプロセッサに機械命令および／またはデータを提供するために使用される任意の信号を指す。
【００５２】
本明細書に記載されている主題および機能動作の実装形態は、デジタル電子回路の形態で、または本明細書に開示されている構造およびそれらの構造的な同等物を含むコンピュータソフトウェア、ファームウェア、もしくはハードウェアの形態で、またはそれらの１つまたは複数の組み合わせの形態で、実装可能である。さらに、本明細書に記載されている主題は、１つまたは複数のコンピュータプログラム製品として実装可能であり、すなわち、データ処理装置によって実行するための、またはデータ処理装置の動作を制御するための、コンピュータ可読媒体上に符号化されたコンピュータプログラム命令の１つまたは複数のモジュールとして実装可能である。コンピュータ可読媒体は、機械可読ストレージデバイス、機械可読ストレージ基板、メモリデバイス、機械可読伝搬信号をもたらす物質の組成物、またはそれらの１つまたは複数の組み合わせであり得る。「データ処理装置」、「コンピューティングデバイス」、および「コンピューティングプロセッサ」という用語は、一例としてプログラマブルプロセッサ、コンピュータ、または複数のプロセッサもしくはコンピュータを含む、データを処理するためのすべての装置、デバイス、および機械を包含する。装置は、ハードウェアに加えて、当のコンピュータプログラムの実行環境を作成するコードを含むことができ、例えば、プロセッサファームウェア、プロトコルスタック、データベース管理システム、オペレーティングシステム、またはそれらの１つまたは複数の組み合わせを構成するコードを含むことができる。伝播信号は、人工的に生成された信号であり、例えば、適切な受信機装置に送信するための情報を符号化するために生成される、機械生成の電気信号、光学信号、または電磁信号である。
【００５３】
同様に、各動作は、図面において特定の順序で図示されているが、このことは、望ましい結果を達成するために、そのような動作が、図示された特定の順序または連続した順序で実行されること、または図示されたすべての動作が実行されることが必要であると理解されるべきではない。特定の状況では、マルチタスク処理および並列処理が有利である場合がある。さらに、上記の実施形態における複数の異なるシステムコンポーネントの分離は、すべての実施形態においてそのような分離が必要であると理解されるべきではなく、記載されている複数のプログラムコンポーネントおよびシステムを、一般に、単一のソフトウェア製品に一緒に組み込むことができるか、または複数のソフトウェア製品にパッケージ化することができることが理解されるべきである。
【００５４】
複数の実装形態について説明してきた。それでもなお、本開示の思想および範囲から逸脱することなく、種々の変更を加えることができることが理解されるであろう。したがって、他の実装形態は、以下の特許請求の範囲内にある。
【図１Ａ】
2021520000.tif 000003
【図１Ｂ】
2021520000.tif 000004
【図１Ｃ】
2021520000.tif 000005
【図２】
2021520000.tif 000006
【図３】
2021520000.tif 000007
【図４】
2021520000.tif 000008
【図５Ａ】
2021520000.tif 000009
【図５Ｂ】
2021520000.tif 000010
【図５Ｃ】
2021520000.tif 000011
【図６】
2021520000.tif 000012
【国際調査報告】
2021520000.tif 000013
2021520000.tif 000014
2021520000.tif 000015