JP2022006811A - Information processor, information processing method and program - Google Patents
Information processor, information processing method and program Download PDFInfo
- Publication number
- JP2022006811A JP2022006811A JP2020109303A JP2020109303A JP2022006811A JP 2022006811 A JP2022006811 A JP 2022006811A JP 2020109303 A JP2020109303 A JP 2020109303A JP 2020109303 A JP2020109303 A JP 2020109303A JP 2022006811 A JP2022006811 A JP 2022006811A
- Authority
- JP
- Japan
- Prior art keywords
- difference
- moving body
- orientation
- sensor
- information processing
- 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.)
- Granted
Links
- 230000010365 information processing Effects 0.000 title claims description 79
- 238000003672 processing method Methods 0.000 title claims description 21
- 238000012937 correction Methods 0.000 claims abstract description 65
- 238000004364 calculation method Methods 0.000 claims abstract description 22
- 238000000034 method Methods 0.000 description 12
- 239000003550 marker Substances 0.000 description 10
- 238000010586 diagram Methods 0.000 description 8
- 238000009434 installation Methods 0.000 description 5
- 238000004590 computer program Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Landscapes
- Navigation (AREA)
Abstract
Description
本開示は、移動体の向きと移動体に搭載されるセンサの向きとの差分を校正するための情報処理装置、情報処理方法及びプログラムに関する。 The present disclosure relates to an information processing apparatus, an information processing method and a program for calibrating a difference between the orientation of a moving body and the orientation of a sensor mounted on the moving body.
車両等の移動体による自動運転又は手動運転支援のためにＬｉＤＡＲ（Ｌｉｇｈｔ Ｄｅｔｅｃｔｉｏｎ Ａｎｄ Ｒａｎｇｉｎｇ）等のセンサが用いられている。このようなセンサを移動体に搭載する場合に、移動体の向き（例えば正面方向）とセンサの向き（例えば正面方向）とが一致しないことがある。 Sensors such as LiDAR (Light Detection And Ringing) are used for automatic driving or manual driving support by a moving body such as a vehicle. When such a sensor is mounted on a moving body, the orientation of the moving body (for example, the front direction) and the orientation of the sensor (for example, the front direction) may not match.
これに対して、特許文献１には、ＬｉＤＡＲの設置姿勢と車体の設置姿勢を推定する技術が開示されている。特許文献１では、車体の進行方向に対して平行な目印を設置し、その目印をＬｉＤＡＲでセンシングし、車体は目印と平行に走行することで、ＬｉＤＡＲの設置姿勢と車体の設置姿勢を推定することができる。 On the other hand, Patent Document 1 discloses a technique for estimating the installation posture of LiDAR and the installation posture of a vehicle body. In Patent Document 1, a mark parallel to the traveling direction of the vehicle body is installed, the mark is sensed by LiDAR, and the vehicle body travels in parallel with the mark to estimate the installation posture of the LiDAR and the installation posture of the vehicle body. be able to.
また、特許文献２には、センサの設置姿勢と車体の姿勢とのズレ量を検出する技術について開示されている。特許文献２では、車体の進行方向に目印を設置し、受信強度の強いエリアを物体検知エリアとして使用するように設定することで、センサの設置姿勢と車体の姿勢とのズレ量を検出することができる。 Further, Patent Document 2 discloses a technique for detecting the amount of deviation between the posture in which the sensor is installed and the posture of the vehicle body. In Patent Document 2, a mark is set in the traveling direction of the vehicle body, and an area with strong reception strength is set to be used as an object detection area, thereby detecting the amount of deviation between the sensor installation posture and the posture of the vehicle body. Can be done.
特許文献１又は２に開示された技術を用いることで、移動体の向きとセンサの向きとの差分を算出することができる。 By using the technique disclosed in Patent Document 1 or 2, the difference between the orientation of the moving body and the orientation of the sensor can be calculated.
しかしながら、上記特許文献１及び２では、移動体の向きとセンサの向きとの差分を算出するためには、物理的な目印の設置が必要であるという問題がある。 However, in Patent Documents 1 and 2, there is a problem that it is necessary to set a physical mark in order to calculate the difference between the orientation of the moving body and the orientation of the sensor.
そこで、本開示は、物理的な目印なしで移動体の向きとセンサの向きとの差分を算出することができる情報処理装置等を提供する。 Therefore, the present disclosure provides an information processing device or the like capable of calculating a difference between the orientation of a moving body and the orientation of a sensor without a physical marker.
本開示に係る情報処理装置は、移動体が移動する経路の向きを取得する経路向き取得部と、前記移動体に搭載されるセンサの向きを当該センサによって取得されるセンサデータに基づいて算出するセンサ向き算出部と、前記センサの向きと前記移動体の向きとの差分として設定される第１差分を取得する第１差分取得部と、算出された前記センサの向きと前記第１差分とに基づいて前記移動体の向きを推定する移動体向き推定部と、取得された前記経路の向きと推定された前記移動体の向きとの第２差分を算出する第２差分算出部と、算出された前記第２差分に基づいて前記第１差分を補正する第１差分補正部と、を備え、前記センサは、前記移動体の向きの推定のためのセンサであり、前記移動体は、設定される経路に沿って移動する移動体である。 The information processing apparatus according to the present disclosure calculates the direction of the sensor mounted on the moving body based on the sensor data acquired by the sensor and the path direction acquiring unit that acquires the direction of the path on which the moving body moves. The sensor orientation calculation unit, the first difference acquisition unit that acquires the first difference set as the difference between the sensor orientation and the orientation of the moving body, and the calculated sensor orientation and the first difference Calculated as a moving body orientation estimation unit that estimates the orientation of the moving object based on the method, and a second difference calculating unit that calculates a second difference between the acquired orientation of the path and the estimated orientation of the moving object. A first difference correction unit that corrects the first difference based on the second difference is provided, the sensor is a sensor for estimating the orientation of the moving body, and the moving body is set. It is a moving body that moves along the path.
なお、これらの包括的又は具体的な態様は、システム、方法、集積回路、コンピュータプログラム又はコンピュータ読み取り可能なＣＤ－ＲＯＭなどの記録媒体で実現されてもよく、システム、方法、集積回路、コンピュータプログラム及び記録媒体の任意な組み合わせで実現されてもよい。 It should be noted that these comprehensive or specific embodiments may be realized in a recording medium such as a system, method, integrated circuit, computer program or computer-readable CD-ROM, and the system, method, integrated circuit, computer program. And may be realized by any combination of recording media.
本開示の一態様に係る情報処理装置等によれば、物理的な目印なしで移動体の向きとセンサの向きとの差分を算出することができる。 According to the information processing apparatus or the like according to one aspect of the present disclosure, it is possible to calculate the difference between the orientation of the moving body and the orientation of the sensor without a physical marker.
移動体の向きの推定のためにＬｉＤＡＲ等のセンサが移動体に搭載されることがあるが、移動体の向きとセンサの向きとが一致しないことがある。そのため、移動体の向きとセンサの向きとの差分を校正するためのキャリブレーション値が設定される。例えば、移動体は、センサのセンサデータに基づいてセンサの正面方向と認識された方向からキャリブレーション値を差し引いた方向を移動体の正面方向として移動するが、キャリブレーション値が正確でない場合、移動体の正面方向からずれた方向に移動してしまう。自動運転では、フィードバック制御が行われるため、移動体の正面方向からずれた方向に移動し続けることはないが、蛇行等が発生してしまう。 A sensor such as LiDAR may be mounted on the moving body to estimate the orientation of the moving body, but the orientation of the moving body and the orientation of the sensor may not match. Therefore, a calibration value for calibrating the difference between the orientation of the moving body and the orientation of the sensor is set. For example, the moving body moves in the direction recognized as the front direction of the sensor based on the sensor data of the sensor minus the calibration value as the front direction of the moving body, but if the calibration value is not accurate, the moving body moves. It moves in a direction deviated from the front direction of the body. In automatic operation, since feedback control is performed, the moving body does not continue to move in a direction deviated from the front direction, but meandering or the like occurs.
これに対し、上述した従来技術では、移動体の向き及びセンサの向き又はこれらの差分を算出するが、物理的な目印が必要となる。 On the other hand, in the above-mentioned conventional technique, the orientation of the moving body and the orientation of the sensor or the difference between them is calculated, but a physical mark is required.
そこで、本開示の一態様に係る情報処理装置は、移動体が移動する経路の向きを取得する経路向き取得部と、前記移動体に搭載されるセンサの向きを当該センサによって取得されるセンサデータに基づいて算出するセンサ向き算出部と、前記センサの向きと前記移動体の向きとの差分として設定される第１差分を取得する第１差分取得部と、算出された前記センサの向きと前記第１差分とに基づいて前記移動体の向きを推定する移動体向き推定部と、取得された前記経路の向きと推定された前記移動体の向きとの第２差分を算出する第２差分算出部と、算出された前記第２差分に基づいて前記第１差分を補正する第１差分補正部と、を備え、前記センサは、前記移動体の向きの推定のためのセンサであり、前記移動体は、設定される経路に沿って移動する移動体である。 Therefore, the information processing apparatus according to one aspect of the present disclosure includes a path orientation acquisition unit that acquires the orientation of the path on which the moving body moves, and sensor data that acquires the orientation of the sensor mounted on the moving body by the sensor. A sensor orientation calculation unit calculated based on the above, a first difference acquisition unit for acquiring a first difference set as a difference between the orientation of the sensor and the orientation of the moving body, and the calculated orientation of the sensor and the said. Second difference calculation for calculating the second difference between the moving body orientation estimation unit that estimates the orientation of the moving body based on the first difference and the acquired orientation of the moving body and the estimated orientation of the moving body. The sensor includes a unit and a first difference correction unit that corrects the first difference based on the calculated second difference. The sensor is a sensor for estimating the orientation of the moving body, and the movement is described. A body is a moving body that moves along a set path.
例えば、センサの向きと移動体の向きとの差分として設定される第１差分（例えばメモリに記憶されたキャリブレーション値）が正確でない場合、センサデータと第１差分とに基づいて推定される移動体の向きは、実際の移動体の向きからずれた向きとなり、移動体は設定された経路からずれるような制御が行われることになる。これに対して、自動運転車両等の移動体は、設定される経路に沿って移動するように設定されている場合、設定された経路からずれるような制御がされても、フィードバック制御が行われて、蛇行するおそれはあるが設定された経路に沿って移動することができる。このとき、推定された移動体の向きには、経路の向きに対して、第１差分の実際の差分からのズレ量に応じた一定の偏りが生じることになる。そこで、その偏り（第２差分）から第１差分を補正することで第１差分を正確な値に補正することができ、移動体の向きとセンサの向きとの差分の正確な校正を行うことができる。このように、物理的な目印なしで移動体の向きとセンサの向きとの差分を算出することができる。例えば、工場等の目印が設置できる特殊な環境だけでなく、目印が設置できない環境も含めて様々な環境で移動体の向きとセンサの向きとの校正を行うことができる。 For example, if the first difference set as the difference between the orientation of the sensor and the orientation of the moving object (for example, the calibration value stored in the memory) is not accurate, the movement estimated based on the sensor data and the first difference. The orientation of the body is deviated from the actual orientation of the moving body, and the moving body is controlled so as to deviate from the set path. On the other hand, when a moving body such as an autonomous driving vehicle is set to move along a set route, feedback control is performed even if the control is performed so as to deviate from the set route. Therefore, it may meander, but it can move along the set route. At this time, the estimated orientation of the moving body has a certain deviation from the actual difference of the first difference with respect to the direction of the path. Therefore, the first difference can be corrected to an accurate value by correcting the first difference from the bias (second difference), and the difference between the orientation of the moving body and the orientation of the sensor can be accurately calibrated. Can be done. In this way, the difference between the orientation of the moving body and the orientation of the sensor can be calculated without a physical marker. For example, it is possible to calibrate the orientation of the moving body and the orientation of the sensor in various environments including not only a special environment where a mark can be installed such as a factory but also an environment where a mark cannot be installed.
また、前記第１差分補正部は、前記第２差分が小さくなるように前記第１差分を補正してもよい。 Further, the first difference correction unit may correct the first difference so that the second difference becomes smaller.
このように、第２差分が小さくなるように第１差分が補正されることで、すなわち、推定される移動体の向きが経路の向きからずれないように第１差分が補正されることで、第１差分を正確な値に補正することができ、移動体の向きとセンサの向きとの差分の正確な校正を行うことができる。 In this way, the first difference is corrected so that the second difference becomes smaller, that is, the first difference is corrected so that the direction of the estimated moving body does not deviate from the direction of the path. The first difference can be corrected to an accurate value, and the difference between the orientation of the moving body and the orientation of the sensor can be accurately calibrated.
また、前記第１差分補正部は、前記第２差分が閾値以上か否かを判定し、前記第２差分が閾値以上の場合、前記第１差分を補正してもよい。 Further, the first difference correction unit may determine whether or not the second difference is equal to or greater than the threshold value, and if the second difference is equal to or greater than the threshold value, may correct the first difference.
これによれば、第２差分が閾値以上の場合、すなわち、推定される移動体の向きが経路の向きから大きくずれている場合に、第１差分を補正できる。言い換えると、第２差分が閾値未満になるまで第１差分を補正することで、第１差分を正確な値に補正することができる。 According to this, when the second difference is equal to or more than the threshold value, that is, when the estimated orientation of the moving body deviates greatly from the orientation of the path, the first difference can be corrected. In other words, the first difference can be corrected to an accurate value by correcting the first difference until the second difference becomes less than the threshold value.
また、さらに、前記第１差分の補正量が閾値以上か否かを判定し、前記第１差分の補正量が閾値以上の場合、前記移動体の移動を制限する移動制限部を備えていてもよい。例えば、前記移動体の移動の制限は、速度の制限、又は停止を含んでいてもよい。 Further, even if a movement limiting unit for limiting the movement of the moving body is provided, it is determined whether or not the correction amount of the first difference is equal to or more than the threshold value, and if the correction amount of the first difference is equal to or more than the threshold value. good. For example, the movement limitation of the moving body may include a speed limitation or a stop.
第１差分の補正量が閾値以上である場合に移動体の移動制御がされると、移動体の移動方向が大きく変わり、安全性に問題が生じるおそれがある。そこで、第１差分の補正量が閾値以上の場合には、移動体の移動が制限される（例えば移動体の速度が制限される、又は移動体が停止される）ことで、安全性を維持できる。 If the movement of the moving body is controlled when the correction amount of the first difference is equal to or greater than the threshold value, the moving direction of the moving body changes significantly, which may cause a safety problem. Therefore, when the correction amount of the first difference is equal to or greater than the threshold value, the movement of the moving body is restricted (for example, the speed of the moving body is limited or the moving body is stopped) to maintain safety. can.
また、さらに、前記経路から直線区間を特定する直線区間特定部を備え、前記経路向き取得部は、前記移動体が前記直線区間を移動するときに、前記経路の向きを取得し、前記センサ向き算出部は、前記移動体が前記直線区間を移動するときに、前記センサの向きを算出してもよい。 Further, a straight section specifying unit for specifying a straight section from the route is provided, and the route orientation acquisition unit acquires the direction of the route when the moving body moves in the straight section, and is oriented toward the sensor. The calculation unit may calculate the orientation of the sensor when the moving body moves in the straight line section.
直線区間では、移動体は経路に沿って移動しやすくなるため、移動体が直線区間を移動するときに経路の向きを取得することで正確な経路の向きを取得でき、また、移動体が直線区間を移動するときにセンサの向きを算出することで正確なセンサの向きを算出でき、ひいては、第１差分をより正確な値に補正することができる。 In a straight section, the moving body tends to move along the path, so when the moving body moves in the straight section, the correct path direction can be obtained by acquiring the direction of the path, and the moving body is straight. An accurate sensor orientation can be calculated by calculating the sensor orientation when moving between sections, and the first difference can be corrected to a more accurate value.
また、さらに、前記第１差分又は前記第１差分の補正量が閾値以上の場合、エラーを通知するエラー通知部を備えていてもよい。 Further, when the first difference or the correction amount of the first difference is equal to or larger than the threshold value, an error notification unit for notifying an error may be provided.
これによれば、第１差分又は第１差分の補正量が閾値以上となっていることを、移動体の乗員、管理者又は監視者等に通知することができる。 According to this, it is possible to notify the occupant, the manager, the observer, or the like of the moving body that the first difference or the correction amount of the first difference is equal to or more than the threshold value.
本開示の一態様に係る情報処理方法は、コンピュータにより実行される情報処理方法であって、移動体が移動する経路の向きを取得し、前記移動体に搭載されるセンサの向きを当該センサによって取得されるセンサデータに基づいて算出し、前記センサの向きと前記移動体の向きとの差分として設定される第１差分を取得し、算出された前記センサの向きと前記第１差分とに基づいて前記移動体の向きを推定し、取得された前記経路の向きと推定された前記移動体の向きとの第２差分を算出し、算出された前記第２差分に基づいて前記第１差分を補正する処理を含み、前記センサは、前記移動体の向きの推定のためのセンサであり、前記移動体は、設定される経路に沿って移動する移動体である。 The information processing method according to one aspect of the present disclosure is an information processing method executed by a computer, in which the direction of a path on which a moving body moves is acquired, and the direction of a sensor mounted on the moving body is determined by the sensor. The first difference calculated based on the acquired sensor data and set as the difference between the orientation of the sensor and the orientation of the moving body is acquired, and based on the calculated orientation of the sensor and the first difference. The direction of the moving body is estimated, the second difference between the acquired direction of the path and the estimated direction of the moving body is calculated, and the first difference is calculated based on the calculated second difference. The sensor includes a correction process, and the sensor is a sensor for estimating the orientation of the moving body, and the moving body is a moving body that moves along a set path.
これによれば、物理的な目印なしで移動体の向きとセンサの向きとの差分を算出することができる情報処理方法を提供できる。 According to this, it is possible to provide an information processing method capable of calculating a difference between the orientation of a moving body and the orientation of a sensor without a physical marker.
本開示の一態様に係る情報処理装置は、経路の向きに移動する移動体の正面方向に対する操舵の向きを取得する操舵向き取得部と、取得された前記操舵の向きに基づいて、前記移動体に搭載されるセンサの向きと移動体の向きとの差分として設定される第１差分を補正する第１差分補正部と、を備え、前記センサは、前記移動体の向きの推定のためのセンサであり、前記移動体は、設定される経路に沿って移動する移動体である。 The information processing apparatus according to one aspect of the present disclosure includes a steering direction acquisition unit that acquires a steering direction with respect to a front direction of a moving body that moves in the direction of a path, and the moving body based on the acquired steering direction. The sensor includes a first difference correction unit that corrects a first difference set as a difference between the orientation of the sensor mounted on the mobile body and the orientation of the moving body, and the sensor is a sensor for estimating the orientation of the moving body. The moving body is a moving body that moves along a set path.
例えば、センサの向きと移動体の向きとの差分として設定される第１差分（例えばメモリに記憶されたキャリブレーション値）が正確でない場合、移動体は設定された経路からずれるような制御が行われることになる。これに対して、自動運転車両等の移動体は、設定される経路に沿って移動するように設定されている場合、設定された経路からずれるような制御がされても、フィードバック制御が行われて操舵の向きが制御され、蛇行するおそれはあるが設定された経路に沿って移動することができる。このとき、移動体の操舵の向きには、移動体の正面方向に対して、第１差分の実際の差分からのズレ量に応じた一定の偏りが生じることになる。そこで、操舵の向きの偏りから第１差分を補正することで第１差分を正確な値に補正することができ、移動体の向きとセンサの向きとの差分の正確な校正を行うことができる。このように、物理的な目印なしで移動体の向きとセンサの向きとの差分を算出することができる。例えば、工場等の目印が設置できる特殊な環境だけでなく、目印が設置できない環境も含めて様々な環境で移動体の向きとセンサの向きとの校正を行うことができる。 For example, if the first difference set as the difference between the orientation of the sensor and the orientation of the moving object (for example, the calibration value stored in the memory) is not accurate, the moving object is controlled to deviate from the set path. Will be struck. On the other hand, when a moving body such as an autonomous driving vehicle is set to move along a set route, feedback control is performed even if the control is performed so as to deviate from the set route. The direction of steering is controlled, and although there is a risk of meandering, it is possible to move along a set path. At this time, the steering direction of the moving body has a certain deviation from the actual difference of the first difference with respect to the front direction of the moving body. Therefore, by correcting the first difference from the deviation of the steering direction, the first difference can be corrected to an accurate value, and the difference between the direction of the moving body and the direction of the sensor can be accurately calibrated. .. In this way, the difference between the orientation of the moving body and the orientation of the sensor can be calculated without a physical marker. For example, it is possible to calibrate the orientation of the moving body and the orientation of the sensor in various environments including not only a special environment where a mark can be installed such as a factory but also an environment where a mark cannot be installed.
また、前記第１差分補正部は、前記操舵の向きが小さくなるように前記第１差分を補正してもよい。 Further, the first difference correction unit may correct the first difference so that the steering direction becomes smaller.
このように、移動体の正面方向に対する操舵の向きが小さくなるように第１差分が補正されることで、移動体の向きとセンサの向きとの差分の正確な校正を行うことができる。 In this way, by correcting the first difference so that the steering direction with respect to the front direction of the moving body becomes small, it is possible to accurately calibrate the difference between the direction of the moving body and the direction of the sensor.
また、前記第１差分補正部は、前記操舵の向きが閾値以上か否かを判定し、前記操舵の向きが閾値以上の場合、前記第１差分を補正してもよい。 Further, the first difference correction unit may determine whether or not the steering direction is equal to or greater than the threshold value, and if the steering direction is equal to or greater than the threshold value, may correct the first difference.
これによれば、移動体の正面方向に対する操舵の向きが閾値以上の場合、すなわち、移動体の操舵の向きが移動体の正面方向から大きくずれている場合に、第１差分を補正できる。言い換えると、移動体の正面方向に対する操舵の向きが閾値未満になるまで第１差分を補正することで、第１差分を正確な値に補正することができる。 According to this, the first difference can be corrected when the steering direction of the moving body with respect to the front direction is equal to or greater than the threshold value, that is, when the steering direction of the moving body deviates significantly from the front direction of the moving body. In other words, the first difference can be corrected to an accurate value by correcting the first difference until the steering direction of the moving body with respect to the front direction becomes less than the threshold value.
また、さらに、前記第１差分の補正量が閾値以上か否かを判定し、前記第１差分の補正量が閾値以上の場合、前記移動体の移動を制限する移動制限部を備えていてもよい。例えば、前記移動体の移動の制限は、速度の制限、又は停止を含んでいてもよい。 Further, even if a movement limiting unit for limiting the movement of the moving body is provided, it is determined whether or not the correction amount of the first difference is equal to or more than the threshold value, and if the correction amount of the first difference is equal to or more than the threshold value. good. For example, the movement limitation of the moving body may include a speed limitation or a stop.
第１差分の補正量が閾値以上である場合に移動体の移動制御がされると、移動体の移動方向が大きく変わり、安全性に問題が生じるおそれがある。そこで、第１差分の補正量が閾値以上の場合には、移動体の移動が制限される（例えば移動体の速度が制限される、又は移動体が停止される）ことで、安全性を維持できる。 If the movement of the moving body is controlled when the correction amount of the first difference is equal to or greater than the threshold value, the moving direction of the moving body changes significantly, which may cause a safety problem. Therefore, when the correction amount of the first difference is equal to or greater than the threshold value, the movement of the moving body is restricted (for example, the speed of the moving body is limited or the moving body is stopped) to maintain safety. can.
また、さらに、前記経路から直線区間を特定する直線区間特定部を備え、前記操舵向き取得部は、前記移動体が前記直線区間を移動するときに、前記操舵の向きを取得してもよい。 Further, a straight section specifying unit for specifying a straight section from the path may be provided, and the steering direction acquisition unit may acquire the steering direction when the moving body moves in the straight section.
直線区間では、移動体は経路に沿って移動しやすくなるため、移動体が直線区間を移動するときに移動体の操舵の向きを算出することで正確な操舵の向きを算出でき、ひいては、第１差分をより正確な値に補正することができる。 In a straight section, the moving body tends to move along the path. Therefore, when the moving body moves in the straight section, the steering direction of the moving body can be calculated to calculate the correct steering direction. 1 The difference can be corrected to a more accurate value.
また、さらに、前記第１差分又は前記第１差分の補正量が閾値以上の場合、エラーを通知するエラー通知部を備えていてもよい。 Further, when the first difference or the correction amount of the first difference is equal to or larger than the threshold value, an error notification unit for notifying an error may be provided.
これによれば、第１差分又は第１差分の補正量が閾値以上となっていることを、移動体の乗員、管理者又は監視者等に通知することができる。 According to this, it is possible to notify the occupant, the manager, the observer, or the like of the moving body that the first difference or the correction amount of the first difference is equal to or more than the threshold value.
本開示の一態様に係る情報処理方法は、コンピュータにより実行される情報処理方法であって、経路の向きに移動する移動体の正面方向に対する操舵の向きを取得し、取得された前記操舵の向きに基づいて、前記移動体に搭載されるセンサの向きと移動体の向きとの差分として設定される第１差分を補正する処理を含み、前記センサは、前記移動体の向きの推定のためのセンサであり、前記移動体は、設定される経路に沿って移動する移動体である。 The information processing method according to one aspect of the present disclosure is an information processing method executed by a computer, which acquires a steering direction with respect to a front direction of a moving body moving in the direction of a path, and obtains the steering direction. The sensor includes a process of correcting a first difference set as a difference between the orientation of the sensor mounted on the moving body and the orientation of the moving body based on the above, and the sensor is used for estimating the orientation of the moving body. It is a sensor, and the moving body is a moving body that moves along a set path.
これによれば、物理的な目印なしで移動体の向きとセンサの向きとの差分を算出することができる情報処理方法を提供できる。 According to this, it is possible to provide an information processing method capable of calculating a difference between the orientation of a moving body and the orientation of a sensor without a physical marker.
本開示の一態様に係るプログラムは、上記の情報処理方法をコンピュータに実行させるためのプログラムである。 The program according to one aspect of the present disclosure is a program for causing a computer to execute the above information processing method.
これによれば、物理的な目印なしで移動体の向きとセンサの向きとの差分を算出することができるプログラムを提供できる。 According to this, it is possible to provide a program that can calculate the difference between the orientation of the moving body and the orientation of the sensor without a physical marker.
以下、実施の形態について、図面を参照しながら具体的に説明する。 Hereinafter, embodiments will be specifically described with reference to the drawings.
なお、以下で説明する実施の形態は、いずれも包括的又は具体的な例を示すものである。以下の実施の形態で示される数値、形状、材料、構成要素、構成要素の配置位置及び接続形態、ステップ、ステップの順序などは、一例であり、本開示を限定する主旨ではない。 It should be noted that all of the embodiments described below show comprehensive or specific examples. The numerical values, shapes, materials, components, arrangement positions and connection forms of the components, steps, the order of steps, etc. shown in the following embodiments are examples, and are not intended to limit the present disclosure.
（実施の形態１）
以下、実施の形態１に係る情報処理装置について説明する。
(Embodiment 1)
Hereinafter, the information processing apparatus according to the first embodiment will be described.
図１は、実施の形態１に係る情報処理装置１０の一例を示すブロック図である。なお、図１には、情報処理装置１０の他にセンサ５０、メモリ６０及びＣＡＮ（Ｃｏｎｔｒｏｌｌｅｒ Ａｒｅａ Ｎｅｔｗｏｒｋ）７０が示されている。
FIG. 1 is a block diagram showing an example of the
センサ５０は、移動体に搭載されるセンサであって、移動体の向きの推定のためのセンサである。センサ５０は、例えばＬｉＤＡＲ等のレーダである。移動体は、例えば自動車等の車両である。ここでは、移動体は例えば自動運転車両であり、設定される経路に沿って移動することができる。なお、移動体は、経路に沿って移動する際に、経路の向きと移動体の向きとが常に一致するように移動しなくてもよい。例えば、移動体の向きが経路の向きからずれることがあっても、移動体が経路から外れなければ、移動体は経路に沿って移動しているとする。なお、移動体は、無人航空機等であってもよい。
The
メモリ６０は、センサ５０の向きと移動体の向きとの差分として設定される第１差分を記憶する。第１差分は、例えば、キャリブレーション値である。
The
ＣＡＮ７０は、移動体（例えば自動車）に搭載されたネットワークであり、移動体に搭載された各種ＥＣＵ（Ｅｌｅｃｔｒｏｎｉｃ Ｃｏｎｔｒｏｌ Ｕｎｉｔ）及びメモリ等が接続される。
The
ここで、移動体の向きとセンサ５０の向きとの差分について、図２を用いて説明する。
Here, the difference between the orientation of the moving body and the orientation of the
図２は、移動体の向きとセンサ５０の向きとの差分を説明するための図である。
FIG. 2 is a diagram for explaining the difference between the orientation of the moving body and the orientation of the
図２に示されるように、センサ５０は、例えば移動体の前側に搭載される。移動体の向き（例えば正面方向）とセンサ５０の向き（例えば正面方向）とを一致させるようにセンサ５０を移動体に搭載することは難しく、図２に示されるように、移動体の向きとセンサ５０の向きとがずれることがある（なお、図２では説明のために、移動体の向きとセンサ５０の向きとのずれを誇張して示している）。そのため、センサ５０が移動体に搭載されるとき等に、移動体の向きとセンサ５０の向きとの差分を校正するためのキャリブレーション値である第１差分が求められ、メモリ６０に記憶される。
As shown in FIG. 2, the
移動体は、センサ５０のセンサデータに基づいてセンサ５０の正面方向と認識された方向から第１差分を差し引いた方向を、移動体の正面方向として移動する。しかし、第１差分が正確でない場合があり、この場合、移動体は、移動体の正面方向からずれた方向に移動してしまう。自動運転では、フィードバック制御が行われるため、移動体は、移動体の正面方向からずれた方向に移動し続けることはないが、蛇行等が発生してしまう。このため、第１差分を補正して正確な値にする、つまり、移動体の向きとセンサ５０の向きとの差分の正確な校正を行うことが望まれる。特に、従来文献に開示されるような物理的な目印なしで移動体の向きとセンサの向きとの差分を算出することが望まれる。
The moving body moves in the direction obtained by subtracting the first difference from the direction recognized as the front direction of the
情報処理装置１０は、物理的な目印なしで移動体の向きとセンサ５０の向きとの差分を算出することができる装置である。
The
図１での説明に戻り、情報処理装置１０は、経路向き取得部１１、センサ向き算出部１２、直線区間特定部１３、第１差分取得部１４、移動体向き推定部１５、第２差分算出部１６、第１差分補正部１７、移動制限部１８及びエラー通知部１９を備える。
Returning to the description in FIG. 1, the
情報処理装置１０は、プロセッサ及びメモリ等を含むコンピュータである。メモリは、ＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）及びＲＡＭ（Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）等であり、プロセッサにより実行されるプログラムを記憶することができる。経路向き取得部１１、センサ向き算出部１２、直線区間特定部１３、第１差分取得部１４、移動体向き推定部１５、第２差分算出部１６、第１差分補正部１７、移動制限部１８及びエラー通知部１９は、メモリに格納されたプログラムを実行するプロセッサ等によって実現される。
The
例えば、情報処理装置１０は、サーバであってもよい。また、情報処理装置１０を構成する構成要素は、複数のサーバに分散して配置されてもよい。
For example, the
また、例えば、情報処理装置１０は、移動体に搭載される装置であってもよい。その場合、情報処理装置１０は、センサ５０を備えていてもよい。
Further, for example, the
また、例えば、情報処理装置１０は、メモリ６０を備えていてもよい。その場合、メモリ６０は、プログラムを記憶するメモリと同じメモリであってもよい。また、その場合、メモリ６０は、情報処理装置１０内のバスに接続されていてもよい。
Further, for example, the
経路向き取得部１１は、移動体が移動する経路の向きを取得する。
The route
センサ向き算出部１２は、移動体に搭載されるセンサ５０の向きをセンサ５０によって取得されるセンサデータに基づいて算出する。
The sensor
直線区間特定部１３は、設定される経路から直線区間を特定する。
The straight line
第１差分取得部１４は、センサ５０の向きと移動体の向きとの差分として設定される第１差分を取得する。
The first
移動体向き推定部１５は、算出されたセンサ５０の向きと第１差分とに基づいて移動体の向きを推定する。
The moving body
第２差分算出部１６は、取得された経路の向きと推定された移動体の向きとの第２差分を算出する。
The second
第１差分補正部１７は、算出された第２差分に基づいて第１差分を補正する。
The first
移動制限部１８は、第１差分の補正量が閾値以上か否かを判定し、第１差分の補正量が閾値以上の場合、移動体の移動を制限する。
The
エラー通知部１９は、第１差分又は第１差分の補正量が閾値以上の場合、エラーを通知する。
The
情報処理装置１０の各機能構成要素の詳細について、図３を用いて説明する。
Details of each functional component of the
図３は、実施の形態１に係る情報処理装置１０の動作の一例を示すフローチャートである。例えば、自動運転システム等において、移動体が移動する経路がソフトウェア上で設定され、移動体はその経路に沿って移動するように設定されているとする。
FIG. 3 is a flowchart showing an example of the operation of the
まず、経路向き取得部１１は、移動体が移動する経路の向きを取得する（ステップＳ１１）。経路向き取得部１１は、例えば、ＣＡＮ７０等を介してサーバ等から取得した地図情報等に基づいて移動体が移動する経路の向きを取得する。例えば、直線区間特定部１３が特定した直線区間を移動体が移動するときに、経路向き取得部１１は経路の向きを取得する。直線区間特定部１３は、例えば、ＣＡＮ７０等を介して各種ＥＣＵ等から取得した移動中の経路の曲率又は回避動作の有無等から直線区間を特定してもよい。また、直線区間特定部１３は、ＣＡＮ７０等を介してサーバ等から取得した地図情報等から直線区間を特定してもよい。直線区間では、移動体は経路に沿って移動しやすくなるため、移動体が直線区間を移動するときに経路の向きを取得することで正確な経路の向きを取得できる。
First, the route
次に、センサ向き算出部１２は、移動体に搭載されるセンサ５０の向きをセンサ５０によって取得されるセンサデータに基づいて算出する（ステップＳ１２）。センサ向き算出部１２は、例えば、ＣＡＮ７０等を介してセンサ５０及びサーバ等からセンサデータ（例えばＬｉＤＡＲによって得られる点群データ）及び地図情報を取得し、センサデータが示す移動体の周辺の情報と、地図情報が示す移動体の周辺の情報とを比較することで、センサ５０の向きを算出することができる。例えば、直線区間特定部１３が特定した直線区間を移動体が移動するときに、センサ向き算出部１２はセンサ５０の向きを算出する。移動体が直線区間を移動するときにセンサ５０の向きを算出することで正確なセンサ５０の向きを算出できる。
Next, the sensor
次に、第１差分取得部１４は、センサ５０の向きと移動体の向きとの差分として設定される第１差分を例えばメモリ６０から取得する（ステップＳ１３）。例えば、第１差分は、センサ５０が移動体に搭載される際に設定されてメモリ６０に記憶される。また、第１差分は、後述するように補正されて更新される。
Next, the first
次に、移動体向き推定部１５は、算出されたセンサ５０の向きと第１差分とに基づいて移動体の向きを推定する（ステップＳ１４）。移動体向き推定部１５は、算出されたセンサ５０の向きから第１差分を差し引くことで、移動体の向きを推定する。なお、第１差分が、センサ５０の向きと移動体の向きとの正確な差分となっていない可能性があるため、推定される移動体の向き、言い換えると、ソフトウェア上の移動体の向きは、現実の移動体の向きからずれている可能性がある。
Next, the moving body
なお、ステップＳ１１は、ステップＳ１２、ステップＳ１３又はステップＳ１４の後に行われてもよい。 In addition, step S11 may be performed after step S12, step S13 or step S14.
次に、第２差分算出部１６は、取得された経路の向きと推定された移動体の向きとの第２差分を算出する（ステップＳ１５）。第２差分について図４を用いて説明する。
Next, the second
図４は、第１差分が正確な場合及び正確でない場合の第２差分の時間変化の一例を示す図である。 FIG. 4 is a diagram showing an example of the time change of the second difference when the first difference is accurate and when it is not accurate.
上述したように、移動体は、センサ５０のセンサデータに基づいてセンサ５０の正面方向と認識された方向から第１差分を差し引いた方向を移動体の正面方向として移動する。第１差分が正確な場合、推定される移動体の向きは、現実の移動体の向き、言い換えると、現実の移動体が移動する経路の向きに近づく。このため、経路の向きと推定された移動体の向きとの第２差分は、図４に示される実線のように０付近となる。
As described above, the moving body moves in the direction obtained by subtracting the first difference from the direction recognized as the front direction of the
一方で、第１差分が正確でない場合、推定される移動体の向きには、現実の移動体が移動する経路の向きに対して、第１差分の、実際の差分からのズレ量に応じた一定の偏りが生じる。フィードバック制御が行われるため、経路の向きと推定された移動体の向きとの第２差分は、大きくなり続けることはないが、図４に示される破線のように偏ることになる。 On the other hand, when the first difference is not accurate, the estimated orientation of the moving body corresponds to the amount of deviation of the first difference from the actual difference with respect to the direction of the path on which the actual moving body moves. A certain bias occurs. Since the feedback control is performed, the second difference between the direction of the path and the direction of the estimated moving body does not continue to increase, but is biased as shown by the broken line shown in FIG.
図３での説明に戻り、次に、第１差分補正部１７は、算出された第２差分に基づいて第１差分を補正する（ステップＳ１６）。
Returning to the description in FIG. 3, next, the first
例えば、第１差分補正部１７は、第２差分（例えば第２差分の絶対値）が小さくなるように第１差分を補正してもよい。第２差分（又は第２差分の統計値）が小さくなるように、すなわち、推定される移動体の向きが経路の向きからずれないように第１差分が補正されることで、第１差分を正確な値に補正することができる。
For example, the first
例えば、第１差分補正部１７は、第２差分が閾値以上か否かを判定し、第２差分が閾値以上の場合、第１差分を補正してもよい。第２差分が閾値以上の場合、すなわち、推定される移動体の向きが経路の向きから大きくずれている場合に、第１差分を補正できる。言い換えると、第２差分が閾値未満になるまで第１差分を補正することで、第１差分を正確な値に補正することができる。
For example, the first
ここで、第１差分補正部１７の動作の具体例について説明する。
Here, a specific example of the operation of the first
図５は、実施の形態１に係る第１差分補正部１７の動作の一例を示すフローチャートである。
FIG. 5 is a flowchart showing an example of the operation of the first
まず、第１差分補正部１７は、Ｎ個のフレームの第２差分の平均を算出する（ステップＳ２１）。Ｎ個のフレームは、例えば、２０個から３０個のフレームである。図４に示されるように、第１差分が正確な場合には、Ｎ個のフレームの第２差分の平均は０に近くなるが、第１差分が正確でない場合には、０付近とならず正又は負の値になる。
First, the first
次に、第１差分補正部１７は、Ｎ個のフレームの第２差分の平均（例えば平均の絶対値）が閾値以上か否かを判定する（ステップＳ２２）。つまり、第１差分補正部１７は、Ｎ個のフレームにおける移動体の平均的な向きが経路の向きから大きくずれているか否かを判定する。
Next, the first
第１差分補正部１７は、Ｎ個のフレームの第２差分の平均が閾値以上である場合（ステップＳ２２でＹｅｓ）、第１差分を補正する（ステップＳ２３）。具体的には、第１差分補正部１７は、推定される移動体の向きと経路の向きとの差を打ち消すように第１差分を補正する。
When the average of the second differences of N frames is equal to or greater than the threshold value (Yes in step S22), the first
なお、Ｎ個のフレームの第２差分を全て得た後に平均の算出が行われなくてもよく、第２差分を得るごとに平均の算出が行われてもよい。また、Ｎ番目のフレームの経過前であっても、平均が閾値以上であれば、ステップＳ２３の処理が行われてもよい。 It is not necessary to calculate the average after obtaining all the second differences of N frames, and the average may be calculated every time the second difference is obtained. Further, even before the lapse of the Nth frame, if the average is equal to or greater than the threshold value, the process of step S23 may be performed.
ステップＳ２１からステップＳ２３までの処理が繰り返されることで、第１差分が正確な値に補正されていき、第１差分補正部１７は、第２差分の平均が閾値未満となった場合（ステップＳ２２でＮｏ）、第１差分の補正処理を終了する。
By repeating the processes from step S21 to step S23, the first difference is corrected to an accurate value, and the first
なお、移動制限部１８は、第１差分の補正量が閾値以上の場合、移動体の移動を制限する。例えば、移動体の移動の制限は、速度の制限、又は停止を含む。第１差分の補正量が閾値以上である場合に移動体の移動制御がされると、移動体の移動方向が大きく変わり、安全性に問題が生じるおそれがあるが、第１差分の補正量が閾値以上の場合には、移動体の移動が制限されることで、安全性を維持できる。
The
また、エラー通知部１９は、第１差分又は第１差分の補正量が閾値以上の場合、エラーを通知する。例えば、エラー通知部１９は、アラートを出力して、移動体の乗員、管理者又は監視者等にエラーを通知する。これにより、第１差分又は第１差分の補正量が閾値以上となっていることを、移動体の乗員、管理者又は監視者等に通知することができる。
Further, the
以上説明したように、第２差分から第１差分を補正することで第１差分を正確な値に補正することができ、移動体の向きとセンサ５０の向きとの差分の正確な校正を行うことができる。本開示では、物理的な目印なしで移動体の向きとセンサ５０の向きとの差分を算出することができる。例えば、工場等の目印が設置できる特殊な環境だけでなく、目印が設置できない環境も含めて様々な環境で移動体の向きとセンサ５０の向きとの校正を行うことができる。
As described above, the first difference can be corrected to an accurate value by correcting the first difference from the second difference, and the difference between the orientation of the moving body and the orientation of the
（実施の形態２）
以下、実施の形態２に係る情報処理装置について説明する。
(Embodiment 2)
Hereinafter, the information processing apparatus according to the second embodiment will be described.
図６は、実施の形態２に係る情報処理装置２０の一例を示すブロック図である。なお、図６には、情報処理装置２０の他にセンサ５０、メモリ６０及びＣＡＮ７０が示されている。センサ５０、メモリ６０及びＣＡＮ７０は、実施の形態１におけるものと同じであるため説明は省略する。
FIG. 6 is a block diagram showing an example of the
情報処理装置２０は、操舵向き取得部２１、第１差分補正部２２、直線区間特定部１３、移動制限部１８及びエラー通知部１９を備える。
The
情報処理装置２０は、プロセッサ及びメモリ等を含むコンピュータである。メモリは、ＲＯＭ及びＲＡＭ等であり、プロセッサにより実行されるプログラムを記憶することができる。操舵向き取得部２１、第１差分補正部２２、直線区間特定部１３、移動制限部１８及びエラー通知部１９は、メモリに格納されたプログラムを実行するプロセッサ等によって実現される。なお、直線区間特定部１３、移動制限部１８及びエラー通知部１９は、実施の形態１におけるものと同じであるため説明は省略する。
The
例えば、情報処理装置２０は、サーバであってもよい。また、情報処理装置２０を構成する構成要素は、複数のサーバに分散して配置されてもよい。
For example, the
また、例えば、情報処理装置２０は、移動体に搭載される装置であってもよい。その場合、情報処理装置２０は、センサ５０を備えていてもよい。
Further, for example, the
また、例えば、情報処理装置２０は、メモリ６０を備えていてもよい。その場合、メモリ６０は、プログラムを記憶するメモリと同じメモリであってもよい。
Further, for example, the
また、実施の形態１と同じように、移動体は、設定される経路に沿って移動する移動体である。 Further, as in the first embodiment, the moving body is a moving body that moves along the set route.
操舵向き取得部２１は、経路の向きに移動する移動体の正面方向に対する操舵の向きを取得する。
The steering
第１差分補正部２２は、取得された操舵の向きに基づいて、移動体に搭載されるセンサ５０の向きと移動体の向きとの差分として設定される第１差分を補正する。
The first
情報処理装置２０の各機能構成要素の詳細について、図７を用いて説明する。
Details of each functional component of the
図７は、実施の形態２に係る情報処理装置２０の動作の一例を示すフローチャートである。例えば、自動運転システム等において、移動体が移動する経路がソフトウェア上で設定され、移動体はその経路に沿って移動するように設定されているとする。
FIG. 7 is a flowchart showing an example of the operation of the
まず、操舵向き取得部２１は、経路の向きに移動する移動体の正面方向に対する操舵の向きを取得する（ステップＳ３１）。操舵向き取得部２１は、例えば、ＣＡＮ７０等を介して各種ＥＣＵ等から操舵の向きを取得する。移動体が経路の向きに移動するとは、経路の向きと移動体の正面方向とが平行になるように移動体が経路をまっすぐ移動することを意味する。例えば、操舵の向きは、タイヤ角であってもよく、タイヤ角をセンシングするセンサ等からタイヤ角を取得することができる。また、例えば、操舵の向きは、ステアリング角であってもよく、ステアリング関連のＥＣＵ等からステアリング角を取得することができる。
First, the steering
例えば、直線区間特定部１３が特定した直線区間を移動体が移動するときに、操舵向き取得部２１は、操舵の向きを取得する。移動体は経路に沿って移動しやすくなるため、移動体が直線区間を移動するときに移動体の操舵の向きを算出することで正確な操舵の向きを算出できる。
For example, when the moving body moves in the straight line section specified by the straight line
第１差分がセンサ５０の向きと移動体の向きとの正確な差分となっていない場合、移動体は、経路の向きからずれて移動することになる。具体的には、移動体は、センサ５０のセンサデータに基づいてセンサ５０の正面方向と認識された方向から第１差分を差し引いた方向を移動体の正面方向（すなわち経路の向き）として移動するが、第１差分が正確でない場合、経路の向きからずれた方向に移動してしまう。これに対して、自動運転では、経路の向きからずれた方向に移動した移動体を経路から外れないように移動させるために、操舵の向きが移動体の正面方向から経路の向きへ制御されることになる。つまり、第１差分が正確でない場合、操舵の向きには、第１差分の、実際の差分からのズレ量に応じた移動方向のズレを解消するための一定の偏りが移動体の正面方向に対して生じる。
If the first difference is not an accurate difference between the orientation of the
次に、第１差分補正部２２は、取得された操舵の向きに基づいて、移動体に搭載されるセンサ５０の向きと移動体の向きとの差分として設定される第１差分を補正する（ステップＳ３２）。
Next, the first
例えば、第１差分補正部２２は、移動体の正面方向に対する操舵の向きが小さくなるように第１差分を補正してもよい。操舵の向き（又は操舵の向きの統計値）が小さくなるように第１差分が補正されることで、言い換えると、移動体が経路の向きからずれた方向に移動しなくなるように第１差分が補正されることで、第１差分を正確な値に補正することができる。
For example, the first
例えば、第１差分補正部２２は、移動体の正面方向に対する操舵の向きが閾値以上か否かを判定し、操舵の向きが閾値以上の場合、第１差分を補正してもよい。移動体の正面方向に対する操舵の向きが閾値以上、すなわち、移動体の操舵の向きが移動体の正面方向から大きくずれている場合に、第１差分を補正できる。言い換えると、移動体の正面方向に対する操舵の向きが閾値未満になるまで第１差分を補正することで、第１差分を正確な値に補正することができる。
For example, the first
なお、第１差分補正部２２は、実施の形態１における第１差分補正部１７と同じように、Ｎ個のフレームに対応する操舵の向きの平均に基づいて、第１差分を補正してもよい。
Note that the first
以上説明したように、操舵の向きの偏りから第１差分を補正することで第１差分を正確な値に補正することができ、移動体の向きとセンサ５０の向きとの差分の正確な校正を行うことができる。本開示では、物理的な目印なしで移動体の向きとセンサ５０の向きとの差分を算出することができる。例えば、工場等の目印が設置できる特殊な環境だけでなく、目印が設置できない環境も含めて様々な環境で移動体の向きとセンサ５０の向きとの校正を行うことができる。また、操舵の向きはＣＡＮ７０等を介して容易に取得することができるため、移動体の向きとセンサ５０の向きとの差分の算出をより簡易に行うことができる。
As described above, the first difference can be corrected to an accurate value by correcting the first difference from the deviation of the steering direction, and the difference between the direction of the moving body and the direction of the
（その他の実施の形態）
以上、本開示の一つ又は複数の態様に係る情報処理装置について、実施の形態に基づいて説明したが、本開示は、これらの実施の形態に限定されるものではない。本開示の趣旨を逸脱しない限り、当業者が思いつく各種変形を各実施の形態に施したものや、異なる実施の形態における構成要素を組み合わせて構築される形態も、本開示の一つ又は複数の態様の範囲内に含まれてもよい。
(Other embodiments)
The information processing apparatus according to one or more aspects of the present disclosure has been described above based on the embodiments, but the present disclosure is not limited to these embodiments. As long as it does not deviate from the gist of the present disclosure, one or a plurality of forms in which various modifications conceived by those skilled in the art are applied to each embodiment or constructed by combining components in different embodiments are also included in the present disclosure. It may be included within the scope of the embodiment.
例えば、上記実施の形態では、情報処理装置は、直線区間特定部１３、移動制限部１８及びエラー通知部１９を備える例について説明したが、情報処理装置は、直線区間特定部１３、移動制限部１８及びエラー通知部１９のうちの少なくとも１つの構成要素を備えていなくてもよい。
For example, in the above embodiment, the information processing apparatus includes the straight line
例えば、移動体に複数のセンサが搭載されていてもよい。移動体に複数のセンサが搭載される場合の校正について図８及び図９を用いて説明する。 For example, a plurality of sensors may be mounted on the moving body. Calibration when a plurality of sensors are mounted on a moving body will be described with reference to FIGS. 8 and 9.
図８は、複数のセンサが搭載された移動体を示す図である。 FIG. 8 is a diagram showing a moving body on which a plurality of sensors are mounted.
図９は、複数のセンサのそれぞれの点群データ及び地図情報が示す点群データを説明するための図である。 FIG. 9 is a diagram for explaining the point cloud data of each of the plurality of sensors and the point cloud data indicated by the map information.
図８に示されるように、例えば、移動体の天井にセンサ５０ａが搭載され、移動体の右側にセンサ５０ｂが搭載され、移動体の左側にセンサ５０ｃが搭載され、移動体の後側にセンサ５０ｄが搭載されているとする。センサ５０ａ、５０ｂ、５０ｃ及び５０ｄは、例えばＬｉＤＡＲ等のレーダである。センサ５０ａは移動体の周囲をセンシングし、センサ５０ｂは移動体の右方をセンシングし、センサ５０ｃは移動体の左方をセンシングし、センサ５０ｄは移動体の後方をセンシングする。
As shown in FIG. 8, for example, the
図９には、センサ５０ａ、５０ｂ、５０ｃ及び５０ｄのそれぞれが取得する点群データ及び地図情報が示す点群データを模式的に示している。白丸で示される点群データ５１ａは、センサ５０ａが取得する点群データである。右上から左下への斜線が付された丸で示される点群データ５１ｂは、センサ５０ｂが取得する点群データである。左上から右下への斜線が付された丸で示される点群データ５１ｃは、センサ５０ｃが取得する点群データである。ドットが付された丸で示される点群データ５１ｄは、センサ５０ｄが取得する点群データである。黒丸で示される点群データ５１ｅは、地図情報が示す点群データである。
FIG. 9 schematically shows the point cloud data acquired by each of the
例えば、実施の形態１又は２で説明した移動体の向きとセンサの向きとの差分の校正は、センサ５０ａ、５０ｂ、５０ｃ及び５０ｄのうちのいずれか１つのセンサについて行われればよく、他のセンサについては行われなくてもよい。地図情報が示す点群データ５１ｅと、センサ５０ａ、５０ｂ、５０ｃ及び５０ｄが取得する点群データ５１ａ、５１ｂ、５１ｃ及び５１ｄとを比較することでセンサ５０ａ、５０ｂ、５０ｃ及び５０ｄの向きを算出することができ、各センサ間の向きの差分の校正を行うことができるためである。具体的には、センサ５０ａについて、移動体の向きとセンサ５０ａの向きとの正確な第１差分が０．２°と求まり、センサ５０ａの向きとセンサ５０ｂの向きとの差分が０．５°と求まれば、移動体の向きとセンサ５０ｂの向きとの正確な第１差分は、実施の形態１又は２に示すようにして求めなくても、センサ５０ａについての第１差分を用いて０．７°と容易に求めることができる。
For example, the calibration of the difference between the orientation of the moving body and the orientation of the sensor described in the first or second embodiment may be performed for any one of the
例えば、上記実施の形態では、ＣＡＮ７０を介して、センサデータ、各種ＥＣＵのデータ又はメモリ６０に記憶された第１差分のデータ等の送受信が行われる例について説明したが、これらのデータの送受信に用いられるネットワークは、ＣＡＮ７０に限らない。例えば、他の有線又は無線のネットワークであってもよい。
For example, in the above embodiment, an example in which sensor data, data of various ECUs, data of the first difference stored in the
例えば、本開示において、移動体の向き、センサの向きとしているところを、移動体の姿勢、センサの姿勢と置き換えてもよい。 For example, in the present disclosure, the orientation of the moving body and the orientation of the sensor may be replaced with the posture of the moving body and the posture of the sensor.
なお、本開示は、情報処理装置として実現できるだけでなく、情報処理装置を構成する各構成要素が行うステップ（処理）を含む情報処理方法として実現できる。 It should be noted that the present disclosure can be realized not only as an information processing device but also as an information processing method including steps (processing) performed by each component constituting the information processing device.
例えば、情報処理方法は、コンピュータにより実行される情報処理方法であって、図３に示されるように、移動体が移動する経路の向きを取得し（ステップＳ１１）、移動体に搭載されるセンサの向きを当該センサによって取得されるセンサデータに基づいて算出し（ステップＳ１２）、センサの向きと移動体の向きとの差分として設定される第１差分を取得し（ステップＳ１３）、算出されたセンサの向きと第１差分とに基づいて移動体の向きを推定し（ステップＳ１４）、取得された経路の向きと推定された移動体の向きとの第２差分を算出し（ステップＳ１５）、算出された第２差分に基づいて第１差分を補正する（ステップＳ１６）処理を含み、センサは、移動体の向きの推定のためのセンサであり、移動体は、設定される経路に沿って移動する移動体である。 For example, the information processing method is an information processing method executed by a computer, and as shown in FIG. 3, a sensor mounted on the moving body obtains the direction of the path on which the moving body moves (step S11). Is calculated based on the sensor data acquired by the sensor (step S12), and the first difference set as the difference between the orientation of the sensor and the orientation of the moving object is acquired (step S13) and calculated. The orientation of the moving object is estimated based on the orientation of the sensor and the first difference (step S14), and the second difference between the acquired path orientation and the estimated orientation of the moving object is calculated (step S15). The process of correcting the first difference based on the calculated second difference (step S16) is included, the sensor is a sensor for estimating the orientation of the moving body, and the moving body is along the set path. It is a moving body that moves.
また、例えば、情報処理方法は、コンピュータにより実行される情報処理方法であって、図７に示されるように、経路の向きに移動する移動体の正面方向に対する操舵の向きを取得し（ステップＳ３１）、取得された操舵の向きに基づいて、移動体に搭載されるセンサの向きと移動体の向きとの差分として設定される第１差分を補正する（ステップＳ３２）処理を含み、センサは、移動体の向きの推定のためのセンサであり、移動体は、設定される経路に沿って移動する移動体である。 Further, for example, the information processing method is an information processing method executed by a computer, and as shown in FIG. 7, the steering direction with respect to the front direction of the moving body moving in the direction of the path is acquired (step S31). ), The first difference set as the difference between the orientation of the sensor mounted on the moving body and the orientation of the moving body is corrected based on the acquired steering direction (step S32), and the sensor comprises. It is a sensor for estimating the orientation of a moving body, and the moving body is a moving body that moves along a set path.
例えば、本開示は、情報処理方法に含まれるステップを、プロセッサに実行させるためのプログラムとして実現できる。さらに、本開示は、そのプログラムを記録したＣＤ－ＲＯＭ等である非一時的なコンピュータ読み取り可能な記録媒体として実現できる。 For example, the present disclosure can be realized as a program for causing a processor to execute a step included in an information processing method. Further, the present disclosure can be realized as a non-temporary computer-readable recording medium such as a CD-ROM in which the program is recorded.
例えば、本開示が、プログラム（ソフトウェア）で実現される場合には、コンピュータのＣＰＵ、メモリ及び入出力回路等のハードウェア資源を利用してプログラムが実行されることによって、各ステップが実行される。つまり、ＣＰＵがデータをメモリ又は入出力回路等から取得して演算したり、演算結果をメモリ又は入出力回路等に出力したりすることによって、各ステップが実行される。 For example, when the present disclosure is realized by a program (software), each step is executed by executing the program using hardware resources such as a computer CPU, memory, and input / output circuit. .. That is, each step is executed by the CPU acquiring data from the memory or the input / output circuit or the like and performing an operation, or outputting the operation result to the memory or the input / output circuit or the like.
なお、上記実施の形態において、情報処理装置に含まれる各構成要素は、専用のハードウェアで構成されるか、各構成要素に適したソフトウェアプログラムを実行することによって実現されてもよい。各構成要素は、ＣＰＵ又はプロセッサなどのプログラム実行部が、ハードディスク又は半導体メモリなどの記録媒体に記録されたソフトウェアプログラムを読み出して実行することによって実現されてもよい。 In the above embodiment, each component included in the information processing apparatus may be configured by dedicated hardware or may be realized by executing a software program suitable for each component. Each component may be realized by a program execution unit such as a CPU or a processor reading and executing a software program recorded on a recording medium such as a hard disk or a semiconductor memory.
上記実施の形態に係る情報処理装置の機能の一部又は全ては典型的には集積回路であるＬＳＩとして実現される。これらは個別に１チップ化されてもよいし、一部又は全てを含むように１チップ化されてもよい。また、集積回路化はＬＳＩに限るものではなく、専用回路又は汎用プロセッサで実現してもよい。ＬＳＩ製造後にプログラムすることが可能なＦＰＧＡ（Ｆｉｅｌｄ Ｐｒｏｇｒａｍｍａｂｌｅ Ｇａｔｅ Ａｒｒａｙ）、又はＬＳＩ内部の回路セルの接続や設定を再構成可能なリコンフィギュラブル・プロセッサを利用してもよい。 Some or all of the functions of the information processing apparatus according to the above embodiment are typically realized as an LSI which is an integrated circuit. These may be individually integrated into one chip, or may be integrated into one chip so as to include a part or all of them. Further, the integrated circuit is not limited to the LSI, and may be realized by a dedicated circuit or a general-purpose processor. An FPGA (Field Programmable Gate Array) that can be programmed after the LSI is manufactured, or a reconfigurable processor that can reconfigure the connection and settings of circuit cells inside the LSI may be used.
さらに、本開示の主旨を逸脱しない限り、本開示の各実施の形態に対して当業者が思いつく範囲内の変更を施した各種変形例も本開示に含まれる。 Further, as long as it does not deviate from the gist of the present disclosure, various modifications made to the extent that a person skilled in the art can think of each embodiment of the present disclosure are also included in the present disclosure.
本開示は、ＬｉＤＡＲ等のレーダを搭載する自動運転車両等に適用できる。 The present disclosure can be applied to an autonomous driving vehicle or the like equipped with a radar such as LiDAR.
１０、２０ 情報処理装置
１１ 経路向き取得部
１２ センサ向き算出部
１３ 直線区間特定部
１４ 第１差分取得部
１５ 移動体向き推定部
１６ 第２差分算出部
１７、２２ 第１差分補正部
１８ 移動制限部
１９ エラー通知部
２１ 操舵向き取得部
５０、５０ａ、５０ｂ、５０ｃ、５０ｄ センサ
５１ａ、５１ｂ、５１ｃ、５１ｄ、５１ｅ 点群データ
６０ メモリ
７０ ＣＡＮ
10, 20
Claims (18)
前記移動体に搭載されるセンサの向きを当該センサによって取得されるセンサデータに基づいて算出するセンサ向き算出部と、
前記センサの向きと前記移動体の向きとの差分として設定される第１差分を取得する第１差分取得部と、
算出された前記センサの向きと前記第１差分とに基づいて前記移動体の向きを推定する移動体向き推定部と、
取得された前記経路の向きと推定された前記移動体の向きとの第２差分を算出する第２差分算出部と、
算出された前記第２差分に基づいて前記第１差分を補正する第１差分補正部と、を備え、
前記センサは、前記移動体の向きの推定のためのセンサであり、
前記移動体は、設定される経路に沿って移動する移動体である
情報処理装置。 A route orientation acquisition unit that acquires the orientation of the route on which the moving object travels,
A sensor orientation calculation unit that calculates the orientation of the sensor mounted on the moving body based on the sensor data acquired by the sensor, and a sensor orientation calculation unit.
A first difference acquisition unit that acquires a first difference set as a difference between the orientation of the sensor and the orientation of the moving body, and
A moving body orientation estimation unit that estimates the orientation of the moving body based on the calculated orientation of the sensor and the first difference.
A second difference calculation unit that calculates a second difference between the acquired orientation of the route and the estimated orientation of the moving body, and
A first difference correction unit that corrects the first difference based on the calculated second difference is provided.
The sensor is a sensor for estimating the orientation of the moving body.
The moving body is an information processing device that is a moving body that moves along a set path.
請求項１に記載の情報処理装置。 The information processing device according to claim 1, wherein the first difference correction unit corrects the first difference so that the second difference becomes smaller.
請求項１又は２に記載の情報処理装置。 The information processing apparatus according to claim 1 or 2, wherein the first difference correction unit determines whether or not the second difference is equal to or greater than a threshold value, and if the second difference is equal to or greater than the threshold value, corrects the first difference. ..
請求項１～３のいずれか１項に記載の情報処理装置。 Further, claims 1 to 3 include a movement limiting unit that determines whether or not the correction amount of the first difference is equal to or greater than the threshold value, and if the correction amount of the first difference is equal to or greater than the threshold value, restricts the movement of the moving body. The information processing apparatus according to any one of the above items.
請求項４に記載の情報処理装置。 The information processing apparatus according to claim 4, wherein the movement limitation of the moving body includes a speed limitation or a stop.
前記経路向き取得部は、前記移動体が前記直線区間を移動するときに、前記経路の向きを取得し、
前記センサ向き算出部は、前記移動体が前記直線区間を移動するときに、前記センサの向きを算出する
請求項１～５のいずれか１項に記載の情報処理装置。 Further, a straight section specifying portion for specifying a straight section from the route is provided.
The route orientation acquisition unit acquires the orientation of the route when the moving body moves in the straight section.
The information processing device according to any one of claims 1 to 5, wherein the sensor orientation calculation unit calculates the orientation of the sensor when the moving body moves in the straight line section.
請求項１～６のいずれか１項に記載の情報処理装置。 The information processing apparatus according to any one of claims 1 to 6, further comprising an error notification unit for notifying an error when the first difference or the correction amount of the first difference is equal to or greater than a threshold value.
移動体が移動する経路の向きを取得し、
前記移動体に搭載されるセンサの向きを当該センサによって取得されるセンサデータに基づいて算出し、
前記センサの向きと前記移動体の向きとの差分として設定される第１差分を取得し、
算出された前記センサの向きと前記第１差分とに基づいて前記移動体の向きを推定し、
取得された前記経路の向きと推定された前記移動体の向きとの第２差分を算出し、
算出された前記第２差分に基づいて前記第１差分を補正し、
前記センサは、前記移動体の向きの推定のためのセンサであり、
前記移動体は、設定される経路に沿って移動する移動体である
情報処理方法。 Information processing method executed by a computer
Get the direction of the path that the moving object travels,
The orientation of the sensor mounted on the moving body is calculated based on the sensor data acquired by the sensor, and the orientation is calculated.
The first difference set as the difference between the direction of the sensor and the direction of the moving body is acquired, and the difference is obtained.
The orientation of the moving body is estimated based on the calculated orientation of the sensor and the first difference.
The second difference between the acquired orientation of the route and the estimated orientation of the moving body was calculated.
The first difference is corrected based on the calculated second difference.
The sensor is a sensor for estimating the orientation of the moving body.
The moving body is an information processing method that is a moving body that moves along a set path.
取得された前記操舵の向きに基づいて、前記移動体に搭載されるセンサの向きと移動体の向きとの差分として設定される第１差分を補正する第１差分補正部と、を備え、
前記センサは、前記移動体の向きの推定のためのセンサであり、
前記移動体は、設定される経路に沿って移動する移動体である
情報処理装置。 A steering direction acquisition unit that acquires the steering direction with respect to the front direction of a moving body that moves in the direction of the path, and a steering direction acquisition unit.
A first difference correction unit that corrects a first difference set as a difference between the direction of the sensor mounted on the moving body and the direction of the moving body based on the acquired steering direction is provided.
The sensor is a sensor for estimating the orientation of the moving body.
The moving body is an information processing device that is a moving body that moves along a set path.
請求項１０に記載の情報処理装置。 The information processing device according to claim 10, wherein the first difference correction unit corrects the first difference so that the steering direction becomes smaller.
請求項１０又は１１に記載の情報処理装置。 The information processing device according to claim 10 or 11, wherein the first difference correction unit determines whether or not the steering direction is equal to or greater than a threshold value, and if the steering direction is equal to or greater than the threshold value, corrects the first difference. ..
請求項１０～１２のいずれか１項に記載の情報処理装置。 Further, claims 10 to 12 include a movement limiting unit that determines whether or not the correction amount of the first difference is equal to or greater than the threshold value, and if the correction amount of the first difference is equal to or greater than the threshold value, restricts the movement of the moving body. The information processing apparatus according to any one of the above items.
請求項１３に記載の情報処理装置。 The information processing apparatus according to claim 13, wherein the movement limitation of the moving body includes a speed limitation or a stop.
前記操舵向き取得部は、前記移動体が前記直線区間を移動するときに、前記操舵の向きを取得する
請求項１０～１４のいずれか１項に記載の情報処理装置。 Further, a straight section specifying portion for specifying a straight section from the route is provided.
The information processing device according to any one of claims 10 to 14, wherein the steering direction acquisition unit acquires the steering direction when the moving body moves in the straight section.
請求項１０～１５のいずれか１項に記載の情報処理装置。 The information processing apparatus according to any one of claims 10 to 15, further comprising an error notification unit for notifying an error when the first difference or the correction amount of the first difference is equal to or greater than a threshold value.
経路の向きに移動する移動体の正面方向に対する操舵の向きを取得し、
取得された前記操舵の向きに基づいて、前記移動体に搭載されるセンサの向きと移動体の向きとの差分として設定される第１差分を補正し、
前記センサは、前記移動体の向きの推定のためのセンサであり、
前記移動体は、設定される経路に沿って移動する移動体である
情報処理方法。 Information processing method executed by a computer
Acquires the steering direction with respect to the front direction of the moving body moving in the direction of the path.
Based on the acquired steering direction, the first difference set as the difference between the direction of the sensor mounted on the moving body and the direction of the moving body is corrected.
The sensor is a sensor for estimating the orientation of the moving body.
The moving body is an information processing method that is a moving body that moves along a set path.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2020109303A JP7482440B2 (en) | 2020-06-25 | 2020-06-25 | Information processing device, information processing method, and program |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2020109303A JP7482440B2 (en) | 2020-06-25 | 2020-06-25 | Information processing device, information processing method, and program |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2022006811A true JP2022006811A (en) | 2022-01-13 |
| JP7482440B2 JP7482440B2 (en) | 2024-05-14 |
Family
ID=80110904
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2020109303A Active JP7482440B2 (en) | 2020-06-25 | 2020-06-25 | Information processing device, information processing method, and program |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7482440B2 (en) |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2020032986A (en) | 2018-08-31 | 2020-03-05 | パイオニア株式会社 | Posture estimation device, control method, program and storage medium |
-
2020
- 2020-06-25 JP JP2020109303A patent/JP7482440B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP7482440B2 (en) | 2024-05-14 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US10088553B2 (en) | Method of automatic sensor pose estimation | |
| JP6838717B2 (en) | Failure detection device | |
| EP3260882B1 (en) | Radar apparatus mounted on moving body and azimuth angle correction method for use in radar apparatus mounted on moving body | |
| US9659378B2 (en) | Point cloud position data processing device, point cloud position data processing system, point cloud position data processing method, and program therefor | |
| CN107710094B (en) | Online calibration check during autonomous vehicle operation | |
| US20210302165A1 (en) | Imu data offset compensation for an autonomous vehicle | |
| US20200047752A1 (en) | Vehicle lateral motion control | |
| US11486988B2 (en) | Method for calibrating the alignment of a moving object sensor | |
| US10338230B2 (en) | Multipath error correction | |
| JPWO2018212346A1 (en) | Control device, scanning system, control method, and program | |
| US10731994B2 (en) | Information processing device and information processing method | |
| CN114111820B (en) | Infrastructure sensor device, system, position correction method, and storage medium | |
| EP3754359A1 (en) | Method of determination of alignment angles of radar sensors for a road vehicle radar auto-alignment controller | |
| CN111684382A (en) | Movable platform state estimation method, system, movable platform and storage medium | |
| CN115436917A (en) | Synergistic estimation and correction of LIDAR boresight alignment error and host vehicle positioning error | |
| EP4020111B1 (en) | Vehicle localisation | |
| JP2022006811A (en) | Information processor, information processing method and program | |
| JP6819441B2 (en) | Target position estimation method and target position estimation device | |
| JP2019219180A (en) | Object detection device for vehicle | |
| CN111982179B (en) | Abnormality detection device, abnormality detection method, and computer-readable medium | |
| JP7412254B2 (en) | Object recognition device and object recognition method | |
| JP7026734B2 (en) | Object recognition device, object recognition method and vehicle driving support system | |
| US11423571B2 (en) | Systems and methods for image-based component detection | |
| JP7409037B2 (en) | Estimation device, estimation method, estimation program | |
| JP7064001B2 (en) | Vehicle control unit |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20230410 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20231207 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20231219 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240216 |
|
| 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: 20240402 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20240417 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7482440 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |