JP2022550231A - 状態決定方法および装置、ロボット、記憶媒体並びにコンピュータプログラム - Google Patents

状態決定方法および装置、ロボット、記憶媒体並びにコンピュータプログラム Download PDF

Info

Publication number
JP2022550231A
JP2022550231A JP2021566210A JP2021566210A JP2022550231A JP 2022550231 A JP2022550231 A JP 2022550231A JP 2021566210 A JP2021566210 A JP 2021566210A JP 2021566210 A JP2021566210 A JP 2021566210A JP 2022550231 A JP2022550231 A JP 2022550231A
Authority
JP
Japan
Prior art keywords
state
robot
noise
information
actual
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP2021566210A
Other languages
English (en)
Inventor
姚▲達▼▲ちぇん▼
何悦
李▲誠▼
Original Assignee
ベイジン・センスタイム・テクノロジー・デベロップメント・カンパニー・リミテッド
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 ベイジン・センスタイム・テクノロジー・デベロップメント・カンパニー・リミテッド filed Critical ベイジン・センスタイム・テクノロジー・デベロップメント・カンパニー・リミテッド
Publication of JP2022550231A publication Critical patent/JP2022550231A/ja
Pending legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1674Programme controls characterised by safety, monitoring, diagnostic
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/088Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • B25J19/04Viewing devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00Manipulators mounted on wheels or on carriages
    • B25J5/007Manipulators mounted on wheels or on carriages mounted on wheels
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1653Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • B25J9/1692Calibration of manipulator

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)

Abstract

本願実施例は、ロボットの状態決定方法および装置、ロボット並びに記憶媒体を開示し、ここで、ロボットの状態決定方法は、ロボットの参照情報を取得することであって、ここで、参照情報は、いくつかの時刻に対応するロボットの測定状態情報、現在時刻に対応するロボットの実際走行情報のうちの少なくとも1つを含むことと、参照情報に基づいて、ロボットの状態ノイズを決定することと、状態ノイズを利用して、現在時刻に対応するロボットの実際状態情報を取得することと、を含む。上記の技術案は、ロボットの状態を決定する精度を向上されることができる。【選択図】図1

Description

