JP7795112B2 - 制御方法及び制御システム - Google Patents

制御方法及び制御システム

Info

Publication number
JP7795112B2
JP7795112B2 JP2022575657A JP2022575657A JP7795112B2 JP 7795112 B2 JP7795112 B2 JP 7795112B2 JP 2022575657 A JP2022575657 A JP 2022575657A JP 2022575657 A JP2022575657 A JP 2022575657A JP 7795112 B2 JP7795112 B2 JP 7795112B2
Authority
JP
Japan
Prior art keywords
vehicle
period
magnetic
restart
control
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
Application number
JP2022575657A
Other languages
English (en)
Other versions
JPWO2022154103A1 (ja
JPWO2022154103A5 (ja
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.)
Aichi Steel Corp
Original Assignee
Aichi Steel Corp
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 Aichi Steel Corp filed Critical Aichi Steel Corp
Publication of JPWO2022154103A1 publication Critical patent/JPWO2022154103A1/ja
Publication of JPWO2022154103A5 publication Critical patent/JPWO2022154103A5/ja
Application granted granted Critical
Publication of JP7795112B2 publication Critical patent/JP7795112B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/20Control system inputs
    • G05D1/24Arrangements for determining position or orientation
    • G05D1/244Arrangements for determining position or orientation using passive navigation aids external to the vehicle, e.g. markers, reflectors or magnetic means
    • GPHYSICS
    • G06COMPUTING OR CALCULATING; COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/70Determining position or orientation of objects or cameras
    • 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/10Path keeping
    • 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
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/36Input/output arrangements for on-board computers
    • 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/20Control system inputs
    • G05D1/24Arrangements for determining position or orientation
    • G05D1/246Arrangements for determining position or orientation using environment maps, e.g. simultaneous localisation and mapping [SLAM]
    • G05D1/2465Arrangements for determining position or orientation using environment maps, e.g. simultaneous localisation and mapping [SLAM] using a 3D model of the environment
    • 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/247Arrangements for determining position or orientation using signals provided by artificial sources external to the vehicle, e.g. navigation beacons
    • 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/646Following a predefined trajectory, e.g. a line marked on the floor or a flight path
    • GPHYSICS
    • G06COMPUTING OR CALCULATING; COUNTING
    • G06KGRAPHICAL DATA READING; PRESENTATION OF DATA; RECORD CARRIERS; HANDLING RECORD CARRIERS
    • G06K19/00Record carriers for use with machines and with at least a part designed to carry digital markings
    • G06K19/06Record carriers for use with machines and with at least a part designed to carry digital markings characterised by the kind of the digital marking, e.g. shape, nature, code
    • G06K19/067Record carriers with conductive marks, printed circuits or semiconductor circuit elements, e.g. credit or identity cards also with resonating or responding marks without active components
    • G06K19/07Record carriers with conductive marks, printed circuits or semiconductor circuit elements, e.g. credit or identity cards also with resonating or responding marks without active components with integrated circuit chips
    • G06K19/0723Record carriers with conductive marks, printed circuits or semiconductor circuit elements, e.g. credit or identity cards also with resonating or responding marks without active components with integrated circuit chips the record carrier comprising an arrangement for non-contact communication, e.g. wireless communication circuits on transponder cards, non-contact smart cards or RFIDs
    • GPHYSICS
    • G06COMPUTING OR CALCULATING; COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/20Analysis of motion
    • G06T7/269Analysis of motion using gradient-based methods
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/01Detecting movement of traffic to be counted or controlled
    • G08G1/042Detecting movement of traffic to be counted or controlled using inductive or magnetic detectors
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/09Arrangements for giving variable traffic instructions
    • G08G1/0962Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0968Systems involving transmission of navigation instructions to the vehicle
    • G08G1/0969Systems involving transmission of navigation instructions to the vehicle having a display in the form of a map
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/166Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/167Driving aids for lane monitoring, lane changing, e.g. blind spot detection
    • 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/50Magnetic or electromagnetic sensors
    • 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
    • B60W2556/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • B60W2556/50External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
    • 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2107/00Specific environments of the controlled vehicles
    • G05D2107/10Outdoor regulated spaces
    • G05D2107/13Spaces reserved for vehicle traffic, e.g. roads, regulated airspace or regulated waters
    • 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
    • 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/30Radio signals
    • G05D2111/34Radio signals generated by transmitters powered by energy received from an external transceiver, e.g. generated by passive radio-frequency identification [RFID] tags
    • 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/60Combination of two or more signals
    • G05D2111/63Combination of two or more signals of the same type, e.g. stereovision or optical flow
    • G05D2111/65Combination of two or more signals of the same type, e.g. stereovision or optical flow taken successively, e.g. visual odometry or optical flow
    • GPHYSICS
    • G06COMPUTING OR CALCULATING; COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/10Image acquisition modality
    • G06T2207/10024Color image
    • GPHYSICS
    • G06COMPUTING OR CALCULATING; COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/10Image acquisition modality
    • G06T2207/10028Range image; Depth image; 3D point clouds
    • GPHYSICS
    • G06COMPUTING OR CALCULATING; COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/30Subject of image; Context of image processing
    • G06T2207/30248Vehicle exterior or interior
    • G06T2207/30252Vehicle exterior; Vicinity of vehicle

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Theoretical Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Microelectronics & Electronic Packaging (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Computer Hardware Design (AREA)
  • Multimedia (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Human Computer Interaction (AREA)
  • Traffic Control Systems (AREA)
  • Electromagnetism (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本発明は、走路に配設された磁気マーカを利用して車両を走行させるための制御方法及び制御システムに関する発明である。
従来より、走路に配列された磁気マーカに対する車両の横ずれ量をゼロに近づけるためのラテラル制御により走路に沿って車両を走行させるシステムが知られている(例えば特許文献1参照。)。磁気マーカを検出するための磁気センサに加えて、電波や光の反射を利用して先行車両を検出し車間距離を計測するためのミリ波レーダやライダーを備える車両であれば、先行車追従を含め、磁気マーカが配設された走路を自動走行することが可能である。
特開2002-334400号公報
しかしながら、上記従来のシステムでは、車両による移動を開始した後、最初に磁気マーカを検出できるまでの期間における自動運転の難易度が高く、マニュアル運転が不可避であるという問題がある。
本発明は、前記従来の問題点に鑑みてなされたものであり、磁気マーカを利用した運転支援制御によって高レベルの自動運転を実現するための制御方法及び制御システムを提供するための発明である。
本発明の一態様は、周辺に磁気を作用する磁気マーカが配設された走路を含む走路を、磁気センサを備える車両が走行するための制御方法であって、
車両の走行を制御する機能が停止された駐車期間を経て当該機能が再始動された後、車両が移動して最初に磁気マーカを検出するまでの再始動期間と、
該再始動期間を経て車両が磁気マーカを検出した後の通常走行期間とで、制御を切り替え、
前記再始動期間では、直前の駐車期間への移行時の車両の位置、あるいは当該再始動期間において測位された位置、に基づいて車両の位置を特定して車両を走行させる制御を実行する一方、
前記通常走行期間では、検出された磁気マーカの位置に基づいて車両の位置を特定して車両を走行させる制御を実行する制御方法にある。
本発明の一態様は、周辺に磁気を作用する磁気マーカが配設された走路を含む走路を、磁気センサを備える車両が走行するための制御システムであって、
車両の走行を制御する機能が停止された駐車期間を経て当該機能が再始動された後、車両が移動して最初に磁気マーカを検出するまでの再始動期間において、直前の駐車期間への移行時の車両の位置、あるいは当該再始動期間において測位された位置、に基づいて車両の位置を特定して車両を走行させる制御を実行する回路と、
前記再始動期間を経て車両が最初に磁気マーカを検出した後の通常走行期間において、検出されたいずれかの磁気マーカの位置に基づいて車両の位置を特定して車両を走行させる制御を実行する回路と、
前記再始動期間から前記通常走行期間へ移行したときに制御の切替を実行する回路と、を備える制御システムにある。
本発明は、磁気マーカが配設された走路を車両が走行するための制御方法あるいは制御システムの発明である。本発明の制御方法及び制御システムでは、車両の走行を制御する機能が停止された駐車期間を経て当該機能が再始動された後、車両が移動して最初に磁気マーカを検出するまでの再始動期間と、車両が磁気マーカを検出した後の通常走行期間とで、制御が切り替えられる。
前記再始動期間では、直前の駐車期間への移行時の車両の位置、あるいは当該再始動期間において測位された位置、に基づいて車両の位置を特定して車両を走行させる制御が実行される。前記通常走行期間では、検出された磁気マーカの位置に基づいて車両の位置を特定して車両を走行させる制御が実行される。
本発明の制御方法及び制御システムでは、前記駐車期間と前記通常走行期間との間に、前記再始動期間が設定される。この再始動期間における車両の制御は、磁気マーカの検出を前提としない制御である。前記通常走行期間と前記再始動期間とで制御を切り替えることで、駐車期間の後、磁気マーカを検出できるまでの走行が可能になる。本発明の制御方法及び制御システムによれば、車両の走行を制御可能な領域を拡大でき、汎用性を向上できる。
このように本発明の制御方法及び制御システムによれば、走路に配設された磁気マーカを利用して、よりレベルの高い自動運転を実現可能である。
幹線道路で行き来可能な2つの地域の説明図。 地域内の道路の説明図。 磁気マーカを示す斜視図。 磁気マーカが配設された道路を走行する車両の説明図。 RFIDタグの正面図。 車両を示す上面図。 車両システムの構成を示すブロック図。 基本処理の流れを示すフロー図。 リスタート制御の流れを示すフロー図。 制御対象のルートを示す説明図。 通常走行制御の流れを示すフロー図。 慣性航法により推定される相対位置の説明図。 ルートに対する偏差ΔDの説明図。 他のリスタート制御の流れを示すフロー図。 他のリスタート制御の流れを示すフロー図。
本発明の実施の形態につき、以下の実施例を用いて具体的に説明する。
(実施例1)
本例は、車両5の制御システムの一例をなす車両システム1、及び車両5の制御方法の例である。この制御方法及び車両システム1によれば、自宅から勤務先に向かって車両5で移動する際、自動運転により自宅の車庫を出発可能である。この内容について、図1~図14を参照して説明する。
本例では、幹線道路61で接続された地域60間を車両5が移動するルートを例示する。地域60内では、生活道路62を利用して移動可能である(図2)。幹線道路61の多くは、例えば2mなどの間隔で磁気マーカ10が配設されている道路である。一方、生活道路62の多くは、磁気マーカ10が配設されていない道路である。このように車両5が走行する走路は、磁気マーカ10が配設された走路を含む走路である。
図2は、地域60の例示であり、地域60における車両5の位置を示している。同図は、出発地点の地域60Dおよび目的地点の地域60Aを兼用している。出発地点の地域60Dである場合の符号622は例えば出発地点である自宅を表し、目的地点の地域60Aである場合の符号622は例えば目的地点である勤務先を表している。
磁気マーカ10が配設された幹線道路61のみならず、図2に例示する生活道路62を制御の対象に含めれば、例えば、出発地点が所在する地域60Dから目的地点が所在する地域60Aへの車両の運転を自動化できる(図1参照。)。例えば、自宅622と勤務先が異なる地域60に所在するような場合には、地域60Dの自宅622から出発した後、幹線道路61を利用して勤務先の会社が所在する地域60Aに移動し、勤務先に至るまでのルートを車両5が自動走行可能である。
以下、走路に配設される(1)磁気マーカ10、及び(2)車両システム1、の構成を説明した後、(3)車両システム1の動作、について説明する。
(1)磁気マーカ
磁気マーカ10(図3)は、直径20mm、高さ28mmの柱状をなす磁石10Mに対して、RFIDタグ15(Radio Frequency IDentification Tag、無線タグ)が一体化されたマーカである。磁気マーカ10は、図4のごとく、路面100Sに穿設された孔に収容された状態で配設される。磁気マーカ10をなす磁石10Mは、磁性材料である酸化鉄の磁粉を基材である高分子材料中に分散させたフェライトプラスチックマグネットである。高分子材料は、例えば、塩素化ポリエチレン(Chlorinated Polyethylene)、ポリフェニレンスルファイド(Poly Phenylene Sulfide - PPS)等である。
磁気マーカ10では、柱状の磁石10Mの端面に、シート状のRFIDタグ15が配置されている。RFIDタグ15は、無線によりタグ情報を出力する電子部品である。なお、磁石10Mの端面にRFIDタグ15を配置した後、樹脂材料によるコーティング層を表面に設けることも良い。コーティング層としては、繊維に樹脂材料を含浸させた複合材料よりなる層であっても良い。あるいは、コーティング層が形成された磁石10Mの端面に、RFIDタグ15を配設しても良い。磁石10Mの外表面の全部あるいは一部に、コーティング層を設けることも良い。
さらに、磁石10Mの内部に、RFIDタグ15の全部又は一部を埋設することも良い。柱状の磁気マーカ10に代えて、磁石シートよりなるシート状の磁気マーカを採用しても良い。この場合、磁石シートの表面にシート状のRFIDタグ15を積層しても良い。さらに、2枚の磁石シートを貼り合わせた磁気マーカであっても良い。この場合、2枚の磁石シートによってシート状のRFIDタグ15を挟み込むことも良い。
RFIDタグ15(図5)は、例えばPET(Polyethylene terephthalate)フィルムから切り出したタグシート150の表面にICチップ157が実装された電子部品である。タグシート150の表面には、アンテナ153の印刷パターンが設けられている。アンテナ153は、外部からの電磁誘導によって励磁電流が発生する給電用のアンテナ機能と、情報を無線送信する通信用のアンテナ機能と、を併せ持っている。RFIDタグ15は、無線による外部給電により動作し、識別情報であるタグIDなどのタグ情報を外部出力する。RFIDタグ15が外部出力するタグIDは、磁気マーカ10の識別情報の一例である。
なお、上記のように磁気マーカ10を構成する磁石10Mは、磁粉を高分子材料中に分散させた磁石である。このような磁石10Mは、電気的な内部抵抗が大きいため、RFIDタグ15に対する無線による電力供給に応じて渦電流が発生するおそれが少ない。それ故、この磁石10Mを採用する場合、RFIDタグ15に対して外部から効率良く電力を供給できる。この磁石10Mは、RFIDタグ15を保持する磁石として好適である。
(2)車両システム
車両システム1(図6及び図7)は、車両5の走行を制御する制御ユニット18、外部制御が可能な各種の走行制御用のアクチュエータ、ミリ波レーダ17や画像センサ19などの物体検知センサ、RFIDタグ15と通信するタグリーダユニット14、及び絶対位置あるいは相対位置を特定するための測位ユニット16を含めて構成されている。
制御ユニット18は、CPU(Central Processing Unit)やROM(Read Only Memory)やRAM(Random Access Memory)などの電子部品が実装された電子基板(図示略)を中心にして構成された回路のユニットである。制御ユニット18では、ハードディスクドライブ(HDD)あるいはソリッドステートドライブ(SSD)等の記憶装置(記憶媒体)や無線通信回路等が、I/O(Input/Output)を介して電子基板に接続されている。
制御ユニット18では、記憶装置の記憶領域を利用して、各磁気マーカ10に関するマーカ情報を記憶するマーカデータベース(マーカDB)18M、3次元地図データを記憶する地図データベース(地図DB)18T等が設けられている。3次元地図データは、道路の形状・構造のほか、縁石やガードレールや中央分離帯や標識などの道路の付帯物の3次元構造や、建物や陸橋などの周囲環境などの3次元構造等を表す地図データである。
マーカDB18Mで記憶されるマーカ情報には、付設されたRFIDタグ15の識別情報であるタグID(タグ情報)がひも付け(対応付け)されている。本例の構成では、タグIDを利用してマーカDB18Mを参照することで、対応する磁気マーカ10の特定が可能である。
マーカ情報には、磁気マーカ10の敷設位置を表す位置データ(位置情報)や、その敷設位置の属性(道路種別など)を表す情報や、制限速度などの規制情報などが含まれている。上記の通り、このマーカ情報には、タグIDがひも付けられている。タグIDを利用してマーカDB18Mを参照すれば、磁気マーカ10の敷設位置を特定できる。つまり、タグIDは、磁気マーカ10の位置を特定可能な情報の一例をなしている。
地図DB18Tに格納される地図データは、道路の構造や周囲環境などを表すベクターデータによって構成されている。この地図データでは、各磁気マーカ10の敷設位置等がマッピングされている。例えば、車両5がいずれかの磁気マーカ10を検出した場合、その磁気マーカ10を特定することにより地図データ中の位置を特定できる。そして、地図データ中の車両5の位置を特定すれば、地図データが表す前方の道路形状、道路構造を把握できる。
なお、工事箇所や信号の点灯状態などのリアルタイムの交通状況を外部サーバから随時、受信可能な制御ユニット18であっても良い。この場合には、リアルタイムの交通状況が反映されたダイナミックマップを構築でき、ダイナミックマップを利用した車両制御が可能になる。
制御ユニット18が制御する各種のアクチュエータとしては、エンジン出力を調節するためのスロットルアクチュエータ181(図7)、操舵方向を変更するためのステアリングアクチュエータ183、制動力を調節するためのブレーキアクチュエータ185などがある。制御ユニット18が、これらのアクチュエータを適宜、制御することで、車両5を走行させることができる。
制御ユニット18に接続されたセンサとしては、磁気センサCn、ミリ波レーダ17、画像センサ19等がある。磁気センサCnは、磁気を検出するためのセンサである。車両5には、15個の磁気センサCnが直線上に配列されたセンサアレイ21が組み込まれている。センサアレイ21は、車幅方向に長い棒状のユニットであり、路面100Sと対面する状態で車両5の底面に取り付けられる。
センサアレイ21は、磁気マーカ10の検出処理等を実行する検出処理回路212を備えている。検出処理回路212は、15個の磁気マーカCnを制御して各磁気マーカCnの磁気計測値を取得する。そして、検出処理回路212は、各磁気マーカCnの磁気計測値を処理することで磁気マーカ10の検出処理等を実行する。
センサアレイ21(図7)では、15個の磁気センサCnが10cm間隔で配置されている。磁気センサC1~C15が出力する磁気計測値は、車幅方向の離散的な磁気分布を形成する。センサアレイ21(検出処理回路212)は、磁気マーカ10を検出したとき、その旨を表す検出信号を出力すると共に、磁気マーカ10に対する車両5の横ずれ量を計測する。センサアレイ21が磁気マーカ10の真上に位置したとき、各磁気センサCnが出力する磁気計測値の分布(車幅方向の磁気分布)に基づけば、車幅方向における磁気マーカ10の位置を特定可能である。そして、センサアレイ21は、車幅方向における磁気マーカの位置に基づいて、磁気マーカ10に対する車両の横ずれ量を特定する。
磁気センサCnとしては、例えば、公知のMI効果(Magneto Impedance Effect)を利用して磁気を検出するMIセンサなどが好適である。MI効果とは、アモルファスワイヤなどの感磁体のインピーダンスが外部磁界に応じて敏感に変化するという磁気的な効果である。MIセンサは、一直線状で組み込まれる感磁体の方向に磁気的な感度を有する。磁気センサCnは、例えば、車幅方向あるいは鉛直方向など一方向の磁気成分を検出可能な磁気センサであっても良い。進行方向の磁気成分および車幅方向の磁気成分など、2方向の磁気成分を検出可能な磁気センサであっても良い。進行方向および車幅方向に加えて鉛直方向の磁気成分を検出可能など、3方向の磁気成分を検出可能な磁気センサであっても良い。
ミリ波レーダ17は、波長1~10mm、周波数30~300GHzのミリ波を利用する物体検出センサである。ミリ波レーダ17は、ミリ波を送信したときの反射電波を利用して対象物を検出すると共に、対象物までの距離を計測する。ミリ波レーダ17によれば、他の車両、ガードレールや縁石などの道路構造物に加えて、人の検出も可能である。車両5では、周囲を監視できるよう、車体の前後左右の隅部にミリ波レーダ17が配置されている。
画像センサ19は、前方の環境を撮影するための前方カメラを含むセンサである。画像センサ19は、画像処理を実行する処理回路(図示略)等を含んで構成されている。画像センサ19は、撮影画像に画像処理を施して、車線を区画する白線、道路標識、信号、人、自転車、先行車両、対向車両などを検出する。なお、歩行者などの検出に当たっては、ミリ波センサ17によって特定された注視領域に対して重点的に画像処理を施す等、複数のセンサを利用して検出精度を高めるセンサフュージョンの技術が活用される。
測位ユニット16は、GPS(Global Positioning System)ユニットや慣性計測ユニット等を含んでいる。GPSユニットは、GNSS(Global Navigation Satellite System、衛星測位システム)の一種であるGPSを利用して車両位置(車両の位置)を計測するユニットである。慣性計測ユニットは、車両のヨー角の変化速度(角速度)や進行方向及び横方向の加速度を計測するユニットである。慣性計測ユニットが計測する角速度や加速度を利用すれば、基準位置からの相対位置(車両の移動による変位量の一例)や車両の向きを特定可能である。慣性計測ユニットを採用すれば、磁気マーカ10の敷設位置などの基準位置を通過した後の相対位置や回頭角(ヨー角の変化量)を精度高く特定できる。慣性計測ユニットを採用すれば、衛星電波を受信できないトンネル内などでの車両位置の特定が可能になる。
タグリーダユニット14は、磁気マーカ10(図4)に保持されたRFIDタグ15と無線で通信する通信ユニットである。タグリーダユニット14は、RFIDタグ15の動作に必要な電力を無線で送電してRFIDタグ15を動作させ、RFIDタグ15の識別情報であるタグID(タグ情報)を読み取る。なお、図6では、磁気センサアレイ21及びタグリーダユニット14を別体で図示しているが、これらが一体化されたユニットを採用することも良い。
(3)車両システムの動作
次に、上記のように構成された車両システム1の動作について、図8~図13を参照して説明する。図8は、車両5が移動する際の(3.1)基本処理の流れを示している。図9は、駐車期間に後続する再始動期間中の(3.2)リスタート制御の流れを示している。図11は、磁気マーカ10を検出しながら走行する(3.3)通常走行制御、の流れを示している。なお、図10は、リスタート制御の説明中の参照図である。図12及び図13は、通常走行制御の説明中の説明図である。
(3.1)基本処理
基本処理(図8)は、車両5の主電源であるイグニッションのオンへの切替(IGオン)の後、目的地点に到着してイグニッションをオフに切り替える(IGオフ)までの処理である。この基本処理の流れについて、図8のフロー図に沿って説明する。
車両5のイグニッションがオフ状態に保持された駐車期間を経て、オン状態に切り替えられると(IGオン、S101:Yes)、制御ユニット18は、例えば車両5の利用者によって入力された目的地点を取得する(S102)。なお、目的地点の入力方法としては、例えばブルートゥース(R)機能によって通信可能に接続された携帯端末(図示略)を利用して入力する方法や、車両5に設けられたタッチパネルディスプレイ(図示略)上で入力する方法等がある。
制御ユニット18は、地図DB18Tに格納された3次元地図データを参照し、目的地点に至るルートを演算により特定し、そのルートを制御目標に設定する(S103)。なお、目的地点に至るルートを特定する際、制御ユニット18は、後述するリスタート制御により車両5が最初に到達する磁気マーカ10を併せて決定する。このように制御ユニット18が決定する磁気マーカ10は、車両が目的地点に到達する際、最初に検出されるべき最適な磁気マーカである。制御ユニット19は、ルートを特定する際に併せて決定した磁気マーカ10の識別情報を記憶する。詳しくは後述するが、この磁気マーカ10の識別情報は、下記のステップS105のリスタート制御からステップS107の通常走行制御に切り替えるための契機となる情報である。
そして、制御ユニット18は、3次元地図データ上でそのルートを表すルートデータを地図DB18Tから読み出し(S104)、対応するルートに沿って車両5を走行させるように制御を開始する。
制御ユニット18は、まず、測位ユニット16により測位された車両位置に基づく自動走行により車両5を走行させるリスタート制御(図9を参照して後述する。)を実行する(S105)。このリスタート制御は、磁気マーカ10を前提としない制御であり、磁気マーカ10を検出できるまでの再始動期間において実行される(S106:No→S105)。
上記のごとく目的地点に至るルートを特定する際に併せて決定された磁気マーカ10を、リスタート制御による車両5の走行中に検出できた場合(S106:Yes)、すなわち、上記のごとく制御ユニット18が記憶した磁気マーカ10の識別情報と一致するタグIDを、対応するRFIDタグ15から取得できた場合、制御ユニット18は、車両5に適用する制御を、上記ステップS105のリスタート制御からステップS107の通常走行制御に切り替える。通常走行制御は、幹線道路61など、磁気マーカ10が配設された道路向けの制御である。この通常走行制御は、磁気マーカ10が連続的に検出されることを前提としている。なお、通常走行制御の内容について、図11~図13を参照して後述する。
制御ユニット18は、出発地点から車両5が移動を開始して最初に磁気マーカ10を検出した後、目的地点に到着するまでの通常走行期間において、通常走行制御を実行する(S108:No→S107)。目的地点に到着すると、制御ユニット18は、車両5のイグニッションのオフ状態への切り替え(IGオフ)に応じて処理を終了させる(S109:Yes)。なお、IGオフの際、制御ユニット18では、車両位置、及び車両5の向き(絶対方位)を表す車両方位が記憶領域に格納(保存、記憶、記録)される。
なお、例えば幹線道路61(図2)から分岐し、目的地点に至る生活道路62(図2参照。)に進入した後では、磁気マーカ10を継続的に検出できなくなる可能性がある。この場合には、制御ユニット18は、最後に検出された磁気マーカ10を基準とする慣性航法により車両5を自動走行させる(自動走行制御)。詳しくは後述するが、制御ユニット18によるこの自動走行制御は、通常走行制御の一環として実行される。
(3.2)リスタート制御
リスタート制御(図8、図9)は、上記のごとく、車両5のイグニッションがオン状態に切り替えられた後、磁気マーカ10を検出できるまでの制御である。このリスタート制御は、磁気マーカ10を前提とせず、車両5を自律的に走行させるための制御である。リスタート制御が適用される状況としては、例えば、図10のごとく、自宅622に駐車した車両5が移動を開始した後、矢印R1に沿って移動し、磁気マーカ10が配設された幹線道路61に進入するまでの状況が想定される。なお、幹線道路61に進入した後は、図11を参照して詳しく説明する通常走行制御に切り替わる。なお、矢印R1は、上述の基本処理におけるステップS103で決定された制御対象のルートの一部である。
図9のリスタート制御では、制御ユニット18は、まず、測位ユニット16による測位データを取得する(S201)。制御ユニット18は、この測位データを利用して、車両位置及び車両方位を特定する(S202)。上記のごとく、測位ユニット16は、絶対位置を表す位置データを出力するGPSユニット、角速度及び加速度を出力する慣性計測ユニット等を含んでいる。
制御ユニット18は、GPSユニットが測位可能な状況である場合、GPSユニットによる位置データを利用し、上記のステップS103で設定されたルート上の車両位置を特定する。また、制御ユニット18は、3次元地図が表す車両位置周辺の3次元構造に対して、車両5が備える画像センサ19及びミリ波レーダ17によって特定される周囲の3次元構造を照合する。制御ユニット18は、この照合により、車両位置の精度を高めると共に、車両5の向きを表す車両方位を特定する。
なお、制御ユニット18は、リスタート制御による車両5の走行中に、衛星電波を受信できない等、GPSが利用不可能な状況に陥った場合、慣性航法により車両位置および車両方位を特定する。制御ユニット18は、車両位置及び車両方位を特定できた直近の時点を基準とし、その後の車両5の走行による相対位置を推定する。そして、基準の時点における車両位置に、推定した相対位置を足し合わせることで、最新の車両位置を特定する。なお、車両5の相対位置は、慣性計測ユニットが計測した加速度及び角速度の履歴に基づいて求められる。
また、制御ユニット18は、上記の基準の時点の後、慣性計測ユニットによる角速度の計測履歴を利用して回頭角を推定する。具体的には、角速度の積分によりヨー角の変位量である回頭角を求めることができる。制御ユニット18は、基準の時点における車両方位に、推定した回頭角(ヨー角の変位量)を足し合わせることで、最新の車両方位を特定する。このとき、画像センサ19及びミリ波レーダ17などのセンサを用いて周囲の3次元構造を把握し、3次元地図が表す3次元構造と照合することで、車両位置および車両方位の精度を高めることが可能である。なお、センサを利用して把握される周囲の3次元構造と、3次元地図が表す3次元構造と、の照合による車両位置あるいは車両方位の推定を主としても良い。
制御ユニット18は、上記のステップS104で読み出したルートデータに対して、上記のステップS202で特定した車両位置及び車両方位を組み合わせることで、ルート上の車両5の位置及び向きを特定する。これにより制御ユニット18は、車両5の前方を含む周囲の3次元構造を特定し、ルートに沿って移動するための車両5の進路の方向を特定する(S203)。
制御ユニット18は、このステップS203で特定した進路の方向に向かって走行できるように車両5を制御する(S204)。この制御中では、ミリ波レーダ17や画像センサ19による検出データ等が随時、制御ユニット18に取り込まれ、安全を確保しながら車両5が制御される。例えば、ミリ波レーダ17によれば、先行車両や対向車両等の周囲の車両や、ガードレールや、自転車や、歩行者などを検出可能である。画像センサ19によれば、標識や横断歩道などの道路標示を検出可能であると共に、信号の状態を認識可能である。
図9のリスタート制御は、図8の基本処理のフロー図を参照して上述した通り、磁気マーカ10が検出されるまで継続される(図8中のS106:No→S105)。磁気マーカ10が検出されたとき、リスタート制御(図9)から通常走行制御(図11)に切り替わる(図8中のS106:Yes→S107)。
(3.3)通常走行制御
制御ユニット18は、図11の通常走行制御の実行中では、磁気マーカ10が検出されたか否かに応じて車両位置等の特定方法を切り替える(S301)。磁気マーカ10が検出された場合(S301:検出有)、制御ユニット18は、その磁気マーカ10に保持されたRFIDタグ15からタグID(マーカ情報)を取得する(S312)。制御ユニット18は、取得したタグIDを利用してマーカDB18Mを参照し、検出した磁気マーカ10の位置(敷設位置)等を特定する。そして、制御ユニット18は、検出した磁気マーカ10の位置に基づいて車両位置を特定する(S313)。具体的には、制御ユニット18は、磁気マーカ10の敷設位置を基準として、磁気マーカ10に対する車両5の横ずれ量の分だけずらした位置を車両位置として特定する。
一方、隣り合う磁気マーカ10の中間に車両5が位置しており、磁気マーカ10を検出できないときには(S301:検出無)、制御ユニット18は、直近で検出された磁気マーカ10の敷設位置に基づいて特定された車両位置(図12中の△印の位置)を基準位置とし、慣性航法により車両5の相対位置を推定する(S302)。具体的には、制御ユニット18は、慣性計測ユニットによる角速度、加速度に基づいて相対位置等を推定する。そして、制御ユニット18は、図12に例示するように、ステップS302で推定した相対位置の分だけ基準位置から移動させた×印の位置を車両位置として特定する(S313)。なお、同図では、この相対位置を表すベクトルの一例を矢印で示している。
制御ユニット18は、車両位置を特定すると、図13において破線で示す制御目標のルートを基準として、自車位置の偏差ΔDを算出する。そして制御ユニット18は、この偏差ΔDに基づいて進路の方向を演算により求める(S314)。制御ユニット18は、このステップS314で求められた進路の方向に向けて車両5を走行させるように制御する(S315)。なお、上記のステップS204と同様、通常走行制御の実行中では、ミリ波レーダ17や画像センサ19による検出データ等が随時、制御ユニット18に取り込まれ、安全を確保しながら車両5が制御される。
なお、目的地点が所在する地域60A(図2参照。)において、磁気マーカ10が配設されていない生活道路62に面して目的地点が位置している場合、図9のリスタート制御と同様の慣性航法による自動走行制御が必要になる場合がある。この場合、制御ユニット18は、ステップS301:検出無→S302の流れで慣性航法により車両位置及び車両方位を特定する(S313)。これにより制御ユニット18は、車両5の前方を含めて周囲の3次元構造を特定し、ルートに沿って移動するための車両5の進路の方向を求める(S314)。
ここで、磁気マーカ10が配設された幹線道路61と、生活道路62など磁気マーカ10が配設されていない道路と、の制御の違いは、磁気マーカ10に対する車両5の横ずれ量を所定の値に近づけるラテラル制御の有無にある。磁気マーカ10が配設されていない道路では、画像処理等による車線認識や、GPSユニットが計測する車両位置や、慣性計測ユニットの計測値に基づく車両方位(ヨー角)等が参照され、操舵角の制御目標が決定される。一方、磁気マーカ10が配設された道路では、上記に加えて、磁気マーカ10に対する横ずれ量を利用して操舵角の制御目標が決定される。
以上の通り、本例の制御方法は、磁気マーカ10が配設された道路(走路)を、磁気センサCnを備える車両5が走行するための制御方法である。この制御方法では、車両5の走行を制御する機能が停止された駐車期間を経てその機能が再始動された後、車両5が移動して最初に磁気マーカ10を検出するまでの再始動期間と、磁気マーカ10を検出した後の通常走行期間とで、制御が切り替わる。
再始動期間では、駐車期間に後続する再始動期間において測位された位置、に基づいて車両位置を特定して車両5を走行させるリスタート制御が実行される。通常走行期間では、検出された磁気マーカ10の位置に基づいて車両位置を特定して車両5を走行させる通常走行制御が実行される。
本例の制御では、駐車期間と通常走行期間との間に、リスタート制御が適用される再始動期間が設定される。この再始動期間における車両5の制御は、磁気マーカ10の検出を前提としない制御である。通常走行期間と再始動期間とで制御を切り替えれば、駐車期間を経て車両5が移動を開始してから磁気マーカ10を検出するまでの自動走行が可能になる。このような制御方法によれば、車両5の走行を制御可能な領域を拡大でき、汎用性を向上できる。本例の制御方法によれば、道路に配設された磁気マーカ10を利用して高レベルの自動運転を実現可能である。
なお、本例では、上記のステップS101(図8)でのIGオンへの切替に応じてリスタート制御が開始されたとき、直ちにステップS201(図9)が実行される構成を説明した。これに代えて、図14のごとく、リスタート制御が開始された直後で、車両位置の特定前であるときには(S210:YES)、まず、GPSによる測位精度を評価し(S211)、GPSの測位データに基づいて車両位置を特定するか否かを決定することも良い。
ここで、GPSによる測位精度の評価としては、例えば、衛星電波を受信可能な衛星数を利用する評価がある。例えば、衛星電波を受信可能な衛星数に基づいて期待できるGPSによる測位精度と、直近のIGオフの際、すなわち直前の駐車期間への移行時に記憶領域に格納された車両位置の推定精度と、を比較する評価が考えられる。例えば、GPSによる測位精度の指標としては、誤差円の大きさがある。例えば、IGオフ時の車両位置の精度の指標としては、慣性航法による車両位置の推定誤差の範囲がある。
例えば、GPSによる誤差円の大きさが、IGオフ時の車両位置の推定誤差の範囲よりも小さく、GPSによる測位精度が十分である場合(S211:OK)、GPSによる測位データに基づき車両位置を特定すると良い(S212)。すなわち、再始動期間の開始時に、GPSにより測位された車両位置の精度と、直前の駐車期間への移行時の車両位置の推定精度と、の比較を実行し、GPSによる測位精度の方が高い場合には、GPSにより測位された車両位置を、再始動期間の開始時の車両位置として特定すると良い。一方、例えば、GPSによる誤差円の大きさが、IGオフ時の車両位置の推定誤差の範囲よりも大きく、GPSによる測位精度が十分でない場合(S211:NG)、IGオフ時に記録された車両位置を読み出すと良い(S222)。すなわち、再始動期間の開始時に、GPSにより測位された車両位置の精度と、直前の駐車期間への移行時の車両位置の推定精度と、の比較を実行し、直前の駐車期間への移行時の車両位置の推定精度の方が高い場合には、直前の駐車期間への移行時の車両位置の推定精度を、再始動期間の開始時の車両位置として特定すると良い。なお、ステップS212あるいはS222にて車両位置が特定された後の処理については、図9を参照して説明した処理と同様である。
このように、IGオンへの切替後(図8中のステップS101:YESに相当。)、車両位置が未特定であるときには(S210:YES)、GPSの測位精度を評価した結果がOKかNGかを判断し(S211)、その判断結果に応じてGPSユニットによる測位データに基づいて車両位置を特定するか(S212)、IGオフ時の車両位置を読み出すか(S222)、を切り替えることも良い。当然ながら、地下の駐車場など、衛星電波を受信できないなどGPSを利用出来ない状況の場合には、ステップS211においてNGと判断し、IGオフ時の車両位置を読み出すと良い(S222)。
本例では、磁気マーカ10の上面に、シート状のRFIDタグ15を取り付けた構成を例示しているが、磁気マーカ10とRFIDタグ15とが一体をなしている構成は必須ではない。磁気マーカ10とRFIDタグ15とが同じ位置に配置されていれば良く、磁気マーカ10の鉛直方向上方、あるいは下方にRFIDタグ15が配置されていても良い。
なお、本例の磁気マーカ10は、RFIDタグ15が一体化されたマーカである。これに代えて、RFIDタグ15が付設されない磁気マーカを含めても良い。例えば、交差点に位置する磁気マーカ10にRFIDタグ15を設ける一方、それ以外の箇所にはタグなしの磁気マーカを配置することも良い。あるいは、5か所毎、10か所毎等の間隔で、RFIDタグ15を備える磁気マーカ10を配置する一方、他をタグなしの磁気マーカとしても良い。
なお、本例では、磁気マーカ10が配設された幹線道路61を例示する一方、地域60内を移動するための生活道路62には磁気マーカ10が配設されていない構成を例示している。これに代えて、全ての道路に磁気マーカ10を配設することも良い。この場合には、道路に面する駐車場から出発した後、道路に進入して最初に磁気マーカを検出するまでの期間、あるいは路肩に駐車した車両の走行を再開してから最初に磁気マーカを検出するまでの期間、などが再始動期間となる。
また、少なくともいずれかの磁気マーカ10に対して、補助的な磁気マーカを付設することも良い。例えば、磁気マーカ10を基準として、道路の方向に沿うように補助的な磁気マーカを配置することも良い。磁気マーカ10に対する横ずれ量と、補助的な磁気マーカに対する横ずれ量と、がわかれば、磁気マーカ10と補助的な磁気マーカとを結ぶ方向である道路の方向と、車両の進行方向と、のなす角を演算等により求めることができる。磁気マーカ10と補助的な磁気マーカとの間隔は、車両側の操舵量の変化が少ないと期待できる間隔が良い。例えば、0.2~3.0m程度の間隔、より好ましくは約1.0mの間隔とすると良い。法律等によって定められた道路の制限速度に応じて、間隔を変更することも良い。例えば、制限速度が高い道路では、1.5~3.0mの間隔を設定し、制限速度が時速10~20km程度の道路では0.2~0.4mの間隔を設定することも良い。
(実施例2)
本例は実施例1の車両5の制御方法に基づき、リスタート制御の内容を変更した例である。この内容について、図15を参照しながら説明する。同図は、実施例1の説明にて参照された図9の置き換え図である。本例のリスタート制御は、GPSによる測位を主体とする実施例1のリスタート制御に代わるものであり、自律航法(デッドレコニング)による測位を主体としている。
本例の制御ユニット(図6、図7中の符号18に相当。)は、測位ユニット(図6、図7中の符号16に相当。)が出力する角速度(車両のヨー角の変化速度)に加えて、車輪の回転に応じて出力される車速パルスを取り込み可能である。制御ユニットは、角速度や車速パルスを利用し、自律航法による測位を実行可能である。
本例のリスタート制御(図15)は、IGオンへの切替(図8中のステップS101:YESに相当。)に応じて、制御ユニットが実行する制御である。リスタート制御の開始時には、制御ユニットは、まず、車両位置の特定前か否か、すなわちリスタート制御の開始直後にて車両位置が未特定の状態であるか否か、を判断する(S320)。制御ユニットは、車両位置の特定前であれば(S320:YES)、直近のIGオフ時、すなわち車両が駐車された時に記録した車両位置及び車両方位を読み出す(S321)。
制御ユニットは、上記のように車両位置が特定された後は(S320:NO)、測位ユニット16による角速度や車速パルス等を取得し(S322)、自律航法により車両位置及び車両方位を特定する(S202)。具体的には、制御ユニット18は、車両位置及び車両方位を特定できた直近の時点の後の角速度の計測履歴や車速パルスの出力履歴等に基づき、車両5の相対位置あるいは相対方位を推定する。そして、制御ユニットは、基準の時点における車両方位に対して、推定した相対方位を足し合わせることで、最新の車両方位を特定する。さらに、制御ユニットは、基準の時点における車両位置を基準として、最新の車両方位に沿って、推定した相対位置の分だけ移動した位置を、最新の車両位置として特定する。なお、上記のステップS202において車両位置及び車両方位が特定された後の処理については、実施例1において図9を参照して説明した処理と同様である。
自律航法による測位の方法としては、上記の角速度や車速パルスを利用する方法に代えて、あるいは加えて、時間的に連続して取得された路面画像から変位を検出して車両位置や車両方位を推定する方法を採用することも良い。この方法は、十分に短い時間間隔で撮影された路面画像中の模様等の動きを、パターンマッチング等の画像的な手法により特定し、模様等の動きに基づいて車両の変位を推定する方法である。
この方法は、例えば光学式マウスにおける動きの検出方法に似通っている。光学式マウスでは、並進の動きのみが検出対象となっているが、並進の動きに加えて、回転の動きを検出することも良い。路面の撮像画像である路面画像から回転の動きを検出できれば、路面画像に基づく自律航法によって車両方位の推定が可能になる。路面画像は、例えば、車両に搭載された撮像カメラを用い、車両の直下の路面を撮影した撮像画像であると良い。例えば、路面画像を撮像する際、赤外線やレーザ光など特定波長の光を照射する一方、路面画像の撮影の際には、その特定波長を透過するフィルタレンズを利用することも良い。例えば、車両の変位を路面画像に基づいて推定する一方、車両方位の変動量を前方画像に基づいて推定することも良い。時間的に連続して取得された前方画像に含まれる例えば、電柱などの横方向の動きを検出すれば、車両方位の変動量を推定可能である。前方画像は、前方を撮影可能なように車両に搭載された撮像カメラを用いて取得できる
なお、その他の構成及び作用効果については、実施例1と同様である。
以上、実施例のごとく本発明の具体例を詳細に説明したが、これらの具体例は、特許請求の範囲に包含される技術の一例を開示しているにすぎない。言うまでもなく、具体例の構成や数値等によって、特許請求の範囲が限定的に解釈されるべきではない。特許請求の範囲は、公知技術や当業者の知識等を利用して前記具体例を多様に変形、変更あるいは適宜組み合わせた技術を包含している。
1 車両システム
10 磁気マーカ
14 タグリーダユニット
15 RFIDタグ(無線タグ)
16 測位ユニット
17 ミリ波レーダ
18 制御ユニット(回路)
19 画像センサ
18M マーカデータベース(マーカDB、データベース)
18T 地図データベース(地図DB)
21 センサアレイ
212 検出処理回路
5 車両
60 地域
61 幹線道路
62 生活道路

Claims (12)

  1. 周辺に磁気を作用する磁気マーカが配設された走路を含む走路を、磁気センサを備える車両が走行するための制御方法であって、
    車両の走行を制御する機能が停止された駐車期間を経て当該機能が再始動された後、車両が移動して最初に磁気マーカを検出するまでの再始動期間と、該再始動期間を経て車両が磁気マーカを検出した後の通常走行期間と、で制御を切り替え、
    前記機能の停止に応じて前記駐車期間へ移行する際、当該駐車期間への移行時の車両の位置を記憶し、
    前記再始動期間の開始時に、直前の駐車期間への移行時に記憶された車両の位置を読み出し、
    前記再始動期間では、当該再始動期間の開始時に読み出した車両の位置に基づいて車両の位置を特定して車両を走行させる制御を実行可能である一方、
    前記通常走行期間では、検出された磁気マーカの位置に基づいて車両の位置を特定して車両を走行させる制御を実行する制御方法。
  2. 周辺に磁気を作用する磁気マーカが配設された走路を含む走路を、磁気センサを備える車両が走行するための制御方法であって、
    車両の走行を制御する機能が停止された駐車期間を経て当該機能が再始動された後、車両が移動して最初に磁気マーカを検出するまでの再始動期間と、
    該再始動期間を経て車両が磁気マーカを検出した後の通常走行期間とで、制御を切り替え、
    前記再始動期間では、直前の駐車期間への移行時の車両の位置、あるいは当該再始動期間において測位された位置、に基づいて車両の位置を特定して車両を走行させる制御を実行する一方、
    前記通常走行期間では、検出された磁気マーカの位置に基づいて車両の位置を特定して車両を走行させる制御を実行し、
    前記再始動期間の開始時に、目的地点に至るルートを演算により特定し、車両が目的地点に到達する際に最初に検出されるべき磁気マーカを決定すると共に、当該磁気マーカの識別情報を記憶し、
    前記再始動期間の開始時に記憶された識別情報の磁気マーカが検出されたとき、当該磁気マーカの検出を契機として、前記再始動期間から前記通常走行期間への切り替えを実行し、
    前記車両の走行を制御する機能の停止に応じて前記駐車期間へ移行する際、当該駐車期間への移行に応じて記憶された車両の位置の位置的な精度を表す情報を記憶し、
    前記再始動期間の開始時に、直前の駐車期間への移行時に記憶された位置的な精度を表す情報を読み出し、当該読み出した情報が表す位置的な精度と、衛星測位システムにより測位された車両の位置の精度と、の比較を実行し、精度が高い方の車両の位置を、当該再始動期間の開始時の車両の位置として特定する制御方法。
  3. 請求項において、前記車両の走行を制御する機能の停止に応じて前記駐車期間へ移行する際、当該駐車期間への移行に応じて記憶された車両の位置の位置的な精度を表す情報を記憶し、
    前記再始動期間の開始時に、直前の駐車期間への移行時に記憶された位置的な精度を表す情報を読み出し、当該読み出した情報が表す位置的な精度と、衛星測位システムにより測位された車両の位置の精度と、の比較を実行し、精度が高い方の車両の位置を、当該再始動期間の開始時の車両の位置として特定する制御方法。
  4. 請求項1~3のいずれか1項において、前記再始動期間において、車両に搭載されたセンサを用いて周囲の3次元構造を把握し、3次元地図が表す3次元構造と照合することにより車両の位置を特定する制御方法。
  5. 請求項1~4のいずれか1項において、車両の走行による変位量を推定可能であって、基準となる位置と、当該基準となる位置を通過後の走行について推定された変位量と、に基づいて、車両の位置を特定可能である制御方法。
  6. 請求項5において、車両に搭載された撮像カメラを用いて路面の撮像画像を時間的に連続して取得し、取得時点の異なる路面の撮像画像を比較することにより前記変位量を推定する制御方法。
  7. 請求項1~6のいずれか1項において、前記磁気マーカの敷設位置を表す位置情報のデータベースが設けられ、
    車両によっていずれかの磁気マーカが検出されたとき、前記データベースの記憶領域を参照して当該磁気マーカの位置情報を取得し、当該磁気マーカの敷設位置を基準として車両の位置を特定する制御方法。
  8. 請求項1~7のいずれか1項において、いずれかの磁気マーカには、該いずれかの磁気マーカの敷設位置を特定可能な情報を無線出力する無線タグが付設されており、
    車両によって前記いずれかの磁気マーカが検出されたとき、対応する無線タグが出力する情報によって特定される当該いずれかの磁気マーカの敷設位置を基準として車両の位置を特定する制御方法。
  9. 請求項1~8のいずれか1項において、前記磁気マーカが配設された走路では、車両の進行方向を特定するための補助的な磁気マーカが少なくともいずれかの磁気マーカに隣り合わせて配置されており、
    当該補助的な磁気マーカと当該いずれかの磁気マーカとを結ぶ方向に対する車両の進行方向のなす角を、演算により求める制御方法。
  10. 周辺に磁気を作用する磁気マーカが配設された走路を含む走路を、磁気センサを備える車両が走行するための制御システムであって、
    車両の走行を制御する機能が停止されている駐車期間へ移行する際に、車両の位置を記憶する回路と、
    車両の走行を制御する機能が停止された駐車期間を経て当該機能が再始動されたとき、当該駐車期間への移行時に記憶された車両の位置を読み出す回路と、
    前記機能が再始動された後、車両が移動して最初に磁気マーカを検出するまでの再始動期間において、前記機能の再始動時に読み出された車両の位置に基づいて車両の位置を特定して車両を走行させる制御を実行可能な回路と、
    前記再始動期間を経て車両が最初に磁気マーカを検出した後の通常走行期間において、検出されたいずれかの磁気マーカの位置に基づいて車両の位置を特定して車両を走行させる制御を実行する回路と、
    前記再始動期間から前記通常走行期間へ移行したときに制御の切替を実行する回路と、を備える制御システム。
  11. 周辺に磁気を作用する磁気マーカが配設された走路を含む走路を、磁気センサを備える車両が走行するための制御システムであって、
    車両の走行を制御する機能が停止された駐車期間を経て当該機能が再始動された後、車両が移動して最初に磁気マーカを検出するまでの再始動期間において、直前の駐車期間への移行時の車両の位置、あるいは当該再始動期間において測位された位置、に基づいて車両の位置を特定して車両を走行させる制御を実行する回路と、
    前記再始動期間を経て車両が最初に磁気マーカを検出した後の通常走行期間において、検出されたいずれかの磁気マーカの位置に基づいて車両の位置を特定して車両を走行させる制御を実行する回路と、
    前記再始動期間から前記通常走行期間へ移行したときに制御の切替を実行する回路と、
    前記機能の再始動時に、目的地点に至るルートを演算により特定し、車両が目的地点に到達する際に最初に検出されるべき磁気マーカを決定する回路と、
    前記機能の再始動時に決定された磁気マーカの識別情報を記憶する回路と、
    前記車両の走行を制御する機能の停止に応じて前記駐車期間へ移行する際、当該駐車期間への移行時に記憶した車両の位置の位置的な精度を表す情報を記憶する回路と、
    前記機能の再始動時に、直前の駐車期間への移行時に記憶された位置的な精度を表す情報を読み出す回路と、
    当該読み出す回路が読み出した情報が表す位置的な精度と、衛星測位システムにより測位された車両の位置の精度と、の比較を実行し、精度が高い方の車両の位置を、当該再始動期間の開始時の車両の位置として特定する回路と、を備え、
    前記制御の切替を実行する回路は、前記機能の再始動時に記憶された識別情報の磁気マーカが検出されたとき、当該磁気マーカの検出を契機として前記再始動期間から前記通常走行期間への切り替えを実行するように構成されている制御システム。
  12. 請求項10において、前記車両の走行を制御する機能の停止に応じて前記駐車期間へ移行する際、当該駐車期間への移行時に記憶した車両の位置の位置的な精度を表す情報を記憶する回路と、
    前記機能の再始動時に、直前の駐車期間への移行時に記憶された位置的な精度を表す情報を読み出す回路と、
    当該読み出す回路が読み出した情報が表す位置的な精度と、衛星測位システムにより測位された車両の位置の精度と、の比較を実行し、精度が高い方の車両の位置を、当該再始動期間の開始時の車両の位置として特定する回路と、を備える制御システム。
JP2022575657A 2021-01-18 2022-01-14 制御方法及び制御システム Active JP7795112B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2021005587 2021-01-18
JP2021005587 2021-01-18
PCT/JP2022/001230 WO2022154103A1 (ja) 2021-01-18 2022-01-14 制御方法及び制御システム

Publications (3)

Publication Number Publication Date
JPWO2022154103A1 JPWO2022154103A1 (ja) 2022-07-21
JPWO2022154103A5 JPWO2022154103A5 (ja) 2023-12-13
JP7795112B2 true JP7795112B2 (ja) 2026-01-07

Family

ID=82448495

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2022575657A Active JP7795112B2 (ja) 2021-01-18 2022-01-14 制御方法及び制御システム

Country Status (6)

Country Link
US (1) US20240400046A1 (ja)
EP (1) EP4280012A4 (ja)
JP (1) JP7795112B2 (ja)
KR (1) KR102937181B1 (ja)
CN (1) CN116783567A (ja)
WO (1) WO2022154103A1 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2626676A (en) * 2024-02-08 2024-07-31 Chen Hongming A system and method for guiding navigation of automated guided vehicles (AGVS)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008002992A (ja) 2006-06-23 2008-01-10 Toyota Motor Corp 姿勢角検出装置と姿勢角検出方法
JP2013184491A (ja) 2012-03-06 2013-09-19 Nissan Motor Co Ltd 車両走行支援装置
WO2016038931A1 (ja) 2014-09-11 2016-03-17 本田技研工業株式会社 運転支援装置
JP2017140981A (ja) 2016-02-12 2017-08-17 株式会社デンソー 車両用装置
JP2019049500A (ja) 2017-09-12 2019-03-28 愛知製鋼株式会社 位置捕捉システム及び位置捕捉方法
WO2019097755A1 (ja) 2017-11-17 2019-05-23 アイシン・エィ・ダブリュ株式会社 表示装置及びコンピュータプログラム
WO2019235188A1 (ja) 2018-06-04 2019-12-12 愛知製鋼株式会社 ジャイロセンサの較正方法
JP2020098566A (ja) 2018-09-28 2020-06-25 先進モビリティ株式会社 自動運転システム
WO2020175438A1 (ja) 2019-02-27 2020-09-03 愛知製鋼株式会社 点群データの取得方法及び点群データ取得システム

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3095189B2 (ja) * 1991-09-10 2000-10-03 株式会社日立製作所 ナビゲーション装置
JP3550916B2 (ja) * 1996-11-12 2004-08-04 トヨタ自動車株式会社 車両用盗難検出装置
JP2002334400A (ja) 2001-05-10 2002-11-22 Mitsubishi Motors Corp 運転支援装置
US20130060461A1 (en) * 2011-09-07 2013-03-07 INRO Technologies Limited Method and apparatus for using pre-positioned objects to localize an industrial vehicle
JP6067315B2 (ja) * 2012-10-12 2017-01-25 富士通テン株式会社 車両制御装置、及び、車両制御方法
JP6156067B2 (ja) * 2013-11-01 2017-07-05 富士通株式会社 移動量推定装置及び移動量推定方法
US9796400B2 (en) * 2013-11-27 2017-10-24 Solfice Research, Inc. Real time machine vision and point-cloud analysis for remote sensing and vehicle control
US9964648B2 (en) * 2015-06-16 2018-05-08 Insero LLC Guidiance system and method based on dead reckoning positioning and heading augmented by GNSS and predictive path selection
EP3467437B1 (en) * 2016-06-03 2022-03-02 Aichi Steel Corporation Position capture method and system
JP7155596B2 (ja) 2018-05-02 2022-10-19 愛知製鋼株式会社 自動駐車システム
US10488202B1 (en) * 2019-01-08 2019-11-26 Adam Benjamin Tannenbaum System and method of use for self-contained vehicular navigation system

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008002992A (ja) 2006-06-23 2008-01-10 Toyota Motor Corp 姿勢角検出装置と姿勢角検出方法
JP2013184491A (ja) 2012-03-06 2013-09-19 Nissan Motor Co Ltd 車両走行支援装置
WO2016038931A1 (ja) 2014-09-11 2016-03-17 本田技研工業株式会社 運転支援装置
JP2017140981A (ja) 2016-02-12 2017-08-17 株式会社デンソー 車両用装置
JP2019049500A (ja) 2017-09-12 2019-03-28 愛知製鋼株式会社 位置捕捉システム及び位置捕捉方法
WO2019097755A1 (ja) 2017-11-17 2019-05-23 アイシン・エィ・ダブリュ株式会社 表示装置及びコンピュータプログラム
WO2019235188A1 (ja) 2018-06-04 2019-12-12 愛知製鋼株式会社 ジャイロセンサの較正方法
JP2020098566A (ja) 2018-09-28 2020-06-25 先進モビリティ株式会社 自動運転システム
WO2020175438A1 (ja) 2019-02-27 2020-09-03 愛知製鋼株式会社 点群データの取得方法及び点群データ取得システム

Also Published As

Publication number Publication date
KR20230118642A (ko) 2023-08-11
US20240400046A1 (en) 2024-12-05
JPWO2022154103A1 (ja) 2022-07-21
EP4280012A1 (en) 2023-11-22
WO2022154103A1 (ja) 2022-07-21
CN116783567A (zh) 2023-09-19
KR102937181B1 (ko) 2026-03-09
EP4280012A4 (en) 2024-12-04

Similar Documents

Publication Publication Date Title
CN112041909B (zh) 自动驻车系统及自动驻车方法
CN110419067B (zh) 标识器系统
JP6342822B2 (ja) 自動運転システム、自動運転の方法及びコンピューティング装置
CN113646221B (zh) 移动体的行为预测方法、行为预测装置以及车辆
CN113173181A (zh) 自动驾驶装置
CN108020229B (zh) 用于定位车辆的方法
WO2007132858A1 (ja) 支援制御装置
WO2007132860A1 (ja) 対象物認識装置
JP7463997B2 (ja) 車両制御装置、車両制御方法及び車両制御用コンピュータプログラム
JP7534651B2 (ja) 点群データの取得方法及び点群データ取得システム
RU2763331C1 (ru) Способ отображения плана движения и устройство отображения плана движения
CN108001457A (zh) 自动车辆传感器控制系统
CN114792475B (zh) 自动停车系统
CN110567465B (zh) 使用精度规范定位车辆的系统和方法
JP2018169301A (ja) マーカシステム
US12246746B2 (en) Operation system and operation system control method
JP7795112B2 (ja) 制御方法及び制御システム
JP2019067353A (ja) 車両用システム及びタグ通信方法
Khosyi'in et al. Review and design of gps-rfid localization for autonomous vehicle navigation
WO2019065176A1 (ja) 車両用システム及びタグ通信方法
WO2024063078A1 (ja) 3次元地図データの生成方法及び生成システム
US12240498B2 (en) Vehicle control system, vehicle control method, and storage medium
CN116892919A (zh) 地图生成装置
WO2020138467A1 (ja) 走行路診断システム
JP7817594B2 (ja) 車両用システム

Legal Events

Date Code Title Description
A529 Written submission of copy of amendment under article 34 pct

Free format text: JAPANESE INTERMEDIATE CODE: A5211

Effective date: 20230706

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20240920

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20250812

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20250912

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: 20251118

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20251201

R150 Certificate of patent or registration of utility model

Ref document number: 7795112

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150