JP5949734B2 - 異常判定システム、及びその判定方法 - Google Patents

異常判定システム、及びその判定方法 Download PDF

Info

Publication number
JP5949734B2
JP5949734B2 JP2013247526A JP2013247526A JP5949734B2 JP 5949734 B2 JP5949734 B2 JP 5949734B2 JP 2013247526 A JP2013247526 A JP 2013247526A JP 2013247526 A JP2013247526 A JP 2013247526A JP 5949734 B2 JP5949734 B2 JP 5949734B2
Authority
JP
Japan
Prior art keywords
distance
mobile body
autonomous mobile
road surface
measured
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
JP2013247526A
Other languages
English (en)
Other versions
JP2015106253A (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.)
Toyota Motor Corp
Original Assignee
Toyota Motor 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 Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2013247526A priority Critical patent/JP5949734B2/ja
Priority to US14/548,612 priority patent/US9540014B2/en
Priority to CN201410705919.0A priority patent/CN104677405B/zh
Publication of JP2015106253A publication Critical patent/JP2015106253A/ja
Application granted granted Critical
Publication of JP5949734B2 publication Critical patent/JP5949734B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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
    • 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
    • B60W40/06—Road conditions
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L53/00—Methods of charging batteries, specially adapted for electric vehicles; Charging stations or on-board charging equipment therefor; Exchange of energy storage elements in electric vehicles
    • B60L53/30—Constructional details of charging stations
    • B60L53/35—Means for automatic or assisted adjustment of the relative position of charging devices and vehicles
    • B60L53/36—Means for automatic or assisted adjustment of the relative position of charging devices and vehicles by positioning the vehicle
    • 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay
    • 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/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2260/00—Operating Modes
    • B60L2260/20—Drive modes; Transition between modes
    • B60L2260/32—Auto pilot mode
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/60—Other road transportation technologies with climate change mitigation effect
    • Y02T10/70—Energy storage systems for electromobility, e.g. batteries
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/60—Other road transportation technologies with climate change mitigation effect
    • Y02T10/7072—Electromobility specific charging systems or methods for batteries, ultracapacitors, supercapacitors or double-layer capacitors
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
    • Y02T90/10—Technologies relating to charging of electric vehicles
    • Y02T90/12—Electric charging stations
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
    • Y02T90/10—Technologies relating to charging of electric vehicles
    • Y02T90/14—Plug-in electric vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Electromagnetism (AREA)
  • Power Engineering (AREA)
  • Mathematical Physics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Road Repair (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Description

本発明は、自律移動体に設けられた距離計測手段の異常を判定する異常判定システム、及びその判定方法に関するものである。
距離計測手段により計測された路面までの距離が閾値を超えたときに段差などを検出し、停止あるいは回避動作することで、その段差などによる落下や転倒を防止する自律移動体が知られている（例えば、特許文献１参照）。
特開２０１２−１３０７８１号公報
ところで、距離計測手段が、例えば、段差があるにもかかわらず、水平路面の距離値を出力するなどの異常な距離値を出力することがある。したがって、自律移動体が確実に段差などを検出するためには、距離計測手段が正常に動作しているか否かを定期的に確認する必要が生じる。なお、ユーザが距離計測手段の点検を行う場合、その手間が掛かることとなる。
本発明は、このような問題点を解決するためになされたものであり、自律移動体が充電ステーションに戻ったときに距離計測手段の異常を自動的に確認できる異常判定システム、及びその判定方法を提供することを主たる目的とする。
上記目的を達成するための本発明の一態様は、進行方向の路面に向けられ、該路面までの距離を計測する少なくとも１つの距離計測手段を有する自律移動体と、前記自律移動体のバッテリに充電を行うための接続端子を有する充電手段と、を備える異常判定システムであって、前記自律移動体が前記充電ステーションの接続端子に接続され位置決めされたときに前記距離計測手段により計測される路面に段差部が設けられており、前記位置決め時に前記距離計測手段により計測された前記段差部までの距離が閾値以内であるか否かを判定する判定手段を備える、ことを特徴とする異常判定システムである。
この一態様において、前記段差部は、凹状部、凸状部、又は前記距離計測手段から出力される信号を反射する反射部であってもよい。
この一態様において、前記自律移動体は、複数の前記距離計測手段を備え、前記位置決め時に各距離計測手段により計測される路面に前記段差部が夫々形成されていてもよい。
この一態様において、前記段差部は、凹状部又は前記距離計測手段から出力される信号を反射する反射部であり、前記判定手段は、前記位置決め時に前記距離計測手段により計測された前記段差部までの距離が閾値を超えたときに、該距離計測手段の異常と判定してもよい。
上記目的を達成するための本発明の一態様は、進行方向の路面に向けられ、該路面までの距離を計測する少なくとも１つの距離計測手段を有する自律移動体と、前記自律移動体のバッテリに充電を行うための接続端子を有する充電手段と、を備える異常判定システムの判定方法であって、前記自律移動体が前記充電ステーションの接続端子に接続され位置決めされたときに前記距離計測手段により計測される路面に段差部が設けられており、 前記位置決め時に前記距離計測手段により前記段差部までの距離を計測するステップと、 前記計測された距離が閾値以内であるか否かを判定するステップと、を含むことを特徴とする異常判定システムの判定方法であってもよい。
本発明によれば、自律移動体が充電ステーションに戻ったときに距離計測手段の異常を自動的に確認できる異常判定システム、及びその判定方法を提供することを主たる目的とする。
実施の形態１に係る異常判定システムの概略的構成を示す構成図である。 実施の形態１に係る異常判定システムのシステム構成を示すブロック図である。 自律移動体が充電ステーションに位置決めされたときの距離センサにより計測される路面に凹状の段差を形成した図である。 実施の形態１に係る異常判定方法の処理フローを示すフローチャートである。 各ミラーを各距離センサにより計測される路面にコ字状に配置した図である。 各ミラーを各距離センサにより計測される路面に自律移動体の４方を囲うように配置した図である。 充電ステーションの前方で各距離センサにより計測される路面に１つのミラーを配置した図である。 ２つの距離センサにより検出された距離に基づいて段差や障害物を検出する自律移動体に適用した図である。 ２つの距離センサにより検出された距離に基づいて段差や障害物を検出する自律移動体に適用した図である。 自律移動体が所定位置に位置決めされたときの各距離センサにより計測される路面にミラーが配置された図である。
以下、図面を参照して本発明の実施の形態について説明する。図１は、本発明の実施の形態１に係る異常判定システムの概略的構成を示す構成図である。図２は、本実施の形態１に係る異常判定システムのシステム構成を示すブロック図である。本実施の形態１に係る異常判定システム１は、少なくとも１つの距離センサ２６を有する自律移動体２と、自律移動体２のバッテリ２５に充電を行うための接続端子３１を有する充電ステーション３と、を備えている。
自律移動体２は、移動体本体２１と、移動体本体２１に回転可能に設けられた車輪２３と、車輪２３を駆動するモータ２４と、モータ２４に電力を供給するバッテリ２５と、上記距離センサ２６と、距離センサ２６により計測された距離に基づいてモータ２４を制御する制御装置２７と、を備えている。なお、上記自律移動体２の構成は一例であり、これに限らず、任意の自律的に移動する移動体であってもよい。
距離センサ２６は、距離計測手段の一具体例であり、進行方向の路面に向けられ、路面までの距離を計測する。自律移動体２は、例えば、距離センサ２６により計測された路面までの距離が所定値を超えたときに段差を検出する。そして、自律移動体２は、検出した段差に基づいて、停止、あるいは段差を回避する動作を行う。
充電ステーション３は、充電手段の一具体例であり、水平方向に延びる接続端子３１を有している。自律移動体２は、定期的に（バッテリ２５の充電量が所定量以下になったとき、や所定時間毎など）充電ステーション３に戻るように構成されている。自律移動体２には、バッテリ２５に充電を行うための接続部２８が設けられている。自律移動体２はバッテリ２５に充電を行うときに、自律的に移動を行い接続部２８を充電ステーション３の接続端子３１に接続する。この充電ステーション３の接続端子３１により、自律移動体２は充電時に一定位置に位置決めされる。
ところで、距離センサが、例えば、段差があるにもかかわらず、通常の水平路面の距離値を出力するなどの異常な距離値を出力することがある。したがって、自律移動体が確実に段差などを検出するためには、距離センサが正常に動作しているか否かを定期的に確認する必要が生じる。
これに対し、本実施の形態１に係る異常判定システム１においては、自律移動体２が充電ステーション３の接続端子３１に接続され位置決めされたときに距離センサ２６により計測される路面に疑似的な段差部４が設けられている。さらに、自律移動体２の制御装置２７は、その位置決め時に距離センサ２６により計測された段差部４までの距離が閾値以内であるか否かを判定する判定部２７１を有している。
自律移動体２が充電のために充電ステーション３に接続され位置決めされた位置（自律移動体２の充電時）において、距離センサ２６は路面の段差部４までの距離を計測する。判定部２７１は、距離センサ２６により計測されたその距離が閾値以内であるか否かを判定することで、距離センサ２６の異常を確認する。
判定部２７１は、判定手段の一具体例であり、上記自律移動体２の充電時に、距離センサ２６により計測された段差部４の距離が予め設定された閾値を超えているとき、距離センサ２６の異常（一定値に張付く異常など）と判定する。
自律移動体２は充電ステーション３により位置決めされているため、距離センサ２６と段差部４との相対関係位置は一定となる。したがって、距離センサ２６により計測された段差部４までの距離と予め設定された閾値とを比較することで、その距離センサ２６が異常である否かを判定できる。このようにして、自律移動体２のバッテリ充電時に距離センサ２６の異常を自動的に確認できる。さらに、自律移動体２が定期的に行うバッテリ充電工程に、距離センサ２６の異常を確認する工程を含めることで、距離センサ２６の異常をより確実に検出でき、その信頼性を向上させることができる。
自律移動体２が充電ステーション３の接続端子３１に接続され位置決めされたときの距離センサ２６により計測される路面に、上記段差部４としてのミラー４が設けられている。ミラー４は、反射部の一具体例であり、距離センサ２６から出力される光信号を反射する。路面にミラー４を設置することで、距離センサ２６により計測される距離は、ミラーに反射され延びた反射光路分だけ増加させることができる。すなわち、実際の凹状の段差で生じる光路の増加分を、ミラー４の反射光路で疑似的に生じさせることができる。
例えば、図１に示す如く、距離センサ２６により計測される距離Ｌは、ＡＢ＋ＢＣとなり、ミラー４までの通常の距離ＡＢよりも延びた反射光路ＢＣ（＝ＢＣ′）分だけ増加する。この反射光路ＢＣが実際の凹状部の光路に相当する。このように、実際に凹状部を形成することなく、簡易にミラー４を設置するだけ、実際に凹状部を形成したときと同様の距離センサ２６の異常判定が可能となる。
なお、自律移動体２が充電ステーション３の接続端子３１に接続され位置決めされたときの距離センサ２６により計測される路面に、凹状の段差を形成してもよい（図３）。
判定部２７１は、例えば、演算処理等と行うＣＰＵ（Central Processing Unit）、ＣＰＵによって実行される演算プログラム等が記憶されたＲＯＭ（Read Only Memory）やＲＡＭ（Random Access Memory）からなるメモリ、外部と信号の入出力を行うインターフェイス部（Ｉ／Ｆ）、などからなるマイクロコンピュータを中心にして、ハードウェア構成されている。ＣＰＵ、メモリ、及びインターフェイス部は、データバスなどを介して相互に接続されている。
図４は、本実施の形態１に係る異常判定方法の処理フローを示すフローチャートである。自律移動体２は、例えば、移動を開始するトリガーとなる移動開始コマンドを受信すると、充電ステーション３の接続端子３１に接続しているか否かを判定する（ステップＳ１０１）。
自律移動体２は、充電ステーション３の接続端子３１に接続していないと判定すると（ステップＳ１０１のＮＯ）、本処理を終了する。自律移動体２は、充電ステーション３の接続端子３１に接続していると判定すると（ステップＳ１０１のＹＥＳ）、距離センサ２６は、路面の段差部４までの距離を計測する（ステップＳ１０２）。
制御装置２７の判定部２７１は、距離センサ２６により計測された段差部４の距離が閾値を超えているか否かを判定する（ステップＳ１０３）。判定部２７１は、距離センサ２６により計測された段差部４の距離が閾値を超えていると判定したとき（ステップＳ１０３のＹＥＳ）、距離センサ２６が異常と判定する（ステップＳ１０４）。この場合、例えば、自律移動体２は、充電ステーション３に接続された状態を維持する（異常停止）（ステップＳ１０５）。なお、判定部２７１は、距離センサ２６の異常を判定したとき、警告装置を用いてユーザに対して警告を行っても良い。警告装置としては、例えば、警告音を出力するスピーカ、警告表示を行う表示装置、警告灯を点灯／点滅させるライト装置、などが含まれる。
一方、判定部２７１は、距離センサ２６により計測された段差部４の距離が閾値以内と判定したとき（ステップＳ１０３のＮＯ）、距離センサ２６が正常と判定する（ステップＳ１０６）。この場合、例えば、自律移動体２は、充電ステーション３から離脱し、移動を開始する（ステップＳ１０７）。
以上、本実施の形態１に係る異常判定システム１において、自律移動体２が充電ステーション３の接続端子３１に接続され位置決めされたときに距離センサ２６により計測される路面に疑似的な段差部４が設けられている。さらに、自律移動体２の制御装置２７は、その位置決め時に距離センサ２６により計測された段差部４までの距離が閾値以内であるか否かを判定する判定部２７１を有している。これにより、自律移動体２のバッテリ充電時に距離センサ２６の異常を自動的に確認できる。
実施の形態２
本発明の実施の形態２において、自律移動体２は、その外周に沿って複数の距離センサ２６を備えていてもよい。この場合、自律移動体２が充電ステーション３に位置決めされたときに各距離センサ２６により計測される路面にミラー４が夫々設置されている。例えば、図５に示す如く、自律移動体２の前方側に等間隔で３つの距離センサ２６が設けられている場合、各ミラー４は各距離センサ２６により計測される路面に略コ字状に夫々配置される。これにより、３つの距離センサ２６の異常を同時に確認できる。
また、図６に示す如く、自律移動体２の外周に等間隔で４つの距離センサ２６が設けられている場合、各ミラー４は、各距離センサ２６により計測される路面に自律移動体２の４方を囲うように夫々配置される。これにより、４つの距離センサ２６の異常を同時に確認できる。上記一例では、自律移動体が３つ及び４つ距離センサを備える場合について説明したが、自律移動体が２つ又は５つ以上備える場合についても上記自律移動体が３つ及び４つ距離センサと同様となる。すなわち、自律移動体２が充電ステーション３に位置決めされたときに各距離センサ２６により計測される路面にミラー４が夫々設置される。そして、判定部２７１は、各距離センサ２６により計測された段差部４の距離が閾値を超えていると判定することで、各距離センサ２６の異常を確認することができる。
さらに、図７に示す如く、充電ステーション３の前方で各距離センサ２６により計測される路面に１つのミラー４を配置するようにしてもよい。この場合、自律移動体２が、充電ステーション３に接続され位置決めされた位置において、距離センサ２６ａは路面のミラー４までの距離を計測し、制御装置２７の判定部２７１は、距離センサ２６ａにより計測されたその距離が閾値以内であるか否かを判定する。次に、自律移動体２は、一旦、充電ステーション３との接続を解除し、その場で９０°旋回する。その状態で、距離センサ２６ｂは路面のミラー４までの距離を計測し、判定部２７１は、距離センサ２６ｂにより計測されたその距離が閾値以内であるか否かを判定する。続いて、自律移動体２は、その場で更に９０°旋回する。その状態で、距離センサ２６ｃは路面のミラー４までの距離を計測し、判定部２７１は、距離センサ２６ｃにより計測されたその距離が閾値以内であるか否かを判定する。自律移動体２は、その場で更に９０°旋回する。その状態で、距離センサ２６ｄは路面のミラー４までの距離を計測し、判定部２７１は、距離センサ２６ｄにより計測された距離が閾値以内であるか否かを判定する。以上のようにして、１つのミラー４を用いて、自律移動体の４つの距離センサ２６の異常を判定することができる。
本実施の形態２において、他の構成は上記実施の形態１と略同一であるため、同一部分には同一符号を付して詳細な説明は省略する。以上、本実施の形態２によれば、自律移動体２のバッテリ充電時に複数の距離センサ２６の異常を自動的に確認できる。
なお、本発明は上記実施の形態に限られたものではなく、趣旨を逸脱しない範囲で適宜変更することが可能である。
上記実施の形態において、路面上の移動方向にある距離を夫々検出する２つの距離センサ２６を備え、各距離センサ２６により検出された距離に基づいて、段差や障害物を検出する自律移動体２にも適用可能である。自律移動体２が充電ステーション３の接続端子３１に接続され位置決めされたときの各距離センサ２６により計測される路面に、ミラー４が配置されている（図８）。判定部２７１は、自律移動体２が充電ステーション３の接続端子３１に接続され位置決めされた状態で、各距離センサ２６により計測されたミラー４の距離が閾値を超えているか否かを判定することで、各距離センサ２６の異常を判定できる。
さらに、自律移動体２が充電ステーション３の接続端子３１に接続され位置決めされたときに、ミラー４を充電ステーション３側から自律移動体２側に移動させることで、各距離センサ２６の異常を判定してもよい。
例えば、図９に示す状態では、上方の距離センサ２６により計測された距離はミラー４の反射光路を含むため、上方の距離センサ２６は段差を検出している。一方、下方の距離センサ２６により計測された距離は、ミラー４の反射光路を含まないため、下方の距離センサ２６は水平路面を検出している。次に、ミラー４を自律移動体２側に移動させると（Δｔ秒後）、図８に示す如く、上方及び下方の距離センサ２６により計測された距離はミラー４の反射光路を含むため、上方及び下方の距離センサ２６は段差を検出する。このように、自律移動体２を移動させる代わりに、ミラー４を移動させ、下方の距離センサ２６が正常に段差を検出するか否かを判定する。なお、ミラー４を固定し、実際に自律移動体２を移動させて（例えば、自律移動体２を充電ステーション３から後退させて）、上記距離センサ２６の判定を行っても良い。
上記実施の形態において、制御装置２７の判定部２７１は自律移動体２に設けられているが、充電ステーション３に設けられていてもよい。
上記実施の形態において、段差部４として凸状部を形成してもよい。上記実施の形態１及び２では、段差部４として、ミラー４を配置及び凹状部を形成している。この場合、距離センサ２６が実際の凹状の段差を正常に測定できるか否かを確認できる。一方で、段差部４として凸状の段差を形成することで、距離センサ２６が実際の凸状の段差を正常に測定できるか否かを確認できる。
上記実施の形態において、自律移動体２の接続部２８と充電ステーション３の接続端子３１とが接触し接続されることで、自律移動体２は充電ステーション３に対して位置決めされているがこれに限らない。自律移動体２の接続部２８と充電ステーション３の接続端子３１とが非接触で接続されることで、自律移動体２は充電ステーション３に対して位置決めされてもよい。
上記実施の形態において、自律移動体２は、カメラなどの画像センサ、超音波センサ、赤外線センサ、ミリ波センサなどの上記判定対象外のセンサ２９を用いて、距離センサ２６を確認するためのセンサ確認領域を認識してもよい。例えば、自律移動体２は、カメラにより撮影された撮影画像に基づいて、予め設定されてセンサ確認を行うための目標物を認識し、そのセンサ確認目標物近傍に設定された所定位置に移動する（図１０）。自律移動体２が所定位置に位置決めされたときの距離センサ２６により計測される路面に、ミラー４が配置されている。制御装置２７の判定部２７１は、自律移動体２が所定位置に位置決めされた状態で、距離センサ２６により計測されたミラー４の距離が閾値を超えているか否かを判定することで、距離センサ２６の異常を判定する。これにより、任意に設定した位置で、距離センサ２６の異常を判定することができる。
本発明の一態様は、進行方向の路面に向けられ、該路面までの距離を計測する少なくとも１つの距離計測手段と、予め設定された所定位置を検出する検出手段と、を有する自律移動体を備える異常判定システムであって、前記自律移動体が前記所定位置に位置決めされたときに前記距離計測手段により計測される路面に段差部が設けられており、前記位置決め時に前記距離計測手段により計測された前記段差までの距離が閾値以内であるか否かを判定する判定手段を備える、ことを特徴とする異常判定システムであってもよい。
１ 異常判定システム、２ 自律移動体、３ 充電ステーション、４ 段差部、２１ 移動体本体、２３ 車輪、２４ モータ、２５ バッテリ、２６ 距離センサ、２７ 制御装置、３１ 接続端子、２７１ 判定部

Claims (3)

  1. 進行方向の路面に向けられ、該路面までの距離を計測する少なくとも１つの距離計測手段を有する自律移動体と、
    前記自律移動体のバッテリに充電を行うための接続端子を有する充電手段と、を備える異常判定システムであって、
    前記自律移動体が前記充電手段の接続端子に接続され位置決めされたときに前記距離計測手段により計測される路面に段差部が設けられており、
    前記位置決め時に前記距離計測手段により計測された前記段差部までの距離が閾値以内であるか否かを判定する判定手段を備え、。
    前記段差部は、前記距離計測手段から出力される信号を反射するミラーであり、
    前記判定手段は、前記位置決め時に前記距離計測手段により計測された前記ミラーの反射光路を含む距離が閾値を超えたときに、該距離計測手段の異常と判定する、
    ことを特徴とする異常判定システム。
  2. 請求項１記載の異常判定システムであって、
    前記自律移動体は、複数の前記距離計測手段を備え、
    前記位置決め時に各距離計測手段により計測される路面に前記段差部が夫々形成されている、ことを特徴とする異常判定システム。
  3. 進行方向の路面に向けられ、該路面までの距離を計測する少なくとも１つの距離計測手段を有する自律移動体と、
    前記自律移動体のバッテリに充電を行うための接続端子を有する充電手段と、を備える異常判定システムの判定方法であって、
    前記自律移動体が前記充電手段の接続端子に接続され位置決めされたときに前記距離計測手段により計測される路面に段差部が設けられており、
    前記位置決め時に前記距離計測手段により前記段差部までの距離を計測するステップと、
    前記計測された距離が閾値以内であるか否かを判定するステップと、を含み、
    前記段差部は、前記距離計測手段から出力される信号を反射するミラーであり、
    前記位置決め時に前記距離計測手段により計測された前記ミラーの反射光路を含む距離が閾値を超えたときに、該距離計測手段の異常と判定する、
    ことを特徴とする異常判定システムの判定方法。
JP2013247526A 2013-11-29 2013-11-29 異常判定システム、及びその判定方法 Active JP5949734B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2013247526A JP5949734B2 (ja) 2013-11-29 2013-11-29 異常判定システム、及びその判定方法
US14/548,612 US9540014B2 (en) 2013-11-29 2014-11-20 Abnormality determination system and determination method thereof
CN201410705919.0A CN104677405B (zh) 2013-11-29 2014-11-27 异常判定系统及其判定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2013247526A JP5949734B2 (ja) 2013-11-29 2013-11-29 異常判定システム、及びその判定方法

Publications (2)

Publication Number Publication Date
JP2015106253A JP2015106253A (ja) 2015-06-08
JP5949734B2 true JP5949734B2 (ja) 2016-07-13

Family

ID=53264349

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2013247526A Active JP5949734B2 (ja) 2013-11-29 2013-11-29 異常判定システム、及びその判定方法

Country Status (3)

Country Link
US (1) US9540014B2 (ja)
JP (1) JP5949734B2 (ja)
CN (1) CN104677405B (ja)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6123710B2 (ja) * 2014-03-10 2017-05-10 トヨタ自動車株式会社 移動体
JP6123081B2 (ja) * 2015-03-13 2017-05-10 パナソニックＩｐマネジメント株式会社 自動給電システム、自動給電装置および自律移動システム
AT517874B1 (de) * 2015-10-21 2018-06-15 Wittmann Kunststoffgeraete Einrichtung zum Umschlag bzw. zur Hantierung und Transport von Werkstücken
US10245730B2 (en) * 2016-05-24 2019-04-02 Asustek Computer Inc. Autonomous mobile robot and control method thereof
CN108267752B (zh) * 2016-12-15 2022-01-18 苏州宝时得电动工具有限公司 自移动设备的工作区域的分区方法、装置和电子设备
CN109059991A (zh) * 2018-09-04 2018-12-21 安克创新科技股份有限公司 智能自移动设备及其传感器校正的方法、计算机存储介质

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7237298B2 (en) * 2003-09-19 2007-07-03 Royal Appliance Mfg. Co. Sensors and associated methods for controlling a vacuum cleaner
JP4371899B2 (ja) * 2004-05-21 2009-11-25 株式会社東芝 自律走行体システム
JP2006231477A (ja) * 2005-02-25 2006-09-07 Mitsubishi Heavy Ind Ltd 移動体における距離検出手段の校正方法
JP2007034769A (ja) * 2005-07-28 2007-02-08 Matsushita Electric Ind Co Ltd 自律走行ロボットシステム
US9144360B2 (en) 2005-12-02 2015-09-29 Irobot Corporation Autonomous coverage robot navigation system
JP2008178959A (ja) * 2007-01-26 2008-08-07 Canon Electronics Inc 移動ロボットシステムおよび充電ステーション
JP2008287384A (ja) * 2007-05-16 2008-11-27 Panasonic Corp 自走式機器およびそのプログラム
JP5213655B2 (ja) * 2008-11-19 2013-06-19 株式会社日立製作所 自律移動ロボット
US8706297B2 (en) * 2009-06-18 2014-04-22 Michael Todd Letsky Method for establishing a desired area of confinement for an autonomous robot and autonomous robot implementing a control system for executing the same
CN103092206A (zh) * 2013-02-27 2013-05-08 慈溪思达电子科技有限公司 管道机器人的遍历路径规划方法

Also Published As

Publication number Publication date
US9540014B2 (en) 2017-01-10
CN104677405B (zh) 2018-09-11
JP2015106253A (ja) 2015-06-08
CN104677405A (zh) 2015-06-03
US20150151765A1 (en) 2015-06-04

Similar Documents

Publication Publication Date Title
JP5949734B2 (ja) 異常判定システム、及びその判定方法
KR101921394B1 (ko) 자율 이동체
CN104850119B (zh) 自主车辆及其故障确定方法
CN102303647B (zh) 用于避免可翻转车盖发生碰撞的装置
CN107179530B (zh) 用于求取固定在车辆上的探测设备的失调的装置
KR102489386B1 (ko) 주차 지원 장치 및 그의 주차 제어 방법
KR20170114054A (ko) 충돌방지장치 및 충돌방지방법
KR20170027179A (ko) 운전 지원 장치 및 운전 지원 방법
JP5428804B2 (ja) 物体検出システム
KR101986166B1 (ko) 차선 인식 장치 및 방법
JP2010013012A (ja) 衝突予測装置
US11550053B2 (en) Object detection apparatus and operating method thereof
JP2018537794A (ja) 支援付きの交通合流
JP6412352B2 (ja) 自動移動車及び自動移動車制御システム
KR101523824B1 (ko) 주차조향지원 공간인식 장치 및 방법
WO2021176825A1 (ja) センシングシステム
KR102308785B1 (ko) 차량 사각지대 감지 장치 및 방법
JP6242284B2 (ja) 駐車支援装置
KR101410109B1 (ko) 차량용 측방 장애물 감지 장치 및 시스템
JP2011221673A (ja) 警報制御装置、警報制御プログラム、及び警報システム
JP2021125072A (ja) 検出装置
KR20210144122A (ko) 단안 카메라를 이용한 자동긴급제동시스템의 검증 장치와 방법
JP2016065733A (ja) 物体検出装置
KR20140079977A (ko) 평행 주차 공간 탐지 시스템 및 이를 사용한 공간 탐지 방법
JP2011214925A (ja) 方向検出装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20150513

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20151005

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20151104

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20151209

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20160523

R151 Written notification of patent or utility model registration

Ref document number: 5949734

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151