(関連出願の相互参照)
本願は、2020年08月26日に中国特許局に提出された、出願番号が202010872662.3である中国特許出願に基づいて提出されるものであり、当該中国特許出願の優先権を主張し、当該中国特許出願の全ての内容は、全文が参照によって本願に組み込まれる。
本願は、ロボット技術分野に関し、特に、状態決定方法および装置、ロボット、記憶媒体並びにコンピュータプログラムに関する。
電子技術およびコンピュータ技術の発展に伴い、ロボットを速達、サービス案内、出前配達などに適用することは、徐々に幅広く注目され、ロボットの適用分野は、ますます広まっている。
例えば、近年、人工知能(AI:Artificial Intelligence)教育は徐々にはやっており、ほとんどのAI教育コースは、オンラインコースプラットフォームを基に展開され、スマートカー、スマートロボットなどのような対応するハードウェア機器は、補助として利用され、授業用以外に、学校は、電子設計コンテスト、自律走行コンテストなどの、ロボットのコンテストを開催する。これらのコンテストでは、参加者は、回路とアルゴリズムを自分で設計して、コンテストで他の参加者のロボットと対抗する。
本願実施例は、状態決定方法および装置、ロボット、記憶媒体並びにコンピュータプログラムを提供する。
本願実施例は、ロボットの状態決定方法を提供し、前記方法は、ロボットの参照情報を取得することであって、ここで、参照情報は、いくつかの時刻に対応するロボットの測定状態情報、現在時刻に対応するロボットの実際走行情報のうちの少なくとも1つを含むことと、参照情報に基づいて、ロボットの状態ノイズを決定することと、状態ノイズを利用して、現在時刻に対応するロボットの実際状態情報を取得することと、を含む。
したがって、ロボットの参照情報を取得し、参照情報は、いくつかの時刻に対応するロボットの測定状態情報、現在時刻に対応するロボットの実際走行情報を含み、参照情報に基づいて、ロボットの状態ノイズを決定して、状態ノイズを利用して、現在時刻に対応するロボットの実際状態情報を取得することにより、状態を決定するプロセスにおいて、大量の粒子でシミュレートする必要がなく、状態決定の速度を向上させるのに役立つことができる。さらに、当該状態ノイズは、いくつかの時刻の測定状態情報および/または現在時刻の実際走行情報に基づいて決定されるものであるため、ロボットの外部測定視点および/またはロボットの自体状態視点からノイズを測定し、それにより、状態ノイズを実際の場合に近づけ、さらに、後続で決定される実際状態情報の精度を向上させることができる。
いくつかの開示された実施例において、参照情報に基づいて、ロボットの状態ノイズを決定することは、前記現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、前記ロボットの測定干渉ノイズを決定すること、および/または、現在時刻の実際走行情報を利用して、ロボットの状態遷移ノイズを決定することを含む。
したがって、現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、ロボットの測定干渉ノイズを決定して、外部測定の視点からロボットのノイズを決定することができ、それにより、走行プロセスにおけるロボットの外部の干渉を測定することができ、現在時刻の実際走行情報を利用して、ロボットの状態遷移ノイズを決定して、ロボットの自体状態の視点からロボットのノイズを決定することができ、それにより、走行プロセスにおけるロボットの内部の干渉を測定することができる。
いくつかの開示された実施例において、現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、ロボットの測定干渉ノイズを決定することは、現在時刻と前のいくつかの時刻の測定状態情報との離散度を取得することと、前記離散度を利用して、測定干渉ノイズを決定することと、を含む。
したがって、現在時刻と前のいくつかの時刻の測定状態情報との離散度を使用し、離散度を使用して測定干渉ノイズを決定して、走行プロセスにおけるロボットの外部の干渉を正確に測定することができる。
いくつかの開示された実施例において、現在時刻と前のいくつかの時刻の測定状態情報との離散度は、現在時刻と前のいくつかの時刻の測定状態情報との標準差であり、対応的に、離散度を利用して、測定干渉ノイズを決定することは、離散度とプリセットのゲインパラメータとの積を測定干渉ノイズとして使用することを含む。
したがって、現在時刻と前のいくつかの時刻の測定状態情報との離散度を、現在時刻と前のいくつかの時刻の測定状態情報との標準差に設定することにより、離散度を決定する複雑さと計算量を減らすことに役立ち、状態を決定する速度を向上させることに役立ち、離散度とプリセットのゲインパラメータとの積を測定干渉ノイズとして使用することは、測定干渉ノイズの精度を向上させることに役立ち、状態決定の精度を向上させることに役立つ。
いくつかの開示された実施例において、実際走行情報は、ロボットの走行角度情報、モーター駆動情報および走行速度情報を含み、現在時刻の実際走行情報を利用して、ロボットの状態遷移ノイズを決定することは、第1状態ノイズおよび第2状態ノイズのうちの少なくとも1つを利用して、ロボットの状態遷移ノイズを取得することを含み、ここで、前記第1状態ノイズは、走行角度情報および走行速度情報を利用して決定されたものであり、前記第2状態ノイズは、モーター駆動情報および走行速度情報を利用して決定されたものである。
したがって、実際走行情報をロボットの走行角度情報、モーター駆動情報および走行速度情報を含むように設定して、第1状態ノイズおよび第2状態ノイズのうちの少なくとも1つを利用して、ロボットの状態遷移ノイズを取得し、且つ、第1状態ノイズは、走行角度情報および走行速度情報を利用して決定されたものであり、第2状態ノイズは、モーター駆動情報および走行速度情報を利用して決定されたものであり、状態遷移ノイズの精度を向上させることに役立つことができる。
いくつかの開示された実施例において、ロボットは、駆動輪および方向転換輪を備え、駆動輪は、ロボットを走行するように駆動するために使用され、方向転換輪は、ロボットの走行方向を変換するために使用され、走行速度情報は、ロボットの駆動輪間の実際速度差を含み、走行角度情報は、ロボットの方向転換輪の実際の方向転換角度を含み、対応的に、第1状態ノイズおよび第2状態ノイズのうちの少なくとも1つを利用して、ロボットの状態遷移ノイズを取得する前に、速度差と方向転換角度との第1マッピング関係を利用して、実際方向転換角度に対してマッピング処理を実行して、実際の方向転換角度に対応する理論速度差を取得することと、実際速度差と理論速度差との差異を利用して、第1状態ノイズを決定することと、をさらに含み、および/または、ロボットは、駆動輪を備え、駆動輪は、ロボットを走行するように駆動するために使用され、走行速度情報は、ロボットの駆動輪の実際平均速度を含み、モーター駆動情報は、ロボットのモーターの実際平均駆動信号値を含み、対応的に、第1状態ノイズおよび第2状態ノイズのうちの少なくとも1つを利用して、ロボットの状態遷移ノイズを取得する前に、平均速度と平均駆動信号値との第2マッピング関係を利用して、実際平均駆動信号値に対してマッピング処理を実行して、実際平均駆動信号値に対応する理論平均速度を取得することと、実際平均速度と理論平均速度との差異を利用して、第2状態ノイズを決定することと、をさらに含む。
したがって、ロボットは、駆動輪および方向転換輪を備え、駆動輪は、ロボットを走行するように駆動するために使用され、方向転換輪は、ロボットの走行方向を変換するために使用され、走行速度情報を、ロボットの駆動輪間の実際速度差を含むように設定し、走行角度情報を、ロボットの方向転換輪の実際方向転換角度を含むように設定して、速度差と方向転換角度との第1マッピング関係を利用して、実際方向転換角度に対してマッピング処理を実行して、実際方向転換角度に対応する理論速度差を取得し、実際速度差と理論速度差との差異を利用して、第1状態ノイズを決定することにより、ロボットの方向転換輪の視点から、ロボットの第1状態ノイズを決定することができる。ロボットは、駆動輪を備え、駆動輪は、ロボットを走行するように駆動するために使用され、走行速度情報を、ロボットの駆動輪の実際平均速度を含むように設定し、モーター駆動情報を、ロボットのモーターの実際平均駆動信号値を含むように設定して、平均速度と平均駆動信号値との第2マッピング関係を利用して、実際平均駆動信号値に対してマッピング処理を実行して、実際平均駆動信号値に対応する理論平均速度を取得し、実際平均速度と理論平均速度との差異を利用して、第2状態ノイズを決定することにより、ロボットの駆動輪の視点から、ロボットの第2状態ノイズを決定することができる。
いくつかの開示された実施例において、実際速度差と理論速度差との差異を利用して、第1状態ノイズを決定することは、実際速度差と理論速度差との差の平方を第1状態ノイズとして使用することを含み、実際平均速度と理論平均速度との差異を利用して、第2状態ノイズを決定することは、実際平均速度と理論平均速度との差の平方を第2状態ノイズとして使用することを含む。
したがって、実際速度差と理論速度差との差の平方を第1状態ノイズとして使用し、実際平均速度と理論平均速度との差の平方を第2状態ノイズとして使用して、第1状態ノイズおよび第2状態ノイズの計算の複雑さと計算量を減らし、状態決定の速度を向上させることに役立つことができる。
いくつかの開示された実施例において、状態ノイズを利用して、現在時刻に対応するロボットの実際状態情報を取得することは、状態ノイズを利用して、ロボットの、前の時刻に対応する実際状態情報および現在時刻に対応する測定状態情報を処理して、現在時刻に対応するロボットの実際状態情報を取得することを含む。
したがって、状態ノイズを利用して、ロボットの、現在時刻に対応する測定状態情報および前の時刻に対応する実際状態情報を処理することにより、ロボットを、現在時刻の測定状態情報と前の時刻の実際状態情報との間でバランスを取れるようにすることに役立ち、決定された実際状態情報を、測定状態情報に対して修正することができるようにし、それによって、ロボットの状態決定の精度を向上させることに役立つことができる。
いくつかの開示された実施例において、状態ノイズを利用して、ロボットの、前の時刻に対応する実際状態情報および現在時刻に対応する測定状態情報を処理して、現在時刻に対応するロボットの実際状態情報を取得することは、状態ノイズに基づいて、フィルターゲインを決定し、ロボットの、直前時刻に対応する実際状態情報および直前時刻に対応する実際走行情報を予測して、現在時刻に対応する予測状態情報を取得し、フィルターゲインのカルマンフィルターを利用して、現在時刻の予測状態情報を現在時刻の測定状態情報と融合して、現在時刻に対応するロボットの実際状態情報を取得することを含む。
したがって、状態ノイズに基づいて、フィルターゲインを決定し、ロボットの、直前時刻に対応する実際状態情報および直前時刻に対応する実際走行情報を予測して、現在時刻に対応する予測状態情報を取得し、フィルターゲインのカルマンフィルターを利用して、現在時刻の予測状態情報を現在時刻の測定状態情報と融合して、外部信号に対する頑健性を増強し、それにより、現在時刻に対応する実際状態情報を正確に決定することができる。
いくつかの開示された実施例において、参照情報に基づいて、ロボットの状態ノイズを決定した後、前記方法は、状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行することをさらに含む。
したがって、状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行して、ユーザを、異常の状態ノイズを感知させ、ユーザ体験を向上させることができる。
いくつかの開示された実施例において、状態ノイズは、現在時刻および前のいくつかの時刻の測定状態情報を利用して得られた測定干渉ノイズを含み、対応的に、プリセットのノイズ条件は、測定干渉ノイズが、第1ノイズ閾値より小さいことを含み、状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行することは、測定干渉ノイズが、プリセットのノイズ条件を満たしない場合、第1警告メッセージを出力することを含み、前記第1警告メッセージは、状態測定が干渉されたことを知らせるために使用され、および/または、状態ノイズは、現在時刻の実際走行情報を利用して得られた状態遷移ノイズを含み、対応的に、プリセットのノイズ条件は、状態遷移ノイズが第2ノイズ閾値より小さいことを含み、状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行することは、状態遷移ノイズが、プリセットのノイズ条件を満たしない場合、第2警告メッセージを出力することを含み、前記第2警告メッセージは、ロボットに車体が滑るリスクがあることを知らせるために使用される。
したがって、測定干渉ノイズが、プリセットの条件を満たしない場合、第1警告メッセージを出力して、状態測定が干渉されたことを通知し、それにより、状態測定が干渉された場合、ユーザを早速に感知させ、ユーザの体験を向上させることができる。状態遷移ノイズが、プリセットの条件を満たしない場合、第2警告メッセージを出力して、ロボットに車体が滑るリスクがあることを通知し、それにより、ロボットに車体が滑るリスクが発生した場合、ユーザを早速に感知させ、ユーザ体験を向上させることができる。
いくつかの開示された実施例において、ロボットの参照情報を取得することは、ロボットの周囲環境に対して画像収集を実行して、現在時刻に対応する環境画像データを取得することと、現在時刻の環境画像データに基づいて、現在時刻に対応するロボットの測定状態情報を決定することと、を含み、測定状態情報および実際状態情報のいずれも、ロボットの位置、ロボットの姿勢、ロボットの速度のうちの少なくとも1つを含む。
したがって、ロボット周囲環境に対して画像収集を実行することにより、現在時刻に対応する環境画像世帯数を取得し、現在時刻の環境画像データに基づいて、現在時刻に対応するロボットの測定状態情報を決定し、且つ、測定状態情報および実際状態情報を、両方とも、ロボットの位置、ロボットの姿勢およびロボットの速度のうちの少なくとも1つを含むように設定し、それにより、現在時刻に対応するロボットの測定状態情報を迅速に取得することができ、さらに、ロボットの状態決定の速度を向上させることに役立つことができる。
本願実施例は、ロボットの状態決定装置を提供し、前記装置は、測定状態取得モジュール、状態ノイズ決定モジュールおよび実際状態取得モジュールを備え、測定状態取得モジュールは、ロボットの参照情報を取得するように構成され、ここで、参照情報は、いくつかの時刻に対応するロボットの測定状態情報、現在時刻に対応するロボットの実際走行情報のうちの少なくとも1つを含む、状態ノイズ決定モジュールは、参照情報に基づいて、ロボットの状態ノイズを決定するように構成され、実際状態取得モジュールは、前記状態ノイズを利用して、現在時刻に対応するロボットの実際状態情報を取得するように構成される。
本願実施例は、ロボット本体およびロボット本体に設置されるメモリおよびプロセッサを備える、ロボットを提供し、メモリとプロセッサは、互いに接続され、プロセッサは、メモリに記憶されるプログラム命令を実行して、上記の状態決定方法を実現するように構成される。
本願実施例は、プログラム命令を記憶する、コンピュータ可読記憶媒体を提供し、プログラム命令は、プロセッサによって実行されるとき、上記の状態決定方法を実現する。
本願実施例は、コンピュータ可読コードを含む、コンピュータプログラムを提供し、前記コンピュータ可読コードが、ロボットで実行されるとき、前記ロボット内のプロセッサは、上記の状態決定方法を実現するために実行される。
本願実施例は、状態決定方法および装置、ロボット、記憶媒体並びにコンピュータプログラムを提供し、ロボットの参照情報を取得し、且つ、参照情報は、いくつかの時刻に対応するロボットの測定状態情報、現在時刻に対応するロボットの実際走行情報を含み、参照情報に基づいて、ロボットの状態ノイズを決定して、状態ノイズを利用して、現在時刻に対応するロボットの実際状態情報を取得することにより、状態を決定するプロセスにおいて、大量の粒子でシミュレートする必要がなく、状態決定の速度を向上させるのに役立つことができる。さらに、当該状態ノイズは、取得された幾つかの測定状態情報および/または現在の実際走行情報に従って決定されるため、ロボットの外部測定視点および/またはロボットの自体状態視点からノイズを測定し、それにより、状態ノイズを実際の場合に近づけ、さらに、後続で決定される実際状態情報の精度を向上させることができる。
本願実施例のロボットの状態決定方法の一実施例の例示的なフローチャートである。 本願実施例のカルマンフィルターを利用して、ロボットの実際状態情報を決定する例示的なフローチャートである。 本願実施例のロボットの状態決定装置の一実施例のフレームワークの概略図である。 本願実施例のロボットの一実施例のフレームワークの概略図である。 本願実施例のコンピュータ可読記憶媒体の一実施例のフレームワークの概略図である。
以下は、図面を参照して、本願実施例の技術案を詳細に説明する。
以下の説明において、限定するためにではなく説明するためであり、本願を完全に理解するために、特定のシステム構造、インターフェース、技術などの具体的な詳細を提案する。
本明細書における「システム」および「ネットワーク」という用語は、本明細書で常に互換的に使用される。本明細書における「および/または」という用語は、関連付けられるオブジェクトを説明する単なる関連付け関係であり、3つの関係が存在できることを示し、例えば、Aおよび/またはBは、Aが独立で存在する場合、AとBが同時に存在する場合、Bが独立で存在する場合という3つの場合を表す。さらに、本明細書における記号「/」は、一般的に、前後の関連付けられるオブジェクトが、「または」という関係であることを示す。なお、本明細書における「複数」は、2つまたは2つ以上を表す。
近年、AI教育は徐々にはやっており、ほとんどのAI教育コースは、オンラインコースプラットフォームを基に展開され、スマートカー、スマートロボットなどの対応するハードウェア機器を補助として使用され、授業用以外に、学校は、常に、電子設計コンテスト、自律走行コンテストなどの、ロボットのコンテストを開催する。これらのコンテストでは、参加者は、回路とアルゴリズムを自分で設計して、コンテストで他の参加者のロボットと対抗する。
このようなコンテストでは、ロボットは、通常、上位機器からコンテストの全局情報を受信する必要があり、その中には、ロボット自体の位置、速度および姿勢などのロボットの意思決定に非常に重要な情報が含まれる。ロボットと上位機器との通信は、基本的にシリアル通信を使用し、通信ルールは、すべての参加者にとって既知情報であり、したがって、一部の参加者がロボットに妨害装置を配置して、他の参加者に誤った通信信号を送信して、相手を誤解させる場合がある。ここで、よく見られるのは、誤った位置、速度および姿勢情報を送信して、相手の判断に干渉することである。干渉されたロボットのアルゴリズムが十分に頑健でない場合、制御不能になる。
コンテスト以外に、いくつかの人工知能展示場でも、通信で情報收集して稼働するロボットがあり、干渉信号を送信して通信に干渉する人がいると、展示場に問題が発生し、計り知れない損失が発生する。例えば、車両に滑るなどの現象が発生する時に、車両の融合測位システムに測位偏差などが発生する可能性があり、これも、典型的な位置偽装の問題である。現在既存の技術案では、粒子フィルターの方法を使用して偽装を防止し、このような方法は、各エージェントに対して、数十万の粒子シミュレートを実行する必要があり、且つ、エリアの拡大に伴い、計算量もさらに増加され、複数のロボットがある場合には、リアルタイムで計算する要求を満たすことができない。
同時に、他の適用シナリオでは、ロボットは、走行プロセスで干渉を受けることを避けられない。例えば、自由空間のどこにもあるホワイトノイズ、または干渉信号によって、ロボットの正常な走行に影響を与え、酷い場合、ロボットには、制御不能、滑るなどの現象が生じる。
よって、本願実施例は、ロボットの状態決定の精度を向上させることができる、ロボットの状態決定方法を提供する。図1を参照すると、図1は、本願実施例のロボットの状態決定方法の一実施例の例示的なフローチャートである。本願実施例による方法ステップは、ロボットなどのハードウェア機器によって実行され、または、プロセッサが、コンピュータ実行可能なコードを実行する方式によって実行されることができる。前記状態決定方法は、以下のステップを含み得る。
ステップS11において、ロボットの参照情報を取得する。
本願実施例において、ロボットの参照情報は、いくつかの時刻に対応するロボットの測定状態情報、現在時刻に対応するロボットの実際走行情報のうちの少なくとも1つを含み得る。
ロボットの状態は、異なる時刻で変化する可能性があり、例えば、ロボットが、現在時刻で、直前時刻に対して移動し、もちろん、他の適用シナリオでは、ロボットの状態は、変化しない可能性もあり、当業者は、ロボットの実際の状況に応じて決定することができることに留意されたい。これに対して、ロボットは、異なる時刻における実際状態を決定して、それによって後続の動作を実行する必要がある。
本願実施例において、現在時刻に対応するロボットの実際状態情報を決定するために、まず、現在時刻に対応する測定状態情報を取得して、本願実施例におけるステップに基づいて、現在時刻に対応する測定状態情報を利用して、現在時刻に対応する実際状態情報を取得することができる。本明細書に記載のある時刻に対応する情報は、必ずしも当該時刻で取得されるものではなく、当該時刻の近くで取得される可能性があることを理解されたい。例えば、現在時刻に対応する測定状態情報は、現在時刻で取得されたものであり得、通信遅延を考慮すると、現在時刻に対応する測定状態情報は、現在時刻の前のいくつかの時刻(例えば、0.5秒前、1秒前など)で取得されたものであり得、ここでは限定しない。
いくつかの開示された実施例において、測定状態情報は、ロボットに対して状態測定を実行して得られたものであり、開示された実施シナリオにおいて、ロボットの周囲環境を収集して、現在時刻に対応する環境画像データを取得し、現在時刻の環境画像データに基づいて、現在時刻に対応するロボットの測定状態情報を決定することができる。例えば、ロボット走行環境に装着された撮影デバイスによって、ロボットの周囲環境に対して画像収集を実行することができ、または、ロボットに装着された撮影デバイスによって、周囲環境に対して画像収集を実行することもでき、ここでは限定しない。いくつかの開示された実施例において、ロボットの状態を正確に説明するために、ロボットの測定状態情報および実際状態情報は、ロボットの位置、ロボットの状態、ロボットの速度のうちの少なくとも1つを含み得る。例えば、ロボットの位置は、ロボットの位置座標(例えば、緯度と経度)を含み得、ロボットの状態は、ロボットの走行状態(例えば、加速度)を含み得る。測定状態情報がロボットの位置とロボットの速度を含むことを例として、説明の便宜上、現在時刻に対応する測定状態情報を式(1)で表すことができる。
Figure 2022550231000002
上記の式において、
Figure 2022550231000003
は、現在時刻kに対応する測定状態情報を表し、pは、測定状態情報内のロボットの位置を表し、vは、測定状態情報内のロボットの速度を表す。
同様に、実際状態情報が、ロボットの位置とロボットの速度を含むことを例として、説明の便宜上、現在時刻に対応する実際状態情報を式(2)で表すことができる。
Figure 2022550231000004
上記の式において、
Figure 2022550231000005
は、現在時刻kに対応する実際状態情報を表し、p′は、実際状態情報内のロボットの位置を表し、v′は、実際状態情報内のロボットの速度を表す。
なお、いくつかの時刻に対応するロボットの測定状態情報は、現在時刻および前のいくつかの時刻に対応するロボットの測定状態情報を含み得る。現在時刻が、k時刻であることを例として、現在時刻前のいくつかの時刻を、k時刻前のn個時刻と表すことができ、nの値は、実際の適用ニーズに応じて設定することができる。例えば、nは、5、10、15などであり得、ここでは限定しない。
別の開示された実施シナリオにおいて、実際走行情報は、ロボットの走行角度情報、モーター駆動情報および走行速度情報を含み得る。ここで、走行角度情報は、ロボットのステアリングギア制御記録から取得されることができ、ロボットは、方向転換輪を備えることができ、ロボットのステアリングギアは、ロボットの方向転換輪が特定の角度方向に転換するように駆動するために使用される。モーター駆動情報は、ロボットのモーター制御記録から取得されることができ、ロボットは、さらに、駆動輪を備えることができ、ロボットのモーターは、ロボットの駆動輪が特定の速度で移動するように駆動するために使用される。走行速度情報は、ロボットのエンコーダから取得されることができる。
ステップS12において、参照情報に基づいて、ロボットの状態ノイズを決定する。
ロボットの状態ノイズは、走行プロセスにおけるロボットが、その状態に影響を与えるノイズを表し、例えば、ロボットが、ある状態から別の状態に遷移するときに生成された状態遷移ノイズ、または、ロボットが、測定状態情報を受信するプロセスで生成された測定干渉ノイズを表し、ここでは限定しない。
開示された実施シナリオにおいて、現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、ロボットの測定干渉ノイズを決定することができる。ここで、現在時刻前のいくつかの時刻は、上記の説明を参照できる。したがって、外部測定の視点からロボットのノイズを決定することができ、それにより、走行プロセスにおけるロボットの外部の干渉を測定することができる。
開示された実施シナリオにおいて、現在時刻と前のいくつかの時刻の測定状態情報との離散度を取得し、離散度を利用して、測定干渉ノイズを決定することができる。例えば、現在時刻と前のいくつかの時刻の測定状態情報との離散度は、現在時刻と前のいくつかの時刻の測定状態情報との標準差であってもよい。例えば、現在時刻と前のいくつかの時刻の測定状態情報との離散度は、現在時刻と前のいくつかの時刻の測定状態情報の方差であってもよいし、ここでは限定しない。したがって、離散度を決定する複雑さと計算量を減らすことに役立ち、状態決定の速度を向上させることに役立つことができる。
別の開示された実施シナリオにおいて、さらに、離散度とプリセットのゲインパラメータとの積を測定干渉ノイズとして使用することができる。プリセットのゲインパラメータは、実際の状況に応じて設定することができ、ここでは限定しない。いくつかの開示された実施例において、測定干渉ノイズを、式(3)で表すことができる。
Figure 2022550231000006
上記の式において、Rは、測定干渉ノイズを表し、
Figure 2022550231000007
は、現在時刻kおよびその前のn個の時刻に対応する測定状態情報を表し、
Figure 2022550231000008
は、現在時刻kとその前のn個の時刻に対応する測定状態情報の標準差を表し、
Figure 2022550231000009
は、プリセットのゲインパラメータを表し、ここで、プリセットのゲインパラメータは、0.5、1、1.5などの、0より大きい数値であり得、ここでは限定しない。
別の開示された実施シナリオにおいて、現在時刻の実際走行情報を利用して、ロボットの状態遷移ノイズを決定することができる。現在時刻が、k時刻であることを例として、k時刻の実際走行情報を利用して、ロボットの状態遷移ノイズを決定することができ、したがって、ロボットの自体状態の視点からロボットのノイズを決定することができ、それにより、走行プロセスにおけるロボットの内部の干渉を測定することができる。いくつかの開示された実施例において、第1状態ノイズ、第2状態ノイズのうちの少なくとも1つに従って、ロボットの状態遷移ノイズを取得することができ、且つ、第1状態ノイズは、走行角度情報および加速度情報を利用して得られたものであり、第2状態ノイズは、モーター駆動情報および走行速度情報を利用して決定されたものである。
一実施シナリオにおいて、ステアリングギアを視点として考慮することができ、走行角度情報および走行速度情報を利用して、ロボットの第1状態ノイズを決定し、それにより、第1状態ノイズを利用して、ロボットの状態遷移ノイズを決定することができる。例えば、走行角度情報および走行速度情報を利用して、ロボットの第1状態ノイズを決定し、第1状態ノイズをロボットの状態遷移ノイズとして使用することができる。
別の一実施シナリオにおいて、さらに、モーターを視点として考慮して、モーター駆動情報および走行速度情報を利用して、ロボットの第2状態ノイズを決定し、それにより、第2状態ノイズを利用して、ロボットの状態遷移ノイズを決定することができる。例えば、モーター駆動情報および走行速度情報を利用して、ロボットの第2状態ノイズを決定し、第2状態ノイズをロボットの状態遷移ノイズとして使用することもできる。
また別の実施シナリオにおいて、さらに、走行角度情報および走行速度情報を利用して、ロボットの第1状態ノイズを決定し、モーター駆動情報および走行速度情報を利用して、ロボットの第2状態ノイズを決定することもでき、それにより、第1状態ノイズおよび第2状態ノイズを利用して、ロボットの状態遷移ノイズを取得することができ、さらに、ステアリングギアの視点およびモーターの視点を同時に考慮することができ、状態遷移ノイズの精度を向上させることに役立つ。
いくつかの開示された実施例において、第1状態ノイズおよび第2状態ノイズを利用して、状態遷移ノイズを取得する場合に、第1状態ノイズおよび第2状態ノイズに対して重み付け処理を実行して、状態遷移ノイズを取得することができる。なお、第1状態ノイズおよび第2状態ノイズに対応する重み値は、実際の状況に応じて設定することができる。例えば、第1状態ノイズが、第2状態ノイズにより重要である場合、第1状態ノイズに対応する重み値を第2状態ノイズの重み値より大きく設定することができ、また、第2状態ノイズが、第1状態ノイズにより重要である場合、第2状態ノイズに対応する重み値を第1状態ノイズの重み値より大きく設定することができる。なお、第1状態ノイズに対応する重み値を、第2状態ノイズに対応する重み値と等しく設定することもでき、例えば、第1状態ノイズに対応する重み値を0.5に設定し、第2状態ノイズに対応する重み値も0.5に設定する。
いくつかの開示された実施例において、ロボットは、駆動輪および方向転換輪を備えることができ、駆動輪は、ロボットが走行するように駆動するために使用され、方向転換輪は、ロボットの走行方向を変換するために使用され、その場合、走行速度情報は、ロボットの駆動輪間の実際速度差を含み得る。例えば、ロボットが、2つの駆動輪を備える場合、2つの駆動輪の速度差が、実際速度差である。説明の便宜上、実際速度差を
Figure 2022550231000010
と表すことができ、走行角度情報は、ロボットの方向転換輪の実際の方向転換角度を含み得、説明の便宜上、実際方向転換角度をαと表すことができ、そうすると、速度差と方向転換角度との第1マッピング関係(説明の便宜上、第1マッピング関係を
Figure 2022550231000011
と表すことができる)を使用して、実際方向転換角度αに対してマッピング処理を実行して、実際方向転換角度αに対応する理論速度差(説明の便宜上、理論速度差を
Figure 2022550231000012
と表すことができる)を取得することができ、それにより、実際速度差
Figure 2022550231000013
と理論速度差
Figure 2022550231000014
との差異を利用して、第1状態ノイズを決定することができ、例えば、実際速度差
Figure 2022550231000015
と理論速度差
Figure 2022550231000016
との差の平方を第1状態ノイズとして使用することができる。第1マッピング関係は、事前に収集された複数対の速度差と方向転換角度を統計し分析して得られることができ、例えば、ロボットが正常に走行する中で、M対の速度差と方向転換角度を収集し、収集されたM対の速度差と方向転換角度をフィッティングして、速度差と方向転換角度との第1マッピング関係を取得し、Mの数値は、実際の状況に応じて設定することができ、ここでは限定しない。
いくつかの開示された実施例において、走行速度情報は、さらに、駆動輪の実際平均速度、即ち、ロボットの各駆動輪の速度平均値を含み得る。例えば、ロボットが、2つの駆動輪を備える場合、2つの駆動輪の速度平均値が、実際平均速度であり、説明の便宜上、実際平均速度を
Figure 2022550231000017
と表すことができ、モーター駆動情報は、ロボットのモーターの実際平均駆動信号値、即ち、ロボットの各駆動輪に対応するモーターの信号平均値を含み得る。例えば、ロボットが、2つの駆動輪を備え、駆動信号が、パルス幅変調信号である場合、実際平均駆動信号値は、2つの駆動輪に対応するモーターのパルス幅変調信号平均値であり得、説明の便宜上、平均駆動信号値を
Figure 2022550231000018
と表すことができ、そうすると、平均速度と平均駆動信号値との第2マッピング関係(説明の便宜上、第2マッピング関係を
Figure 2022550231000019
と表すことができる)を利用して、実際平均駆動信号値に対してマッピング処理を実行して、実際平均駆動信号値に対応する理論平均速度(説明の便宜上、理論平均速度を
Figure 2022550231000020
と表すことができる)を取得することができ、それにより、実際平均速度と理論平均速度との差異を利用して、第2状態ノイズを決定することができる。例えば、実際平均速度
Figure 2022550231000021
と理論平均速度
Figure 2022550231000022
との差の平方を第2状態ノイズとして使用することができる。第2マッピング関係は、事前に収集された複数対の平均速度と平均駆動信号値を統計し分析して得られることができる。例えば、ロボットが正常に走行する中で、N対の平均速度と平均駆動信号値を収集し、N対の平均速度と平均駆動信号値をフィッティングして、平均速度と平均駆動信号値との第2マッピング関係を取得し、Nの数値は、実際の状況に応じて設定することができ、ここでは限定しない。
上記のステップによって、ロボットの状態遷移ノイズを取得することができ、ここで、前記状態遷移ノイズは、式(4)で表すことができる。
Figure 2022550231000023
上記の式において、Qは、ロボットの状態遷移ノイズを表し、
Figure 2022550231000024
は、第1状態ノイズに対応する重み値を表し、
Figure 2022550231000025
は、第2状態ノイズに対応する重み値を表し、
Figure 2022550231000026
は、第1状態ノイズを表し、
Figure 2022550231000027
は、第2状態ノイズを表し、
Figure 2022550231000028
は、実際速度差を表し、
Figure 2022550231000029
は、第1マッピング関係を表し、αは、実際方向転換角度を表し、
Figure 2022550231000030
は、実際平均速度を表し、
Figure 2022550231000031
は、第2マッピング関係を表し、
Figure 2022550231000032
は、平均駆動信号値を表す。
開示された実施シナリオにおいて、上記のステップによって、状態遷移ノイズおよび測定干渉ノイズを取得することができる。もちろん、実際に適用するとき、実際の状況に応じて、上記のステップによって、状態遷移ノイズを取得し、測定干渉ノイズを固定値に設定することができ、理想的な状況である場合、測定干渉ノイズを0に設定することができ、即ち、状態遷移ノイズをロボットの状態ノイズとして直接に使用することができる。例えば、測定干渉ノイズを1、2、3などの非0値に設定することができ、さらに、測定干渉ノイズをホワイトノイズに設定することができ、ここでは限定しない。もちろん、実際の状況に応じて、上記のステップによって、測定干渉ノイズを取得し、状態遷移ノイズを固定値に設定することもでき、理想的な状況である場合、状態遷移ノイズを0に設定し、即ち、測定干渉ノイズをロボットの状態ノイズとして直接に使用することができ、さらに、状態遷移ノイズを1、2、3などの非0値に設定することもでき、さらに、状態遷移ノイズをホワイトノイズに設定することもでき、ここでは限定しない。
ステップS13において、状態ノイズを利用して、現在時刻に対応するロボットの実際状態情報を取得する。
いくつかの開示された実施例において、状態ノイズを利用して、ロボットの、前の時刻に対応する実際状態情報および現在時刻に対応する測定状態情報を処理して、現在時刻に対応するロボットの実際状態情報を取得することができる。例えば、カルマンフィルターを利用して状態ノイズと組み合わせて、ロボットの、前の時刻に対応する実際状態情報および現在時刻に対応する測定状態情報を処理して、現在時刻に対応するロボットの実際状態情報を取得することができる。
開示された実施シナリオにおいて、状態ノイズに基づいて、フィルターゲインを決定し、ロボットの、直前時刻に対応する実際状態情報および直前時刻に対応する実際走行情報を予測して、現在時刻に対応する予測状態情報を取得し、フィルターゲインのカルマンフィルターを利用して、現在時刻の予測状態情報を現在時刻の測定状態情報と融合して、現在時刻に対応するロボットの実際状態情報を取得することができる。
開示された実施シナリオにおいて、図2を参照すると、図2は、本願実施例のカルマンフィルターを利用して、ロボットの実際状態情報を決定する例示的なフローチャートであり、本願実施例による方法ステップは、ロボットなどのハードウェア機器によって実行され、または、プロセッサが、コンピュータ実行可能なコードを実行する方式によって実行されることができる。ここで、以下のステップによって、カルマンフィルターを利用してロボットの実際状態情報を決定することができる。
ステップS21において、ロボットの状態遷移パラメータおよび状態遷移ノイズを利用して、前の時刻に対応する事後確率推定共分散を処理して、現在時刻に対応する事前確率推定共分散を取得する。
いくつかの開示された実施例において、現在時刻が、k時刻であり、現在時刻の直前時刻が、k-1時刻であることを例として、前記現在時刻に対応する事前確率推定共分散は、式(5)で表すことができる。
Figure 2022550231000033
上記の式において、
Figure 2022550231000034
は、現在時刻に対応する事前確率推定共分散を表し、
Figure 2022550231000035
は、直前時刻に対応する事後確率推定共分散を表し、事後確率推定共分散は、直前時刻の実際状態情報
Figure 2022550231000036
の共分散を表し、即ち、直前時刻の実際状態情報
Figure 2022550231000037
の不確実度合いを表す。本願の実施シナリオに記載されているのは、現在時刻に対応する実際状態情報
Figure 2022550231000038
を取得することであるため、直前時刻の実際状態情報
Figure 2022550231000039
は、開示された実施シナリオで開示されるステップを参照して得られることができることに留意されたい。事後確率推定共分散の取得方式は、本願実施例における後文を参照することができる。さらに、Aは、行列の形式のロボットの状態遷移パラメータを表し、状態遷移パラメータAは、ロボットの運動モデルを表すために使用される。例えば、状態遷移パラメータAを使用して、ロボットが、特定の加速度で加速運動をすること、またはロボットが、特定の速度で等速運動をすることを表すことができ、ユーザによって設定することができ、
Figure 2022550231000040
は、状態遷移パラメータの転置を表し、Qは、状態遷移ノイズを表し、計算方式は、上記の関連する説明を参照できる。
ステップS22において、実際状態情報から測定状態情報への変換パラメータおよび測定干渉ノイズを利用して、現在時刻に対応する事前確率推定共分散を処理して、現在時刻に対応するフィルターゲインを取得する。
いくつかの開示された実施例において、依然として、現在時刻が、k時刻であり、現在時刻の直前時刻が、k-1時刻であることを例として、前記現在時刻に対応するフィルターゲインは、式(6)で表すことができる。
Figure 2022550231000041
上記の式において、
Figure 2022550231000042
は、現在時刻に対応するフィルターゲインを表し、Hは、行列の形式の変換パラメータを表し、変換パラメータHは、実際状態情報と測定状態情報との変換関係を説明するために使用され、例えば、実際状態情報と測定状態情報は、線性関係であることを説明するために使用され、例えば、変換パラメータHは、ユーザによって設定されることができ、例えば、変換パラメータHを単位行列に設定することができ、ここでは限定しない。
Figure 2022550231000043
は、変換パラメータの転置を表し、Rは、測定干渉ノイズを表し、計算方式は、上記の関連する説明を参照できる。
Figure 2022550231000044
は、現在時刻に対応する事前確率推定共分散を表し、事前確率推定共分散
Figure 2022550231000045
は、現在時刻に対応する予測状態情報
Figure 2022550231000046
の共分散を表し、即ち、現在時刻に対応する予測状態情報
Figure 2022550231000047
の不確実度合いを表し、計算方式は、上記の関連する説明を参照できる。
したがって、測定干渉ノイズおよび状態遷移ノイズによって、現在時刻に対応するフィルターゲインを決定することができる。いくつかの開示された実施例において、測定干渉ノイズおよび状態遷移ノイズのうちの少なくとも1つは、上記のステップによって計算されたものであり、例えば、測定干渉ノイズは、上記のステップによって計算されたものであり、または、状態遷移ノイズは、上記のステップによって計算されたものであり、または、測定干渉ノイズおよび状態遷移ノイズは、両方とも上記のステップによって計算されたものであり、ここでは限定しない。
ステップS23において、ロボットの状態遷移パラメータおよび入力状態遷移パラメータを使用して、ロボットの、直前時刻に対応する実際状態情報および直前時刻に対応する実際走行情報をそれぞれ処理して、現在時刻に対応する予測状態情報を取得する。
いくつかの開示された実施例において、依然として、現在時刻が、k時刻であり、現在時刻の直前時刻が、k-1時刻であることを例として、前記現在時刻に対応する予測状態情報は、式(7)で表すことができる。
Figure 2022550231000048
上記の式において、
Figure 2022550231000049
は、現在時刻に対応する予測状態情報を表し、
Figure 2022550231000050
は、直前時刻に対応する実際状態情報を表し、上記のように、本願の実施シナリオに記載されているのは、現在時刻に対応する実際状態情報
Figure 2022550231000051
を取得することあるため、直前時刻の実際状態情報
Figure 2022550231000052
は、本願の実施シナリオで開示されたステップを参照して得られることができる。特に、kが0である場合、実際状態情報
Figure 2022550231000053
は、0に初期化でき、
Figure 2022550231000054
は、直前時刻に対応する実際走行情報を表し、実際走行情報は、ロボットの走行角度情報、モーター駆動情報および走行速度情報を含み得、取得方式は、開示された実施例における関連する説明を参照できる。Aは、ロボットの状態遷移パラメータを表し、上記の説明を参照でき、Bは、入力状態遷移パラメータを表し、入力状態遷移パラメータBは、入力された実際走行情報と状態情報との変換関係を説明するために使用され、それにより、入力状態遷移パラメータBによって、入力された実際走行情報を状態情報に変換し、さらに、直前時刻に対応するロボットの実際状態情報と組み合わせて、現在時刻に対応するロボットの予測状態情報、即ち、理論上、現在時刻に対応するロボットの状態情報を取得することができる。
ステップS24において、現在時刻の予測状態情報を現在時刻の測定状態情報と融合して、現在時刻に対応するロボットの実際状態情報を取得する。
いくつかの開示された実施例において、依然として、現在時刻が、k時刻であり、現在時刻の直前時刻が、k-1時刻であることを例として、前記現在時刻に対応する実際状態情報は、式(8)で表すことができる。
Figure 2022550231000055
上記の式において、
Figure 2022550231000056
は、現在時刻に対応する実際状態情報を表し、
Figure 2022550231000057
は、現在時刻に対応する予測状態情報を表し、
Figure 2022550231000058
は、現在時刻に対応するフィルターゲインを表し、
Figure 2022550231000059
は、現在時刻の測定状態情報に対応し、Hは、実際状態情報から測定状態情報への変換パラメータを表し、上記の関連する説明を参照できる。即ち、
Figure 2022550231000060
は、測定状態情報と予測状態情報との残差を表し、フィルターゲイン
Figure 2022550231000061
および予測状態情報を利用して、当該残差を修正することによって、現在時刻に対応するロボットの実際状態情報
Figure 2022550231000062
を取得する。
ステップS25において、フィルターゲインおよび変換パラメータを利用して、現在時刻に対応する事前確率推定共分散を更新して、現在時刻に対応する事後確率推定共分散を取得する。
いくつかの開示された実施例において、依然として、現在時刻がk時刻であり、現在時刻の直前時刻がk-1時刻であることを例として、前記現在時刻に対応する事後確率推定共分散は、式(9)で表すことができる。
Figure 2022550231000063
上記の式において、
Figure 2022550231000064
は、現在時刻に対応する事後確率推定共分散を表し、Iは、単位行列を表し、
Figure 2022550231000065
は、行列の形式のフィルターゲインを表し、Hは、行列の形式の変換パラメータを表し、
Figure 2022550231000066
は、行列の形式の現在時刻に対応する事前確率推定共分散を表す。特に、kが0である時に、事後確率推定共分散
Figure 2022550231000067
は、すべて0である行列に初期化できる。
現在時刻に対応する事前確率推定共分散を更新して、現在時刻に対応する事後確率推定共分散を取得することができ、そのため、本願実施例におけるステップを再度実行して、次の時刻(即ち、k+1時刻)の実際状態情報を決定することができ、このように繰り返して、ロボットの走行プロセスで、各時刻に対応するロボットの実際状態情報を決定することができる。
上記の技術案は、ロボットの参照情報を取得し、参照情報は、いくつかの時刻に対応するロボットの測定状態情報、現在時刻に対応するロボットの実際走行情報を含み、参照情報に基づいて、ロボットの状態ノイズを決定して、状態ノイズを利用して、現在時刻に対応するロボットの実際状態情報を取得する。さらに、状態決定中では、大量の粒子を使用してシミュレートする必要なく、状態決定の速度を向上させることに役立つことができる。さらに、当該状態ノイズは、いくつかの時刻の測定状態情報および/または現在時刻の実際走行情報に基づいて決定されるものであるため、ロボットの外部測定視点および/またはロボットの自体状態視点からノイズを測定し、それにより、状態ノイズを実際の場合に近づけ、さらに、後続で決定される実際状態情報の精度を向上させることができる。
ここで、いくつかの開示された実施例において、ユーザを、異常の状態ノイズを早速に感知させ、ユーザ体験を向上させるために、状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行することもできる。プリセットの通知は、声、光、テキストのうちの少なくとも1つの形で実現できる。例えば、通知音声を放送し、または、リマインダを点滅し、または通知テキストを出力するなど、ここでは限定しない。
開示された実施シナリオにおいて、状態ノイズは、いくつかの測定状態情報を利用して得られた測定干渉ノイズを含み得、取得方式は、上記で開示された実施例における関連するステップを参照できる。さらに、プリセットのノイズ条件は、測定干渉ノイズが、第1ノイズ閾値より小さいことを含み得、第1ノイズ閾値の数値は、実際の状況に応じて設定することができる。測定干渉ノイズが、プリセットのノイズ条件を満たしない場合、第1警告メッセージを出力して、状態測定が干渉されたことを知らせることができ、それにより、状態測定が干渉された場合、ユーザを早速に感知させ、ユーザ体験を向上させることができる。
別の開示された実施シナリオにおいて、状態ノイズは、現在時刻の実際走行情報を利用して得られた状態遷移ノイズを含み得、取得方式は、上記で開示された実施例における関連するステップを参照できる。さらに、プリセットのノイズ条件は、状態遷移ノイズが第2ノイズ閾値より小さいことを含み得、第2ノイズ閾値の数値実際の状況に応じて設定でき、ここでは限定しない。状態遷移ノイズが、プリセットのノイズ条件を満たしない場合、第2警告メッセージを出力して、ロボットに車体が滑るリスクがあることを通知し、それにより、ロボットに車体が滑るリスクが発生した場合、ユーザを早速に感知させ、ユーザ体験を向上させることができる。
上記の第1警告メッセージ、第2警告メッセージは、声、光、テキストのうちの少なくとも1つの形で実現できる。例えば、通知音声を放送し、または、リマインダを点滅し、または通知テキストを出力するなど、ここでは限定しない。
本願実施例において、カルマンフィルターシステムを使用して、内蔵エンコーダと外部入力の融合測位を実現し、左右の輪の速度状態に従って状態遷移ノイズ推定を行い、さらに、前記ノイズ推定を使用して、外部入力変化が合理的であるか否かを判断し、最後に、判断結果に従って融合的に意思決定を実行し、測位の偽装を回避し、障害信号を送信して、以下の効果を得られることができる。(1)信号偽装の頑健性を向上させ、受信する干渉を減らす。(2)信号偽装が発生した場合、アラートを送信する。(3)先行技術で常に使用される大量の粒子モデルによる粒子フィルターを実施する方法と比較して、本方法の計算量は少なく、収束速度が速く、精度と速度に対するロボットの測位システムの要求を満たすことができる。
図3を参照すると、図3は、本願実施例のロボットの状態決定装置30の一実施例のフレームワークの概略図である。ロボットの状態決定装置30は、測定状態取得モジュール31、状態ノイズ決定モジュール32および実際状態取得モジュール33を備える。測定状態取得モジュール31は、ロボットの参照情報を取得するように構成され、ここで、参照情報は、いくつかの時刻に対応するロボットの測定状態情報、現在時刻に対応するロボットの実際走行情報のうちの少なくとも1つを含み、状態ノイズ決定モジュール32は、参照情報に基づいて、ロボットの状態ノイズを決定するように構成され、実際状態取得モジュール33は、前記状態ノイズを利用して、現在時刻に対応するロボットの実際状態情報を取得するように構成される。
上記の技術案は、ロボットの参照情報を取得し、且つ、参照情報は、いくつかの時刻に対応するロボットの測定状態情報、現在時刻に対応するロボットの実際走行情報を含み、参照情報に基づいて、ロボットの状態ノイズを決定して、状態ノイズを利用して、現在時刻に対応するロボットの実際状態情報を取得することにより、状態を決定するプロセスにおいて、大量の粒子でシミュレートする必要がなく、状態決定の速度を向上させるのに役立つことができる。さらに、当該状態ノイズは、いくつかの時刻の測定状態情報および/または現在時刻の実際走行情報に基づいて決定されるものであるため、ロボットの外部測定視点および/またはロボットの自体状態視点からノイズを測定し、それにより、状態ノイズを実際の場合に近づけ、さらに、後続で決定される実際状態情報の精度を向上させることができる。
いくつかの開示された実施例において、状態ノイズ決定モジュール32は、現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、ロボットの測定干渉ノイズを決定するように構成される、測定干渉決定サブモジュールを備え、状態ノイズ決定モジュール32は、現在時刻の実際走行情報を利用して、ロボットの状態遷移ノイズを決定するように構成される、状態遷移決定サブモジュールを備える。
上記の開示された実施例と異なり、現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、ロボットの測定干渉ノイズを決定して、外部測定の視点からロボットのノイズを決定することができ、それにより、走行プロセスにおけるロボットの外部の干渉を測定することができ、現在時刻の実際走行情報を利用して、ロボットの状態遷移ノイズを決定して、ロボットの自体状態の視点からロボットのノイズを決定することができ、それにより、走行プロセスにおけるロボットの内部の干渉を測定することができる。
いくつかの開示された実施例において、測定干渉決定サブモジュールは、現在時刻と前のいくつかの時刻の測定状態情報との離散度を取得するように構成される、離散取得ユニットを備え、測定干渉決定サブモジュールは、離散度を利用して、測定干渉ノイズを決定するように構成される、ノイズ決定ユニットを備える。
上記の開示された実施例と異なり、現在時刻と前のいくつかの時刻の測定状態情報との離散度を使用し、離散度を使用して測定干渉ノイズを決定して、走行プロセスにおけるロボットの外部の干渉を正確に測定することができる。
いくつかの開示された実施例において、現在時刻と前のいくつかの時刻の測定状態情報との離散度は、現在時刻と前のいくつかの時刻の測定状態情報との標準差である。
上記の開示された実施例と異なり、現在時刻と前のいくつかの時刻の測定状態情報との離散度を、現在時刻と前のいくつかの時刻の測定状態情報との標準差に設定することにより、離散度を決定する複雑さと計算量を減らすことに役立ち、状態を決定する速度を向上させることに役立つ。
いくつかの開示された実施例において、ノイズ決定ユニットは、離散度とプリセットのゲインパラメータとの積を測定干渉ノイズとして使用するように構成される。
上記の開示された実施例と異なり、離散度とプリセットのゲインパラメータとの積を測定干渉ノイズとして使用して、測定干渉ノイズの精度を向上させることに役立ち、状態決定の精度を向上させることに役立つことができる。
いくつかの開示された実施例において、実際走行情報は、ロボットの走行角度情報、モーター駆動情報および走行速度情報を含み、状態遷移決定サブモジュールは、第1状態ノイズおよび第2状態ノイズのうちの少なくとも1つを利用して、ロボットの状態遷移ノイズを取得するように構成され、ここで、第1状態ノイズは、走行角度情報および走行速度情報を利用して決定されたものであり、第2状態ノイズは、モーター駆動情報および走行速度情報を利用して決定されたものである。
上記の開示された実施例と異なり、実際走行情報をロボットの走行角度情報、モーター駆動情報および走行速度情報を含むように設定して、第1状態ノイズおよび第2状態ノイズのうちの少なくとも1つを利用して、ロボットの状態遷移ノイズを取得し、且つ、第1状態ノイズは、走行角度情報および走行速度情報を利用して決定されたものであり、第2状態ノイズは、モーター駆動情報および走行速度情報を利用して決定されたものであり、状態遷移ノイズの精度を向上させることに役立つことができる。
いくつかの開示された実施例において、ロボットは、駆動輪および方向転換輪を備え、駆動輪は、ロボットを走行するように駆動するために使用され、方向転換輪は、ロボットの走行方向を変換するために使用され、走行速度情報は、ロボットの駆動輪間の実際速度差を含み、走行角度情報は、ロボットの方向転換輪の実際の方向転換角度を含み、第1状態ノイズ決定ユニットは、速度差と方向転換角度との第1マッピング関係を利用して、実際方向転換角度に対してマッピング処理を実行して、実際方向転換角度に対応する理論速度差を取得するように構成され、第1マッピングサブユニットを備え、第1状態ノイズ決定ユニットは、実際速度差と理論速度差との差異を利用して、第1状態ノイズを決定するように構成される、第1状態ノイズ決定サブユニットを備える。
上記の開示された実施例と異なり、走行速度情報を、ロボットの駆動輪間の実際速度差を含むように設定し、走行角度情報を、ロボットの方向転換輪の実際方向転換角度を含むように設定して、速度差と方向転換角度との第1マッピング関係を利用して、実際方向転換角度に対してマッピング処理を実行して、実際方向転換角度に対応する理論速度差を取得し、実際速度差と理論速度差との差異を利用して、第1状態ノイズを決定することにより、ロボットの方向転換輪の視点から、ロボットの第1状態ノイズを決定することができる。
いくつかの開示された実施例において、ロボットは、駆動輪を備え、駆動輪は、ロボットが走行するように駆動するために使用され、走行速度情報は、ロボットの駆動輪の実際平均速度を含み、モーター駆動情報は、ロボットのモーターの実際平均駆動信号値を含み、第2状態ノイズ決定ユニットは、平均速度と平均駆動信号値との第2マッピング関係を利用して、実際平均駆動信号値に対してマッピング処理を実行して、実際平均駆動信号値に対応する理論平均速度を取得するように構成される、第2マッピングサブユニットを備え、第2状態ノイズ決定ユニットは、実際平均速度と理論平均速度との差異を利用して、第2状態ノイズを決定するように構成される、第2状態ノイズ決定サブユニットを備える。
上記の開示された実施例と異なり、走行速度情報を、ロボットの駆動輪の実際平均速度を含むように設定し、モーター駆動情報を、ロボットのモーターの実際平均駆動信号値を含むように設定して、平均速度と平均駆動信号値との第2マッピング関係を利用して、実際平均駆動信号値に対してマッピング処理を実行して、実際平均駆動信号値に対応する理論平均速度を取得し、実際平均速度と理論平均速度との差異を利用して、第2状態ノイズを決定することにより、ロボットの駆動輪の視点から、ロボットの第2状態ノイズを決定することができる。
いくつかの開示された実施例において、第1状態ノイズ決定サブユニットは、実際速度差と理論速度差との差の平方を第1状態ノイズとして使用するように構成され、第2状態ノイズ決定サブユニットは、実際平均速度と理論平均速度との差の平方を第2状態ノイズとして使用するように構成される。
上記の開示された実施例と異なり、実際速度差と理論速度差との差の平方を第1状態ノイズとして使用し、実際平均速度と理論平均速度との差の平方を第2状態ノイズとして使用して、第1状態ノイズおよび第2状態ノイズの計算の複雑さと計算量を減らし、状態決定の速度を向上させることに役立つことができる。
いくつかの開示された実施例において、実際状態取得モジュール33は、状態ノイズを利用して、ロボットの、前の時刻に対応する実際状態情報および現在時刻に対応する測定状態情報を処理して、現在時刻に対応するロボットの実際状態情報を取得するように構成される。
上記の実施例と異なり、状態ノイズを利用して、ロボットの、現在時刻に対応する測定状態情報および前の時刻に対応する実際状態情報を処理することにより、ロボットを、現在時刻の測定状態情報と前の時刻の実際状態情報との間でバランスを取れるようにすることに役立ち、決定された実際状態情報を、測定状態情報に対して修正することができるようにし、それによって、ロボットの状態決定の精度を向上させることに役立つことができる。
いくつかの開示された実施例において、実際状態取得モジュール33は、状態ノイズに基づいて、フィルターゲインを決定し、ロボットの、直前時刻に対応する実際状態情報および直前時刻に対応する実際走行情報を予測して、現在時刻に対応する予測状態情報を取得し、フィルターゲインのカルマンフィルターを利用して、現在時刻の予測状態情報を現在時刻の測定状態情報と融合して、現在時刻に対応するロボットの実際状態情報を取得するように構成される。
上記の開示された実施例と異なり、状態ノイズに基づいて、フィルターゲインを決定し、ロボットの、直前時刻に対応する実際状態情報および直前時刻に対応する実際走行情報を予測して、現在時刻に対応する予測状態情報を取得し、フィルターゲインのカルマンフィルターを利用して、現在時刻の予測状態情報を現在時刻の測定状態情報と融合して、外部信号に対する頑健性を増強し、それにより、現在時刻に対応する実際状態情報を正確に決定することができる。
いくつかの開示された実施例において、ロボットの状態決定装置30は、さらに、前記状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行するように構成される、通知モジュールを備える。
上記の開示された実施例と異なり、状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行して、ユーザを、異常の状態ノイズを感知させ、ユーザ体験を向上させることができる。
いくつかの開示された実施例において、状態ノイズは、いくつかの測定状態情報を利用して得られた測定干渉ノイズを含み、対応的に、プリセットのノイズ条件は、測定干渉ノイズが、第1ノイズ閾値より小さいことを含み、通知モジュールは、測定干渉ノイズが、プリセットのノイズ条件を満たしない場合、第1警告メッセージを出力して、状態測定が干渉されたことを知らせるように構成される、第1早期警告サブモジュールを備え、および/または、状態ノイズは、現在時刻の実際走行情報を利用して得られた状態遷移ノイズを含み、対応的に、プリセットのノイズ条件は、状態遷移ノイズが第2ノイズ閾値より小さいことを含み、通知モジュールは、状態遷移ノイズが、プリセットのノイズ条件を満たしない場合、第2警告メッセージを出力して、ロボットに車体が滑るリスクがあることを知らせるように構成される、第2早期警告サブモジュールを備える。
上記の開示された実施例と異なり、測定干渉ノイズが、プリセットの条件を満たしない場合、第1警告メッセージを出力して、状態測定が干渉されたことを通知し、それにより、状態測定が干渉された場合、ユーザを早速に感知させ、ユーザの体験を向上させることができる。状態遷移ノイズが、プリセットの条件を満たしない場合、第2警告メッセージを出力して、ロボットに車体が滑るリスクがあることを通知し、それにより、ロボットに車体が滑るリスクが発生した場合、ユーザを早速に感知させ、ユーザ体験を向上させることができる。
いくつかの開示された実施例において、測定状態取得モジュール31は、ロボットの周囲環境に対して画像収集を実行して、現在時刻に対応する環境画像データを取得するように構成される、データ収集サブモジュールを備え、測定状態取得モジュール31は、現在時刻の環境画像データに基づいて、現在時刻に対応するロボットの測定状態情報を決定するように構成される、測定状態決定サブモジュールを備え、ここで、測定状態情報および実際状態情報のいずれも、ロボットの位置、ロボットの姿勢、ロボットの速度のうちの少なくとも1つを含む。
上記の開示された実施例と異なり、ロボット周囲環境に対して画像収集を実行することにより、現在時刻に対応する環境画像世帯数を取得し、現在時刻の環境画像データに基づいて、現在時刻に対応するロボットの測定状態情報を決定し、且つ、測定状態情報および実際状態情報を、両方とも、ロボットの位置、ロボットの姿勢およびロボットの速度のうちの少なくとも1つを含むように設定し、それにより、現在時刻に対応するロボットの測定状態情報を迅速に取得することができ、さらに、ロボットの状態決定の速度を向上させることに役立つことができる。
図4を参照すると、図4は、本願実施例のロボット40の実施例のフレームワークの概略図である。ロボット40は、ロボット本体41およびロボット本体41に設置されたメモリ42とプロセッサ43を備え、メモリ42とプロセッサ43は、互いに接続され、プロセッサ43は、メモリ42に記憶されたプログラム命令を実行して、上記の任意の1つの状態決定方法実施例のステップを実現するように構成される。
いくつかの開示された実施例において、プロセッサ43は、その自体およびメモリ42を制御して、上記の任意の1つの状態決定方法実施例のステップを実現するように構成される。プロセッサ43は、中央処理ユニット(CPU:Central Processing Unit)とも称し得る。プロセッサ43は、信号の処理能力を有する集積回路チップであり得る。プロセッサ43は、汎用プロセッサ、デジタル信号プロセッサ(DSP:Digital Signal Processor)、特定用途向け集積回路(ASIC:Application Specific Integrated Circuit)、フィールドプログラマブルゲートアレイ(FPGA:Field-Programmable Gate Array)または他のプログラマブルロジックデバイス、ディスクリートゲート、またはトランジスタロジックデバイス、ディスクリートハードウェアコンポーネントなどであってもよい。汎用プロセッサは、マイクロプロセッサであり得、または当該プロセッサは、任意の従来のプロセッサなどであり得る。さらに、プロセッサ43は、集積回路チップによって一緒に実現されることができる。
上記の技術案において、状態ノイズは、取得されたいくつかの測定状態情報および/または現在の実際走行情報に従って決定され、ロボットの外部測定視点および/またはロボットの自体状態視点からノイズを測定することができ、それにより、状態ノイズを実際の場合に近づけ、さらに、後続で決定される実際状態情報の精度を向上させることができる。
いくつかの開示された実施例において、当該ロボット40は、さらに、ロボット本体41に設置されたいくつかの輪および輪を行走するように駆動するためのモーターと、輪子を方向転換するように駆動するためのステアリングギアを備える。例えば、当該ロボットは、第1輪グループおよび第2輪グループを備え、第1輪グループは、モーターと接続して、駆動輪として使用され、第2輪グループは、ステアリングギアと接続され、方向転換輪として使用される。さらに、ロボットの走行情報を取得するために、ロボット40は、さらに、速度測定アセンブリを備えることができ、当該速度測定アセンブリは、駆動輪の速度を取得するために、駆動輪に設置されることができる。一適用シナリオにおいて、ロボット40は、4つの輪を備え、ここで、2つの前輪は、方向転換輪として使用され、2つの後輪は、駆動輪として使用され、且つ、後輪に対応する速度を取得するために、各後輪には、エンコーダが設置される。したがって、ロボットは、エンコーダを読み取ることにより、走行速度を取得することができ、ステアリングギア制御記録を読み取ることにより、走行角度を取得することができる。さらに、異なる実際の適用ニーズによって、ロボット本体41を異なる形状に設定することができる。例えば、速達用途について、ロボット本体41を、自動車、ミニバスなどの形状に設定することができ、または、サービス案内用途について、ロボット本体41を、一般的な人間の形状、漫画動物などの形状に設定することができ、実際の適用ニーズによって設定することができ、ここではいちいち列挙をしない。
いくつかの開示された実施例において、測定状態情報を取得するために、ロボット40に、さらに、撮影デバイスを設置することもでき、それにより、撮影デバイスによって撮影された環境画像によって、ロボット40の測定状態情報を決定する。
図5を参照すると、図5は、本願実施例のコンピュータ可読記憶媒体50の一実施例のフレームワークの概略図である。コンピュータ可読記憶媒体50は、プロセッサによって実行されることができるプログラム命令501を記憶し、プログラム命令501は、上記の任意の1つの状態決定方法実施例のステップを実現するために使用される。
上記の技術案において、状態ノイズは、取得されたいくつかの測定状態情報および/または現在の実際走行情報に従って決定され、ロボットの外部測定視点および/またはロボットの自体状態視点からノイズを測定することができ、それにより、状態ノイズを実際の場合に近づけ、さらに、後続で決定される実際状態情報の精度を向上させることができる。
いくつかの開示された実施例において、本願実施例は、コンピュータ可読コードを含む、コンピュータプログラムを提供し、前記コンピュータ可読コードがロボットで実行されるとき、前記ロボット内のプロセッサは、上記の方法を実現するために実行される。
本願によるいくつかの実施例では、開示された方法および装置は、他の方法で実現されることができることを理解されたい。例えば、上記で説明された装置の実施形態は、例示的なものに過ぎず、例えば、モジュールまたはユニットの分割は、論理機能の分割に過ぎず、実際に実現することには、別の分割方式があり、例えば、ユニットまたはコンポーネントを別のシステムに統合または集積してもよいし、特徴の一部を無視するか実行しなくてもよい。さらに、表示または議論される相互結合、または直接結合、または通信接続は、いくつかのインターフェースを使用して実現することができ、装置またはユニット間の間接結合または通信接続は、電気的または機械的な形であってもよく、他の形であってもよい。
分離部品として説明されるユニットは、物理的に分離されなくてもよく、ユニットとして表示される部品は、物理的ユニットであってもなくてもよい。つまり、1箇所に配置されてもよく、ネットワークユニットに分散されてもよい。実際のニーズに応じて、その中の一部またはすべてのユニットを選択して、本実施形態の技術案の目的を実現することができる。
さらに、本願の各実施例における各機能ユニットは、1つの処理ユニットに統合されてもよく、または各ユニットが、物理的に別々に存在してもよく、または2つまたは2つ以上のユニットが1つのユニットに統合されてもよい。前記統合されたユニットは、ハードウェアの形で実装されてもよく、ソフトウェア機能ユニットの形で実装されてもよい。
統合されたユニットが、ソフトウェア機能ユニットの形で実現され、かつ独立した製品として販売または使用される場合、コンピュータ可読記憶媒体に記憶されることができる。このような理解に基づいて、本願実施例の技術的解決策は、本質的にまたは先行技術に対して寄与する部分または前記技術的解決策のすべてまたは一部は、ソフトウェア製品の形で具現されることができ、当該コンピュータソフトウェア製品は、1つの記憶媒体に記憶され、1台のコンピュータ機器(パーソナルコンピュータ、サーバ、またはネットワーク機器等であり得る)またはプロセッサ(Processor)に本願実施例の各実施形態の方法の全部または一部のステップを実行させるためのいくつかの命令を含む。前述した記憶媒体は、Uディスク、モバイルハードディスク、読み取り専用メモリ(ROM:Read-Only Memory)、ランダムアクセスメモリ(RAM:Random Access Memory)、磁気ディスクまたは光ディスク等のプログラムコードを記憶することができる様々な媒体を含む。
本願実施例は、状態決定方法および装置、ロボット、記憶媒体並びにコンピュータプログラムを提供し、前記方法は、前記ロボットの参照情報を取得することであって、ここで、前記参照情報は、いくつかの時刻に対応する前記ロボットの測定状態情報、現在時刻に対応する前記ロボットの実際走行情報のうちの少なくとも1つを含むことと、前記参照情報に基づいて、前記ロボットの状態ノイズを決定することと、前記状態ノイズを利用して、前記現在時刻に対応する前記ロボットの実際状態情報を取得することと、を含む。本願実施例によるロボットの状態決定方法によれば、状態を決定するプロセスでは、大量の粒子を使用してシミュレートする必要なく、状態決定の速度を向上させることに役立つことができる。さらに、当該状態ノイズは、取得されたいくつかの測定状態情報および/または現在の実際走行情報に従って決定されたものであるため、ロボットの外部測定視点および/またはロボットの自体状態視点からノイズを測定し、それにより、状態ノイズを実際の場合に近づけ、さらに、後続で決定される実際状態情報の精度を向上させることができる。
本願実施例は、コンピュータ可読コードを含む、コンピュータプログラムを提供し、前記コンピュータ可読コードが、ロボットで実行されるとき、前記ロボット内のプロセッサは、上記の状態決定方法を実現するために実行される。
例えば、本願は以下の項目を提供する。
(項目1)
ロボットの状態決定方法であって、
前記ロボットの参照情報を取得することであって、前記参照情報は、いくつかの時刻に対応する前記ロボットの測定状態情報、現在時刻に対応する前記ロボットの実際走行情報のうちの少なくとも1つを含むことと、
前記参照情報に基づいて、前記ロボットの状態ノイズを決定することと、
前記状態ノイズを利用して、前記現在時刻に対応する前記ロボットの実際状態情報を取得することと、を含む、ロボットの状態決定方法。
(項目2)
前記参照情報に基づいて、前記ロボットの状態ノイズを決定することは、
前記現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、前記ロボットの測定干渉ノイズを決定すること、
および/または、前記現在時刻の実際走行情報を利用して、前記ロボットの状態遷移ノイズを決定することを含む、
項目1に記載の状態決定方法。
(項目3)
前記現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、前記ロボットの測定干渉ノイズを決定することは、
前記現在時刻と前のいくつかの時刻の測定状態情報との離散度を取得することと、
前記離散度を利用して、前記測定干渉ノイズを決定することと、を含む、
項目2に記載の状態決定方法。
(項目4)
前記現在時刻と前のいくつかの時刻の測定状態情報との離散度は、前記現在時刻と前のいくつかの時刻の測定状態情報との標準差であり、対応的に、
前記離散度を利用して、前記測定干渉ノイズを決定することは、
前記離散度とプリセットのゲインパラメータとの積を前記測定干渉ノイズとして使用することを含む、
項目3に記載の状態決定方法。
(項目5)
前記実際走行情報は、前記ロボットの走行角度情報、モーター駆動情報および走行速度情報を含み、
前記現在時刻の実際走行情報を利用して、前記ロボットの状態遷移ノイズを決定することは、
第1状態ノイズ、第2状態ノイズのうちの少なくとも1つを利用して、前記ロボットの前記状態遷移ノイズを取得することを含み、
前記第1状態ノイズは、前記走行角度情報および前記走行速度情報を利用して決定されたものであり、前記第2状態ノイズは、前記モーター駆動情報および前記走行速度情報を利用して決定されたものである、
項目2ないし4のいずれか一項に記載の状態決定方法。
(項目6)
前記ロボットは、駆動輪および方向転換輪を備え、前記駆動輪は、前記ロボットを走行するように駆動するために使用され、前記方向転換輪は、前記ロボットの走行方向を変換するために使用され、前記走行速度情報は、前記ロボットの駆動輪間の実際の速度差を含み、前記走行角度情報は、前記ロボットの方向転換輪の実際の方向転換角度を含み、
対応的に、前記第1状態ノイズ、第2状態ノイズのうちの少なくとも1つを利用して、前記ロボットの前記状態遷移ノイズを取得する前に、前記状態決定方法は、
速度差と方向転換角度との第1マッピング関係を利用して、前記実際の方向転換角度に対してマッピング処理を実行して、前記実際の方向転換角度に対応する理論速度差を取得することと、
前記実際速度差と前記理論速度差との差異を利用して、前記第1状態ノイズを決定することと、をさらに含み、および/または、
前記ロボットは、駆動輪を備え、前記駆動輪は、前記ロボットを走行するように駆動するために使用され、前記走行速度情報は、前記ロボットの駆動輪の実際平均速度を含み、前記モーター駆動情報は、前記ロボットのモーターの実際平均駆動信号値を含み、
対応的に、前記第1状態ノイズ、第2状態ノイズのうちの少なくとも1つを利用して、前記ロボットの前記状態遷移ノイズを取得する前に、前記状態決定方法は、
平均速度と平均駆動信号値との第2マッピング関係を利用して、前記実際平均駆動信号値に対してマッピング処理を実行して、前記実際平均駆動信号値に対応する理論平均速度を取得することと、
前記実際平均速度と前記理論平均速度との差異を利用して、前記第2状態ノイズを決定することと、をさらに含む、
項目5に記載の状態決定方法。
(項目7)
前記実際速度差と前記理論速度差との差異を利用して、前記第1状態ノイズを決定することは、
前記実際速度差と前記理論速度差との差の平方を前記第1状態ノイズとして使用することを含み、
前記実際平均速度と前記理論平均速度との差異を利用して、前記第2状態ノイズを決定することは、
前記実際平均速度と前記理論平均速度との差の平方を前記第2状態ノイズとして使用することを含む、
項目6に記載の状態決定方法。
(項目8)
前記状態ノイズを利用して、前記現在時刻に対応する前記ロボットの実際状態情報を取得することは、
前記状態ノイズを利用して、前記ロボットの、前の時刻に対応する実際状態情報および前記現在時刻に対応する測定状態情報を処理して、前記現在時刻に対応する前記ロボットの実際状態情報を取得することを含む、
項目1ないし7のいずれか一項に記載の状態決定方法。
(項目9)
前記状態ノイズを利用して、前記ロボットの、前の時刻に対応する実際状態情報および前記現在時刻に対応する測定状態情報を処理して、前記現在時刻に対応する前記ロボットの実際状態情報を取得することは、
前記状態ノイズに基づいて、フィルターゲインを決定することと、
前記ロボットの、直前時刻に対応する実際状態情報および前記直前時刻に対応する実際走行情報を予測して、現在時刻に対応する予測状態情報を取得することと、
前記フィルターゲインのカルマンフィルターを利用して、前記現在時刻の予測状態情報を前記現在時刻の測定状態情報と融合して、前記現在時刻に対応する前記ロボットの実際状態情報を取得することと、を含む、
項目8に記載の状態決定方法。
(項目10)
前記状態ノイズに基づいて、フィルターゲインを決定することは、
前記ロボットの状態遷移パラメータおよび状態遷移ノイズを利用して、前の時刻に対応する事後確率推定共分散を処理して、現在時刻に対応する事前確率推定共分散を取得し、実際状態情報から測定状態情報への変換パラメータおよび測定干渉ノイズを利用して、前記現在時刻に対応する事前確率推定共分散を処理して、現在時刻に対応するフィルターゲインを取得することを含み、
前記ロボットの、直前時刻に対応する実際状態情報および前記直前時刻に対応する実際走行情報を予測して、現在時刻に対応する予測状態情報を取得することは、前記ロボットの状態遷移パラメータおよび入力状態遷移パラメータを使用して、ロボットの、直前時刻に対応する実際状態情報および直前時刻に対応する実際走行情報をそれぞれ処理して、現在時刻に対応する予測状態情報を取得することを含む、
項目9に記載の状態決定方法。
(項目11)
前記参照情報に基づいて、前記ロボットの状態ノイズを決定した後、前記状態決定方法は、
前記状態ノイズがプリセットのノイズ条件を満たしない場合、プリセットの通知を実行することをさらに含む、
項目1ないし10のいずれか一項に記載の状態決定方法。
(項目12)
前記状態ノイズは、前記現在時刻および前のいくつかの時刻の測定状態情報を利用して得られた測定干渉ノイズを含み、対応的に、前記プリセットのノイズ条件は、前記測定干渉ノイズが、第1ノイズ閾値より小さいことを含み、前記状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行することは、
前記測定干渉ノイズが前記プリセットのノイズ条件を満たしない場合、第1警告メッセージを出力することを含み、前記第1警告メッセージは、状態測定が干渉されたことを知らせるために使用され、
および/または、前記状態ノイズは、前記現在時刻の実際走行情報を利用して得られた状態遷移ノイズを含み、対応的に、前記プリセットのノイズ条件は、前記状態遷移ノイズが第2ノイズ閾値より小さいことを含み、前記状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行することは、
前記状態遷移ノイズが前記プリセットのノイズ条件を満たしない場合、第2警告メッセージを出力することを含み、前記第2警告メッセージは、前記ロボットに車体が滑るリスクがあることを知らせるために使用される、
項目11に記載の状態決定方法。
(項目13)
前記ロボットの参照情報を取得することは、
前記ロボットの周囲環境に対して画像収集を実行して、現在時刻に対応する環境画像データを取得することと、
前記現在時刻の環境画像データに基づいて、現在時刻に対応する前記ロボットの測定状態情報を決定することと、を含み、
前記測定状態情報および実際状態情報のいずれも、前記ロボットの位置、前記ロボットの姿勢、前記ロボットの速度のうちの少なくとも1つを含む、
項目1ないし12のいずれか一項に記載の状態決定方法。
(項目14)
ロボットの状態決定装置であって、
前記ロボットの参照情報を取得するように構成される測定状態取得モジュールであって、前記参照情報は、いくつかの時刻に対応する前記ロボットの測定状態情報、現在時刻に対応する前記ロボットの実際走行情報のうちの少なくとも1つを含む、測定状態取得モジュールと、
前記参照情報に基づいて、前記ロボットの状態ノイズを決定するように構成される、状態ノイズ決定モジュールと、
前記状態ノイズを利用して、前記現在時刻に対応する前記ロボットの実際状態情報を取得するように構成される、実際状態取得モジュールと、を備える、ロボットの状態決定装置。
(項目15)
前記状態ノイズ決定モジュールは、
前記現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、前記ロボットの測定干渉ノイズを決定するように構成される、測定干渉決定サブモジュールと、
前記現在時刻の実際走行情報を利用して、前記ロボットの状態遷移ノイズを決定するように構成される、状態遷移決定サブモジュールと、を備える、
項目14に記載の状態決定装置。
(項目16)
測定干渉決定サブモジュールは、
前記現在時刻と前のいくつかの時刻の測定状態情報との離散度を取得するように構成される、離散取得ユニットと、
前記離散度を利用して、前記測定干渉ノイズを決定するように構成される、ノイズ決定ユニットと、を備える、
項目15に記載の状態決定装置。
(項目17)
前記現在時刻と前のいくつかの時刻の測定状態情報との離散度は、前記現在時刻と前のいくつかの時刻の測定状態情報との標準差であり、対応的に、
前記ノイズ決定ユニットは、前記離散度とプリセットのゲインパラメータとの積を前記測定干渉ノイズとして使用するように構成される、
項目16に記載の状態決定装置。
(項目18)
前記実際走行情報は、前記ロボットの走行角度情報、モーター駆動情報および走行速度情報を含み、
前記状態遷移決定サブモジュールは、第1状態ノイズ、第2状態ノイズのうちの少なくとも1つを利用して、前記ロボットの前記状態遷移ノイズを取得するように構成され、
前記第1状態ノイズは、前記走行角度情報および前記走行速度情報を利用して決定されたものであり、前記第2状態ノイズは、前記モーター駆動情報および前記走行速度情報を利用して決定されたものである、
項目15ないし17のいずれか一項に記載の状態決定装置。
(項目19)
前記ロボットは、駆動輪および方向転換輪を備え、前記駆動輪は、前記ロボットを走行するように駆動するために使用され、前記方向転換輪は、前記ロボットの走行方向を変換するために使用され、前記走行速度情報は、前記ロボットの駆動輪間の実際の速度差を含み、前記走行角度情報は、前記ロボットの方向転換輪の実際の方向転換角度を含み、
対応的に、前記状態決定装置は、さらに、第1状態ノイズ決定ユニットを備え、前記第1状態ノイズ決定ユニットは、
速度差と方向転換角度との第1マッピング関係を利用して、実際の方向転換角度に対してマッピング処理を実行して、実際の方向転換角度に対応する理論速度差を取得するように構成される、第1マッピングサブユニットと、
実際速度差と理論速度差との差異を利用して、第1状態ノイズを決定するように構成される、第1状態ノイズ決定サブユニットと、を備え、
および/または、前記ロボットは、駆動輪を備え、前記駆動輪は、前記ロボットを走行するように駆動するために使用され、前記走行速度情報は、前記ロボットの駆動輪の実際平均速度を含み、前記モーター駆動情報は、ロボットのモーターの実際平均駆動信号値を含み、
対応的に、前記状態決定装置は、さらに、第2状態ノイズ決定ユニットを備え、前記第2状態ノイズ決定ユニットは、
平均速度と平均駆動信号値との第2マッピング関係を利用して、実際平均駆動信号値に対してマッピング処理を実行して、実際平均駆動信号値に対応する理論平均速度を取得するように構成される、第2マッピングサブユニットと、
実際平均速度と理論平均速度との差異を利用して、第2状態ノイズを決定するように構成される、第2状態ノイズ決定サブユニットと、を備える、
項目18に記載の状態決定装置。
(項目20)
前記第1状態ノイズ決定サブユニットは、実際速度差と理論速度差との差の平方を第1状態ノイズとして使用するように構成され、
前記第2状態ノイズ決定サブユニットは、実際平均速度と理論平均速度との差の平方を第2状態ノイズとして使用するように構成される、
項目19に記載の状態決定装置。
(項目21)
前記実際状態取得モジュールは、記状態ノイズを利用して、ロボットの、前の時刻に対応する実際状態情報および現在時刻に対応する測定状態情報を処理して、現在時刻に対応するロボットの実際状態情報を取得するように構成される、
項目14ないし20のいずれか一項に記載の状態決定装置。
(項目22)
前記実際状態取得モジュールは、状態ノイズに基づいて、フィルターゲインを決定し、ロボットの、直前時刻に対応する実際状態情報および直前時刻に対応する実際走行情報を予測して、現在時刻に対応する予測状態情報を取得し、フィルターゲインのカルマンフィルターを利用して、現在時刻の予測状態情報を現在時刻の測定状態情報と融合して、現在時刻に対応するロボットの実際状態情報を取得するように構成される、
項目21に記載の状態決定装置。
(項目23)
前記状態決定装置は、さらに、
前記状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行するように構成される、通知モジュールを備える、
項目14ないし22のいずれか一項に記載の状態決定装置。
(項目24)
前記状態ノイズは、いくつかの測定状態情報を利用して得られた測定干渉ノイズを含み、対応的に、前記プリセットのノイズ条件は、測定干渉ノイズが、第1ノイズ閾値より小さいことを含み、前記通知モジュールは、測定干渉ノイズが、プリセットのノイズ条件を満たしない場合、第1警告メッセージを出力するように構成される、第1早期警告サブモジュールを備え、前記第1警告メッセージは、状態測定が干渉されたことを知らせるために使用され、
および/または、前記状態ノイズは、現在時刻の実際走行情報を利用して得られた状態遷移ノイズを含み、対応的に、前記プリセットのノイズ条件は、状態遷移ノイズが第2ノイズ閾値より小さいことを含み、前記通知モジュールは、状態遷移ノイズが、プリセットのノイズ条件を満たしない場合、第2警告メッセージを出力するように構成される、第2早期警告サブモジュールを備え、前記第2警告メッセージは、ロボットに車体が滑るリスクがあることを知らせるために使用される、
項目23に記載の状態決定装置。
(項目25)
前記測定状態取得モジュールは、
ロボットの周囲環境に対して画像収集を実行して、現在時刻に対応する環境画像データを取得するように構成される、データ収集サブモジュールと、
現在時刻の環境画像データに基づいて、現在時刻に対応するロボットの測定状態情報を決定するように構成される、測定状態決定サブモジュールと、を備え、
前記測定状態情報および実際状態情報のいずれも、前記ロボットの位置、前記ロボットの姿勢、前記ロボットの速度のうちの少なくとも1つを含む、
項目14ないし24のいずれか一項に記載の状態決定装置。
(項目26)
ロボット本体および前記ロボット本体に設置されるメモリとプロセッサを備え、前記プロセッサとメモリは、互いに接続され、前記プロセッサは、前記メモリに記憶されるプログラム命令を実行して、項目1ないし13のいずれか一項に記載の状態決定方法を実現するように構成される、ロボット。
(項目27)
プログラム命令を記憶する、コンピュータ可読記憶媒体であって、前記プログラム命令は、プロセッサによって実行されるとき、前記プロセッサに、項目1ないし13のいずれか一項に記載の状態決定方法を実行させる、コンピュータ可読記憶媒体。
(項目28)
コンピュータ可読コードを含む、コンピュータプログラムであって、前記コンピュータ可読コードが、ロボットで実行されるとき、前記ロボット内のプロセッサに、項目1ないし13のいずれか一項に記載の状態決定方法を実行させる、コンピュータプログラム。

Claims (28)

  1. ロボットの状態決定方法であって、
    前記ロボットの参照情報を取得することであって、前記参照情報は、いくつかの時刻に対応する前記ロボットの測定状態情報、現在時刻に対応する前記ロボットの実際走行情報のうちの少なくとも1つを含むことと、
    前記参照情報に基づいて、前記ロボットの状態ノイズを決定することと、
    前記状態ノイズを利用して、前記現在時刻に対応する前記ロボットの実際状態情報を取得することと、を含む、ロボットの状態決定方法。
  2. 前記参照情報に基づいて、前記ロボットの状態ノイズを決定することは、
    前記現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、前記ロボットの測定干渉ノイズを決定すること、
    および/または、前記現在時刻の実際走行情報を利用して、前記ロボットの状態遷移ノイズを決定することを含む、
    請求項1に記載の状態決定方法。
  3. 前記現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、前記ロボットの測定干渉ノイズを決定することは、
    前記現在時刻と前のいくつかの時刻の測定状態情報との離散度を取得することと、
    前記離散度を利用して、前記測定干渉ノイズを決定することと、を含む、
    請求項2に記載の状態決定方法。
  4. 前記現在時刻と前のいくつかの時刻の測定状態情報との離散度は、前記現在時刻と前のいくつかの時刻の測定状態情報との標準差であり、対応的に、
    前記離散度を利用して、前記測定干渉ノイズを決定することは、
    前記離散度とプリセットのゲインパラメータとの積を前記測定干渉ノイズとして使用することを含む、
    請求項3に記載の状態決定方法。
  5. 前記実際走行情報は、前記ロボットの走行角度情報、モーター駆動情報および走行速度情報を含み、
    前記現在時刻の実際走行情報を利用して、前記ロボットの状態遷移ノイズを決定することは、
    第1状態ノイズ、第2状態ノイズのうちの少なくとも1つを利用して、前記ロボットの前記状態遷移ノイズを取得することを含み、
    前記第1状態ノイズは、前記走行角度情報および前記走行速度情報を利用して決定されたものであり、前記第2状態ノイズは、前記モーター駆動情報および前記走行速度情報を利用して決定されたものである、
    請求項2ないし4のいずれか一項に記載の状態決定方法。
  6. 前記ロボットは、駆動輪および方向転換輪を備え、前記駆動輪は、前記ロボットを走行するように駆動するために使用され、前記方向転換輪は、前記ロボットの走行方向を変換するために使用され、前記走行速度情報は、前記ロボットの駆動輪間の実際の速度差を含み、前記走行角度情報は、前記ロボットの方向転換輪の実際の方向転換角度を含み、
    対応的に、前記第1状態ノイズ、第2状態ノイズのうちの少なくとも1つを利用して、前記ロボットの前記状態遷移ノイズを取得する前に、前記状態決定方法は、
    速度差と方向転換角度との第1マッピング関係を利用して、前記実際の方向転換角度に対してマッピング処理を実行して、前記実際の方向転換角度に対応する理論速度差を取得することと、
    前記実際速度差と前記理論速度差との差異を利用して、前記第1状態ノイズを決定することと、をさらに含み、および/または、
    前記ロボットは、駆動輪を備え、前記駆動輪は、前記ロボットを走行するように駆動するために使用され、前記走行速度情報は、前記ロボットの駆動輪の実際平均速度を含み、前記モーター駆動情報は、前記ロボットのモーターの実際平均駆動信号値を含み、
    対応的に、前記第1状態ノイズ、第2状態ノイズのうちの少なくとも1つを利用して、前記ロボットの前記状態遷移ノイズを取得する前に、前記状態決定方法は、
    平均速度と平均駆動信号値との第2マッピング関係を利用して、前記実際平均駆動信号値に対してマッピング処理を実行して、前記実際平均駆動信号値に対応する理論平均速度を取得することと、
    前記実際平均速度と前記理論平均速度との差異を利用して、前記第2状態ノイズを決定することと、をさらに含む、
    請求項5に記載の状態決定方法。
  7. 前記実際速度差と前記理論速度差との差異を利用して、前記第1状態ノイズを決定することは、
    前記実際速度差と前記理論速度差との差の平方を前記第1状態ノイズとして使用することを含み、
    前記実際平均速度と前記理論平均速度との差異を利用して、前記第2状態ノイズを決定することは、
    前記実際平均速度と前記理論平均速度との差の平方を前記第2状態ノイズとして使用することを含む、
    請求項6に記載の状態決定方法。
  8. 前記状態ノイズを利用して、前記現在時刻に対応する前記ロボットの実際状態情報を取得することは、
    前記状態ノイズを利用して、前記ロボットの、前の時刻に対応する実際状態情報および前記現在時刻に対応する測定状態情報を処理して、前記現在時刻に対応する前記ロボットの実際状態情報を取得することを含む、
    請求項1ないし7のいずれか一項に記載の状態決定方法。
  9. 前記状態ノイズを利用して、前記ロボットの、前の時刻に対応する実際状態情報および前記現在時刻に対応する測定状態情報を処理して、前記現在時刻に対応する前記ロボットの実際状態情報を取得することは、
    前記状態ノイズに基づいて、フィルターゲインを決定することと、
    前記ロボットの、直前時刻に対応する実際状態情報および前記直前時刻に対応する実際走行情報を予測して、現在時刻に対応する予測状態情報を取得することと、
    前記フィルターゲインのカルマンフィルターを利用して、前記現在時刻の予測状態情報を前記現在時刻の測定状態情報と融合して、前記現在時刻に対応する前記ロボットの実際状態情報を取得することと、を含む、
    請求項8に記載の状態決定方法。
  10. 前記状態ノイズに基づいて、フィルターゲインを決定することは、
    前記ロボットの状態遷移パラメータおよび状態遷移ノイズを利用して、前の時刻に対応する事後確率推定共分散を処理して、現在時刻に対応する事前確率推定共分散を取得し、実際状態情報から測定状態情報への変換パラメータおよび測定干渉ノイズを利用して、前記現在時刻に対応する事前確率推定共分散を処理して、現在時刻に対応するフィルターゲインを取得することを含み、
    前記ロボットの、直前時刻に対応する実際状態情報および前記直前時刻に対応する実際走行情報を予測して、現在時刻に対応する予測状態情報を取得することは、前記ロボットの状態遷移パラメータおよび入力状態遷移パラメータを使用して、ロボットの、直前時刻に対応する実際状態情報および直前時刻に対応する実際走行情報をそれぞれ処理して、現在時刻に対応する予測状態情報を取得することを含む、
    請求項9に記載の状態決定方法。
  11. 前記参照情報に基づいて、前記ロボットの状態ノイズを決定した後、前記状態決定方法は、
    前記状態ノイズがプリセットのノイズ条件を満たしない場合、プリセットの通知を実行することをさらに含む、
    請求項1ないし10のいずれか一項に記載の状態決定方法。
  12. 前記状態ノイズは、前記現在時刻および前のいくつかの時刻の測定状態情報を利用して得られた測定干渉ノイズを含み、対応的に、前記プリセットのノイズ条件は、前記測定干渉ノイズが、第1ノイズ閾値より小さいことを含み、前記状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行することは、
    前記測定干渉ノイズが前記プリセットのノイズ条件を満たしない場合、第1警告メッセージを出力することを含み、前記第1警告メッセージは、状態測定が干渉されたことを知らせるために使用され、
    および/または、前記状態ノイズは、前記現在時刻の実際走行情報を利用して得られた状態遷移ノイズを含み、対応的に、前記プリセットのノイズ条件は、前記状態遷移ノイズが第2ノイズ閾値より小さいことを含み、前記状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行することは、
    前記状態遷移ノイズが前記プリセットのノイズ条件を満たしない場合、第2警告メッセージを出力することを含み、前記第2警告メッセージは、前記ロボットに車体が滑るリスクがあることを知らせるために使用される、
    請求項11に記載の状態決定方法。
  13. 前記ロボットの参照情報を取得することは、
    前記ロボットの周囲環境に対して画像収集を実行して、現在時刻に対応する環境画像データを取得することと、
    前記現在時刻の環境画像データに基づいて、現在時刻に対応する前記ロボットの測定状態情報を決定することと、を含み、
    前記測定状態情報および実際状態情報のいずれも、前記ロボットの位置、前記ロボットの姿勢、前記ロボットの速度のうちの少なくとも1つを含む、
    請求項1ないし12のいずれか一項に記載の状態決定方法。
  14. ロボットの状態決定装置であって、
    前記ロボットの参照情報を取得するように構成される測定状態取得モジュールであって、前記参照情報は、いくつかの時刻に対応する前記ロボットの測定状態情報、現在時刻に対応する前記ロボットの実際走行情報のうちの少なくとも1つを含む、測定状態取得モジュールと、
    前記参照情報に基づいて、前記ロボットの状態ノイズを決定するように構成される、状態ノイズ決定モジュールと、
    前記状態ノイズを利用して、前記現在時刻に対応する前記ロボットの実際状態情報を取得するように構成される、実際状態取得モジュールと、を備える、ロボットの状態決定装置。
  15. 前記状態ノイズ決定モジュールは、
    前記現在時刻および前のいくつかの時刻に対応する測定状態情報を利用して、前記ロボットの測定干渉ノイズを決定するように構成される、測定干渉決定サブモジュールと、
    前記現在時刻の実際走行情報を利用して、前記ロボットの状態遷移ノイズを決定するように構成される、状態遷移決定サブモジュールと、を備える、
    請求項14に記載の状態決定装置。
  16. 測定干渉決定サブモジュールは、
    前記現在時刻と前のいくつかの時刻の測定状態情報との離散度を取得するように構成される、離散取得ユニットと、
    前記離散度を利用して、前記測定干渉ノイズを決定するように構成される、ノイズ決定ユニットと、を備える、
    請求項15に記載の状態決定装置。
  17. 前記現在時刻と前のいくつかの時刻の測定状態情報との離散度は、前記現在時刻と前のいくつかの時刻の測定状態情報との標準差であり、対応的に、
    前記ノイズ決定ユニットは、前記離散度とプリセットのゲインパラメータとの積を前記測定干渉ノイズとして使用するように構成される、
    請求項16に記載の状態決定装置。
  18. 前記実際走行情報は、前記ロボットの走行角度情報、モーター駆動情報および走行速度情報を含み、
    前記状態遷移決定サブモジュールは、第1状態ノイズ、第2状態ノイズのうちの少なくとも1つを利用して、前記ロボットの前記状態遷移ノイズを取得するように構成され、
    前記第1状態ノイズは、前記走行角度情報および前記走行速度情報を利用して決定されたものであり、前記第2状態ノイズは、前記モーター駆動情報および前記走行速度情報を利用して決定されたものである、
    請求項15ないし17のいずれか一項に記載の状態決定装置。
  19. 前記ロボットは、駆動輪および方向転換輪を備え、前記駆動輪は、前記ロボットを走行するように駆動するために使用され、前記方向転換輪は、前記ロボットの走行方向を変換するために使用され、前記走行速度情報は、前記ロボットの駆動輪間の実際の速度差を含み、前記走行角度情報は、前記ロボットの方向転換輪の実際の方向転換角度を含み、
    対応的に、前記状態決定装置は、さらに、第1状態ノイズ決定ユニットを備え、前記第1状態ノイズ決定ユニットは、
    速度差と方向転換角度との第1マッピング関係を利用して、実際の方向転換角度に対してマッピング処理を実行して、実際の方向転換角度に対応する理論速度差を取得するように構成される、第1マッピングサブユニットと、
    実際速度差と理論速度差との差異を利用して、第1状態ノイズを決定するように構成される、第1状態ノイズ決定サブユニットと、を備え、
    および/または、前記ロボットは、駆動輪を備え、前記駆動輪は、前記ロボットを走行するように駆動するために使用され、前記走行速度情報は、前記ロボットの駆動輪の実際平均速度を含み、前記モーター駆動情報は、ロボットのモーターの実際平均駆動信号値を含み、
    対応的に、前記状態決定装置は、さらに、第2状態ノイズ決定ユニットを備え、前記第2状態ノイズ決定ユニットは、
    平均速度と平均駆動信号値との第2マッピング関係を利用して、実際平均駆動信号値に対してマッピング処理を実行して、実際平均駆動信号値に対応する理論平均速度を取得するように構成される、第2マッピングサブユニットと、
    実際平均速度と理論平均速度との差異を利用して、第2状態ノイズを決定するように構成される、第2状態ノイズ決定サブユニットと、を備える、
    請求項18に記載の状態決定装置。
  20. 前記第1状態ノイズ決定サブユニットは、実際速度差と理論速度差との差の平方を第1状態ノイズとして使用するように構成され、
    前記第2状態ノイズ決定サブユニットは、実際平均速度と理論平均速度との差の平方を第2状態ノイズとして使用するように構成される、
    請求項19に記載の状態決定装置。
  21. 前記実際状態取得モジュールは、記状態ノイズを利用して、ロボットの、前の時刻に対応する実際状態情報および現在時刻に対応する測定状態情報を処理して、現在時刻に対応するロボットの実際状態情報を取得するように構成される、
    請求項14ないし20のいずれか一項に記載の状態決定装置。
  22. 前記実際状態取得モジュールは、状態ノイズに基づいて、フィルターゲインを決定し、ロボットの、直前時刻に対応する実際状態情報および直前時刻に対応する実際走行情報を予測して、現在時刻に対応する予測状態情報を取得し、フィルターゲインのカルマンフィルターを利用して、現在時刻の予測状態情報を現在時刻の測定状態情報と融合して、現在時刻に対応するロボットの実際状態情報を取得するように構成される、
    請求項21に記載の状態決定装置。
  23. 前記状態決定装置は、さらに、
    前記状態ノイズが、プリセットのノイズ条件を満たしない場合、プリセットの通知を実行するように構成される、通知モジュールを備える、
    請求項14ないし22のいずれか一項に記載の状態決定装置。
  24. 前記状態ノイズは、いくつかの測定状態情報を利用して得られた測定干渉ノイズを含み、対応的に、前記プリセットのノイズ条件は、測定干渉ノイズが、第1ノイズ閾値より小さいことを含み、前記通知モジュールは、測定干渉ノイズが、プリセットのノイズ条件を満たしない場合、第1警告メッセージを出力するように構成される、第1早期警告サブモジュールを備え、前記第1警告メッセージは、状態測定が干渉されたことを知らせるために使用され、
    および/または、前記状態ノイズは、現在時刻の実際走行情報を利用して得られた状態遷移ノイズを含み、対応的に、前記プリセットのノイズ条件は、状態遷移ノイズが第2ノイズ閾値より小さいことを含み、前記通知モジュールは、状態遷移ノイズが、プリセットのノイズ条件を満たしない場合、第2警告メッセージを出力するように構成される、第2早期警告サブモジュールを備え、前記第2警告メッセージは、ロボットに車体が滑るリスクがあることを知らせるために使用される、
    請求項23に記載の状態決定装置。
  25. 前記測定状態取得モジュールは、
    ロボットの周囲環境に対して画像収集を実行して、現在時刻に対応する環境画像データを取得するように構成される、データ収集サブモジュールと、
    現在時刻の環境画像データに基づいて、現在時刻に対応するロボットの測定状態情報を決定するように構成される、測定状態決定サブモジュールと、を備え、
    前記測定状態情報および実際状態情報のいずれも、前記ロボットの位置、前記ロボットの姿勢、前記ロボットの速度のうちの少なくとも1つを含む、
    請求項14ないし24のいずれか一項に記載の状態決定装置。
  26. ロボット本体および前記ロボット本体に設置されるメモリとプロセッサを備え、前記プロセッサとメモリは、互いに接続され、前記プロセッサは、前記メモリに記憶されるプログラム命令を実行して、請求項1ないし13のいずれか一項に記載の状態決定方法を実現するように構成される、ロボット。
  27. プログラム命令を記憶する、コンピュータ可読記憶媒体であって、前記プログラム命令は、プロセッサによって実行されるとき、前記プロセッサに、請求項1ないし13のいずれか一項に記載の状態決定方法を実行させる、コンピュータ可読記憶媒体。
  28. コンピュータ可読コードを含む、コンピュータプログラムであって、前記コンピュータ可読コードが、ロボットで実行されるとき、前記ロボット内のプロセッサに、請求項1ないし13のいずれか一項に記載の状態決定方法を実行させる、コンピュータプログラム。
JP2021566210A 2020-08-26 2021-04-19 状態決定方法および装置、ロボット、記憶媒体並びにコンピュータプログラム Pending JP2022550231A (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
CN202010872662.3A CN112025706B (zh) 2020-08-26 2020-08-26 机器人的状态确定方法及装置、机器人及存储介质
CN202010872662.3 2020-08-26
PCT/CN2021/088224 WO2022041797A1 (zh) 2020-08-26 2021-04-19 状态确定方法及装置、机器人、存储介质和计算机程序

Publications (1)

Publication Number Publication Date
JP2022550231A true JP2022550231A (ja) 2022-12-01

Family

ID=73579964

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021566210A Pending JP2022550231A (ja) 2020-08-26 2021-04-19 状態決定方法および装置、ロボット、記憶媒体並びにコンピュータプログラム

Country Status (4)

Country Link
JP (1) JP2022550231A (ja)
KR (3) KR20220084434A (ja)
CN (3) CN114260890B (ja)
WO (1) WO2022041797A1 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114260890B (zh) * 2020-08-26 2023-11-03 北京市商汤科技开发有限公司 机器人的状态确定方法及装置、机器人及存储介质

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016212039A (ja) * 2015-05-13 2016-12-15 株式会社Ihi 状態データ更新装置と方法
CN110422175A (zh) * 2019-07-31 2019-11-08 上海智驾汽车科技有限公司 车辆状态估计方法以及装置、电子设备、存储介质、车辆

Family Cites Families (32)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0663930B2 (ja) * 1989-10-04 1994-08-22 日産自動車株式会社 車両状態量推定装置
JP2002331478A (ja) * 2001-05-02 2002-11-19 Yaskawa Electric Corp ロボットの動作速度決定方法
KR101234797B1 (ko) * 2006-04-04 2013-02-20 삼성전자주식회사 로봇 및 산출된 공분산을 이용한 로봇의 위치 추정 방법
KR100877071B1 (ko) * 2007-07-18 2009-01-07 삼성전자주식회사 파티클 필터 기반의 이동 로봇의 자세 추정 방법 및 장치
KR101409990B1 (ko) * 2007-09-14 2014-06-23 삼성전자주식회사 로봇의 위치를 계산하기 위한 장치 및 방법
KR101038581B1 (ko) * 2008-10-31 2011-06-03 한국전력공사 트랙형 이동 로봇을 이용하여 발전설비 시설물의 감시점검을 제공하기 위한 방법, 이동 로봇 시스템 및 운영방법
KR101086364B1 (ko) * 2009-03-20 2011-11-23 삼성중공업 주식회사 칼만 필터를 이용한 로봇 기구학 변수 추정 방법 및 시스템
JP5803155B2 (ja) * 2011-03-04 2015-11-04 セイコーエプソン株式会社 ロボット位置検出装置及びロボットシステム
CN102862666B (zh) * 2011-07-08 2014-12-10 中国科学院沈阳自动化研究所 一种基于自适应ukf的水下机器人状态和参数联合估计方法
KR101390776B1 (ko) * 2013-03-14 2014-04-30 인하대학교 산학협력단 퍼지 확장 칼만 필터를 이용한 위치인식 장치, 방법 및 이동로봇
KR102009481B1 (ko) * 2013-12-26 2019-08-09 한화디펜스 주식회사 이동체 주행 제어 장치 및 방법
US9517561B2 (en) * 2014-08-25 2016-12-13 Google Inc. Natural pitch and roll
KR101789776B1 (ko) * 2015-12-09 2017-10-25 세종대학교산학협력단 주행로봇의 진행각 추정을 위한 바이어스 보정 장치 및 방법
CN106156790B (zh) * 2016-06-08 2020-04-14 北京工业大学 一种应用于传感器网络的分布式协作算法和数据融合机制
JP6770393B2 (ja) * 2016-10-04 2020-10-14 株式会社豊田中央研究所 トラッキング装置及びプログラム
KR20180068102A (ko) * 2016-12-13 2018-06-21 주식회사 큐엔티 로봇 고장 모니터링 서비스 제공 방법 및 서버
CN106956282B (zh) * 2017-05-18 2019-09-13 广州视源电子科技股份有限公司 角加速度确定方法、装置、机器人及存储介质
CN107644441A (zh) * 2017-08-30 2018-01-30 南京大学 基于三维成像的多足机器人复杂路况离散成落脚点方法
CN107748562A (zh) * 2017-09-30 2018-03-02 湖南应用技术学院 一种综合性服务机器人
CN109959381B (zh) * 2017-12-22 2021-06-04 深圳市优必选科技有限公司 一种定位方法、装置、机器人及计算机可读存储介质
CN108128308B (zh) * 2017-12-27 2020-04-14 长沙理工大学 一种分布式驱动电动汽车的车辆状态估计系统及方法
CN110361003B (zh) * 2018-04-09 2023-06-30 中南大学 信息融合方法、装置、计算机设备和计算机可读存储介质
CN108710295B (zh) * 2018-04-20 2021-06-18 浙江工业大学 一种基于渐进容积信息滤波的机器人跟随方法
CN108621161B (zh) * 2018-05-08 2021-03-02 中国人民解放军国防科技大学 基于多传感器信息融合的足式机器人本体状态估计方法
CN108896049A (zh) * 2018-06-01 2018-11-27 重庆锐纳达自动化技术有限公司 一种机器人室内运动定位方法
CN108645415A (zh) * 2018-08-03 2018-10-12 上海海事大学 一种船舶航迹预测方法
CN109443356A (zh) * 2019-01-07 2019-03-08 大连海事大学 一种含测量噪声的无人船位置与速度估计结构及设计方法
CN109813307A (zh) * 2019-02-26 2019-05-28 大连海事大学 一种无人船多传感器数据融合的导航系统及其设计方法
CN110861123A (zh) * 2019-11-14 2020-03-06 华南智能机器人创新研究院 机器人运行状态的可视化监控和评估的方法及装置
CN111044053B (zh) * 2019-12-31 2022-04-01 三一重工股份有限公司 单舵轮无人车的导航方法、装置和单舵轮无人车
CN111136660B (zh) * 2020-02-19 2021-08-03 清华大学深圳国际研究生院 机器人位姿定位方法及系统
CN114260890B (zh) * 2020-08-26 2023-11-03 北京市商汤科技开发有限公司 机器人的状态确定方法及装置、机器人及存储介质

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016212039A (ja) * 2015-05-13 2016-12-15 株式会社Ihi 状態データ更新装置と方法
CN110422175A (zh) * 2019-07-31 2019-11-08 上海智驾汽车科技有限公司 车辆状态估计方法以及装置、电子设备、存储介质、车辆

Also Published As

Publication number Publication date
CN112025706A (zh) 2020-12-04
CN114260890B (zh) 2023-11-03
KR20220027832A (ko) 2022-03-08
KR102412066B1 (ko) 2022-06-22
CN112025706B (zh) 2022-01-04
CN114131604B (zh) 2023-11-03
KR20220084434A (ko) 2022-06-21
KR20220084435A (ko) 2022-06-21
CN114260890A (zh) 2022-04-01
WO2022041797A1 (zh) 2022-03-03
CN114131604A (zh) 2022-03-04

Similar Documents

Publication Publication Date Title
JP6544594B2 (ja) 情報処理システム、情報処理方法、プログラムおよび車両
CN111742310A (zh) 创建包含语义信息的干净的地图
JP2019125368A (ja) 複数のコネクティッド車両による観測値を関連付ける方法
CN111201448B (zh) 用于产生反演传感器模型的方法和设备以及用于识别障碍物的方法
US11242050B2 (en) Reinforcement learning with scene decomposition for navigating complex environments
US20230257003A1 (en) Method and system for graph neural network based pedestrian action prediction in autonomous driving systems
CN108062095A (zh) 在概率框架内使用传感器融合的物体追踪
JP2015076104A (ja) ランダムフォレストモデルを用いた、リアルタイムの多クラス運転者動作認識
JP2019125369A (ja) 複数のコネクティッド車両による観測値を関連付けるための学習方法
CN108116408A (zh) 多传感器概率对象和自动制动
CN108327724A (zh) 通过无监督学习的对象跟踪
JP2022550231A (ja) 状態決定方法および装置、ロボット、記憶媒体並びにコンピュータプログラム
CN112990249A (zh) 往复式生成模型
EP3460400B1 (en) Improved localization of a mobile device based on image and radio words
EP4050510A1 (en) Object information calculation method and system
US20200001881A1 (en) Vehicle event identification
JP2022552690A (ja) 他の道路利用者と通信するための通信ネットワークにおいて道路利用者の周辺で検知された物体に関する物体メッセージを提供するための方法
EP3761285A1 (en) Smart object knowledge sharing
WO2020106902A2 (en) Coordinated component interface control framework
EP4219262A1 (en) In-vehicle system for estimation of risk exposure for an autonomous vehicle
Ross et al. Sensor Principles for Digital Sound Twin
WO2021230314A1 (ja) 計測システム、車両、計測装置、計測プログラム及び計測方法
EP4372584A1 (en) A method for performing a perception task of an electronic device or a vehicle using a plurality of neural networks
US20230293086A1 (en) Motion sickness estimation device, motion sickness estimation method, and non-transitory storage medium
CN106341838B (zh) 发射功率确定方法、装置及车载设备

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20211108

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20211108

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230105

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20230724