JP7601955B2 - 自律的デバイスのリアルタイム制御のためのシステムおよび方法 - Google Patents
自律的デバイスのリアルタイム制御のためのシステムおよび方法 Download PDFInfo
- Publication number
- JP7601955B2 JP7601955B2 JP2023102264A JP2023102264A JP7601955B2 JP 7601955 B2 JP7601955 B2 JP 7601955B2 JP 2023102264 A JP2023102264 A JP 2023102264A JP 2023102264 A JP2023102264 A JP 2023102264A JP 7601955 B2 JP7601955 B2 JP 7601955B2
- Authority
- JP
- Japan
- Prior art keywords
- occupancy grid
- global
- sdsf
- grid
- occupancy
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0025—Planning or execution of driving tasks specially adapted for specific operations
- B60W60/00256—Delivery operations
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Purposes 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/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3453—Special cost functions, i.e. other than distance or default speed limit of road segments
- G01C21/3461—Preferred or disfavoured areas, e.g. dangerous zones, toll or emission zones, intersections, manoeuvre types or segments such as motorways, toll roads or ferries
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/86—Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
- G01S13/865—Combination of radar systems with lidar systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/86—Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
- G01S13/867—Combination of radar systems with cameras
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/86—Combinations of sonar systems with lidar systems; Combinations of sonar systems with systems not using wave reflection
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/88—Sonar systems specially adapted for specific applications
- G01S15/93—Sonar systems specially adapted for specific applications for anti-collision purposes
- G01S15/931—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/42—Simultaneous measurement of distance and other co-ordinates
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4808—Evaluating distance, position or velocity data
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control 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
- G05D1/0248—Control 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 in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control 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
- G05D1/0251—Control 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 extracting 3D information from a plurality of images taken from different locations, e.g. stereo vision
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Details 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
- B60W2050/0001—Details of the control system
- B60W2050/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0004—In digital systems, e.g. discrete-time systems involving sampling
- B60W2050/0005—Processor details or data handling, e.g. memory registers or chip architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Details 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
- B60W2050/0001—Details of the control system
- B60W2050/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0008—Feedback, closed loop systems or details of feedback error signal
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Details 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
- B60W2050/0001—Details of the control system
- B60W2050/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
- B60W2050/0052—Filtering, filters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/408—Radar; Laser, e.g. lidar
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/54—Audio sensitive means, e.g. ultrasound
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9318—Controlling the steering
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/93185—Controlling the brakes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9319—Controlling the accelerator
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9323—Alternative operation using light waves
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Automation & Control Theory (AREA)
- Acoustics & Sound (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Mathematical Physics (AREA)
- Human Computer Interaction (AREA)
- Optics & Photonics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Description
本実用特許出願は、参照することによってその全体として本明細書に組み込まれる、2020年2月25日に出願され、「System and Method for Surface Feature Detection and Traversal」と題された、米国特許出願第16/800,497号(弁理士整理番号第AA164号)の一部継続出願である。本特許出願は、2019年7月10日に出願され、「Apparatus for Long and Short Range Sensors on an Autonomous Delivery Device」と題された、米国仮特許出願第62/872,396号(弁理士整理番号第AA028号)、2020年3月17日に出願され、「System and Method for Managing an Occupancy Grid」と題された、米国仮特許出願第62/990,485号(弁理士整理番号第AA037号)、および2019年7月10日に出願され、「System and Method for Real-Time Control of the Configuration of an Autonomous Device」と題された、米国仮特許出願第62/872,320号(弁理士整理番号第Z96号)の利益を主張する。
AVおよび半自律的車両(AV)のナビゲーションは、典型的には、例えば、限定ではないが、LIDAR、カメラ、ステレオカメラ、およびレーダを含む、長距離センサに依拠する。長距離センサは、AVから4~100メートルを感知することができる。対照的に、物体回避および/または表面検出は、典型的には、例えば、限定ではないが、ステレオカメラ、短距離レーダ、ならびに超音波センサを含む、短距離センサに依拠する。これらの短距離センサは、典型的には、AVの周囲約5メートルの面積または体積を観察する。センサは、例えば、その環境内でAVを配向すること、ならびに所望の目的地に到達するように道路、歩道、障害物、および開放空間をナビゲートすることを可能にすることができる。センサはまた、人間、標識、交通信号、障害物、および表面特徴を視覚化することを可能にすることができる。
本教示のAVは、所望の場所に自律的にナビゲートすることができる。いくつかの構成では、AVは、センサと、知覚サブシステムと、自律性サブシステムと、ドライバサブシステムとを含む、デバイスコントローラと、電力基部と、4つの動力供給される車輪と、2つのキャスタ車輪と、貨物コンテナとを含むことができる。いくつかの構成では、知覚および自律性サブシステムは、センサ情報(知覚)ならびにマップ情報(知覚および自律性)を受信ならびに処理することができ、指示をドライバサブシステムに提供することができる。マップ情報は、表面分類と、関連付けられるデバイスモードとを含むことができる。ドライバサブシステムによって制御され、電力基部によって可能にされる、AVの移動は、センササブシステムによって感知され、フィードバックループを提供することができる。いくつかの構成では、SDSFは、例えば、本明細書に説明されるプロセスに従って、点群データから正確に識別され、マップ内に記憶されることができる。AVの場所と関連付けられるマップの部分は、ナビゲーションの間にAVに提供されることができる。知覚サブシステムは、横断されるべき経路が現在占有されている確率についてAVに知らせ得る、占有グリッドを維持することができる。いくつかの構成では、AVは、複数の明確に異なるモードで動作することができる。モードは、他の利益の中でもとりわけ、複雑な地形横断を可能にすることができる。マップ(例えば、表面分類)、センサデータ(AVを囲繞する特徴を感知する)、占有グリッド(来たる経路点が占有されている確率)、モード(困難な地形を横断することができる状態かどうか)の組み合わせが、AVの方向、構成、および速度を識別するために使用されることができる。
本発明は、例えば、以下を提供する。
(項目1)
自律的送達車両であって、
2つの動力供給される前部車輪と、2つの動力供給される後部車輪と、エネルギー貯蔵装置とを含む、電力基部であって、前記電力基部は、コマンドされる速度において、かつコマンドされる方向において移動し、少なくとも1つの物体の輸送を実施するように構成される、電力基部と、
複数の短距離センサを含む、貨物プラットフォームであって、前記貨物プラットフォームは、前記電力基部に機械的に取り付けられる、貨物プラットフォームと、
前記少なくとも1つの物体を受容するための容積を伴う貨物コンテナであって、前記貨物コンテナは、前記貨物プラットフォームの上に搭載される、貨物コンテナと、
LIDARと、1つ以上のカメラとを備える、長距離センサスイートであって、前記長距離センサスイートは、前記貨物コンテナの上に搭載される、長距離センサスイートと、
前記長距離センサスイートおよび前記複数の短距離センサからデータを受信するためのコントローラであって、前記コントローラは、少なくとも前記データに基づいて、前記コマンドされる速度および前記コマンドされる方向を判定し、前記コントローラは、前記コマンドされる速度および前記コマンドされる方向を前記電力基部に提供し、前記輸送を完了させる、コントローラと
を備える、自律的送達車両。
(項目2)
前記複数の短距離センサからの前記データは、その上で前記電力基部が進行する表面の少なくとも1つの特性を備える、項目1に記載の自律的送達車両。
(項目3)
前記複数の短距離センサは、少なくとも1つのステレオカメラを備える、項目1に記載の自律的送達車両。
(項目4)
前記複数の短距離センサは、少なくとも1つのIRプロジェクタと、少なくとも1つの画像センサと、少なくとも1つのRGBセンサとを備える、項目1に記載の自律的送達車両。
(項目5)
前記複数の短距離センサは、少なくとも1つのレーダセンサを備える、項目1に記載の自律的送達車両。
(項目6)
前記複数の短距離センサからの前記データは、RGB-Dデータを備える、項目1に記載の自律的送達車両。
(項目7)
前記コントローラは、前記複数の短距離センサから受信されたRGB-Dデータに基づいて、道路表面の幾何学形状を判定する、項目1に記載の自律的送達車両。
(項目8)
前記複数の短距離センサは、前記AVの4メートル以内の物体を検出し、前記長距離センサスイートは、前記自律的送達車両から4メートルを上回る物体を検出する、項目1に記載の自律的送達車両。
(項目9)
前記複数の短距離センサは、冷却回路を備える、項目1に記載の自律的送達車両。
(項目10)
前記複数の短距離センサは、超音波センサを備える、項目1に記載の自律的送達車両。
(項目11)
前記コントローラは、
実行可能コードを備え、前記実行可能コードは、
マップにアクセスすることを含み、前記マップは、マッププロセッサによって形成され、前記マッププロセッサは、
前記長距離センサスイートからの点群データにアクセスする、第1のプロセッサであって、前記点群データは、前記表面を表す、第1のプロセッサと、
前記点群データをフィルタリングする、フィルタと、
前記フィルタリングされた点群データから処理可能部分を形成する、第2のプロセッサと、
前記処理可能部分を少なくとも1つの多角形に併合する、第3のプロセッサと、
存在する場合、前記少なくとも1つの多角形内の前記少なくとも1つの実質的不連続表面特徴(SDSF)を位置特定および標識化する、第4のプロセッサであって、前記位置特定および標識化することは、標識化された点群データを形成する、第4のプロセッサと、
前記標識化された点群データからグラフ化多角形を作成する、第5のプロセッサと、
少なくとも前記グラフ化多角形に基づいて、開始点から終了点までの経路を選定する、第6のプロセッサであって、前記AVは、前記経路に沿って前記少なくとも1つのSDSFを横断する、第6のプロセッサと
を備える、項目2に記載の自律的送達車両。
(項目12)
前記フィルタは、
前記点群データから過渡物体を表す点および外れ値を表す点を条件付きで除去することと、
事前選択された高さを有する前記除去された点を置換することと
を含む、コードを実行する、第7のプロセッサを備える、項目11に記載の自律的送達車両。
(項目13)
前記第2のプロセッサは、
前記点群データを前記処理可能部分にセグメント化することと、
前記処理可能部分から事前選択された高さの点を除去することと
を含む、前記実行可能コードを含む、項目11に記載の自律的送達車両。
(項目14)
前記第3のプロセッサは、
外れ値、ボクセル、および法線を分析することによって、前記処理可能部分のサイズを縮小することと、
前記縮小サイズの処理可能部分からの領域を拡大させることと、
前記拡大された領域から初期走行可能表面を判定することと、
前記初期走行可能表面をセグメント化およびメッシュ化することと、
前記セグメント化およびメッシュ化された初期走行可能表面内の多角形を位置特定することと、
少なくとも前記多角形に基づいて、少なくとも1つの走行可能表面を設定することと
を含む、前記実行可能コードを含む、項目11に記載の自律的送達車両。
(項目15)
前記第4のプロセッサは、
SDSFフィルタに従って、前記初期走行可能表面の点群データをソートすることであって、前記SDSFフィルタは、少なくとも3つのカテゴリの点を含む、ことと、
少なくとも、前記少なくとも3つのカテゴリの点が、組み合わせて、少なくとも1つの第1の事前選択された基準を満たすかどうかに基づいて、少なくとも1つのSDSF点を位置特定することと
を含む、前記実行可能コードを含む、項目14に記載の自律的送達車両。
(項目16)
前記第4のプロセッサは、少なくとも、複数の前記少なくとも1つのSDSF点が、組み合わせて、少なくとも1つの第2の事前選択された基準を満たすかどうかに基づいて、少なくとも1つのSDSF軌道を作成することを含む、前記実行可能コードを含む、項目15に記載の自律的送達車両。
(項目17)
グラフ化多角形を作成することは、
前記少なくとも1つの走行可能表面から少なくとも1つの多角形を作成することであって、前記少なくとも1つの多角形は、外縁を含む、ことと、
前記外縁を平滑化することと、
前記平滑化された外縁に基づいて、走行マージンを形成することと、
前記少なくとも1つのSDSF軌道を前記少なくとも1つの走行可能表面に追加することと、
少なくとも1つの第3の事前選択された基準に従って、前記少なくとも1つの走行可能表面から内縁を除去することと
を含む、前記実行可能コードを含む、第8のプロセッサを含む、項目14に記載の自律的送達車両。
(項目18)
前記外縁を平滑化することは、前記外縁を外向きにトリミングし、外向き縁を形成することを含む、前記実行可能コードを含む、第9のプロセッサを含む、項目17に記載の自律的送達車両。
(項目19)
前記平滑化された外縁の走行マージンを形成することは、前記外向き縁を内向きにトリミングすることを含む、前記実行可能コードを含む、第10のプロセッサを含む、項目18に記載の自律的送達車両。
(項目20)
前記コントローラは、
前記自律的送達車両(AV)によって遭遇される少なくとも1つの実質的不連続表面特徴(SDSF)をナビゲートするためのサブシステムを備え、前記AVは、表面にわたる経路を進行し、前記表面は、前記少なくとも1つのSDSFを含み、前記経路は、開始点と、終了点とを含み、前記サブシステムは、
ルート形態にアクセスする、第1のプロセッサであって、前記ルート形態は、フィルタリングされた点群データを含む、少なくとも1つのグラフ化多角形を含み、前記フィルタリングされた点群データは、標識化された特徴を含み、前記点群データは、走行可能マージンを含む、第1のプロセッサと、
前記点群データをグローバル座標系に変換する、第2のプロセッサと、
前記少なくとも1つのSDSFの境界を判定する、第3のプロセッサであって、前記第3のプロセッサは、前記境界の周囲に事前選択されたサイズのSDSF緩衝を作成する、第3のプロセッサと、
少なくとも、少なくとも1つのSDSF横断基準に基づいて、横断され得る前記少なくとも1つのSDSFを判定する、第4のプロセッサと、
少なくとも、前記少なくとも1つのSDSF横断基準、前記変換された点群データ、および前記ルート形態に基づいて、縁/加重グラフを作成する、第5のプロセッサと、
少なくとも前記縁/加重グラフに基づいて、前記開始点から前記終了点までの前記経路を選定する、基部コントローラと
を備える、項目1に記載の自律的送達車両。
(項目21)
前記少なくとも1つのSDSF横断基準は、
前記少なくとも1つのSDSFの事前選択された幅および前記少なくとも1つのSDSFの事前選択された平滑度と、
走行可能表面を含む、前記少なくとも1つのSDSFと前記AVとの間の最小進入距離および最小退出距離と、
前記AVによる前記少なくとも1つのSDSFへの約90°アプローチを適応させる、前記少なくとも1つのSDSFと前記AVとの間の前記最小進入距離と
を備える、項目20に記載の自律的送達車両。
(項目22)
自律的デバイスに関するグローバル占有グリッドを管理するための方法であって、前記グローバル占有グリッドは、グローバル占有グリッドセルを含み、前記グローバル占有グリッドセルは、占有確率と関連付けられ、前記方法は、
前記自律的デバイスと関連付けられるセンサからセンサデータを受信することと、
少なくとも前記センサデータに基づいて、ローカル占有グリッドを作成することであって、前記ローカル占有グリッドは、ローカル占有グリッドセルを有する、ことと、
前記自律的デバイスが、第1の面積から第2の面積に移動した場合、
前記第2の面積と関連付けられる履歴データにアクセスすることと、
少なくとも前記履歴データに基づいて、静的グリッドを作成することと、
前記グローバル占有グリッドを移動させ、前記グローバル占有グリッドの中心位置において前記自律的デバイスを維持することと、
前記静的グリッドに基づいて、前記移動されたグローバル占有グリッドを更新することと、
前記グローバル占有グリッドセルのうちの少なくとも1つが、前記自律的デバイスの場所と一致する場合、前記グローバル占有グリッドセルのうちの少なくとも1つを非占有としてマーキングすることと、
前記ローカル占有グリッドセル毎に、
前記グローバル占有グリッド上の前記ローカル占有グリッドセルの位置を計算することと、
前記位置における前記グローバル占有グリッドセルからの第1の占有確率にアクセスすることと、
前記位置における前記ローカル占有グリッドセルからの第2の占有確率にアクセスすることと、
少なくとも前記第1の占有確率および前記第2の占有確率に基づいて、前記グローバル占有グリッド上の前記位置における新しい占有確率を算出することと
を含む、方法。
(項目23)
前記新しい占有確率を範囲チェックすることをさらに含む、項目22に記載の方法。
(項目24)
前記範囲チェックすることは、
前記新しい占有確率が<0である場合、前記新しい占有確率を0に設定することと、
前記新しい占有確率が>1である場合、前記新しい占有確率を1に設定することと
を含む、項目23に記載の方法。
(項目25)
前記グローバル占有グリッドセルを前記新しい占有確率に設定することをさらに含む、項目22に記載の方法。
(項目26)
前記グローバル占有グリッドセルを前記範囲チェックされた新しい占有確率に設定することをさらに含む、項目23に記載の方法。
(項目27)
占有グリッドを作成および管理するための方法であって、
ローカル占有グリッド作成ノードによって、センサ測定値をデバイスと関連付けられる基準フレームに変換することと、
タイムスタンプ付き測定占有グリッドを作成することと、
前記タイムスタンプ付き測定占有グリッドをローカル占有グリッドとして公開することと、
複数のローカル占有グリッドを作成することと、
リポジトリ内の表面特性に基づいて、静的占有グリッドを作成することであって、前記表面特性は、前記デバイスの位置と関連付けられる、ことと、
前記デバイスの位置と関連付けられるグローバル占有グリッドを移動させ、前記グローバル占有グリッドに対してほぼ心合される前記デバイスおよび前記ローカル占有グリッドを維持することと、
前記静的占有グリッドから前記グローバル占有グリッドに情報を追加することと、
前記デバイスによって現在占有されている前記グローバル占有グリッド内の面積を非占有としてマーキングすることと、
各ローカル占有グリッド内の少なくとも1つのセル毎に、
前記グローバル占有グリッド内の前記少なくとも1つのセルの場所を判定することと、
前記場所における第1の値にアクセスすることと、
前記第1の値と前記ローカル占有グリッド内の前記少なくとも1つのセルにおけるセル値との間の関係に基づいて、前記場所における第2の値を判定することと、
前記第2の値を事前選択された確率範囲に対して比較することと、
確率値が、前記事前選択された確率範囲内である場合、前記新しい値を伴う前記グローバル占有グリッドを設定することと
を含む、方法。
(項目28)
前記グローバル占有グリッドを公開することをさらに含む、項目27に記載の方法。
(項目29)
前記表面特性は、表面タイプと、表面不連続性とを備える、項目27に記載の方法。
(項目30)
前記関係は、合計することを含む、項目27に記載の方法。
(項目31)
占有グリッドを作成および管理するためのシステムであって、
少なくとも1つのローカル占有グリッドを作成する、複数のローカルグリッド作成ノードであって、前記少なくとも1つのローカル占有グリッドは、デバイスの位置と関連付けられ、前記少なくとも1つのローカル占有グリッドは、少なくとも1つのセルを含む、複数のローカルグリッド作成ノードと、
前記少なくとも1つのローカル占有グリッドにアクセスする、グローバル占有グリッドマネージャと
を備え、
前記グローバル占有グリッドマネージャは、
リポジトリ内の表面特性に基づいて、静的占有グリッドを作成することであって、前記表面特性は、前記デバイスの位置と関連付けられる、ことと、
前記デバイスの位置と関連付けられるグローバル占有グリッドを移動させ、前記グローバル占有グリッドに対してほぼ心合される前記デバイスおよび前記少なくとも1つのローカル占有グリッドを維持することと、
前記静的占有グリッドから少なくとも1つのグローバル占有グリッドに情報を追加することと、
前記デバイスによって現在占有されている前記グローバル占有グリッド内の面積を非占有としてマーキングすることと、
各ローカル占有グリッド内の前記少なくとも1つのセル毎に、
前記グローバル占有グリッド内の前記少なくとも1つのセルの場所を判定することと、
前記場所における第1の値にアクセスすることと、
前記第1の値と前記ローカル占有グリッド内の前記少なくとも1つのセルにおけるセル値との間の関係に基づいて、前記場所における第2の値を判定することと、
前記第2の値を事前選択された確率範囲に対して比較することと、
確率値が、前記事前選択された確率範囲内である場合、前記新しい値を伴う前記グローバル占有グリッドを設定することと
を行う、システム。
(項目32)
グローバル占有グリッドを更新するための方法であって、
自律的デバイスが、新しい位置に移動した場合、前記新しい位置と関連付けられる静的グリッドからの情報を用いて前記グローバル占有グリッドを更新することと、
前記新しい位置における表面を分析することと、
前記表面が、走行可能である場合、前記表面を更新し、前記更新された表面を用いて前記グローバル占有グリッドを更新することと、
静的値のリポジトリからの値を用いて前記グローバル占有グリッドを更新することであって、前記静的値は、前記新しい位置と関連付けられる、ことと
を含む、方法。
(項目33)
前記表面を更新することは、
前記新しい位置と関連付けられるローカル占有グリッドにアクセスすることと、
前記ローカル占有グリッド内のセル毎に、
ローカル占有グリッド表面分類信頼値およびローカル占有グリッド表面分類にアクセスすることと、
前記ローカル占有グリッド表面分類が、前記セル内の前記グローバル占有グリッド内のグローバル表面分類と同一である場合、前記グローバル占有グリッド内のグローバル表面分類信頼値を前記ローカル占有グリッド表面分類信頼値に加算し、合計を形成し、前記合計を用いて前記セルにおける前記グローバル占有グリッドを更新することと、
前記ローカル占有グリッド表面分類が、前記セル内の前記グローバル占有グリッド内の前記グローバル表面分類と同一ではない場合、前記グローバル占有グリッド内の前記グローバル表面分類信頼値から前記ローカル占有グリッド表面分類信頼値を減算し、差を形成し、前記差を用いて前記グローバル占有グリッドを更新することと、
前記差が、ゼロ未満である場合、前記ローカル占有グリッド表面分類を用いて前記グローバル占有グリッドを更新することと
を含む、項目32に記載の方法。
(項目34)
前記静的値のリポジトリからの前記値を用いて前記グローバル占有グリッドを更新することは、
ローカル占有グリッド内のセル毎に、
前記ローカル占有グリッドからの前記セルが占有値であるローカル占有グリッド確率である、対数オッズ値にアクセスすることと、
前記セルにおける前記ローカル占有グリッド対数オッズ値を用いて前記グローバル占有グリッド内の前記対数オッズ値を更新することと、
前記セルが占有されていない事前選択された確実性が、満たされる場合、および前記自律的デバイスが、レーン障壁内で進行している場合、ならびにローカル占有グリッド表面分類が、走行可能表面を示す場合、前記セルが前記ローカル占有グリッド内で占有されている前記対数オッズを減少させることと、
前記自律的デバイスが、比較的に均一な表面に遭遇することを予期する場合、および前記ローカル占有グリッド表面分類が、比較的に不均一な表面を示す場合、前記ローカル占有グリッド内の前記対数オッズを増加させることと、
前記自律的デバイスが、比較的に均一な表面に遭遇することを予期する場合、および前記ローカル占有グリッド表面分類が、比較的に均一な表面を示す場合、前記ローカル占有グリッド内の前記対数オッズを減少させることと
を含む、項目32に記載の方法。
(項目35)
デバイスの構成のリアルタイム制御のための方法であって、前記デバイスは、シャーシと、少なくとも4つの車輪と、前記少なくとも4つの車輪のうちの少なくとも1つと動作可能に結合される、前記シャーシの第1の側と、前記少なくとも4つの車輪のうちの少なくとも1つと動作可能に結合される、前記シャーシの対向する第2の側とを含み、前記方法は、
少なくとも事前の表面特徴および占有グリッドに基づいて、マップを作成することであって、前記マップは、非リアルタイムで作成され、前記マップは、少なくとも1つの場所を含み、前記少なくとも1つの場所は、少なくとも1つの表面特徴と関連付けられ、前記少なくとも1つの表面特徴は、少なくとも1つの表面分類および少なくとも1つのモードと関連付けられる、ことと、
前記デバイスが進行する際、現在の表面特徴を判定することと、
前記現在の表面特徴を用いて前記占有グリッドをリアルタイムで更新することと、
前記占有グリッドおよび前記マップから、前記デバイスが前記少なくとも1つの表面特徴を横断するために進行し得る経路を判定することと
を含む、方法。
(項目36)
デバイスの構成のリアルタイム制御のための方法であって、前記デバイスは、シャーシと、少なくとも4つの車輪と、前記少なくとも4つの車輪のうちの少なくとも1つと動作可能に結合される、前記シャーシの第1の側と、前記少なくとも4つの車輪のうちの少なくとも1つと動作可能に結合される、前記シャーシの対向する第2の側とを含み、前記方法は、
環境データを受信することと、
少なくとも前記環境データに基づいて、表面タイプを判定することと、
少なくとも前記表面タイプおよび第1の構成に基づいて、モードを判定することと、
少なくとも前記モードおよび前記表面タイプに基づいて、第2の構成を判定することと、
少なくとも前記第2の構成に基づいて、移動コマンドを判定することと、
前記移動コマンドを使用することによって前記デバイスの構成を制御し、前記デバイスを前記第1の構成から前記第2の構成に変更することと
を含む、方法。
(項目37)
前記環境データは、RGB-D画像データを備える、項目36に記載の方法。
(項目38)
少なくとも前記表面タイプおよび前記モードに基づいて、占有グリッドを取り込むことと、
少なくとも前記占有グリッドに基づいて、前記移動コマンドを判定することと
をさらに含む、項目36に記載の方法。
(項目39)
前記占有グリッドは、少なくとも、少なくとも1つの画像センサからのデータに基づく情報を備える、項目38に記載の方法。
(項目40)
前記環境データは、道路表面の形態を備える、項目36に記載の方法。
(項目41)
前記構成は、前記少なくとも4つの車輪のクラスタ化された2つの対を備え、前記2つの対の第1の対は、前記第1の側上に位置付けられ、前記2つの対の第2の対は、前記第2の側上に位置付けられ、前記第1の対は、第1の前部車輪と、第1の後部車輪とを含み、前記第2の対は、第2の前部車輪と、第2の後部車輪とを含む、項目36に記載の方法。
(項目42)
前記構成の制御は、少なくとも前記環境データに基づく、前記第1の対および前記第2の対の協調された動力供給を含む、項目41に記載の方法。
(項目43)
前記構成の制御は、前記少なくとも4つの車輪および後退されるキャスタの対を駆動することから遷移することを含み、前記キャスタの対は、前記シャーシに動作可能に結合される、ことから、前記第1の前部車輪および前記第2の前部車輪を持上するように回転される前記クラスタ化された第1の対ならびに前記クラスタ化された第2の対を伴う2つの車輪を駆動することであって、前記デバイスは、前記第1の後部車輪、前記第2の後部車輪、および前記キャスタの対上に静置される、項目41に記載の方法。
(項目44)
前記構成の制御は、少なくとも前記環境データに基づいて、前記第1の側上の第1の2つの動力供給される車輪および前記第2の側上の第2の2つの動力供給される車輪と動作可能に結合される、クラスタの対を回転させることを含む、項目41に記載の方法。
(項目45)
前記デバイスはさらに、貨物コンテナを備え、前記貨物コンテナは、前記シャーシ上に搭載され、前記シャーシは、前記貨物コンテナの高さを制御する、項目36に記載の方法。
(項目46)
前記貨物コンテナの高さは、少なくとも前記環境データに基づく、項目45に記載の方法。
(項目47)
デバイスの構成のリアルタイム制御のためのシステムであって、前記デバイスは、シャーシと、少なくとも4つの車輪と、前記シャーシの第1の側と、前記シャーシの対向する第2の側とを含み、前記システムは、
前記デバイスを囲繞するリアルタイム環境データを受信する、デバイスプロセッサであって、前記デバイスプロセッサは、少なくとも前記環境データに基づいて、表面タイプを判定し、前記デバイスプロセッサは、少なくとも前記表面タイプおよび第1の構成に基づいて、モードを判定し、前記デバイスプロセッサは、少なくとも前記モードおよび前記表面タイプに基づいて、第2の構成を判定する、デバイスプロセッサと、
少なくとも前記第2の構成に基づいて、移動コマンドを判定する、電力基部プロセッサであって、前記電力基部プロセッサは、前記移動コマンドを使用することによって前記デバイスの構成を制御し、前記デバイスを前記第1の構成から前記第2の構成に変更する、電力基部プロセッサと
を備える、システム。
(項目48)
前記環境データは、RGB-D画像データを備える、項目47に記載のシステム。
(項目49)
前記デバイスプロセッサは、少なくとも前記表面タイプおよび前記モードに基づいて、占有グリッドを取り込むことを含む、項目47に記載のシステム。
(項目50)
前記電力基部プロセッサは、少なくとも前記占有グリッドに基づいて、前記移動コマンドを判定することを含む、項目49に記載のシステム。
(項目51)
前記占有グリッドは、少なくとも、少なくとも1つの画像センサからのデータに基づく情報を備える、項目49に記載のシステム。
(項目52)
前記環境データは、道路表面の形態を備える、項目47に記載のシステム。
(項目53)
前記構成は、前記少なくとも4つの車輪のクラスタ化された2つの対を備え、前記2つの対の第1の対は、前記第1の側上に位置付けられ、前記2つの対の第2の対は、前記第2の側上に位置付けられ、前記第1の対は、第1の前部車輪と、第1の後部車輪とを有し、前記第2の対は、第2の前部車輪と、第2の後部車輪とを有する、項目47に記載のシステム。
(項目54)
前記構成の制御は、少なくとも前記環境データに基づく、前記第1の対および前記第2の対の協調された動力供給を含む、項目53に記載のシステム。
(項目55)
前記構成の制御は、前記少なくとも4つの車輪および後退されるキャスタの対を駆動することから遷移することを含み、前記キャスタの対は、前記シャーシに動作可能に結合される、ことから、前記第1の前部車輪および前記第2の前部車輪を持上するように回転される前記クラスタ化された第1の対ならびに前記クラスタ化された第2の対を伴う2つの車輪を駆動することであって、前記デバイスは、前記第1の後部車輪、前記第2の後部車輪、および前記キャスタの対上に静置される、項目53に記載のシステム。
(項目56)
グローバル占有グリッドを維持するための方法であって、
自律的デバイスの第1の位置を位置特定することと、
前記自律的デバイスが、第2の位置に移動するとき、前記前記第2の位置は、前記グローバル占有グリッドおよびローカル占有グリッドと関連付けられ、
前記第1の位置と関連付けられる少なくとも1つの占有確率値を用いて前記グローバル占有グリッドを更新することと、
前記ローカル占有グリッドと関連付けられる少なくとも1つの走行可能表面を用いて前記グローバル占有グリッドを更新することと、
前記少なくとも1つの走行可能表面と関連付けられる表面信頼度を用いて前記グローバル占有グリッドを更新することと、
第1のベイズ関数を使用して、前記少なくとも1つの占有確率値の対数オッズを用いて前記グローバル占有グリッドを更新することと、
少なくとも前記第2の位置と関連付けられる特性に基づいて、前記対数オッズを調節することと、
前記自律的デバイスが、前記第1の位置に留まり、前記グローバル占有グリッドおよび前記ローカル占有グリッドが、共同設置されるとき、
前記ローカル占有グリッドと関連付けられる前記少なくとも1つの走行可能表面を用いて前記グローバル占有グリッドを更新することと、
前記少なくとも1つの走行可能表面と関連付けられる前記表面信頼度を用いて前記グローバル占有グリッドを更新することと、
第2のベイズ関数を使用して、前記少なくとも1つの占有確率値の対数オッズを用いて前記グローバル占有グリッドを更新することと、
少なくとも前記第2の位置と関連付けられる特性に基づいて、前記対数オッズを調節することと
を含む、方法。
(項目57)
前記マップを作成することは、
前記表面を表す点群データにアクセスすることと、
前記点群データをフィルタリングすることと、
前記フィルタリングされた点群データを処理可能部分に形成することと、
前記処理可能部分を少なくとも1つの凹多角形に併合することと、
前記少なくとも1つの凹多角形内の前記少なくとも1つのSDSFを位置特定および標識化することであって、前記位置特定および標識化することは、標識化された点群データを形成する、ことと、
少なくとも、前記少なくとも1つの凹多角形に基づいて、グラフ化多角形を作成することと、
少なくとも前記グラフ化多角形に基づいて、開始点から終了点までの前記経路を選定することであって、前記AVは、前記経路に沿って前記少なくとも1つのSDSFを横断する、ことと
を含む、項目35に記載の方法。
(項目58)
前記点群データをフィルタリングすることは、
前記点群データから過渡物体を表す点および外れ値を表す点を条件付きで除去することと、
事前選択された高さを有する前記除去された点を置換することと
を含む、項目57に記載の方法。
(項目59)
処理部分を形成することは、
前記点群データを前記処理可能部分にセグメント化することと、
前記処理可能部分から事前選択された高さの点を除去することと
を含む、項目57に記載の方法。
(項目60)
前記処理可能部分を併合することは、
外れ値、ボクセル、および法線を分析することによって、前記処理可能部分のサイズを縮小することと、
前記縮小サイズの処理可能部分からの領域を拡大させることと、
前記拡大された領域から初期走行可能表面を判定することと、
前記初期走行可能表面をセグメント化およびメッシュ化することと、
前記セグメント化およびメッシュ化された初期走行可能表面内の多角形を位置特定することと、
少なくとも前記多角形に基づいて、少なくとも1つの走行可能表面を設定することと
を含む、項目57に記載の方法。
(項目61)
前記少なくとも1つのSDSFを位置特定および標識化することは、
SDSFフィルタに従って、前記初期走行可能表面の点群データをソートすることであって、前記SDSFフィルタは、少なくとも3つのカテゴリの点を含む、ことと、
少なくとも、前記少なくとも3つのカテゴリの点が、組み合わせて、少なくとも1つの第1の事前選択された基準を満たすかどうかに基づいて、少なくとも1つのSDSF点を位置特定することと
を含む、項目60に記載の方法。
(項目62)
少なくとも、複数の前記少なくとも1つのSDSF点が、組み合わせて、少なくとも1つの第2の事前選択された基準を満たすかどうかに基づいて、少なくとも1つのSDSF軌道を作成することをさらに含む、項目61に記載の方法。
(項目63)
前記グラフ化多角形を作成することはさらに、
前記少なくとも1つの走行可能表面から少なくとも1つの多角形を作成することであって、前記少なくとも1つの多角形は、外縁を含む、ことと、
前記外縁を平滑化することと、
前記平滑化された外縁に基づいて、走行マージンを形成することと、
前記少なくとも1つのSDSF軌道を前記少なくとも1つの走行可能表面に追加することと、
少なくとも1つの第3の事前選択された基準に従って、前記少なくとも1つの走行可能表面から内縁を除去することと
を含む、項目62に記載の方法。
(項目64)
前記外縁の平滑化は、前記外縁を外向きにトリミングし、外向き縁を形成することを含む、項目63に記載の方法。
(項目65)
前記平滑化された外縁の走行マージンを形成することは、前記外向き縁を内向きにトリミングすることを含む、項目63に記載の方法。
(項目66)
自律的送達車両であって、
2つの動力供給される前部車輪と、2つの動力供給される後部車輪と、エネルギー貯蔵装置とを含む、電力基部であって、前記電力基部は、コマンドされる速度において移動するように構成される、電力基部と、
複数の短距離センサを含む、貨物プラットフォームであって、前記貨物プラットフォームは、前記電力基部に機械的に取り付けられる、貨物プラットフォームと、
送達するべき1つ以上の物体を受容するための容積を伴う貨物コンテナであって、前記貨物コンテナは、前記貨物プラットフォームの上に搭載される、貨物コンテナと、
LIDARと、1つ以上のカメラとを備える、長距離センサスイートであって、前記長距離センサスイートは、前記貨物コンテナの上に搭載される、長距離センサスイートと、
前記長距離センサスイートおよび前記複数の短距離センサからデータを受信するためのコントローラと
を備える、自律的送達車両。
(項目67)
前記複数の短距離センサは、走行可能表面の少なくとも1つの特性を検出する、項目66に記載の自律的送達車両。
(項目68)
前記複数の短距離センサは、ステレオカメラである、項目66に記載の自律的送達車両。
(項目69)
前記複数の短距離センサは、IRプロジェクタと、2つの画像センサと、RGBセンサとを備える、項目66に記載の自律的送達車両。
(項目70)
前記複数の短距離センサは、レーダセンサである、項目66に記載の自律的送達車両。
(項目71)
前記短距離センサは、RGB-Dデータを前記コントローラに供給する、項目66に記載の自律的送達車両。
(項目72)
前記コントローラは、前記複数の短距離センサから受信されたRGB-Dデータに基づいて、道路表面の幾何学形状を判定する、項目66に記載の自律的送達車両。
(項目73)
前記複数の短距離センサは、前記自律的送達車両の4メートル以内の物体を検出し、前記長距離センサスイートは、前記自律的送達車両から4メートルを上回る物体を検出する、項目66に記載の自律的送達車両。
(項目74)
自律的送達車両であって、
少なくとも2つの動力供給される後部車輪と、キャスタ前部車輪と、エネルギー貯蔵装置とを含む、電力基部であって、前記電力基部は、コマンドされる速度において移動するように構成される、電力基部と、
複数の短距離センサを含む、貨物プラットフォームであって、前記貨物プラットフォームは、前記電力基部に機械的に取り付けられる、貨物プラットフォームと、
送達するべき1つ以上の物体を受容するための容積を伴う貨物コンテナであって、前記貨物コンテナは、前記貨物プラットフォームの上に搭載される、貨物コンテナと、
LIDARと、1つ以上のカメラとを備える、長距離センサスイートであって、前記長距離センサスイートは、前記貨物コンテナの上に搭載される、長距離センサスイートと、
前記長距離センサスイートおよび前記複数の短距離センサからデータを受信するためのコントローラと
を備える、自律的送達車両。
(項目75)
前記複数の短距離センサは、走行可能表面の少なくとも1つの特性を検出する、項目74に記載の自律的送達車両。
(項目76)
前記複数の短距離センサは、ステレオカメラである、項目74に記載の自律的送達車両。
(項目77)
前記複数の短距離センサは、IRプロジェクタと、2つの画像センサと、RGBセンサとを備える、項目74に記載の自律的送達車両。
(項目78)
前記複数の短距離センサは、レーダセンサである、項目74に記載の自律的送達車両。
(項目79)
前記短距離センサは、RGB-Dデータを前記コントローラに供給する、項目74に記載の自律的送達車両。
(項目80)
前記コントローラは、前記複数の短距離センサから受信されたRGB-Dデータに基づいて、道路表面の幾何学形状を判定する、項目74に記載の自律的送達車両。
(項目81)
前記複数の短距離センサは、前記自律的送達車両の4メートル以内の物体を検出し、前記長距離センサスイートは、前記自律的送達車両から4メートルを上回る物体を検出する、項目74に記載の自律的送達車両。
(項目82)
前記キャスタ車輪が、地面から離れて持上される間、前記地面に係合し得る、動力供給される車輪の第2のセットをさらに備える、項目74に記載の自律的送達車両。
(項目83)
自律的送達車両であって、
少なくとも2つの動力供給される後部車輪と、キャスタ前部車輪と、エネルギー貯蔵装置とを含む、電力基部であって、前記電力基部は、コマンドされる速度において移動するように構成される、電力基部と、
貨物プラットフォームであって、前記貨物プラットフォームは、前記電力基部に機械的に取り付けられる、貨物プラットフォームと、
走行可能表面の少なくとも1つの特性を検出する、前記貨物プラットフォームに搭載される、短距離カメラアセンブリと
を備え、
前記短距離カメラアセンブリは、
カメラと、
第1のライトと、
第1の液冷ヒートシンクと
を備え、
前記第1の液冷ヒートシンクは、前記第1のライトおよび前記カメラを冷却する、自律的送達車両。
(項目84)
前記短距離カメラアセンブリはさらに、前記カメラと前記液冷ヒートシンクとの間に熱電気冷却器を備える、項目83に記載の自律的送達車両。
(項目85)
前記第1のライトおよび前記カメラは、前記カメラから離れるように前記第1のライトからの照明を偏向する、開口部を伴うカバー内に埋め込まれる、項目83に記載の自律的送達車両。
(項目86)
前記ライトは、少なくとも15°下向きに角度付けられ、カバー内に少なくとも4mmに埋め込まれ、歩行者の気を散らす照明を最小限にする、項目83に記載の自律的送達車両。
(項目87)
前記カメラは、視野を有し、前記第1のライトは、前記カメラの視野を照明するように拡散する光の2つのビームを生成するためのレンズを伴う2つのLEDを備える、項目83に記載の自律的送達車両。
(項目88)
前記ライトは、約50°離れて角度付けられ、前記レンズは、60°のビームを生成する、項目87に記載の自律的送達車両。
(項目89)
前記短距離カメラアセンブリは、前記カメラの上方に搭載される、超音波センサを含む、項目83に記載の自律的送達車両。
(項目90)
前記短距離カメラアセンブリは、前記貨物プラットフォームの前面上の中心位置に搭載される、項目83に記載の自律的送達車両。
(項目91)
前記貨物プラットフォームの前面の少なくとも1つの角上に搭載される、少なくとも1つのコーナーカメラアセンブリをさらに備え、前記少なくとも1つのコーナーカメラアセンブリは、
超音波センサと、
コーナーカメラと、
第2のライトと、
第2の液冷ヒートシンクであって、前記第2の液冷ヒートシンクは、前記第2のライトおよび前記コーナーカメラを冷却する、第2の液冷ヒートシンクと
を備える、項目83に記載の自律的送達車両。
(項目92)
前記履歴データは、表面データを備える、項目22に記載の方法。
(項目93)
前記履歴データは、不連続性データを備える、項目22に記載の方法。
本教示のシステムおよび方法は、オンボードセンサおよび以前に開発されたマップを使用し、占有グリッドを開発し、これらの補助を使用し、表面タイプおよび以前のものに基づいてAVを再構成することを含め、表面特徴を横断してAVをナビゲートすることができる。
Claims (18)
- 自律的デバイスに関するグローバル占有グリッドを管理するための方法であって、前記グローバル占有グリッドは、グローバル占有グリッドセルを含み、前記グローバル占有グリッドセルは、占有確率と関連付けられ、前記方法は、
前記自律的デバイスと関連付けられるセンサからセンサデータを受信することと、
前記センサデータに少なくとも基づいて、ローカル占有グリッドを作成することであって、前記ローカル占有グリッドは、ローカル占有グリッドセルを有し、前記ローカル占有グリッドは、面積と関連付けられる、ことと、
面積と関連付けられる履歴データおよび前記ローカル占有グリッドに少なくとも基づいて、前記グローバル占有グリッドを作成することであって、前記履歴データは、前記面積内の縁、不連続性、および表面のうちの少なくとも1つを含む、ことと、
前記自律的デバイスが、第1の面積から第2の面積に移動した場合、
前記第2の面積と関連付けられる履歴データにアクセスすることと、
前記第2の面積と関連付けられる前記履歴データに少なくとも基づいて、静的グリッドを作成することと、
前記グローバル占有グリッドを移動させ、前記グローバル占有グリッドの中心位置において前記自律的デバイスを維持することと、
前記静的グリッドからのデータを追加することによって、前記移動されたグローバル占有グリッドを更新することと、
前記グローバル占有グリッドセルのうちの少なくとも1つが、前記自律的デバイスの場所と一致する場合、前記グローバル占有グリッドセルのうちの前記少なくとも1つを非占有としてマーキングすることと、
前記ローカル占有グリッドセル毎に、
前記グローバル占有グリッド上の前記ローカル占有グリッドセルの位置を計算することと、
前記位置における前記グローバル占有グリッドセルからの第1の占有確率にアクセスすることと、
前記位置における前記ローカル占有グリッドセルからの第2の占有確率にアクセスすることと、
前記第1の占有確率および前記第2の占有確率に少なくとも基づいて、前記グローバル占有グリッド上の前記位置における新しい占有確率を算出することと
を行うことと
を行うことと
を含む、方法。 - 前記新しい占有確率を範囲チェックすることと、
前記グローバル占有グリッドセルを前記新しい占有確率に設定することと
をさらに含む、請求項1に記載の方法。 - 占有グリッドを作成および管理するための方法であって、
デバイスと関連付けられるローカル占有グリッド作成ノードによって、センサ測定値を前記デバイスと関連付けられる基準フレームに変換することと、
タイムスタンプ付き測定占有グリッドを作成することと、
前記タイムスタンプ付き測定占有グリッドをローカル占有グリッドとして公開することと、
複数のローカル占有グリッドを作成することと、
面積と関連付けられる履歴データおよび前記複数のローカル占有グリッドに少なくとも基づいて、グローバル占有グリッドを作成することであって、前記履歴データは、前記面積内の縁、不連続性、および表面のうちの少なくとも1つを含む、ことと、
リポジトリ内の表面特性に基づいて、静的占有グリッドを作成することであって、前記表面特性は、前記デバイスの位置と関連付けられる、ことと、
前記デバイスの位置と関連付けられる前記グローバル占有グリッドを移動させ、前記グローバル占有グリッドの中心に前記デバイスを維持することと、
前記静的占有グリッドから前記グローバル占有グリッドに情報を追加することと、
前記グローバル占有グリッド内の面積が前記デバイスの位置と一致する場合、前記面積を非占有としてマーキングすることと、
各ローカル占有グリッド内の少なくとも1つのセル毎に、
前記グローバル占有グリッド内の前記少なくとも1つのセルの場所を判定することと、
前記場所における第1の占有確率値にアクセスすることと、
前記第1の占有確率値および前記ローカル占有グリッド内の前記少なくとも1つのセルにおけるセル占有確率値を合計することによって、前記場所における第2の占有確率値を判定することと、
前記第2の占有確率値を事前選択された確率範囲に対して比較することと、
前記第2の占有確率値が、前記事前選択された確率範囲内である場合、前記第2の占有確率値を伴う前記グローバル占有グリッドを設定することと
を行うことと
を含む、方法。 - 前記表面特性は、表面タイプと、表面不連続性とを備える、請求項3に記載の方法。
- 占有グリッドを作成および管理するためのシステムであって、
少なくとも1つのローカル占有グリッドを作成するデバイスと関連付けられる複数のローカルグリッド作成ノードであって、前記少なくとも1つのローカル占有グリッドは、前記デバイスの位置と関連付けられ、前記少なくとも1つのローカル占有グリッドは、少なくとも1つのセルを含む、複数のローカルグリッド作成ノードと、
前記少なくとも1つのローカル占有グリッドにアクセスするグローバル占有グリッドマネージャと
を備え、
前記グローバル占有グリッドマネージャは、
履歴データおよび前記少なくとも1つのローカル占有グリッドに少なくとも基づいて、グローバル占有グリッドを作成することであって、前記履歴データは、縁、不連続性、および表面のうちの少なくとも1つを含む、ことと、
リポジトリ内の表面特性に基づいて、静的占有グリッドを作成することであって、前記表面特性は、前記デバイスの位置と関連付けられる、ことと、
前記デバイスの位置と関連付けられる前記グローバル占有グリッドを移動させ、前記グローバル占有グリッドの中心に前記デバイスを維持することと、
前記静的占有グリッドから少なくとも1つのグローバル占有グリッドに情報を追加することと、
前記グローバル占有グリッド内の面積が前記デバイスの位置と一致する場合、前記面積を非占有としてマーキングすることと、
各ローカル占有グリッド内の前記少なくとも1つのセル毎に、
前記グローバル占有グリッド内の前記少なくとも1つのセルの場所を判定することと、
前記場所における第1の占有確率値にアクセスすることと、
前記第1の占有確率値および前記ローカル占有グリッド内の前記少なくとも1つのセルにおけるセル占有確率値を合計することによって、前記場所における第2の占有確率値を判定することと、
前記第2の占有確率値を事前選択された確率範囲に対して比較することと、
前記第2の占有確率値が、前記事前選択された確率範囲内である場合、前記第2の占有確率値を伴う前記グローバル占有グリッドを設定することと
を行うことと
を行う、システム。 - グローバル占有グリッドを更新するための方法であって、
自律的デバイスが、新しい位置に移動した場合、前記新しい位置と関連付けられる静的グリッドからの情報を用いて前記グローバル占有グリッドを更新することであって、前記グローバル占有グリッドは、処理された履歴データおよびローカル占有グリッドに少なくとも基づいて作成され、前記処理された履歴データは、縁、不連続性、および表面のうちの少なくとも1つを含み、前記ローカル占有グリッドは、センサデータに少なくとも基づいて作成され、前記ローカル占有グリッドは、ローカル占有グリッドセルを有し、前記静的グリッドは、履歴データに少なくとも基づいて作成される、ことと、
前記新しい位置における表面を分析することと、
前記表面が、走行可能である場合、
前記新しい位置と関連付けられる前記ローカル占有グリッドにアクセスすることと、
前記ローカル占有グリッド内のセル毎に、
ローカル占有グリッド表面分類信頼値およびローカル占有グリッド表面分類にアクセスすることと、
前記ローカル占有グリッド表面分類が、前記セル内の前記グローバル占有グリッド内のグローバル表面分類と同一である場合、前記グローバル占有グリッド内のグローバル表面分類信頼値を前記ローカル占有グリッド表面分類信頼値に加算し、合計を形成し、前記合計を用いて前記セルにおける前記グローバル占有グリッドを更新することと、
前記ローカル占有グリッド表面分類が、前記セル内の前記グローバル占有グリッド内の前記グローバル表面分類と同一ではない場合、前記グローバル占有グリッド内の前記グローバル表面分類信頼値から前記ローカル占有グリッド表面分類信頼値を減算し、差を形成し、前記差を用いて前記グローバル占有グリッドを更新することと、
前記差が、ゼロ未満である場合、前記ローカル占有グリッド表面分類を用いて前記グローバル占有グリッドを更新することと
を行うことと
を行うことと、
前記履歴データの静的値のリポジトリからの値を用いて前記グローバル占有グリッドを更新することであって、前記静的値は、前記新しい位置と関連付けられる、ことと
を含む、方法。 - 前記静的値のリポジトリからの前記値を用いて前記グローバル占有グリッドを更新することは、
前記ローカル占有グリッド内のセル毎に、
前記ローカル占有グリッドからの前記セルが占有値であるローカル占有グリッド確率である、対数オッズ値にアクセスすることと、
前記セルにおける前記ローカル占有グリッド対数オッズ値を用いて前記グローバル占有グリッド内の前記対数オッズ値を更新することと、
前記セルが占有されていない事前選択された確実性が、満たされる場合、および前記自律的デバイスが、レーン障壁内で進行している場合、ならびにローカル占有グリッド表面分類が、走行可能表面を示す場合、前記セルが前記ローカル占有グリッド内で占有されている前記対数オッズを減少させることと、
前記自律的デバイスが、比較的に均一な表面に遭遇することを予期する場合、および前記ローカル占有グリッド表面分類が、比較的に不均一な表面を示す場合、前記ローカル占有グリッド内の前記対数オッズを増加させることと、
前記自律的デバイスが、比較的に均一な表面に遭遇することを予期する場合、および前記ローカル占有グリッド表面分類が、比較的に均一な表面を示す場合、前記ローカル占有グリッド内の前記対数オッズを減少させることと
を行うことを含む、請求項6に記載の方法。 - デバイスの構成のリアルタイム制御のための方法であって、前記デバイスは、シャーシと、少なくとも4つの車輪と、前記少なくとも4つの車輪のうちの少なくとも1つと動作可能に結合される、前記シャーシの第1の側と、前記少なくとも4つの車輪のうちの少なくとも1つと動作可能に結合される、前記シャーシの対向する第2の側とを含み、前記方法は、
事前の表面特徴および占有グリッドに少なくとも基づいて、マップを作成することであって、前記マップは、非リアルタイムで作成され、前記マップは、少なくとも1つの場所を含み、前記少なくとも1つの場所は、少なくとも1つの表面特徴と関連付けられ、前記少なくとも1つの表面特徴は、少なくとも1つの表面分類および少なくとも1つのモードと関連付けられ、前記マップは、前記占有グリッドからの占有データを含むグリッドマップである、ことと、
前記デバイスが進行する際、現在の表面特徴を判定することと、
前記現在の表面特徴を用いて前記占有グリッドをリアルタイムで更新することと、
前記占有グリッドおよび前記マップから、前記デバイスが前記少なくとも1つの表面特徴を横断するために進行し得る経路を判定することと
を含む、方法。 - グローバル占有グリッドを維持するための方法であって、
自律的デバイスの第1の位置を位置特定することと、
前記自律的デバイスが、第2の位置であって、前記第2の位置は、前記グローバル占有グリッドおよびローカル占有グリッドと関連付けられ、前記グローバル占有グリッドは、履歴データおよび前記ローカル占有グリッドに少なくとも基づいて作成され、前記履歴データは、前記第2の位置と関連付けられる縁、不連続性、および表面のうちの少なくとも1つを含む、第2の位置に移動するとき、
前記第1の位置と関連付けられる少なくとも1つの占有確率値を用いて前記グローバル占有グリッドを更新することと、
前記ローカル占有グリッドと関連付けられる少なくとも1つの走行可能表面を用いて前記グローバル占有グリッドを更新することと、
前記少なくとも1つの走行可能表面と関連付けられる表面信頼度を用いて前記グローバル占有グリッドを更新することと、
第1のベイズ関数を使用して、前記少なくとも1つの占有確率値の対数オッズを用いて前記グローバル占有グリッドを更新することと、
前記第2の位置と関連付けられる特性に少なくとも基づいて、前記対数オッズを調節することと
を行うことと、
前記自律的デバイスが、前記第1の位置に留まり、前記グローバル占有グリッドおよび前記ローカル占有グリッドが同一の場所に設置されるとき、
前記ローカル占有グリッドと関連付けられる前記少なくとも1つの走行可能表面を用いて前記グローバル占有グリッドを更新することと、
前記少なくとも1つの走行可能表面と関連付けられる前記表面信頼度を用いて前記グローバル占有グリッドを更新することと、
第2のベイズ関数を使用して、前記少なくとも1つの占有確率値の対数オッズを用いて前記グローバル占有グリッドを更新することと、
前記第2の位置と関連付けられる特性に少なくとも基づいて、前記対数オッズを調節することと
を行うことと
を含む、方法。 - 前記マップを作成することは、
表面を表す点群データにアクセスすることと、
前記点群データをフィルタリングすることと、
前記フィルタリングされた点群データを処理可能部分に形成することと、
前記処理可能部分を少なくとも1つの凹多角形に併合することと、
前記少なくとも1つの凹多角形内の少なくとも1つのSDSFを位置特定および標識化することであって、前記位置特定および標識化することは、標識化された点群データを形成する、ことと、
前記少なくとも1つの凹多角形に少なくとも基づいて、グラフ化多角形を作成することと、
前記グラフ化多角形に少なくとも基づいて、開始点から終了点までの前記経路を選定することであって、前記デバイスは、前記経路に沿って前記少なくとも1つのSDSFを横断する、ことと
を含む、請求項8に記載の方法。 - 前記点群データをフィルタリングすることは、
前記点群データから過渡物体を表す点および外れ値を表す点を条件付きで除去することと、
事前選択された高さを有する前記除去された点を置換することと
を含む、請求項10に記載の方法。 - 処理部分を形成することは、
前記点群データを前記処理可能部分にセグメント化することと、
前記処理可能部分から事前選択された高さの点を除去することと
を含む、請求項10に記載の方法。 - 前記処理可能部分を併合することは、
外れ値、ボクセル、および法線を分析することによって、前記処理可能部分のサイズを縮小することと、
前記縮小サイズの処理可能部分からの領域を拡大させることと、
前記拡大された領域から初期走行可能表面を判定することと、
前記初期走行可能表面をセグメント化およびメッシュ化することと、
前記セグメント化およびメッシュ化された初期走行可能表面内の多角形を位置特定することと、
前記多角形に少なくとも基づいて、少なくとも1つの走行可能表面を設定することと
を含む、請求項10に記載の方法。 - 前記少なくとも1つのSDSFを位置特定および標識化することは、
SDSFフィルタに従って、前記初期走行可能表面の点群データをソートすることであって、前記SDSFフィルタは、少なくとも3つのカテゴリの点を含む、ことと、
前記少なくとも3つのカテゴリの点が、組み合わせて、少なくとも1つの第1の事前選択された基準を満たすかどうかに少なくとも基づいて、少なくとも1つのSDSF点を位置特定することと
を含む、請求項13に記載の方法。 - 複数の前記少なくとも1つのSDSF点が、組み合わせて、少なくとも1つの第2の事前選択された基準を満たすかどうかに少なくとも基づいて、少なくとも1つのSDSF軌道を作成することをさらに含む、請求項14に記載の方法。
- 前記グラフ化多角形を作成することは、
前記少なくとも1つの走行可能表面から少なくとも1つの多角形を作成することであって、前記少なくとも1つの多角形は、外縁を含む、ことと、
前記外縁を平滑化することと、
前記平滑化された外縁に基づいて、走行マージンを形成することと、
前記少なくとも1つのSDSF軌道を前記少なくとも1つの走行可能表面に追加することと、
少なくとも1つの第3の事前選択された基準に従って、前記少なくとも1つの走行可能表面から内縁を除去することと
をさらに含む、請求項15に記載の方法。 - 前記外縁の平滑化は、前記外縁を外向きにトリミングし、外向き縁を形成することを含む、請求項16に記載の方法。
- 前記平滑化された外縁の走行マージンを形成することは、前記外向き縁を内向きにトリミングすることを含む、請求項16に記載の方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2024202254A JP7832283B2 (ja) | 2019-07-10 | 2024-11-20 | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 |
Applications Claiming Priority (8)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| US201962872320P | 2019-07-10 | 2019-07-10 | |
| US201962872396P | 2019-07-10 | 2019-07-10 | |
| US62/872,396 | 2019-07-10 | ||
| US62/872,320 | 2019-07-10 | ||
| US202062990485P | 2020-03-17 | 2020-03-17 | |
| US62/990,485 | 2020-03-17 | ||
| PCT/US2020/041711 WO2021007561A1 (en) | 2019-07-10 | 2020-07-10 | System and method for real time control of an autonomous device |
| JP2022501336A JP7572420B2 (ja) | 2019-07-10 | 2020-07-10 | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 |
Related Parent Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2022501336A Division JP7572420B2 (ja) | 2019-07-10 | 2020-07-10 | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 |
Related Child Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2024202254A Division JP7832283B2 (ja) | 2019-07-10 | 2024-11-20 | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 |
Publications (3)
| Publication Number | Publication Date |
|---|---|
| JP2023112104A JP2023112104A (ja) | 2023-08-10 |
| JP2023112104A5 JP2023112104A5 (ja) | 2024-08-19 |
| JP7601955B2 true JP7601955B2 (ja) | 2024-12-17 |
Family
ID=71944349
Family Applications (4)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2022501336A Active JP7572420B2 (ja) | 2019-07-10 | 2020-07-10 | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 |
| JP2023102264A Active JP7601955B2 (ja) | 2019-07-10 | 2023-06-22 | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 |
| JP2024135628A Active JP7820455B2 (ja) | 2019-07-10 | 2024-08-15 | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 |
| JP2024202254A Active JP7832283B2 (ja) | 2019-07-10 | 2024-11-20 | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 |
Family Applications Before (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2022501336A Active JP7572420B2 (ja) | 2019-07-10 | 2020-07-10 | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 |
Family Applications After (2)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2024135628A Active JP7820455B2 (ja) | 2019-07-10 | 2024-08-15 | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 |
| JP2024202254A Active JP7832283B2 (ja) | 2019-07-10 | 2024-11-20 | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 |
Country Status (10)
| Country | Link |
|---|---|
| EP (1) | EP3997484A1 (ja) |
| JP (4) | JP7572420B2 (ja) |
| KR (1) | KR102950944B1 (ja) |
| CN (2) | CN119937377A (ja) |
| AU (3) | AU2020310932B2 (ja) |
| CA (2) | CA3146648C (ja) |
| GB (1) | GB2600638A (ja) |
| IL (1) | IL289689A (ja) |
| MX (5) | MX2022000458A (ja) |
| WO (1) | WO2021007561A1 (ja) |
Families Citing this family (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US11691648B2 (en) * | 2020-07-24 | 2023-07-04 | SafeAI, Inc. | Drivable surface identification techniques |
| CN114862684A (zh) * | 2021-01-18 | 2022-08-05 | 广东博智林机器人有限公司 | 地砖铺贴方法、装置、电子设备及存储介质 |
| EP4123336B1 (en) * | 2021-07-21 | 2024-11-06 | Hyundai Mobis Co., Ltd. | Apparatus and method for monitoring surrounding environment of vehicle |
| US11988749B2 (en) | 2021-08-19 | 2024-05-21 | Argo AI, LLC | System and method for hybrid LiDAR segmentation with outlier detection |
| JP7628972B2 (ja) | 2022-01-11 | 2025-02-12 | トヨタ自動車株式会社 | 移動体制御方法、移動体制御システム、及び移動体制御プログラム |
| CN114715187B (zh) * | 2022-03-23 | 2025-09-12 | 北京京东乾石科技有限公司 | 异常曲线行驶确定方法和装置 |
| DE102023001762A1 (de) | 2022-05-24 | 2023-11-30 | Sew-Eurodrive Gmbh & Co Kg | Mobiles System |
| US12269505B2 (en) | 2023-01-16 | 2025-04-08 | Ford Global Technologies, Llc | Photometric stereo for vehicle navigation |
| DE102023202244A1 (de) * | 2023-03-13 | 2024-09-19 | Robert Bosch Gesellschaft mit beschränkter Haftung | Verfahren für eine dreidimensionale Straßenbereichssegmentierung für ein Fahrzeug |
| JP7551091B1 (ja) | 2024-05-24 | 2024-09-17 | 株式会社トクイテン | 自動走行システムおよび自動走行方法 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20080009966A1 (en) | 2006-07-05 | 2008-01-10 | Battelle Energy Alliance, Llc | Occupancy Change Detection System and Method |
| JP2016157473A (ja) | 2012-10-01 | 2016-09-01 | アイロボット コーポレイション | センサデータの空間的集約を用いる適応マッピング |
| WO2018053100A1 (en) | 2016-09-14 | 2018-03-22 | Irobot Corporation | Systems and methods for configurable operation of a robot based on area classification |
| WO2018158248A2 (de) | 2017-03-02 | 2018-09-07 | RobArt GmbH | Verfahren zur steuerung eines autonomen,mobilen roboters |
Family Cites Families (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4121613B2 (ja) * | 1998-05-19 | 2008-07-23 | 日本車輌製造株式会社 | 無人搬送車のガイドセンサ取付構造 |
| JP2000202792A (ja) * | 1999-01-14 | 2000-07-25 | Sharp Corp | 掃除ロボット |
| ATE300932T1 (de) | 1999-03-15 | 2005-08-15 | Deka Products Lp | Steuerungssystem und -verfahren für rollstühle |
| US8717456B2 (en) * | 2002-02-27 | 2014-05-06 | Omnivision Technologies, Inc. | Optical imaging systems and methods utilizing nonlinear and/or spatially varying image processing |
| JP2003316436A (ja) | 2002-04-25 | 2003-11-07 | Sanyo Electric Co Ltd | 台 車 |
| JP4043416B2 (ja) | 2003-07-30 | 2008-02-06 | オリンパス株式会社 | 安全移動支援装置 |
| JP4886201B2 (ja) | 2005-03-14 | 2012-02-29 | 株式会社日立製作所 | 移動ロボット |
| US11176655B2 (en) * | 2014-01-27 | 2021-11-16 | Cognex Corporation | System and method for determining 3D surface features and irregularities on an object |
| US9684305B2 (en) * | 2015-09-11 | 2017-06-20 | Fuji Xerox Co., Ltd. | System and method for mobile robot teleoperation |
| CN108369775B (zh) * | 2015-11-04 | 2021-09-24 | 祖克斯有限公司 | 响应于物理环境的改变自适应制图以对自主车辆进行导航 |
| US9880561B2 (en) * | 2016-06-09 | 2018-01-30 | X Development Llc | Sensor trajectory planning for a vehicle |
| US10539676B2 (en) * | 2017-03-22 | 2020-01-21 | Here Global B.V. | Method, apparatus and computer program product for mapping and modeling a three dimensional structure |
| CN109229109B (zh) | 2017-07-04 | 2020-03-31 | 百度在线网络技术(北京)有限公司 | 判断车辆行驶方向的方法、装置、设备和计算机存储介质 |
| US20210127930A1 (en) | 2017-11-16 | 2021-05-06 | Sharp Kabushiki Kaisha | Wheel support structure for self-propelled electronic device |
| US20190204845A1 (en) * | 2017-12-29 | 2019-07-04 | Waymo Llc | Sensor integration for large autonomous vehicles |
| JP2024135628A (ja) * | 2023-03-23 | 2024-10-04 | 株式会社リコー | 立体造形装置及び立体造形方法 |
-
2020
- 2020-07-10 GB GB2201700.8A patent/GB2600638A/en not_active Withdrawn
- 2020-07-10 JP JP2022501336A patent/JP7572420B2/ja active Active
- 2020-07-10 WO PCT/US2020/041711 patent/WO2021007561A1/en not_active Ceased
- 2020-07-10 MX MX2022000458A patent/MX2022000458A/es unknown
- 2020-07-10 CA CA3146648A patent/CA3146648C/en active Active
- 2020-07-10 EP EP20750954.8A patent/EP3997484A1/en active Pending
- 2020-07-10 AU AU2020310932A patent/AU2020310932B2/en active Active
- 2020-07-10 CN CN202411965142.1A patent/CN119937377A/zh active Pending
- 2020-07-10 CA CA3300039A patent/CA3300039A1/en active Pending
- 2020-07-10 CN CN202080058758.4A patent/CN114270140B/zh active Active
- 2020-07-10 KR KR1020227004537A patent/KR102950944B1/ko active Active
-
2022
- 2022-01-09 IL IL289689A patent/IL289689A/en unknown
- 2022-01-10 MX MX2025001981A patent/MX2025001981A/es unknown
- 2022-01-10 MX MX2025007525A patent/MX2025007525A/es unknown
- 2022-01-10 MX MX2025011374A patent/MX2025011374A/es unknown
- 2022-01-10 MX MX2025011373A patent/MX2025011373A/es unknown
-
2023
- 2023-06-22 JP JP2023102264A patent/JP7601955B2/ja active Active
-
2024
- 2024-08-15 JP JP2024135628A patent/JP7820455B2/ja active Active
- 2024-11-20 JP JP2024202254A patent/JP7832283B2/ja active Active
-
2026
- 2026-01-30 AU AU2026200675A patent/AU2026200675A1/en active Pending
- 2026-02-10 AU AU2026200950A patent/AU2026200950A1/en active Pending
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20080009966A1 (en) | 2006-07-05 | 2008-01-10 | Battelle Energy Alliance, Llc | Occupancy Change Detection System and Method |
| JP2016157473A (ja) | 2012-10-01 | 2016-09-01 | アイロボット コーポレイション | センサデータの空間的集約を用いる適応マッピング |
| WO2018053100A1 (en) | 2016-09-14 | 2018-03-22 | Irobot Corporation | Systems and methods for configurable operation of a robot based on area classification |
| WO2018158248A2 (de) | 2017-03-02 | 2018-09-07 | RobArt GmbH | Verfahren zur steuerung eines autonomen,mobilen roboters |
Also Published As
| Publication number | Publication date |
|---|---|
| CA3300039A1 (en) | 2026-03-02 |
| CN119937377A (zh) | 2025-05-06 |
| MX2025011373A (es) | 2025-10-01 |
| BR112022000356A2 (pt) | 2022-05-10 |
| JP7572420B2 (ja) | 2024-10-23 |
| JP2022540640A (ja) | 2022-09-16 |
| JP7820455B2 (ja) | 2026-02-25 |
| CN114270140A (zh) | 2022-04-01 |
| GB202201700D0 (en) | 2022-03-30 |
| KR20220034843A (ko) | 2022-03-18 |
| AU2020310932A1 (en) | 2022-01-27 |
| CA3146648C (en) | 2026-03-10 |
| JP2024159792A (ja) | 2024-11-08 |
| AU2026200675A1 (en) | 2026-02-19 |
| KR102950944B1 (ko) | 2026-04-10 |
| CA3146648A1 (en) | 2021-01-14 |
| MX2025001981A (es) | 2025-04-02 |
| JP2023112104A (ja) | 2023-08-10 |
| MX2025011374A (es) | 2025-10-01 |
| IL289689A (en) | 2022-03-01 |
| MX2022000458A (es) | 2022-04-25 |
| JP7832283B2 (ja) | 2026-03-17 |
| AU2026200950A1 (en) | 2026-02-26 |
| MX2025007525A (es) | 2025-08-01 |
| WO2021007561A1 (en) | 2021-01-14 |
| JP2025019134A (ja) | 2025-02-06 |
| AU2020310932B2 (en) | 2026-02-19 |
| EP3997484A1 (en) | 2022-05-18 |
| GB2600638A8 (en) | 2022-11-23 |
| CN114270140B (zh) | 2025-03-18 |
| GB2600638A (en) | 2022-05-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US12601609B2 (en) | Method of controlling an autonomous device | |
| JP7601955B2 (ja) | 自律的デバイスのリアルタイム制御のためのシステムおよび方法 | |
| JP7801392B2 (ja) | 表面特徴検出および横断のためのシステムおよび方法 | |
| KR20260052210A (ko) | 자율 디바이스의 실시간 제어를 위한 시스템 및 방법 | |
| BR112022000356B1 (pt) | Veículo de entrega autônomo | |
| BR122023013708B1 (pt) | Método e sistema para controle em tempo real de uma configuração de um dispositivo | |
| CA3131838C (en) | System and method for surface feature detection and traversal |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20230622 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240808 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20240821 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20241120 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20241204 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20241205 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7601955 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |