JP2022501032A - トラクターに連結する自律的な農機具 - Google Patents

トラクターに連結する自律的な農機具 Download PDF

Info

Publication number
JP2022501032A
JP2022501032A JP2021515207A JP2021515207A JP2022501032A JP 2022501032 A JP2022501032 A JP 2022501032A JP 2021515207 A JP2021515207 A JP 2021515207A JP 2021515207 A JP2021515207 A JP 2021515207A JP 2022501032 A JP2022501032 A JP 2022501032A
Authority
JP
Japan
Prior art keywords
tractor
route
trailer
path
operator
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP2021515207A
Other languages
English (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.)
Continental Automotive Systems Inc
Original Assignee
Continental Automotive Systems Inc
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 Continental Automotive Systems Inc filed Critical Continental Automotive Systems Inc
Publication of JP2022501032A publication Critical patent/JP2022501032A/ja
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/001Steering by means of optical assistance, e.g. television cameras
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/003Steering or guiding of machines or implements pushed or pulled by or mounted on agricultural vehicles such as tractors, e.g. by lateral shifting of the towing connection
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/003Steering or guiding of machines or implements pushed or pulled by or mounted on agricultural vehicles such as tractors, e.g. by lateral shifting of the towing connection
    • A01B69/004Steering or guiding of machines or implements pushed or pulled by or mounted on agricultural vehicles such as tractors, e.g. by lateral shifting of the towing connection automatic
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60DVEHICLE CONNECTIONS
    • B60D1/00Traction couplings; Hitches; Draw-gear; Towing devices
    • B60D1/01Traction couplings or hitches characterised by their type
    • B60D1/06Ball-and-socket hitches, e.g. constructional details, auxiliary devices, their arrangement on the vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60DVEHICLE CONNECTIONS
    • B60D1/00Traction couplings; Hitches; Draw-gear; Towing devices
    • B60D1/24Traction couplings; Hitches; Draw-gear; Towing devices characterised by arrangements for particular functions
    • B60D1/36Traction couplings; Hitches; Draw-gear; Towing devices characterised by arrangements for particular functions for facilitating connection, e.g. hitch catchers, visual guide means, signalling aids
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60DVEHICLE CONNECTIONS
    • B60D1/00Traction couplings; Hitches; Draw-gear; Towing devices
    • B60D1/24Traction couplings; Hitches; Draw-gear; Towing devices characterised by arrangements for particular functions
    • B60D1/36Traction couplings; Hitches; Draw-gear; Towing devices characterised by arrangements for particular functions for facilitating connection, e.g. hitch catchers, visual guide means, signalling aids
    • B60D1/363Hitch guiding or catching elements, e.g. V-shaped plates partially surrounding a coupling member for guiding the other coupling member
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60DVEHICLE CONNECTIONS
    • B60D1/00Traction couplings; Hitches; Draw-gear; Towing devices
    • B60D1/58Auxiliary devices
    • B60D1/62Auxiliary devices involving supply lines, electric circuits, or the like
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18036Reversing
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/027Parking aids, e.g. instruction means
    • B62D15/0285Parking performed automatically
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20Control system inputs
    • G05D1/22Command input arrangements
    • G05D1/229Command input data, e.g. waypoints
    • G05D1/2297Command input data, e.g. waypoints positional data taught by the user, e.g. paths
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20Control system inputs
    • G05D1/24Arrangements for determining position or orientation
    • G05D1/243Means capturing signals occurring naturally from the environment, e.g. ambient optical, acoustic, gravitational or magnetic signals
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/60Intended control result
    • G05D1/656Interaction with payloads or external entities
    • G05D1/661Docking at a base station
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • B60W2050/146Display means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2300/00Indexing codes relating to the type of vehicle
    • B60W2300/15Agricultural vehicles
    • B60W2300/152Tractors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/403Image sensing, e.g. optical camera
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/22Articulation angle, e.g. between tractor and trailer
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2105/00Specific applications of the controlled vehicles
    • G05D2105/15Specific applications of the controlled vehicles for harvesting, sowing or mowing in agriculture or forestry
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2107/00Specific environments of the controlled vehicles
    • G05D2107/20Land use
    • G05D2107/21Farming, e.g. fields, pastures or barns
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2109/00Types of controlled vehicles
    • G05D2109/10Land vehicles
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2111/00Details of signals used for control of position, course, altitude or attitude of land, water, air or space vehicles
    • G05D2111/10Optical signals

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Physics & Mathematics (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Soil Sciences (AREA)
  • Environmental Sciences (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Electromagnetism (AREA)
  • Combustion & Propulsion (AREA)
  • Chemical & Material Sciences (AREA)
  • Human Computer Interaction (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Guiding Agricultural Machines (AREA)

Abstract

トラクターをトレーラーに連結支援システムを用いて取り付けるために後退方向に自律的に移動させる方法であって、この方法は、連結支援モードに入るステップと、ユーザインタフェース上にカメラ画像を表示するステップと、選択されたトレーラーの表示を受け取るステップと、を含む。この方法は、演算装置を用いて計画された経路、すなわち、トラクターをトラクター経路に沿って初期位置から最終位置まで移動させるように構成された動きを含む、初期位置からトレーラーに近接する最終位置までのトラクター経路を確定するステップも含む。この方法は、演算装置と通信する駆動系において、トラクター経路を初期位置から最終位置まで自律的に追従するステップも含む。

Description

本開示は、トラクターに近接して配置された1つ以上の農機具を識別すると共に、機具をトレーラーに取り付けるために1つ以上の農機具のうちの1つに向かって走行するように構成されたトラクターに関する。
トレーラーは通常、牽引動力車により牽引される無動力の車両、道具、または機具である。農機具に言及する場合、牽引動力車は典型的には、トレーラーに取り付けてトレーラーを牽引するように構成されたトラクター(リヤまたはフロントローディング)またはその他の任意の車両を指す。トレーラーは、ベーラー、トレーラーベッド、すき、シーダー、ハーベスター、ベーラー等といった、任意の形式の農機具であってよい。フロントローディングトラクターの場合、トレーラー(すなわち車両に動力は供給されていない)は実際には、牽引車(すなわち動力を供給する車両)の前方に配置されることがある。
トレーラーは、トレーラーヒッチを用いてトラクターに取り付けられてよい。レシーバーヒッチがトラクターに取り付けられ、トレーラーヒッチに連結されて連結を形成する。農機具を扱う場合、連結点、すなわちトラクターとトレーラーとの間のヒッチは、トレーラーの機具の形式に応じて変わることがある。
トレーラーヒッチは、ボールとソケット、フィフスホイールとグースネック、トレーラージャック、アイとリング、ピントルヒッチ、ドローバー、または3点ヒッチであってよい。その他の取付け機構が使用されてもよい。トレーラーとトラクターとの間の機械的な連結に加え、いくつかの例では、トレーラーはトラクターに電気的に接続されている。よって、電気的な接続により、トレーラーに、動力が供給されたトラクターの後部ライト回路から給電することができ、トレーラーが、動力を供給されたトラクターのライトと同期するライトを有することを可能にする。
トラクターのオペレータが直面する難題のうちのいくつかは、トラクターをトレーラーに連結することである。なぜならば、2人以上の人員が必要とされるからである。例えば、1人はトラクターを運転する例えばオペレータであり、他の1人以上が、トラクターとトレーラーとを見て、ヒッチを整列させるためにトラクターがとらねばならない経路に関する指示をオペレータに出すために必要となる。オペレータに指示を出す人が、トラクターをトレーラーに連結することに慣れていないと、トラクターの経路を指示する効果的な指示を出すことは難しい場合がある。
センサ技術の昨今の進歩により、車両用の安全システムが改良されてきている。衝突を検出して回避するための段取りや方法が利用可能になっている。このようなオペレータ支援システムは、進行中の衝突を検出するために車両に配置されたセンサを使用する。いくつかの例では、システムは、衝突を防ぐかまたは最小限にするために、オペレータに1つ以上の運転状況を警告することができる。さらに、車両が前進方向に移動した場合にオペレータに障害物の可能性を警告するために、センサとカメラとが使用されてもよい。よって、トラクターのオペレータが直面する難題を克服するためには、センサを含むシステムを提供することが望ましい。
1つの全般的な態様は、トラクターをトレーラーに連結支援システムを用いて取り付けるために後退方向に移動させる方法を含み、この方法は、連結支援モードに入るステップを含む。この方法は、ユーザインタフェース上にカメラ画像を表示するステップも含み、表示された画像は、少なくとも1つのカメラを示す。この方法は、通信中のユーザインタフェースにおいて、選択されたトレーラーの表示を受け取るステップも含む。この方法は、演算装置を用いて計画された経路、すなわち、トラクターをトラクター経路に沿って初期位置から最終位置まで移動させるように構成された動きを含む、初期位置からトレーラーに近接する最終位置までのトラクター経路を確定するステップも含む。この方法は、演算装置と通信する駆動系において、トラクター経路を初期位置から最終位置まで自律的に追従するステップも含む。
実施形態には、1つ以上の以下の特徴が含まれていてよい。この方法はさらに、トラクターがトラクター経路に沿って移動する際に、ニューラルネットワークにおいて、トラクター経路内の1つ以上の物体を連続的に検出するステップを含む。この方法は、物体を検出した場合には、演算装置においてトラクター経路を変更するステップを含んでいてもよい。1つ以上のトレーラーを検出する方法は、ニューラルネットワークと通信し、少なくとも1つが、後退方向に向いたトレーラーの後ろ側に配置された1つ以上の画像装置において、1つ以上の画像を捉えるステップを含む。この方法は、ニューラルネットワークにおいて、1つ以上の画像内で1つ以上のトレーラーを確定するステップを含んでいてもよい。ユーザインタフェース上に表示する方法はさらに、コントローラにおいて、トラクターの後部に配置されかつコントローラと通信する1つ以上のカメラから1つ以上の画像を受け取り、コントローラにおいて、トラクターヒッチから始まり、これに沿ってトラクターが走行する予想経路を示す経路図を重ねるステップを含む。トレーラーを選択する方法はさらに、コントローラにおいて、経路図が関心点で終わるといった、経路図における変更を示す第1のコマンドを、ユーザインタフェースを介して受け取り、かつコントローラにおいて、第1のコマンドに基づき経路図を調整し、連結支援システム用のコントローラが、経路計画を完了させるステップを含む。この方法はさらに、駆動系において、トラクターが最終位置に到達する前に、初期位置よりも最終位置に近い中間位置に停止または駐車させるステップを含む。この方法は、駆動系において、トラクターに関連する1つ以上のトラクターサスペンションを変化させて、トラクターヒッチとトレーラーヒッチとを整列させるステップを含んでいてもよい。この方法は、駆動系において、トラクター経路を中間位置から最終位置まで自律的に追従するステップを含んでいてもよい。この方法は、駆動系において、トラクターヒッチとトレーラーヒッチとを連結するステップを含んでいてもよい。トラクターヒッチとトレーラーヒッチとを連結する方法は、トラクターに関連する1つ以上のトラクターサスペンションを変化させて、トラクターヒッチとトレーラーヒッチとを整列させるステップを含む。
本開示の1つの態様は、関心点に向かって車両を後退方向に自律運転させる方法を提供する。この方法は、データ処理ハードウェアにおいて、車両の後部に位置しかつデータ処理ハードウェアと通信するカメラから1つ以上の画像を受け取るステップを含む。この方法は、データ処理ハードウェアにおいて、データ処理ハードウェアと通信するユーザインタフェースからオペレータが計画した経路を受け取るステップも含む。オペレータが計画した経路には、複数の中間点が含まれている。この方法は、データ処理ハードウェアから、データ処理ハードウェアと通信する駆動系に、オペレータが計画した経路に沿って車両を自律的に移動させる1つ以上のコマンドを送信するステップを含む。この方法は、データ処理ハードウェアにおいて、現在の車両位置を確定するステップを含む。さらに、この方法は、データ処理ハードウェアにおいて、オペレータが計画した経路に基づき後続の推定車両位置を確定するステップを含む。後続の推定車両位置は、現在の車両位置からオペレータが計画した経路に沿って続く中間点である。この方法は、データ処理ハードウェアにおいて、現在の車両位置から後続の推定車両位置までの経路調整を確定するステップも含む。さらに、この方法は、経路調整に基づき後続の推定車両位置に向かって車両を自律的に移動させる命令を、データ処理ハードウェアから駆動系に送信するステップを含む。
本開示の別の態様は、関心点に向かって車両を後退方向に自律的に移動させるためのシステムを提供する。このシステムは、データ処理ハードウェアと、データ処理ハードウェアと通信するメモリハードウェアとを含む。メモリハードウェアは、データ処理ハードウェア上で実行されると、データ処理ハードウェアに上述した方法を含む工程を行わせる命令を記憶している。
本開示の態様の実施形態には、以下の1つ以上の任意の特徴が含まれていてよい。いくつかの実施形態では、方法は、経路を1つ以上の画像に重ねるステップおよびコマンドを、データ処理ハードウェアと通信するユーザインタフェースを介して受け取るステップを含む。コマンドには、オペレータが計画した経路のとおりに経路を調整する命令が含まれる。コマンドには、経路の距離を調整する命令が含まれていてよい。いくつかの例では、コマンドには、経路の角度を調整する命令が含まれる。コマンドには、経路の終端部の角度を調整する命令が含まれていてよい。
いくつかの実施形態では、現在の車両位置を確定するステップは、1つ以上のホイールに関連するホイールエンコーダセンサデータを受け取るステップと、操舵角センサデータを受け取るステップとを含む。現在の車両位置は、ホイールエンコーダセンサデータと操舵角センサデータとに基づく。
本開示の1つ以上の実施形態の詳細は、添付の図面および以下の説明に記載されている。その他の態様、特徴および利点は、説明、図面および請求項から明らかになる。
トラクターの後ろのトレーラーの表示を表示するユーザインタフェースを有する、例示的なトラクターを示す概略図である。 例示的なトラクターを示す概略図である。 計画した経路に沿って自律的に動く例示的なトラクターを示す斜視図である。 計画した経路に沿って自律的に動く例示的なトラクターを示す斜視図である。 図4Aは、初期位置にある例示的なトラクターを示す斜視図であり、図4Bは、中間位置にある例示的なトラクターを示す斜視図であり、図4Cは、最終位置にある例示的なトラクターを示す斜視図である。 図5A〜図5Dは、例示的なトラクターシステム用のトレーラーヒッチに連結する例示的なヒッチを示す斜視図である。 第2の例示的なトラクターシステムを示す概略図である。 第2の例示的なトラクターシステムを示す概略図である。 系の例示的なステートチャートを示す概略図である。 系の例示的なステートチャートを示す概略図である。 図8Aおよび図8Bは、第2の例示的なトラクターシステム用の例示的な角度モードを示す概略図である。 図9Aおよび図9Bは、第2の例示的なトラクターシステム用の例示的な距離モードを示す概略図である。 図10Aおよび図10Bは、第2の例示的なトラクターシステム用の例示的な2円弧モードを示す概略図である。 図11Aおよび図11Bは、軌道生成計算を示す概略図であり、図11Cは、推定された角速度およびシミュレートされた角速度を示す図であり、図11Dは、DGPSからの動作推定装置のずれを示す図である。 第2の例示的なトラクターシステム用の動作推定計算を示す概略図である。 第2の例示的なトラクターシステム用の動作推定計算を示す概略図である。 関心点に向かって車両を後退方向に自律運転させる例示的な方法を示す概略図である。 第1および第2の例示的なトラクターシステム用のトレーラーに取り付けるために、トラクターを逆方向に操作するための、操作の例示的な段取りを示すフローチャートである。
異なる図面中の同じ参照符号は、それぞれ同じ部材を表す。
詳細な説明
限定はしないがリヤロードトラクターまたはフロントロードトラクター等のトラクター(以下トラクターと呼ぶ)は、トレーラーを牽引するように構成することができる。トラクターは、別の農機具を牽引するように動力を供給されて構成された、他の形式の車両および農機具であってもよい。トレーラーは、ベーラー、トレーラーベッド、すき、シーダー、ハーベスター、ベーラー等といった、任意の形式の農機具であってよい。フロントローディングトラクターの場合、トレーラー(すなわち車両に動力は供給されていない)は実際には、トラクター(すなわち動力を供給する車両)の前方に配置されることがある。以下、このような機具は全て、トレーラーと呼ばれる。
トラクターは、トレーラーヒッチを用いてトレーラーに連結する。トレーラーに向かって自律的に動いてトレーラーを取り付けることができ、よってオペレータがトラクターを(例えば後退方向に)運転する一方で、別の1人以上の人がオペレータに、トレーラーと最終的にはトレーラーのヒッチとに整列するようになっていなければならない経路に関する命令を与える必要を無くすことができるトラクターを有することが望ましい。このように、自律運転・連結機能を備えたトラクターは、トラクターをトレーラーに連結する際、オペレータに、より安全でより迅速な経験をもたらす。
図1〜図2Bを参照すると、いくつかの実施形態で、トラクター100のオペレータが、1つのトレーラー200,200a〜c、例えばトレーラー200,200a〜cの群からの1つの特定のトレーラー200a〜cを牽引しようとしている。トラクター100は、選択されるトレーラー200,200a〜cに関するオペレータの選択144の命令を受け取り、選択されたトレーラー200,200a〜cに向かって自律運転するように構成されることができる。トラクター100は、例えばx、yおよびz成分を有する駆動コマンドに基づき路面にわたってトラクター100を動かす駆動系110を有していてよい。図示のように、駆動系110は右前輪112,112a、左前輪112,112b、右後輪112,112c、および左後輪112,112dを有している。駆動系110は、別の車輪構成を有していてもよい。駆動系110は、各車輪112,112a〜dに関するブレーキを含む制動系120と、トラクター100の速度および方向を調整するように構成された加速系130も含んでいてよい。さらに、駆動系110は懸架系132を含んでいてよく、懸架系132は、各車輪112,112a〜dに関するタイヤと、タイヤ空気と、ばねと、緩衝装置と、トラクター100をその車輪112,112a〜dに結合し、トラクター100と車輪112,112a〜dとの間の相対運動を可能にするリンク機構とを含む。懸架系132は、トラクター100のハンドリングを改善すると共に、騒音、衝撃および振動を絶つことで、より良質な乗り心地をもたらす。さらに、懸架系132は、トラクターヒッチ160をトレーラーヒッチ210に整合させることを可能にするトラクター100の高さを調整するように構成されており、これにより、トラクター100とトレーラー200との間の自律的な連結が可能になる。
トラクター100は、トラクター100により規定される互いに垂直な3つの軸、すなわち横軸X、縦軸Y、および中心の鉛直軸Zに関する動きの様々な組合せに基づき、路面にわたり移動することができる。横軸Xは、トラクター100の右側Rと左側との間に延在している。縦軸Yに沿った前進方向はFと表されており、前進動作とも呼ばれる。さらに、縦軸Yに沿った後方または後退方向はRと表されており、後退動作とも呼ばれる。懸架系132がトラクター100のサスペンションを調整すると、トラクター100はX軸およびまたはY軸を中心として傾くことができ、または中心の鉛直軸Zに沿って動くことができる。ここでは、トラクター100の後方位置に配置されたトレーラー200が例示されている。ただし、これは当然、例として示したものであるに過ぎず、当業者は、この実施形態を、トラクター100の前方または一般には後方に配置されたトレーラー200にも適用することができるであろう。代替的に、当業者はこの実施形態を、フロントローディングトラクターヒッチ160を有する場合があるトラクター100に適用することができるであろう。さらに、図示のトラクター100およびトレーラー200は、牽引を簡単にするために、ボール形式のヒッチを備えたヒッチとレシーバーとを使用している。別の形式のヒッチがこの例示的な実施形態と共に使用されてもよい。
トラクター100は、ディスプレイ等のユーザインタフェース140を有していてよい。ユーザインタフェース140は、オペレータからの1つ以上のユーザコマンドを、1つ以上の入力機構またはタッチスクリーンディスプレイ142を介して受け取りかつ/または1つ以上の通知をオペレータに表示する。ユーザインタフェース140は、コントローラ300と通信しており、コントローラ300もまた、センサシステム400と通信している。いくつかの例では、ユーザインタフェース140は、トラクター100の周辺環境の画像を表示し、(オペレータから)ユーザインタフェース140が受け取った1つ以上のコマンドが、1つ以上の動作の実行を開始させる。コントローラ300は、演算プロセッサにおいて実行可能な命令を記憶することができる非一時的なメモリ304(例えばハードディスク、フラッシュメモリ、ランダムアクセスメモリ)と通信する演算装置(またはプロセッサ)302(例えば1つ以上の演算プロセッサを有する中央処理ユニット)を有している。
コントローラ300はオペレータ支援システム310を実行し、オペレータ支援システム310もまた、経路追従サブシステム320を有している。経路追従サブシステム320は、経路計画システム550から計画された経路552(図3Aおよび図3B)を受け取り、コマンド301を駆動系110に送る動作322〜330を実行し、これにより、トラクター100は計画された経路552付近を後退方向Rに自律運転する。
経路追従サブシステム320には、制動動作322、速度動作324、操舵動作326、ヒッチ連結動作328、およびサスペンション調整動作330が含まれる。各動作330,330a〜cに基づき、トラクター100はとりわけ、後退走行、特定の角度での方向転換、制動、加速、減速等の行動を取る。コントローラ300は駆動系110を制御することにより、より具体的には駆動系110にコマンド301を出すことにより、トラクター100を路面にわたり任意の方向に動かすことができる。例えば、コントローラ300はトラクター100を、(図4Aに示すような)初期位置から(図4Cに示すような)最終位置まで動かすことができる。最終位置で、トラクター100のヒッチカプラー162とトレーラー200のヒッチカプラー212とが整列し、トラクター100と、選択されたトレーラー200,200a〜cとを連結する。
トラクター100は、信頼性およびエラー強さのある自律運転を提供するために、センサシステム400を有していてよい。センサシステム400は複数の異なる形式のセンサを有していてよく、センサは別個にまたは互いにトラクターの周辺環境を認知し、トラクターの周辺環境は、トラクター100が自律運転しかつセンサシステム400により検出された物体および障害物に基づき情報処理的な決定を下すために用いられる。センサには、限定はしないが1つ以上の画像装置(カメラ等)410、および限定はしないがレーダー、ソナー、LIDAR(遠方ターゲットへの到達距離および/または別の情報を見いだすために散乱光の特性を測定する光学リモートセンシングを必要とし得る光検出と測距(Light detection and Ranging))、LADAR(レーザー検出と測距(Laser Detection and Ranging))等のセンサ420が含まれていてよい。さらに、トラクター100が前進方向Fまたは後退方向Rに移動する際に、ユーザインタフェース140を介して可聴警報および/または可視警報により障害物の可能性をオペレータに警告するために、カメラ410とセンサ420とを使用することができる。よって、センサシステム400は特に、半自律的または自律的な条件下で運転するトラクター100において安全性を高めるために有用である。
いくつかの実施形態では、トラクター100は、トラクター100の後進経路の視野を提供するために取り付けられたリヤカメラ410,410aを有している。さらに、いくつかの例では、トラクター100は、トラクター100の前進経路の視野を提供するフロントカメラ410,410b、トラクター100の右側に位置する右カメラ410,410c、およびトラクター100の左側に位置する左カメラ410,410dを有している。左右のカメラ410,410c,410dは、トラクター100の追加的な側方視野を提供する。この場合、トラクター100は、前進経路および後進経路に沿って検出される物体および障害物に加え、トラクター100の各側に位置する物体および障害物も検出することができる。カメラ410,410a〜dは、一眼カメラ、二眼カメラ、またはトラクター100の後進経路の視野を提供することができる別の形式のセンサ装置であってよい。
いくつかの実施形態では、トラクター100は、トラクター100の自律運転を改良するために、1つ以上のニューラルネットワーク(NN)500、例えばディープニューラルネットワーク(DNN)を有している。DNN500は、数ある分野の中で、とりわけコンピュータサイエンスに用いられる計算的なアプローチであり、神経単位の大きな集合に基づくものであり、生物の脳が、軸索により結合された生物の神経細胞の大きなクラスターを用いて問題を解決する方法を漠然と模したものである。DNN500は、プログラムされるというよりはむしろセルフラーニングしてトレーニングされるものであり、従来のコンピュータプログラムではソリューション機能の検出を表現し難い分野において優れている。換言すると、DNN500は、パターンを認識するように設計されたアルゴリズムのセットである。DNN500は、(例えばセンサシステム400からの)センサシステムデータ402を、機械認知、ラベリングまたは生入力のクラスタリングを介して翻訳する。認識されるパターンは、画像、テキスト、音声、または時系列等の、全ての実世界データが変換された数値、ベクトルである。DNN500には、非一時的なDNNメモリ504と通信する、非線形処理ユニット502の複数の層が含まれる。非一時的なDNNメモリ504は、非線形処理ユニット502上で実行されるとDNN500に出力値506,508を提供させる命令を記憶している。各非線形処理ユニット502は、トレーニングにより学習したパラメータを用いて、入力値または信号(例えばセンサシステムデータ402)を変換するように構成されている。入力値(例えばセンサシステムデータ402)から出力値506,508への一連の変換は、非線形処理ユニット502の複数の層において生じる。よって、DNN500は画像412またはセンサデータ422に基づき位置を確定することができ、DGPSまたはGPSを有する必要がない。
DNN500は、(画像412および/またはセンサデータ422を含む)センサシステムデータ402を受け取り、受け取ったデータ402に基づき画像出力値506をユーザインタフェース140に供給しかつ/またはデータ出力値508をコントローラ300に供給する。いくつかの例では、DNN500はトラクター100の後方視野の画像412を、DNN500と通信するカメラ410から受け取る。DNN500は、画像412を分析し、受け取った画像412の中の1つ以上のトレーラー200を識別する。DNN500は、DNN500と通信するセンサ420からセンサデータ422を受け取り、受け取ったセンサデータ422を分析してもよい。分析した画像412(または分析した画像412およびセンサデータ422)に基づき、DNN500は識別した各トレーラー200の、トラクター100に対する位置を、例えば座標系を用いて識別する。よって、DNN500はユーザインタフェース140に受け取った画像412を表示し、受け取った画像412は、トラクター100の後方に距離をあけて配置された、識別されたトレーラー200,200a〜cのトレーラー像146,146a〜cを表している。図1に示すように、第1、第2および第3のトレーラー200a,200b,200cが、トラクター100の後方に位置している。よって、ユーザインタフェース140は第1、第2および第3のトレーラー200a,200b,200cそれぞれに関する第1、第2および第3のトレーラー像146a,146b,146cを表示する。
オペレータは、トレーラー像146,146a〜cのうちの1つを選択することができ、これにより、オペレータがトラクター100を自律運転させ、選択したトレーラー像146、すなわちオペレータの選択144に関連するトレーラー200,200a〜cに連結させたいということを知らせる。いくつかの例では、ユーザインタフェースはタッチスクリーンディスプレイ142であり、したがってオペレータは指を差してトレーラー像146を選択することができる。別の例では、ユーザインタフェース140はタッチスクリーンではなく、オペレータはトレーラー像146,146a〜cを選択するために、限定はしないが回転つまみまたはマウス等の入力装置を使用することができる。
オペレータがトラクター100に連結させたいトレーラー200,200a〜cを選択すると、経路計画システム550が、トラクター100とトレーラー200との間の経路552(図3)を、(受け取ったセンサシステムデータ402からDNN500により確定される)選択したトレーラー200,200a〜cの、トラクター100の位置に対する位置(例えば方向および距離)に基づき計画する。トラクター100は、選択したトレーラー200(図1に示すような第1のトレーラー200a)に向かって自律的に後退する。計画された経路552は、トラクター100が自律運転してトレーラー200に連結することを可能にする。経路計画システム550は、トレーラー200から予め規定された距離D内の中間位置にあるトラクター100が、トレーラー200と概ね並列に整列するように方向付けられ、かつ、トレーラー200とは反対の側を向き、トラクター100のヒッチ160とトレーラー200のヒッチ210とが実質的に整列するように、トラクター100が自律的に移動するための経路552を計画する。
いくつかの例では、経路計画システム550は、図2Aに示すようにコントローラ300の一部である。一方、別の例では、経路計画システム550は、図2Bに示すようにDNN500の一部である。図2Aを参照すると、オペレータがトラクター100を自律的に接近運転させて連結しようとするトレーラー200aに関するトレーラー像146aをオペレータが選択した場合、DNN500aはコントローラ300に、選択したトレーラー200aと、選択したトレーラー200aの、トラクター100に対する位置とを含むデータ出力値508を送る。この場合、経路計画システム550aは、トラクター100と、選択されたトレーラー200aとの間の経路552を計画する。経路計画システム550aは、経路552を確定するためにいくつかの方法を用いてよい。図3Aおよび図3Bは、経路計画法を提供するものである。いくつかの例では、経路計画システム550aがその縦軸Yを後退方向Rに延ばしているのに対し、トレーラー200aは、トレーラー200の長さに関する縦軸を前進方向に延ばしている。経路計画システム550aは、第1の接点555において、トレーラー縦軸に面したトラクター縦軸Yに接する第1の円554と、第2の接点557において、トラクター縦軸Yに面したトレーラー縦軸に接する第2の円556とを描く。第1の円554と第2の円556とは、交点558において交わる。第1および第2の円554,556の寸法は、トラクター100とトレーラー200との間の距離、トラクター100とトレーラー200との間の障害物および物体、およびその他の考慮すべき全ての事柄に基づき調整し、操作することができる。経路計画システム550aは、第1の接点555までトラクター縦軸Yに追従し、次いで第1の円554の円弧に沿って交点558まで移動し、次いで第2の円556の円弧に沿って第2の接点557まで移動し、次いでトレーラー縦軸に追従することにより、経路552を確定する。このようにして、計画された経路552はトラクター100を、トレーラー200と概ね並列に整列する向きで、トレーラー200aとは反対の側を向き、トラクター100のヒッチ160とトレーラー200用のトレーラーヒッチ210のヒッチレシーバー212とが実質的に整列するように、位置決めする。換言すると、そこではトラクター100の縦軸Yとトレーラー200aの縦軸Tとが、実質的に整列している。図3Aには、トラクター100の縦軸Yとトレーラー200aの縦軸Tとが実質的に並列している、経路552の一例が示されている。一方、図3Bには、トラクター100の縦軸Yとトレーラー200aの縦軸Tとが実質的に並列していない、経路552の一例が示されている。
引き続き図2A、図3Aおよび図3Bを参照すると、いくつかの例では、トラクター100が計画された経路552に沿って自律運転する場合、トラクター100が、受け取ったセンサシステムデータ402、すなわち画像412に基づき計画された経路552に沿って移動すると、DNN500はコントローラ300に、選択されたトレーラー200aの、トラクター100に対する位置を連続的に送る。画像412は、トラクター100が選択されたトレーラー200aに接近すると更新されるため、この場合、トラクター100が選択されたトレーラー200aにより近づくと、選択されたトレーラー200aの、トラクター100に対する位置も変化する。いくつかの例では、DNN500は、計画された経路552に沿って1つ以上の物体を識別し、この1つ以上の物体の位置に関するデータを経路計画システム550aに送る。この場合、経路計画システム550aは、1つ以上の物体を回避するために、計画された経路552を再計算することができる。いくつかの例では、経路計画システム550aは衝突の確率を確定し、衝突の確率が予め規定されたしきい値を上回った場合、経路計画システム550aは経路を調整し、これを経路追従サブシステム320に送る。
再び図2Bを参照すると、いくつかの実施形態ではDNN500に経路計画システム500bが含まれている。よって、経路計画システム550bは経路552を、学習した動作に基づき確定することができる。例えば、DNN500は、選択されたトレーラー200aの位置を確定し、この位置に基づきトラクター100の経路552を確定する。いくつかの例では、確定された経路552は、図3Aおよび図3Bに関して説明した経路に類似していてよい。ただし、別の経路確定法も可能であり得る。同様に、DNN500、すなわちDNN500の経路計画システム550bは、トラクター100が経路552付近を移動する際に、計画された経路552内で識別することができる(動いているまたは静止している)1つ以上の物体に基づき、計画した経路552を調整する。いくつかの例では、経路計画システム550bは衝突の確率を確定し、衝突の確率が予め規定されたしきい値を上回った場合、経路計画システム550bは経路を調整し、これを経路追従サブシステム320に送る。
再び図2Aおよび図2Bを参照すると、経路追従サブシステム320は、経路計画システム550が経路552を計画すると、駆動系110が計画された経路552に自律的に追従する動作を実行するように構成されている。よって、経路追従サブシステム320には、実行されると、計画された経路552に沿ったトラクター100の自律運転を可能にする1つ以上の動作322〜330が含まれる。動作322〜330には、限定はしないが制動動作322、速度動作324、操舵動作326、ヒッチ連結動作328、およびサスペンション調整動作330が含まれていてよい。
制動動作322は、計画された経路552に基づきトラクター100を停止させるためまたはトラクターを減速させるために実行されてよい。制動動作322は、トラクター100を停止させるためまたはトラクター100の速度を低下させるために、駆動系110、例えば制動系120に信号またはコマンド301を送る。
速度動作324は、計画された経路552に基づき、加速または減速によりトラクター100の速度を変更するために実行されてよい。速度動作324は、減速用の制動系120または加速用の加速系130に信号またはコマンド301を送る。
操舵動作326は、計画された経路に基づきトラクター100の方向を転換させるために実行されてよい。よって、操舵動作326は、駆動系110に方向転換させる操舵角を示す信号またはコマンド301を、加速系130に送る。
図4A〜図4Cには、選択したトレーラー200aに対してそれぞれ初期位置P(図4A)、中間位置P(図4B)および最終位置P(図4C)または連結位置にあるトラクター100が示されている。図4Aを参照すると、トラクター100は、選択されたトレーラー200aに向かう自律的な移動を開始する前は、トレーラー200に対して初期位置Pに位置している。いくつかの例では、トラクター100と選択されたトレーラー200aとの間の初期距離Dは、約15メートルである。トラクター100は、図4Bに示すようにトラクター100が選択されたトレーラー200aから中間距離Dをあけた中間位置Pに到達するまで、計画された経路552に沿って自律的に移動する。中間位置Pでは、トラクターヒッチ160が選択されたトレーラー200aに概ね並列して整列するように方向付けられており、トラクターヒッチ160と、トレーラーヒッチ210のトレーラーヒッチレシーバー/カプラー212とは実質的に整列している。換言すると、トラクター縦軸Yは、トラクター鉛直軸Zと、トレーラー鉛直軸に沿ったトレーラー縦軸Tとに沿って延在する平面を規定する。いくつかの例では、中間距離Dは、約1メートルである。
図5A〜図5Dを参照すると、いくつかの例では、トラクター100が中間位置Pに位置するとき、ヒッチ連結動作328が、トラクターヒッチ160とトレーラーヒッチ210との連結を実行する。図示の例では、ボール形式のヒッチとレシーバーとが用いられている。ただし、図5A〜図5Dに示す例示的な実施形態は、トラクターヒッチとヒッチレシーバーとの間の鉛直方向の配置を利用する任意の形式のヒッチを用いて実施することができる。トラクターヒッチとヒッチレシーバーとの間の水平方向の配置を必要とするヒッチの形式に関して、鉛直方向の動きは、各コンポーネントの間で所望の水平方向の整列を達成するためだけに必要な場合、または全く不要な場合がある。
コントローラ300は、トラクターヒッチカプラー162の上部とトレーラーヒッチカプラー212の下部との間の相対高さHを確定する。トラクター100と選択されたトレーラー200aとを連結するために、トレーラーヒッチカプラー212は、トラクターヒッチカプラー162を解放可能に収容する。よって、トラクターヒッチカプラー162をトレーラーヒッチカプラー212に結合するためには、相対高さHがゼロに等しくなければならず、これにより、トラクターヒッチカプラー162が下降して、トレーラーヒッチカプラー212内に挿入されることが可能になる。よって、ヒッチ連結動作328が、コントローラ300からトラクターヒッチカプラー162とトレーラーヒッチカプラー212との間のゼロよりも大きな相対高さHを受け取ると、ヒッチ連結動作328はサスペンション調整動作330にコマンドを送り、これによりサスペンション調整動作330は懸架系132にコマンド301を出してトラクター100の高さ調整を実行し、コントローラ300からの測定に基づき相対高さHを低下させる。ヒッチ連結動作328が、ゼロに等しい相対高さHを受け取ると、ヒッチ連結動作328は駆動系110にコマンド301を出し、残りの経路552に沿って、すなわち中間位置Pから最終位置P(図4C)まで移動させ、トラクター100を選択されたトレーラー200aに連結させる。
図1および図6A〜図7Bを参照すると、第2の例示的なトラクター100が示されている。この場合も、トラクター100は、トラクター100の周辺環境の画像412を捉えるように構成されたカメラ410を有していてよい。画像412は、トラクター100の後方に位置するトレーラー200のトレーラー像を示すディスプレイ142上に表示される。オペレータは、トラクターヒッチカプラー162をトレーラーヒッチカプラー212の下または隣に位置決めすることになる軌道または経路554を、受け取った画像412内で確認する。オペレータが画像412内で確認した経路554に基づき、トラクター100は確認された経路554に沿って自律運転する。
トラクター100は、ユーザインタフェース140を有していてよい。ユーザインタフェース140には、ディスプレイ142と、つまみ143と、ボタン145とが含まれていてよく、これらは入力機構として用いられる。いくつかの例では、ディスプレイ142が、つまみ143およびボタン145を示してもよい。一方、別の例では、つまみ143およびボタン145は、つまみとボタンとが組み合わされたものである。いくつかの例では、ユーザインタフェース140は、オペレータからの1つ以上のオペレータコマンドを、1つ以上の入力機構またはタッチスクリーンディスプレイ142を介して受け取りかつ/または1つ以上の通知をオペレータに表示する。ユーザインタフェース140は、トラクターコントローラ300と通信しており、トラクターコントローラ300もまた、センサシステム400と通信している。いくつかの例では、ディスプレイ142は、トラクター100の周辺環境の画像を表示し、(オペレータから)ユーザインタフェース140が受け取った1つ以上のコマンドが、1つ以上の動作の実行を開始させる。いくつかの例では、ユーザディスプレイ142は、トラクター100の後方の周辺環境を表す画像を表示する。この場合、オペレータは、オペレータが車両を自律的に接近移動させたい周辺環境を示す、画像内の位置を選択することができる。いくつかの例では、ユーザディスプレイ142は、トラクター100の後方に位置する複数のトレーラー200の1つ以上の像を表示する。この場合、オペレータは、トラクター100を自律的に接近移動させるトレーラー200の像を選択する。
ディスプレイ142は、トラクター100の後方の周辺環境のカメラ画像412に重ねられた、トラクター100の推定経路554を表示する。オペレータは、ユーザインタフェース140を用いて推定経路554を変更してもよい。例えば、オペレータは、仮想のステアリング車輪を模したつまみ143を回転させることができる。オペレータがつまみ143を回転させると、ディスプレイ142に表示される推定経路が更新される。オペレータは、ディスプレイ142上に表示された推定経路と、ユーザがトラクター100を接近運転させようとするトレーラー像または別の物体とが交わるまで、表示された経路554を調整する。ユーザが表示された推定経路554に納得すると、オペレータは、経路554の確定を示す動作を実行し、トラクター100が計画された経路554に自律的に追従することを可能にする。計画された経路554は、トラクターヒッチカプラー162からトレーラーヒッチレシーバー/カプラー212までの経路である。車輪経路552は、車輪が計画された経路554に沿って移動するであろうと推定された経路である。
いくつかの実施形態では、ユーザは3つの経路モード312を調整することができ、3つの経路モード312には、図8Aおよび図8Bに示すような、経路の湾曲角度を調整するための角度モード314と、図9Aおよび図9Bに示すような、推定経路554の長さを調整するための距離モード316と、任意には図10Aおよび図10Bに示すような、移動終了時にトレーラー(または別の物体)に対して車両を方向付けるために「接近角度」を調整するための2円弧モード318とが含まれている。2円弧モードは任意であるため、ユーザが目下構成されている経路(1円弧)に納得した場合には、ユーザはボタンをもう一度押すことにより、移動の選択を決定することができる。そうでない場合には、ユーザは3度目のつまみ調整を行って、2円弧または別の適当な経路の形状を変更することができる。このことは、トレーラーまたは別の物体に対する最終接近角度の調整を可能にする。ユーザが接近角度の選択に納得すると、ユーザはボタンを押して経路の選択を決定する。
トラクターコントローラ300は、演算プロセッサ302において実行可能な命令を記憶することができる非一時的なメモリ304(例えばハードディスク、フラッシュメモリ、ランダムアクセスメモリ)と通信する演算装置(またはプロセッサ)302(例えば1つ以上の演算プロセッサを有する中央処理ユニット)を有している。
トラクターコントローラ300は、オペレータ支援システム310を実行し、オペレータ支援システム310は、経路システム550から計画された経路554を受け取り、コマンド301を駆動系110に送る動作330,330a〜330cを実行し、これにより、トラクター100は計画された経路554付近を(例示した)後退方向Rに自律運転する。
経路追従動作330には、制動動作330aと、速度動作330bと、操舵動作330cとが含まれる。いくつかの例では、経路追従動作330にはヒッチ連結動作とサスペンション調整動作も含まれる。各動作330,330a〜330cに基づき、トラクター100はとりわけ、後退走行、特定の角度での方向転換、制動、加速、減速等の行動を取る。トラクターコントローラ300は駆動系110を制御することにより、より具体的には駆動系110にコマンド301を出すことにより、トラクター100を路面にわたり任意の方向に動かすことができる。
トラクター100は、信頼性およびエラー強さのある運転を提供するために、センサシステム400を有していてよい。センサシステム400は、複数の異なる形式のセンサを有していてよく、センサは別個にまたは互いにトラクター100の周辺環境を認知し、トラクターの周辺環境は、トラクター100を運転しかつオペレータがセンサシステム400により検出された物体および障害物に基づき情報処理的な決定を下すことを支援するために用いられる。センサシステム400には、1つ以上のカメラ410が含まれていてよい。いくつかの実施形態では、トラクター100は、トラクター100の後進経路の視野を提供するために取り付けられたリヤカメラ410,410aを有している。リヤカメラ410は、広幅のパノラマ画像または半球形画像を生成することを意図して視覚の大幅な歪みを生じさせる超広角レンズを含む魚眼レンズを有していてよい。魚眼カメラは、極度に広幅の画角を有する画像を捉える。さらに、魚眼カメラにより捉えられた画像は、特徴的な凸状の非直線的な外観を有している。トラクター100の後方の画像を捉えるためには、別の形式のカメラも使用することができる。
センサシステム400には、トラクターの線形加速度(1つ以上の加速度計を使用)および回転速度(1つ以上のジャイロスコープを使用)を計測するように構成されたIMU(慣性計測装置)420も含まれていてよい。いくつかの例では、IMU420はトラクター100の向きの基準をも確定する。よって、IMU420はトラクター100のピッチ、ロールおよびヨーを確定する。
センサシステム400には、限定はしないがレーダー、ソナー、LIDAR(遠方ターゲットへの到達距離および/または別の情報を見いだすために散乱光の特性を測定する光学リモートセンシングを必要とし得る光検出と測距(Light detection and Ranging))、LADAR(レーザー検出と測距(Laser Detection and Ranging))等の、別のセンサが含まれていてよい。
トラクターコントローラ300は、カメラ410から画像412を受け取り、受け取った画像412にトラクターの経路552を重ねる連結支援システム310を実行する。
再び図6A〜図6Bを参照すると、トラクターコントローラ300は、トラクター100をトレーラー200に向かって自律運転させるための経路554をオペレータが選択することを支援する、連結支援システム310を実行する。オペレータは、ユーザインタフェース140を用いて、例えばディスプレイ142上で選択して、連結支援システム310の実行を開始することができる。開始されると、連結支援システム310はディスプレイ142に命令し、トラクター100の後方の周辺環境のカメラ画像412に重ねられるトラクター100の経路554を表示させる。オペレータはユーザインタフェース140を用いて、計画された経路554を変更してもよい。例えば、オペレータは、仮想のステアリングホイールを模したつまみ143を回転させることができる。オペレータがつまみ143を回転させると、ディスプレイ142に表示される、計画された経路554が更新される。オペレータは、ディスプレイ142上に表示された、更新済みの計画された経路554と、オペレータがトラクター100を接近運転させようとするトレーラー像138または別の物体とが交わるまで、表示された経路554を調整する。オペレータが表示された、計画された経路554に納得すると、オペレータは、経路554の確定を表す動作を実行し、トラクター100が計画された経路に自律的に追従することを可能にする。
いくつかの実施形態では、連結支援システム310には、軌道生成器560と、動作推定装置570と、経路追跡装置580とが含まれている。軌道生成器560は、オペレータが選択した経路554に基づきトラクター100の推定位置を確定する。動作推定装置570は、トラクター100の実際位置を確定し、経路追跡装置580は、推定位置Peと実際位置Paとに基づき誤差562を確定すると共にトラクター100の計画された経路554を調整して、実際位置Paと推定位置Peとの間の誤差562を解消する。
いくつかの実施形態では、軌道生成器560はカメラ410から画像412を受け取り、受け取った画像412に車両の経路554を重ねる。オペレータは、1つ以上の経路モード312に基づき、経路554の選択を調整することができる。いくつかの例では、経路モード312には、角度サブモード314と距離サブモード316とを有する1円弧モード312が含まれる。いくつかの例では、経路モード312には、2円弧モード318が含まれていてもよい。よってオペレータは、トレーラー200または物体までの経路554を確定しかつ調整するために、角度サブモード314、距離サブモード、および/または2円弧モード318の間で選択することができる。
図7Aおよび図7Bを参照すると、いくつかの例では、角度サブモード314および距離サブモード316は円弧モード312の一部であり(図7A)、よってオペレータは最初に1つのモード312,318を選択してから、選択したモード312,318内のサブモードを選択する。このように、例えばディスプレイ142は1円弧モードボタン145および2円弧モードボタン145を表示することができ、オペレータはこれらのボタンから選択することができる。図7Bに示す例では、各サブモード/モード314,316,318が独立している。よって、ボタン145を押すと、3つのモード314,316,318の間でローテーションが行われる。
角度サブモード314は、図8Aおよび図8Bに示すような経路552の湾曲角度を調整するように構成されている。よって、オペレータはつまみ143を右に回し、これにより、表示された経路552が図8Aに示すような右に向かう湾曲を有するようにすることができる。さらに、オペレータはつまみ143を左に回し、これにより、表示された経路552が図8Bに示すように左に向かう湾曲を有するようにすることもできる。距離サブモード316は、図8Aおよび図8Bに示すような推定経路552の長さを調整するように構成されている。例えば、図8Aを参照すると、オペレータはつまみ143を回して、経路552の目的地を画像412内のトレーラー像138に近接するように位置決めすることができる。図8Bを参照すると、画像412が示す経路552は、図8Aに示した経路よりも短い距離を有している。よって、この場合、オペレータは、トラクター100が後退方向Rに数メートルだけ自律的に移動することを希望する場合がある。2円弧モード318は、図10Aおよび図10Bに示すような経路552の終点においてトラクター100をトレーラー200(または別の物体)に対して方向付ける方法を示す接近角度を調整するように構成されている。例えば、2円弧モード318は、トラクター100とトレーラー200とを整列させ、これにより、トラクター100の縦軸Yとトレーラー200の縦軸Yとを整列させるという点においてオペレータを支援し、これによりオペレータは、トラクター100とトレーラー200との間での連結プロセス中に支援される。図11Aおよび図11Bを参照すると、円弧モード312と2円弧モード318とは両方共、同じ終点を有している。ただし、2円弧モード318は、トレーラー200に向かう接近角度の調整を可能にする。いくつかの例では、オペレータが2円弧モード318に切り替えると、軌道生成器560はスタート位置と終点位置とをそのまま保つ。2円弧モード318では、オペレータはトレーラー200に対する接近角度のみを調整することができる。オペレータが2円弧モード318で距離を調整することはない。いくつかの例では、オペレータが選択した経路552の半径と長さとが、トラクター100の最終位置を確定する。車両コントローラ150は、デュビン経路を用いて最適な計算の経路552を確定する。
2円弧モード318が任意であるいくつかの実施形態では、オペレータが円弧モード312の選択に基づく経路552に納得すると、オペレータはボタン145を押すことにより、経路552を決定することができる。そうでない場合には、オペレータはつまみ143の3度目の調整を行って、2円弧または別の適当な経路552の形状を変更する。このことは、トレーラー200または別の物体に対する最終接近角度の調整を可能にする。オペレータが接近角度の選択に納得すると、オペレータはボタン145を押して経路の選択を決定する。
いくつかの実施形態では、オペレータはトラクター100を、トレーラー200、または別の物体または関心点がトラクター100のリヤカメラ410の視野内にある位置に駐車させる。トラクター100のエンジンはアイドリング状態であり、トランスミッションはパーキングポジションになっていてよい。オペレータは、ボタン145を押すことおよび/またはディスプレイ142上で選択することにより、軌道生成器560を始動させることができる。いくつかの例では、ディスプレイ142は、選択可能なオプションまたはボタン145を表示して、オペレータが円弧モード312を開始させることを可能にする。軌道生成器560は、図7Aおよび図7Bに示すように、円弧モード312の角度サブモード314を実行することにより始動する。オペレータは、例えばボタン145を押すことにより距離サブモード316に切り替えて、経路552の距離を調整する。いくつかの例では、オペレータは角度サブモード314と距離サブモード316との間を切り替えることと、ディスプレイに所望の経路552が表示されるまで経路552を調整することとにより、経路552を調整することができる。オペレータは、経路552の外側の境界線554をトレーラー200(すなわち画像412内のトレーラー像138)または別の関心点に関与させるように、経路552を調整する。
いくつかの実施形態では、トレーラー200または関心点に対する最終接近角度が、例えば車両縦軸Yとトレーラー縦軸Yとを整列させるために重要である。この場合、オペレータは(ディスプレイ142上に表示される)「円弧/2円弧モード」ボタン145を選択するかまたは押して、2円弧モード318に切り替えることができる。2円弧モード318では、先にセットした経路552の終点は不変のままであり、オペレータはつまみ143で最終接近角度を調整する。オペレータが最終接近角度と完成した軌道または経路552に納得すると、オペレータは動作を実行することで、選択した経路552を確認することができる。いくつかの例では、オペレータはトランスミッションをリバースに切り替え、これにより、オペレータが表示された経路552に納得したということを示す。いくつかの例では、オペレータがブレーキを作動させると共にトランスミッションをリバースに切り替えてからブレーキを解除すると、トラクター100は選択された経路552に追従する。いくつかの例では、車両が経路552に沿って後退方向Rに自律的に移動している間、オペレータは例えばブレーキを踏むことにより、トラクター100を停止させることができる。このことは、連結支援システム310から車両コントローラ150を抜け出させる。
いくつかの実施形態では、軌道生成器560は、経路の距離をデフォルトにセットし、これは、経路がトレーラー200または別の関心点と交差するまで、オペレータは操舵角を調整するだけであるということを可能にする。
いくつかの実施形態では、最終接近角度は調整されない。その代わり、最終接近角度は常に、最初の車両出発角度と同じである。つまり、最終車両縦軸Yは、最初の車両縦軸Yに対して平行である。この場合、オペレータは経路552の最終位置を調整して、トレーラーに関与させる。
いくつかの例では、トラクター100が経路552に沿って後退方向Rに移動している間、ディスプレイ142は、経路552に沿ったトラクター100の進行を示すことができる。例えば、ディスプレイ142は地面に投影された元の軌道を示すことができるが、これは車両の位置変化により更新される。ディスプレイ142は、この軌道に車両がどれだけ良好に追従しているかの指標を示すこともできる。
いくつかの実施形態では、軌道生成器560は他の車両システムからデータを受け取って経路552を生成する。いくつかの例では、軌道生成器560は(x,y,θ)により規定された車両姿勢データを受け取り、この場合、xはX−Y平面内で横軸Xに沿ったトラクター100の中心の位置であり、yはX−Y平面内で縦軸Yに沿った車両の中心の位置であり、θはトラクター100の向きである。さらに軌道生成器560は、つまみ143からつまみ143の位置、例えばつまみの角度を受け取ることができる。軌道生成器560は、モードボタン状態(すなわち円弧モード312または2円弧モード318)と、サブモードボタン状態(すなわち角度サブモード314または距離サブモード316)とを受け取ることもできる。受け取ったデータに基づき、軌道生成器560は経路552を調整し、ディスプレイ142にこの経路552を表示するように命令する。いくつかの例では、軌道552には外側の境界線554と、牽引ボール122の推定経路である牽引ボール経路166とが含まれる。軌道生成器560はディスプレイ142に、運転者が経路552を調整するために選択したモード/サブモードを示す現在のモードまたはサブモード状態を表示するように命令することもできる。
再び図6Aおよび図6Bを参照すると、オペレータがユーザインタフェース140を介して経路選択の完了を知らせると、車両コントローラ150は、計画された経路552に追従するためにオペレータ支援システム320を実行する。オペレータ支援システム320には、経路追従動作330が含まれている。経路追従動作330は、選択された経路552を受け取って1つ以上の動作330a〜cを実行し、1つ以上の動作330a〜cは駆動系110にコマンド301を送り、トラクター100が計画された経路552に沿って自律運転するようにする。トラクター100が計画された経路552に沿って自律的に移動すると、連結支援システム310は以下に述べるように、動作推定装置570と経路追跡装置とに基づき、経路552を連続的に更新する。
再び図6Aおよび図6Bを参照すると、トラクター100が経路552に沿って後退方向Rに自律的に移動すると、動作推定装置570は、トラクター100の現在の位置Paを確定する。上述したように、軌道生成器560は、計画された経路552、すなわち推定位置Peに基づいて、トラクター100があるべき所を確定する。よって、動作推定装置は、トラクター100の実際位置Paを確定する。いくつかの例では、動作推定装置は、相対的な車両位置および速度を出力する動作推定アルゴリズムを有している。例えば、動作推定アルゴリズムは、拡張カルマンフィルター(EKF)を有していてよい。EKFは、限定はしないが4つのホイールから成るエンコーダ(例えば1回転につき96ティック)、および操舵角等の測定を用いる。動作推定装置570は、複数の測定値を融合して、トラクター100の実際位置を確定する。動作推定装置570は、トラクター100が後退方向に自律的に移動しているときのトラクター100の低速に基づき、自転車モデルを用いてもよい。自転車モデルは、2つの前輪を表す単一の操舵前輪と、2つの後輪を表す単一の非操舵後輪とを使用する。車輪はそれぞれ、単一のリジッドリンクにより結合されている。動作は、2次元の水平な地面に制限される。自転車モードの入力値は速度と操舵角である一方で、その状態は位置および向きである。動作推定装置570は、線形速度、回転速度および位置(例えば車両の向き)を推定する。いくつかの例では、動作推定装置570は、センサシステム400、例えばカメラ、レーダー、GPS測定からのセンサデータを考慮して、あらゆるドリフトを改良する。
いくつかの実施形態では、動作推定装置570は拡張カルマンフィルター(EKF)を使用する。EKFの数式も、以下に方程式(3)〜(7)として提供されている。状態ベクトルは、数式1:
Figure 2022501032
に示された9つの要素を有している。
最初の3つは、車両の「姿勢」(x,y,θ)である。次の2つは、線形速度および角速度(v,ω)である。最後の4つは、左後ろ、右後ろ、左前、右前の4つのタイヤそれぞれが移動した距離(dlr,drr,dlf,drf)である。
完全な測定ベクトルは、数式2:
Figure 2022501032
に示された5つの要素を有している。
最初の4つは再び、4つのタイヤが移動した距離(dlr,drr,dlf,drf)である。最後の要素φは、前輪の平均角度(ステアリングホイール角ではなく、縦軸に対する前タイヤの平均角度)である。
動作推定装置570は、推定車両速度を提供する。距離変化を時間変化で割って(Δd/Δt)おおよその速度を計算することは一般的であるが、これはホイールエンコーダの数が比較的少数であり、かつ車両が比較的低速で移動するこの場合の状況に関しては、ノイズが大幅に増えることになる。よって、距離変化を時間変化で割ること(Δd/Δt)を含む直接計算を回避するために、動作推定装置570は、測定されたホイール累積距離に基づくEKFを使用することによって車両の線形速度vを推定し、除算を含む明確な速度計算はない。
拡張カルマンフィルターは、2つの予測式および3つの測定式として記述することができる。予測式は:
Figure 2022501032
Figure 2022501032
である。
数式(3)は、状態μの更新を提供する。数式(4)は、共分散Σの更新を提供する。共分散は、状態の現在の不確定性の推定を提供する。行列Rは、状態μのノイズ共分散である。
測定更新式は:
Figure 2022501032
Figure 2022501032
Figure 2022501032
である。数式(5)は、最適なカルマンゲインKの値を設定する。数式(6)は、状態μの更新を提供する。数式(7)は、共分散Σの更新を提供する。行列Qは、測定zのノイズ共分散である。
予測するためには、非線形ベクトル関数gを規定する必要がある。行列Gは、このベクトル関数の導関数であり、便宜上、これも提供される。ベクトル関数gは、
Figure 2022501032
により与えられる。
この場合、wは車両の「軌道幅」である。より具体的には、これは左タイヤの中心から右タイヤの中心までの横方向距離である。フロントタイヤ間の距離と、リヤタイヤ間の距離とは同じであると想定されている。ホイールベースはlで表されている。最後の2つの要素には、式がdlfおよびdrfから減算されるマイナス符号があることに留意されたい。このマイナス符号は、後退動作を想定している。よって、この予測式を前進動作に使用することはできない。ただし、車両の方向(前方または後方)のいくつかの測定値があると、最後の2つの要素の符号(前方は正、後方は負)を変更し、この数式を前方および後方の両方向に対して有効にすることは簡単になる。
行列Gは、9つの行および9つの列を有している。
Figure 2022501032
とする。Iは9×9の単位行列である。この場合、
Figure 2022501032
である。その他の要素は全てゼロである。
更新完了は、ホイールティックおよびホイール角の測定値が全て同時に利用可能であるということを想定している。ホイールティックのみが利用可能な場合にはホイールティックが別個に組み込まれてよく、ホイール角のみが利用可能な場合にはホイール角が別個に組み込まれてよい。更新完了のためにはベクトルhが規定される。行列Hは、このベクトル関数の導関数である。便宜上、これも提供される。ベクトル関数hは、
Figure 2022501032
により与えられる。行列Hはhの導関数であり、5×9である。非ゼロ要素は
Figure 2022501032
である。特定の量h,H54,H55には、容易にゼロになり得る除数が含まれることに留意されたい。よって、実施形態では、除算を実行する前にこれらの除数がゼロでないことをテストする必要がある。
操舵角のみから成る測定値と同様、ホイールティックのみから成る測定値も考慮することができる。ただし、提供される情報を考慮すると、これらの変化形は明白であるため、含まれていない。
車両が計画された経路552に沿って後退方向Rに自律的に移動している間、軌道生成器560は、トラクター100が計画された経路552に基づき位置すべき所、すなわち推定位置Peを確定する。一方、動作推定装置570は、トラクター100の実際位置Paを確定する。よって経路追跡装置580は、推定位置Peと実際位置Paとに基づき、誤差562を確定する。経路追跡装置580は、誤差562に基づき車両の現在の位置Paを調整し、これによりトラクター100は、計画された経路552の追従を継続することができる。
図12A〜図12Dを参照すると、いくつかの実施形態では、経路追跡装置580が純粋な追跡アプローチを実行し、トラクター100を計画された経路552上に保つ。オペレータが選択した経路552は、予め規定された時間間隔で、例えば毎分サンプリングされ、これにより、計画された経路552の牽引ボール経路166に沿って位置決めされた複数の中間点168を生成する。経路追跡装置580(例えばアルゴリズム)は、動作推定装置570から受け取った現在の牽引ボール位置および向きPaと、次の中間点位置Pbとを比較する。車両連結支援システム310は、現在の中間点Pb、すなわち車両が接近運転している中間点に向かう車両の操舵を絶えず調整する。経路追跡装置580は、車両牽引ボール122が各中間点168をたどることを可能にする。換言すると、経路追跡装置580は、牽引ボール122が牽引ボール経路166に沿って各中間点をたどることを可能にする。いくつかの例では、中間点168は世界座標から車両座標に変換される。例えば、経路追跡装置580は牽引ボール位置Paと中間点位置Pbとに基づき、旋回円の中心Ccを計算する。次いで、経路追跡装置580は旋回円の中心に基づき、車両旋回半径Rrを計算する。最後に、経路追跡装置580はアッカーマンアングルを用いて旋回円の中心に基づき、操舵角を計算する。換言すると、経路追跡装置580は、推定位置Peと現在の位置Paとを比較して車両が経路に従っていることを確認し、かつ次の中間点Pbを確定し、かつ現在の車両位置および向きから次のまたは後続の中間点Pbまでの経路を確定または調整する。よって、経路追跡装置580は、トラクター100が計画された経路に沿って自律的に移動しかつトラクター100が計画された経路から逸脱した場合には車両の動作または運転を調整することを維持する。
いくつかの例では、コントローラは、計画された経路552に沿って1つ以上の物体を識別する物体検出システム(図示せず)を有している。この場合、連結支援システム310が経路552を調整して、検出された1つ以上の物体を回避する。いくつかの例では、連結支援システム310が衝突の確率を確定し、衝突の確率が、予め規定されたしきい値を上回った場合、連結支援システム310は経路552を調整し、これをオペレータ支援システム320に送る。
オペレータが、選択した経路552が入力されたことを知らせると、車両コントローラ150はオペレータ支援システム320を実行し、オペレータ支援システム320もまた、経路追従動作330を有している。経路追従動作330は、選択された経路552を受け取って1つ以上の動作330a〜bを実行し、1つ以上の動作330a〜bは駆動系110にコマンド301を送り、トラクター100が計画された経路に沿って後退方向Rに自律運転するようにする。
経路追従動作330a〜bには、限定はしないが制動動作330aと、速度動作330bと、操舵動作330cといった、1つ以上の動作が含まれていてよい。各動作330a〜bに基づき、トラクター100はとりわけ、後退走行、特定の角度での方向転換、制動、加速、減速等の行動を取る。車両コントローラ150は駆動系110を制御することによって、より具体的には駆動系110にコマンド301を出すことによって、トラクター100を路面にわたり任意の方向に動かすことができる。
制動動作330aは、計画された経路に基づきトラクター100を停止させるためまたはトラクター100を減速させるために実行されてよい。制動動作330aは、トラクター100を停止させるためまたはトラクター100の速度を低下させるために、駆動系110、例えば制動系(図示せず)に信号またはコマンド301を送る。
速度動作330bは、計画された経路552に基づき、加速または減速によってトラクター100の速度を変更するために実行されてよい。速度動作330bは、減速用の制動系120または加速用の加速系130に信号またはコマンド301を送る。
操舵動作330cは、計画された経路552に基づきトラクター100の方向を転換させるために実行されてよい。よって、操舵動作330cは、駆動系110に方向転換させる操舵角を命令する信号またはコマンド301を、加速系130に送る。
図13には、トラクター100を(図1〜図12Dに示したように)選択したトレーラー200,200aに向かって自律的に移動させる方法800を運用する段取りの一例が示されている。ブロック802において方法800は、オペレータがトラクター100をトレーラー200,200aに自律的に連結させようとする命令を受け取ることにより、連結支援モードを開始させるステップを含む。命令は、トラクター100のユーザインタフェース140上での選択、トラクターを(後退はさせずに)リヤに入れること、またはその他の任意の命令によるものであってよい。ブロック804において、DNN500がトラクター100の後方の1つ以上のトレーラー200,200a〜cを検出して位置を確認し、確認した1つ以上のトレーラー200,200a〜cそれぞれに関するトレーラー像146,146a〜cを、ユーザインタフェース140を介して表示する。代替的には、カメラ画像がディスプレイ142に表示される。決定ブロック806において、方法800はオペレータの選択144を待つ。オペレータは、ディスプレイ上の1つ以上のトレーラー像146,146a〜cを選択することにより、または経路図、すなわち経路追跡装置580と、関心点、すなわち連結画像位置を含むトレーラー像146とが表示された画像上で整列するまでユーザ入力つまみ143を操作することにより、表示された画像から選択することができる。オペレータが、選択したトレーラー200aに関連するトレーラー像146,146a〜cを選択すると、ブロック808において、方法800は、トラクター100の初期位置Pから、選択したトレーラー200に対する最終位置Pまでのトラクター経路552を計画するステップを含む。いくつかの例では、経路計画システム550,550a,550bが経路552を計画する。経路計画システム550,550a,550bは、コントローラ300の一部またはDNN500の一部であってよい。ブロック810において、方法800は、経路追従サブシステム320を実行するステップを含む。決定ブロック812において、方法800は、選択したトレーラー200aからトラクター100が予め規定した距離内にあるか否かを確定する、すなわち方法800は、トラクター100が中間位置Pに到達したか否かを確定する。トラクター100が中間位置Pに到達すると、方法800は決定ブロック812において、トラクター100のトラクターヒッチカプラー162の上部と、選択したトレーラー200aのヒッチカプラー212の下部との間の相対高さHを確定し、かつヒッチカプラー212が相対高さHに基づきトラクターヒッチカプラー162を解放可能に収容することができるか否かを確定する。換言すると、方法800は、相対高さHがゼロに等しくなっているか否かを確定する。相対高さHがゼロに等しくなっていない場合には、ブロック816において、方法800はトラクター100のサスペンションを調整し、次いでブロック814において相対高さHを確定し、かつ相対高さHがゼロに等しくなっているか否かを確認する。相対高さHがゼロに等しくなっていると、方法800はブロック818において、中間位置Pから最終位置Pまで、経路552を巡る移動を継続し、トラクター100のトラクターヒッチカプラー162を、選択したトレーラー200aのヒッチカプラー212に連結させる。
図13は、図1〜図8Bで説明したシステムを使用してトラクター100(例えば牽引車)をトレーラー200等の関心点に向かって後退方向Rに自律的に移動させる方法900を運用する段取りの一例を提供する。ブロック902において、方法900は、データ処理ハードウェア152において、トラクター100の後部に位置しかつデータ処理ハードウェア152と通信するカメラ410から1つ以上の画像143を受け取るステップを含む。ブロック904において、方法900は、データ処理ハードウェア152において、データ処理ハードウェア152と通信するユーザインタフェース140からオペレータが計画した経路162を受け取るステップを含む。オペレータが計画した経路162には、複数の中間点168が含まれている。ブロック906において、方法900は、データ処理ハードウェア152から、データ処理ハードウェア152と通信する駆動系110に、オペレータが計画した経路162に沿ってトラクター100を自律的に移動させる1つ以上のコマンド161,194を送信するステップを含む。ブロック908において、方法900は、データ処理ハードウェア152において、現在の車両位置Paを確定するステップを含む。ブロック910において、方法900は、データ処理ハードウェア152においてオペレータが計画した経路に基づき、現在の車両位置Paから見てオペレータが計画した経路162に沿った後続の中間点Pbになる後続の推定車両位置を確定するステップを含む。ブロック912において、方法900は、データ処理ハードウェア152において、現在の車両位置Paから後続の推定車両位置Pbまでの経路調整を確定するステップを含む。ブロック914において、方法900は、経路調整に基づき後続の推定車両位置Pbに向かってトラクター100を自律的に移動させる命令を、データ処理ハードウェア152から駆動系110に送信するステップを含む。
図14は、図1〜図8Bで説明したシステムを使用してトラクター100(例えば牽引車)をトレーラー200等の関心点に向かって後退方向Rに自律的に移動させる別の方法1000を運用する段取りの一例を提供する。ブロック1002において、方法1000は、データ処理ハードウェア152において、トラクター100の後部に位置しかつデータ処理ハードウェア152と通信する1つ以上のカメラ142から1つ以上の画像143を受け取るステップを含む。ブロック1004において、方法1000は、データ処理ハードウェア152において、データ処理ハードウェア152と通信するユーザインタフェース140からオペレータが計画した経路162を受け取るステップを含む。ブロック1006において、方法1000は、データ処理ハードウェア152から、データ処理ハードウェア152と通信する駆動系110に、オペレータが計画した経路162に沿ってトラクター100を自律的に移動させる1つ以上のコマンド161,194を送信するステップを含む。ブロック1008において、方法1000は、データ処理ハードウェア152において、オペレータが計画した経路162に基づき推定車両位置Peを確定するステップを含む。ブロック1010において、方法1000は、データ処理ハードウェア152において、現在の車両位置Paを確定するステップを含む。ブロック1012において、方法1000は、データ処理ハードウェア152において、推定車両位置Peと現在の車両位置Paとに基づき誤差184を確定するステップを含む。ブロック1014において、方法1000は、データ処理ハードウェア152において、トラクター100を現在の車両位置Paから推定車両位置Peへ自律的に移動させて誤差184を解消する1つ以上の経路調整コマンドを確定するステップを含む。ブロック1016において、方法1000は、データ処理ハードウェア152から駆動系110に1つ以上の経路調整コマンドを送信するステップを含む。
いくつかの例では、方法900,1000は、経路を1つ以上の画像143に重ねるステップおよびコマンドを、データ処理ハードウェア152と通信するユーザインタフェース140を介して受け取るステップを含んでいる。コマンドには、オペレータが計画した経路162のとおりに経路を調整する命令が含まれる。いくつかの例では、コマンドには、経路の距離を調整する命令が含まれる。コマンドには、経路の角度を調整する命令または経路の終端部の角度を調整する命令が含まれてもよい。
いくつかの実施形態では、現在の車両位置を確定することには、1つ以上の車輪112に関連するホイールエンコーダセンサデータ145を受け取ることと、操舵角センサデータ145を受け取ることとが含まれる。現在の車両位置Paは、ホイールエンコーダセンサデータ145と操舵角センサデータ145とに基づく。
上述したように、提案したアルゴリズムは、GPU、グラフィックアクセラレータ、トレーニングまたはFPGAを用いてまたは用いずに、標準的なCPUにおいてリアルタイムで動作するように設計されている。さらに、提案したアプローチは、オペレータからの初期入力のみを必要とする自動化された方法を提供する。さらに、説明したシステムは、オペレータへのガイドラインの提供と、全ての後退機能の自動化との間の折衷案を提供する。
ここで説明したシステムおよび技術の様々な実施形態は、デジタル電子回路、集積回路、特別に設計されたASIC(特定用途向け集積回路(application specific integrated circuits))、コンピュータハードウェア、ファームウェア、ソフトウェア、および/またはそれらの組合せにおいて実現することができる。これらの様々な実施形態は、特別または汎用であってよく、データおよび命令を、ストレージシステム、少なくとも1つの入力デバイス、および少なくとも1つの出力デバイスから受け取りかつこれらに送信するように接続された、少なくとも1つのプログラム可能なプロセッサを含むプログラム可能なシステム上で実行可能かつ/または翻訳可能な1つ以上のコンピュータプログラムにおける実施形態を含んでいてよい。
これらの(プログラム、ソフトウェア、ソフトウェアアプリケーションまたはコードとして知られてもいる)コンピュータプログラムには、プログラム可能なプロセッサに対する機械命令が含まれ、高度なプロセデュラル型および/またはオブジェクト指向型のプログラミング言語、および/またはアセンブリ/マシン言語で実行することができる。本明細書で使用する場合、「機械可読媒体」および「コンピュータ可読媒体」という用語は、プログラム可能なプロセッサに機械命令および/またはデータを提供するために使用される任意のコンピュータプログラム製品、装置および/またはデバイス(例えば磁気ディスク、光ディスク、メモリ、プログラマブルロジックデバイス(PLD))を指し、機械命令を機械可読信号として受信する機械可読媒体を含む。「機械可読信号」という用語は、プログラム可能なプロセッサに機械命令および/またはデータを提供するために使用される任意の信号を指す。
本明細書に記載した主題および機能運用の実施形態は、本明細書に開示した構造およびそれらと構造的に同等のものを含むデジタル電子回路、またはコンピュータソフトウェア、ファームウェア、またはハードウェアで、またはこれらを1つ以上組み合わせて実施することができる。さらに、本明細書に記載した主題は、データ処理装置の動作を制御してまたは制御することを実行するためにコンピュータ可読媒体上でコード化された1つ以上のコンピュータプログラム製品、すなわち、コンピュータプログラム命令の1つ以上のモジュールとして実行することができる。コンピュータ可読媒体は、機械可読記憶装置、機械可読記憶基板、メモリ装置、機械可読伝達信号に影響を及ぼす組成物、またはこれらを1つ以上組み合わせたものであってよい。「データ処理装置」、「演算装置」および「演算プロセッサ」という用語には、例えばプログラム可能な1つのプロセッサ、1つのコンピュータ、または複数のプロセッサまたはコンピュータを含む、データを処理するあらゆる装置、デバイス、および機械が含まれる。装置は、ハードウェアに加えて、当該のコンピュータプログラム用の実行環境を生成するコード、例えば、プロセッサファームウェア、プロトコルスタック、データベース管理システム、運用システム、またはこれらを1つ以上組み合わせたものを構成するコードを含んでいてよい。伝達信号は、人為的に生成された信号、例えば、適切な受信器装置に送信する情報をコード化するために生成される、機械により生成された電気信号、光信号、または電磁信号である。
同様に、工程は特定の順序で図示されている一方で、望ましい結果を達成するために、このような工程は図示の特定の順序または連続した順序で実施されること、または図示の全ての工程が実施されることが要求されていると理解されるべきではない。特定の状況では、マルチタスクおよび並列処理が有利な場合もある。さらに、上述した実施形態における様々なシステムコンポーネントの分離は、このような分離が全ての実施形態において要求されていると理解されるべきではなく、記載したプログラムコンポーネントおよびシステムは一般に、単一のソフトウェア製品に一緒に組み込むことができるか、または複数のソフトウェア製品にパッケージングすることができると理解されるべきである。
いくつかの実施形態を説明してきた。それにもかかわらず、様々な変更が、本開示の思想および範囲から逸脱すること無しに行われてよいということが理解されるであろう。よって、その他の実施形態は、以下の請求項の範囲内にある。

Claims (20)

  1. トラクターをトレーラーに連結支援システムを用いて取り付けるために後退方向に移動させる方法であって、
    連結支援モードに入るステップと、
    少なくとも1つのカメラを示すカメラ画像をユーザインタフェース上に表示するステップと、
    通信中のユーザインタフェースにおいて、選択されたトレーラーの表示を受け取るステップと、
    演算装置を用いて計画された経路、すなわち、トラクターをトラクター経路に沿って初期位置から最終位置まで移動させるように構成された動きを含む、前記初期位置から前記トレーラーに近接する前期最終位置までの前記トラクター経路を確定するステップと、
    前記演算装置と通信する駆動系において、前記トラクター経路を前記初期位置から前記最終位置まで自律的に追従するステップと、
    を含む方法。
  2. 前記ユーザインタフェース上に表示するステップは、2つ以上のトレーラーを表示することを含み、前記トレーラーを選択することは、所望のトレーラーの画像を選択することを含み、前記経路の計画は、ディープニューラルネットワークにより完了する、請求項1記載の方法。
  3. 前記トラクターが前記トラクター経路に沿って移動する際に、前記ニューラルネットワークにおいて、前記トラクター経路内の1つ以上の物体を連続的に検出するステップと、
    前記物体を検出した場合には、前記演算装置において前記トラクター経路を変更するステップと、
    をさらに含む、請求項2記載の方法。
  4. 1つ以上のトレーラーを検出するステップは、
    前記ニューラルネットワークと通信し、少なくとも1つが、後退方向に向いた前記トレーラーの後ろ側に配置された1つ以上の画像装置において、1つ以上の画像を捉えるステップと、
    ニューラルネットワークにおいて、1つ以上の前記画像内で1つ以上の前記トレーラーを確定するステップと、
    を含む、請求項2記載の方法。
  5. 前記ユーザインタフェース上に表示するステップはさらに、コントローラにおいて、前記トラクターの後部に配置されかつ前記コントローラと通信する1つ以上のカメラから1つ以上の画像を受け取り、前記コントローラにおいて、トラクターヒッチから始まり、これに沿って前記トラクターが走行する予想経路を示す経路図を重ねるステップを含む、請求項1記載の方法。
  6. 前記トレーラーを選択するステップはさらに、前記コントローラにおいて、前記経路図が関心点で終わるといった、前記経路図における変更を示す第1のコマンドを、ユーザインタフェースを介して受け取り、かつ前記コントローラにおいて、前記第1のコマンドに基づき前記経路図を調整し、前記連結支援システム用のコントローラが、前記経路の計画を完了させるステップを含む、請求項5記載の方法。
  7. 前記駆動系において、前記トラクターが前記最終位置に到達する前に、前記初期位置よりも前記最終位置に近い中間位置に停止または駐車させるステップと、
    前記駆動系において、前記トラクターに関連する1つ以上のトラクターサスペンションを変化させて、トラクターヒッチとトレーラーヒッチとを整列させるステップと、
    前記駆動系において、前記トラクター経路を前記中間位置から前記最終位置まで自律的に追従するステップと、
    前記駆動系において、前記トラクターヒッチと前記トレーラーヒッチとを連結するステップと、
    をさらに含む、請求項1記載の方法。
  8. トラクターヒッチとトレーラーヒッチとを連結するステップは、前記トラクターに関連する1つ以上のトラクターサスペンションを変化させて、トラクターヒッチとトレーラーヒッチとを整列させるステップを含む、請求項1記載の方法。
  9. トラクターを関心点に向かって後退方向に自律運転させる方法であって、
    データ処理ハードウェアにおいて、前記トラクターの後部に位置しかつ前記データ処理ハードウェアと通信するカメラから1つ以上の画像を受け取るステップと、
    前記データ処理ハードウェアにおいて、該データ処理ハードウェアと通信するユーザインタフェースから、オペレータが計画した、複数の中間点を含む経路を受け取るステップと、
    前記データ処理ハードウェアから、該データ処理ハードウェアと通信する駆動系に、オペレータが計画した前記経路に沿って前記トラクターを自律的に移動させる1つ以上のコマンドを送信するステップと、
    前記データ処理ハードウェアにおいて、現在のトラクター位置を確定するステップと、
    前記データ処理ハードウェアにおいて、オペレータが計画した前記経路に基づき、前記現在のトラクター位置から見てオペレータが計画した前記経路に沿った後続の中間点になる後続の推定トラクター位置を確定するステップと、
    前記データ処理ハードウェアにおいて、前記現在のトラクター位置から前記後続の推定トラクター位置までの経路調整を確定するステップと、
    前記経路調整に基づき前記後続の推定トラクター位置に向かって前記トラクターを自律的に移動させる命令を、前記データ処理ハードウェアから前記駆動系に送信するステップと、
    を含む方法。
  10. 経路を前記1つ以上の画像に重ねるステップと、
    前記経路を、オペレータが計画した前記経路のとおりに調整する命令を含むコマンドを、前記データ処理ハードウェアと通信する前記ユーザインタフェースを介して受け取るステップと、
    をさらに含む、請求項9記載の方法。
  11. 前記コマンドには、前記経路の距離を調整する命令が含まれる、請求項10記載の方法。
  12. 前記コマンドには、前記経路の角度を調整する命令が含まれる、請求項10記載の方法。
  13. 前記コマンドには、前記経路の終端部の角度を調整する命令が含まれる、請求項10記載の方法。
  14. 前記現在のトラクター位置を確定するステップは、
    1つ以上のホイールに関連するホイールエンコーダセンサデータを受け取るステップと、
    操舵角センサデータを受け取るステップと、
    を含み、
    前記現在のトラクター位置は、前記ホイールエンコーダセンサデータと前記操舵角センサデータとに基づく、請求項9記載の方法。
  15. トラクターを関心点に向かって後退方向に自律運転させるためのシステムであって、
    通信におけるデータ処理ハードウェアと、
    前記データ処理ハードウェアと通信するメモリハードウェアと、
    を含み、
    前記メモリハードウェアは、前記データ処理ハードウェア上で実行されると、該データ処理ハードウェアに
    前記トラクターの後部に位置しかつ前記データ処理ハードウェアと通信するカメラから1つ以上の画像を受け取るステップと、
    前記データ処理ハードウェアと通信するユーザインタフェースから、オペレータが計画した、複数の中間点を含む経路を受け取るステップと、
    前記データ処理ハードウェアと通信する駆動系に、オペレータが計画した前記経路に沿って前記トラクターを自律的に移動させる1つ以上のコマンドを送信するステップと、
    現在のトラクター位置を確定するステップと、
    オペレータが計画した前記経路に基づき、前記現在のトラクター位置から見てオペレータが計画した前記経路に沿った後続の中間点になる後続の推定トラクター位置を確定するステップと、
    前記現在のトラクター位置から前記後続の推定トラクター位置までの経路調整を確定するステップと、
    前記経路調整に基づき前記後続の推定トラクター位置に向かって前記トラクターを自律的に移動させる命令を、前記駆動系に送信するステップと、
    を含む工程を行わせる命令を記憶している、システム。
  16. 前記工程はさらに、
    経路を前記1つ以上の画像に重ねるステップと、
    オペレータが計画した前記経路のとおりに前記経路を調整する命令を含むコマンドを、前記データ処理ハードウェアと通信する前記ユーザインタフェースを介して受け取るステップと、
    を含む、請求項15記載のシステム。
  17. 前記コマンドには、前記経路の距離を調整する命令が含まれる、請求項16記載のシステム。
  18. 前記コマンドには、前記経路の角度を調整する命令が含まれる、請求項16記載のシステム。
  19. 前記コマンドには、前記経路の終端部の角度を調整する命令が含まれる、請求項16記載のシステム。
  20. 前記現在のトラクター位置を確定するステップは、
    1つ以上のホイールに関連するホイールエンコーダセンサデータを受け取るステップと、
    操舵角センサデータを受け取るステップと、
    を含み、
    前記現在のトラクター位置は、前記ホイールエンコーダセンサデータと前記操舵角センサデータとに基づく、
    請求項15記載のシステム。
JP2021515207A 2018-09-19 2019-09-19 トラクターに連結する自律的な農機具 Pending JP2022501032A (ja)

Applications Claiming Priority (5)

Application Number Priority Date Filing Date Title
US201862733458P 2018-09-19 2018-09-19
US62/733,458 2018-09-19
US16/575,096 2019-09-18
US16/575,096 US20200097021A1 (en) 2018-09-19 2019-09-18 Autonomous Farm Equipment Hitching To A Tractor
PCT/US2019/052002 WO2020061362A1 (en) 2018-09-19 2019-09-19 Autonomous farm equipment hitching to a tractor

Publications (1)

Publication Number Publication Date
JP2022501032A true JP2022501032A (ja) 2022-01-06

Family

ID=69884291

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021515207A Pending JP2022501032A (ja) 2018-09-19 2019-09-19 トラクターに連結する自律的な農機具

Country Status (5)

Country Link
US (1) US20200097021A1 (ja)
EP (1) EP3853047A1 (ja)
JP (1) JP2022501032A (ja)
CN (1) CN112996677A (ja)
WO (1) WO2020061362A1 (ja)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10086870B2 (en) * 2015-08-18 2018-10-02 Magna Electronics Inc. Trailer parking assist system for vehicle
JP7184925B2 (ja) 2018-05-08 2022-12-06 コンチネンタル オートモーティブ システムズ インコーポレイテッド 後退方向で着目ポイントに向かって車両の自律運転を実施する方法、およびシステム
US11641790B2 (en) * 2018-05-09 2023-05-09 Deere & Company Method of planning a path for a vehicle having a work tool and a vehicle path planning system
US11603100B2 (en) * 2018-08-03 2023-03-14 Continental Autonomous Mobility US, LLC Automated reversing by following user-selected trajectories and estimating vehicle motion
US11279405B2 (en) * 2018-10-16 2022-03-22 Ford Global Technologies, Llc Hitch assist system
US11090991B2 (en) * 2018-12-04 2021-08-17 Ford Global Technologies, Llc Human machine interface for vehicle alignment in an acceptable hitch zone
US11180148B2 (en) * 2019-09-03 2021-11-23 Ford Global Technologies, Llc Detection and response to confined trailer in system-assisted hitch operation
US11390294B2 (en) * 2019-09-25 2022-07-19 Ford Global Technologies, Llc Differentiating between near trailer and connected trailer
US11772557B2 (en) * 2019-11-05 2023-10-03 Ford Global Technologies, Llc Guided coaching for vehicle positioning to operate an automated hitching feature
US11654965B2 (en) * 2020-06-24 2023-05-23 Robert Bosch Gmbh Method and system for steering control during reverse vehicle operation for maneuvering of a trailer
US11236492B1 (en) * 2020-08-25 2022-02-01 Built Robotics Inc. Graphical user interface for real-time management of an earth shaping vehicle
GB202019443D0 (en) * 2020-12-10 2021-01-27 Agco Int Gmbh Methods and systems for controlling motion of agricultrial vehicles
US11622495B2 (en) 2021-06-01 2023-04-11 Gint Co., Ltd. Method of automatically combining farm vehicle and work machine and farm vehicle
CN113641159B (zh) * 2021-08-16 2024-04-12 佛山市毕佳索智能科技有限公司 一种基于agv的拖车控制方法
DE102021123694A1 (de) 2021-09-14 2023-03-16 Claas E-Systems Gmbh Steuerungssystem zum Lenken einer landwirtschaftlichen Arbeitsmaschine
WO2023172428A1 (en) * 2022-03-09 2023-09-14 Ametek, Inc. Tractor-to-trailer verification system

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH058610U (ja) * 1991-07-10 1993-02-05 株式会社明電舎 自律走行無人搬送車の位置検出装置
US20130321634A1 (en) * 2011-03-02 2013-12-05 Panasonic Corporation Driving assistance device and towing vehicle
US20140052337A1 (en) * 2011-04-19 2014-02-20 Ford Global Technologies Trailer backup assist system
US20140358429A1 (en) * 2011-04-19 2014-12-04 Ford Global Technologies, Llc Method of inputting a path for a vehicle and trailer
US20160052548A1 (en) * 2013-04-26 2016-02-25 Jaguar Land Rover Limited Vehicle Hitch Assistance System
JP2016150616A (ja) * 2015-02-16 2016-08-22 株式会社デンソー 運転支援装置
US20160304122A1 (en) * 2015-04-14 2016-10-20 Continental Automotive Systems, Inc. Automated hitching assist system
JP2016199262A (ja) * 2015-04-10 2016-12-01 コンチネンタル オートモーティブ システムズ インコーポレイテッドContinental Automotive Systems, Inc. 後退走行中の前輪軌道逸脱に基づく衝突の回避
JP2018060511A (ja) * 2016-10-06 2018-04-12 株式会社アドバンスド・データ・コントロールズ シミュレーションシステム、シミュレーションプログラム及びシミュレーション方法
WO2018150642A1 (ja) * 2017-02-16 2018-08-23 アイシン精機株式会社 周辺監視装置
US20180251153A1 (en) * 2017-03-03 2018-09-06 Continental Automotive Systems, Inc. Autonomous Trailer Hitching Using Neural Network

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2447672B (en) * 2007-03-21 2011-12-14 Ford Global Tech Llc Vehicle manoeuvring aids
US7777615B2 (en) * 2008-03-20 2010-08-17 Toyota Motor Engineering & Manufacturing North America, Inc. System for assisting the attachment of a trailer to a vehicle
US8909426B2 (en) * 2011-04-19 2014-12-09 Ford Global Technologies Trailer path curvature control for trailer backup assist
US9914333B2 (en) * 2012-07-05 2018-03-13 Uusi, Llc Vehicle trailer connect system
US20150115571A1 (en) * 2013-10-24 2015-04-30 GM Global Technology Operations LLC Smart tow
US20160375831A1 (en) * 2015-06-23 2016-12-29 GM Global Technology Operations LLC Hitching assist with pan/zoom and virtual top-view
US9731568B2 (en) * 2015-12-01 2017-08-15 GM Global Technology Operations LLC Guided tow hitch control system and method
US9849878B2 (en) * 2016-02-26 2017-12-26 GM Global Technology Operations LLC System and method for providing a corrected lane following path through a curve for trailering vehicles
US20180099660A1 (en) * 2016-10-06 2018-04-12 GM Global Technology Operations LLC System And Method For Control Of A Towed Trailer
US11014561B2 (en) * 2017-02-01 2021-05-25 Magna Electronics Inc. Vehicle trailer hitch assist system
US10987984B2 (en) * 2017-09-25 2021-04-27 Continental Automotive Systems, Inc. Automated trailer hitching using image coordinates

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH058610U (ja) * 1991-07-10 1993-02-05 株式会社明電舎 自律走行無人搬送車の位置検出装置
US20130321634A1 (en) * 2011-03-02 2013-12-05 Panasonic Corporation Driving assistance device and towing vehicle
JPWO2012117693A1 (ja) * 2011-03-02 2014-07-07 パナソニック株式会社 運転支援装置及び牽引車
US20140052337A1 (en) * 2011-04-19 2014-02-20 Ford Global Technologies Trailer backup assist system
US20140358429A1 (en) * 2011-04-19 2014-12-04 Ford Global Technologies, Llc Method of inputting a path for a vehicle and trailer
US20160052548A1 (en) * 2013-04-26 2016-02-25 Jaguar Land Rover Limited Vehicle Hitch Assistance System
JP2016150616A (ja) * 2015-02-16 2016-08-22 株式会社デンソー 運転支援装置
US20180061102A1 (en) * 2015-02-16 2018-03-01 Denso Corporation Drive assist device and drive assist method
JP2016199262A (ja) * 2015-04-10 2016-12-01 コンチネンタル オートモーティブ システムズ インコーポレイテッドContinental Automotive Systems, Inc. 後退走行中の前輪軌道逸脱に基づく衝突の回避
US20160304122A1 (en) * 2015-04-14 2016-10-20 Continental Automotive Systems, Inc. Automated hitching assist system
JP2016203972A (ja) * 2015-04-14 2016-12-08 コンチネンタル オートモーティブ システムズ インコーポレイテッドContinental Automotive Systems, Inc. 自動化されたヒッチアシストシステム
JP2018060511A (ja) * 2016-10-06 2018-04-12 株式会社アドバンスド・データ・コントロールズ シミュレーションシステム、シミュレーションプログラム及びシミュレーション方法
WO2018150642A1 (ja) * 2017-02-16 2018-08-23 アイシン精機株式会社 周辺監視装置
US20180251153A1 (en) * 2017-03-03 2018-09-06 Continental Automotive Systems, Inc. Autonomous Trailer Hitching Using Neural Network

Also Published As

Publication number Publication date
US20200097021A1 (en) 2020-03-26
EP3853047A1 (en) 2021-07-28
WO2020061362A1 (en) 2020-03-26
CN112996677A (zh) 2021-06-18

Similar Documents

Publication Publication Date Title
JP2022501032A (ja) トラクターに連結する自律的な農機具
EP3787909B1 (en) Coupler and tow-bar detection for automated trailer hitching via cloud points
US11198341B2 (en) Trailer detection and autonomous hitching
EP3687839B1 (en) Automated trailer hitching using image coordinates
EP3589506B1 (en) Autonomous trailer hitching using neural network
JP7412412B2 (ja) ユーザ選択軌跡の追従および車両動き推定による自動後退
JP7136997B2 (ja) ターゲット位置の選択による自動後退
CN112512843A (zh) 实时拖车联接器定位和跟踪
CN112004696B (zh) 牵引车辆和拖车的对准
US20200079165A1 (en) Hitch assist system
CN112424002A (zh) 视觉对象跟踪器
US11987287B2 (en) Autonomous truck-trailer maneuvering and parking
US10800217B2 (en) Hitch assist system
GB2589982A (en) Automated hitching system with variable backing paths
CN110641453A (zh) 用于检测和响应于挂车倒退的系统

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220714

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230517

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230530

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20231220