JP2008087676A - Method of measuring relative angle and position with respect to index position of moving object, and parking support method and system using the same - Google Patents

Abstract

<P>PROBLEM TO BE SOLVED: To measure a distance and a direction with respect to an index by setting the index serving as a known mark in an objective environment, and to guide a vehicle to support parking thereby. <P>SOLUTION: The two indexes with a known diameter and a space are arranged as the known marks in the objective environment, in the present invention, a laser beam is emitted horizontally at every fixed angle, and a laser range finder is fixed on the moving object to calculate a distance thereof. Relative angles and positions with respect to positions located with the two indexes are calculated based on values of the distances and angles of the indexes measured by the laser range finder. Relative distances and angles between the laser range finder fixed onto the vehicle and the positions located with the two indexes are calculated to thereby guide the vehicle. <P>COPYRIGHT: (C)2008,JPO&INPIT

Description

本発明は、移動物体の指標位置への相対角度及び位置計測方法及び、それを利用した駐車支援方法及びシステムに関する。車両などの移動物体を目標位置に移動させる場合には、目標位置と車両との位置関係を知る必要がある。本発明は、目標位置として駐車スペースを想定し、後方駐車における駐車スペースと車両との相対位置の計測手法と、その位置関係を基にした駐車支援方法及びシステムに関する。   The present invention relates to a method for measuring a relative angle and position of a moving object to an index position, and a parking support method and system using the method. When moving a moving object such as a vehicle to a target position, it is necessary to know the positional relationship between the target position and the vehicle. The present invention relates to a method for measuring a relative position between a parking space and a vehicle in rear parking, and a parking support method and system based on the positional relationship, assuming a parking space as a target position.

駐車支援の研究は、これまでにも盛んに行われており、既に、駐車支援を目的とした支援システムも市販されている。市販されているものは、車両後方に設置したカメラを利用したものが多く、駐車スペースの画像に、現在の操舵また直進時の車両諸元に基づき予想される車幅の軌跡線をナビゲーションシステムなどのモニタに重畳して表示させるものや、駐車スペースを画像上で確定後に、自動で操舵を行うものもある。駐車スペースとの相対位置関係を知るために、カメラが利用されているが、夜間などの明度の低い環境では相対位置の把握が困難な場合がある。また、駐車時における障害物の認識は、ドライバにゆだねられていることが多く、障害に対する情報を提供するものはほとんど無い。   Research on parking assistance has been actively conducted so far, and support systems for parking assistance have already been marketed. Most of the products on the market use a camera installed at the rear of the vehicle, and a navigation system or the like shows the trajectory line of the expected vehicle width based on the current steering and straight vehicle specifications in the parking space image. Some of them are displayed superimposed on the other monitor, and some are automatically steered after the parking space is determined on the image. A camera is used to know the relative positional relationship with the parking space, but it may be difficult to grasp the relative position in an environment with low lightness such as at night. In addition, the recognition of obstacles at the time of parking is often left to the driver, and there is little that provides information on obstacles.

研究レベルでは、高精度に位置検出可能なGPSと詳細な地図情報、さらにはジャイロや操舵角センサ、速度センサなどを車両に搭載して、駐車スペースとの位置関係を基に、駐車誘導支援を行うシステムもある。このシステムでは、高精度なGPSやジャイロなどが必要なことから車載装置のコストが高くなることが欠点であり、詳細な地図情報の作成コストも問題になる。
大前学、橋本尚久、藤岡健彦、清水浩：駐車場を有する構内における自動車の自動運転の運動制御に関する研究、自動車技術会論文集Vol．35-3、p．235-240 (2004) 加藤晋、橋本尚久、美濃部直子、津川定之：通信を利用した外部誘導システムの開発、自動車技術会春季大会、No．42-06、p．13-18、20065155 (2006) 加藤晋、橋本尚久、美濃部直子、津川定之：通信を利用した外部誘導システムの実フィールド検証、自動車技術会秋季大会、20065731 (2006) 酒井克博、広中慎司、駐車操作時のドライバ負担軽減システムの研究、自動車技術会春季大会、No．10-06、p．9-12、20065014 (2006) At the research level, GPS that can detect the position with high accuracy and detailed map information, as well as a gyro, steering angle sensor, speed sensor, etc., are installed in the vehicle, and parking guidance assistance is provided based on the positional relationship with the parking space. Some systems do it. This system requires a high-accuracy GPS, gyro, and the like, so the cost of the in-vehicle device is high, and the cost of creating detailed map information is also a problem.
Manabu Ohmae, Naohisa Hashimoto, Takehiko Fujioka, Hiroshi Shimizu: Research on the movement control of the automatic driving of the car on the premises with the parking lot, Vol. 35-3, p. 235-240 (2004) Satoshi Kato, Naohisa Hashimoto, Naoko Minobe, Sadayuki Tsukawa: Development of an external guidance system using communication, Japan Society of Automotive Engineers Spring Meeting, No. 42-06, p. 13-18, 20065155 (2006) Satoshi Kato, Naohisa Hashimoto, Naoko Minobe, Sadayuki Tsukawa: Verification of real field of external guidance system using communications, Autumn Meeting of the Society of Automotive Engineers of Japan, 20065731 (2006) Katsuhiro Sakai, Shinji Hironaka, research on driver burden reduction system when parking, Automobile Engineering Society Spring Meeting, No. 10-06, p. 9-12, 20065014 (2006)

本発明は、高精度なGPSやジャイロなどを必要とすることなく、計測対象となる指標が円柱状であれば計測方向に左右されずに，対象となる環境に既知の目印となる指標を置くことで，その指標との距離や方向を計測し、さらにこれによって、車両を誘導して駐車支援を行うことを目的としている。   The present invention does not require a high-precision GPS or gyroscope, and places an index that is a known mark in the target environment without being influenced by the measurement direction if the index to be measured is cylindrical. Thus, the object is to measure the distance and direction from the index, and further guide the vehicle to provide parking assistance.

本発明の移動物体の指標位置への相対角度及び位置計測方法は、対象となる環境に既知の目印として、径及び間隔が既知の２つの指標を配置し、水平方向にレーザを一定角度毎に照射し、その距離を算出することのできるレーザレンジファインダを、移動物体に固定し、この指標をレーザレンジファインダで計測した距離と角度の値から、２つの指標の置かれた位置との相対的な角度と位置を算出する。   According to the method of measuring the relative angle and position of the moving object to the index position of the present invention, two indices having a known diameter and interval are arranged as known markers in the target environment, and the laser is horizontally aligned at a certain angle. A laser range finder that can irradiate and calculate the distance is fixed to a moving object, and this indicator is relative to the position where the two indicators are placed from the distance and angle values measured by the laser range finder. The correct angle and position.

また、本発明の駐車支援方法は、上記方法を用いて、車両に固定したレーザレンジファインダと２つの指標の置かれた位置との相対的な角度と位置を算出して、車両の誘導を行う。
また、本発明の駐車支援システムは、上記方法を用いて、車両に固定したレーザレンジファインダと２つの指標の置かれた位置との相対的な角度と位置を算出して、目標駐車スペースに収まるように、車両位置の情報提示或いは運転操作指示を行ない、或いは、目標駐車スペースに収まるように、車両の目標操舵角及び目標速度算出し、車両のアクチュエータを制御する。 Further, the parking assist method of the present invention uses the above method to calculate the relative angle and position between the laser range finder fixed to the vehicle and the position where the two indicators are placed, and guides the vehicle. .
In addition, the parking assist system of the present invention calculates the relative angle and position between the laser range finder fixed to the vehicle and the position where the two indicators are placed using the above method, and fits in the target parking space. As described above, the vehicle position information is presented or a driving operation instruction is given, or the target steering angle and target speed of the vehicle are calculated so as to be within the target parking space, and the actuator of the vehicle is controlled.

本発明によれば、高精度なGPSやジャイロなどを必要とせず、車載装置のコストを高くすることも、詳細な地図情報の作成コストが問題になることもなく、指標となる円柱として，カラーコーンや弾性車止めポール，パイプなど，様々なものを利用可能にして、指標と車両の距離や方向を計測し、さらにこれによって駐車支援を行うことが可能となる。   According to the present invention, a high-precision GPS or gyroscope is not required, the cost of an in-vehicle device is increased, and the cost of creating detailed map information is not a problem. Various things such as cones, elastic car stop poles, and pipes can be used to measure the distance and direction between the indicator and the vehicle, thereby further providing parking assistance.

以下、例示に基づき、本発明を説明する。図１は、相対位置計測の原理を示す図である。移動物体における相対位置の計測手法は、自動車やロボットの分野で、様々に研究開発が行われている。本発明による相対位置の計測手法は、レーザレンジファインダ（LRF）を用いて、対象となる環境に既知の目印となる指標を置くことで、その指標との距離や方向を計測するものである。   Hereinafter, the present invention will be described based on examples. FIG. 1 is a diagram illustrating the principle of relative position measurement. Various methods for measuring the relative position of a moving object have been researched and developed in the fields of automobiles and robots. The relative position measuring method according to the present invention is to measure the distance and direction from an index that is a known mark in a target environment using a laser range finder (LRF).

レーザレンジファインダは、水平方向にレーザを一定角度毎に照射し、その距離を算出するものを利用する。また目印となる指標には、角度の計測のために2点以上、または平面が必要であるため、2つの円柱（直径、間隔は既知）を利用している。図１に示すように、指標である2つの円柱は直径、間隔は既知であるため、各円柱をレーザレンジファインダで計測した距離と角度の値から、2つの円柱の置かれた位置との相対的な角度と位置が算出可能である。この指標の設置位置が、絶対地図上で既知であれば、絶対位置と方向を推定することが可能となる。また、レーザレンジファインダの車両上の設置方向より、自己の方向も推定可能である。さらに、速度に関しては、誤差は大きいものの計測周期と移動距離から求めることも可能である。   The laser range finder uses a laser that irradiates a laser at a certain angle in the horizontal direction and calculates the distance. In addition, since the index used as a mark requires two or more points or a plane for measuring the angle, two cylinders (the diameter and interval are known) are used. As shown in Fig. 1, the diameter and spacing of the two cylinders, which are the indices, are known, so the relative distance from the position where the two cylinders are placed from the distance and angle values measured by the laser range finder. Angle and position can be calculated. If the installation position of this index is known on the absolute map, the absolute position and direction can be estimated. In addition, the direction of the laser range finder can be estimated from the installation direction on the vehicle. Further, the speed can be obtained from the measurement cycle and the moving distance although the error is large.

相対位置計測の手順を以下に示す。ただし、計測範囲内に指標としての2つの円柱のセットは、1組しかないものとした。また、相対座標系は、車両や円柱の指標など様々な位置を原点とすることが可能である。
１）LRF計測範囲内の円柱候補の位置（角度と距離）を検出（目標駐車スペースとのおおよその位置関係と、既知である円柱の直径情報による絞込み）
２）円柱候補のうち、指標としての2つの円柱のセットの1組のみの位置（各円柱の角度と距離）を検出（既知である指標としての2本の円柱の間隔情報による絞込み）。1組以上の場合は、１)に戻って再検出
３）指標となる2つの円柱の距離から、その中点の距離を算出（２つの距離を加算し2分の１としたもの）
４）指標となる2つの円柱の検出角度から、その中点の角度を算出（２つの検出角度を加算し2分の１としたもの）
５）指標となる2つの円柱の位置を結ぶ線分を求め、それに対し垂直となる角度を算出することで、2つの円柱の置かれた方向を算出
６）相対座標系の原点から、各位置の関係を再計算して変換する。
７）相対座標系における車両の位置を、車両のLRFの取り付け位置、円柱のセットの計測位置・角度、円柱の置かれた方向などから推定（時系列変化から車両速度も推定）
８）相対座標系における車両の向きを、車両のLRFの取り付け方向、円柱のセットの計測角度、円柱の置かれた方向などから推定（時系列変化から車両ヨーレート及び速度も推定）
９）２）で指標となる円柱のセットが検出された場合は、車両の移動方向、速度などを考慮して、次の計測時の円柱を探索する位置を絞り込み、計測時間の短縮を図る。
１０）計測を１）に戻って繰り返す。 The procedure for relative position measurement is shown below. However, there was only one set of two cylinders as indicators within the measurement range. Further, the relative coordinate system can have various positions such as a vehicle and a cylinder index as the origin.
1) Detecting the position (angle and distance) of a cylinder candidate within the LRF measurement range (approximate positional relationship with the target parking space and narrowing down using known cylinder diameter information)
2) Of the cylinder candidates, the position (angle and distance of each cylinder) of only one set of two cylinder sets as an index is detected (restriction based on the interval information of two cylinders as a known index). In the case of more than one set, go back to 1) and re-detect 3) Calculate the distance of the midpoint from the distance between the two cylinders that serve as indices (adding the two distances to halve)
4) Calculate the angle of the midpoint from the detected angles of the two cylinders that serve as indices (adding the two detected angles to a half)
5) Calculate the direction in which the two cylinders are placed by calculating the angle that is perpendicular to the line segment connecting the positions of the two cylinders that serve as indices. 6) Each position from the origin of the relative coordinate system. Recalculate and convert the relationship.
7) Estimate the position of the vehicle in the relative coordinate system from the LRF mounting position of the vehicle, the measurement position and angle of the cylinder set, the direction in which the cylinder is placed, etc. (the vehicle speed is also estimated from the time series change)
8) Estimate the direction of the vehicle in the relative coordinate system from the mounting direction of the LRF of the vehicle, the measurement angle of the cylinder set, the direction in which the cylinder is placed, etc. (the vehicle yaw rate and speed are also estimated from time series changes)
9) When a set of cylinders serving as an index is detected in 2), considering the moving direction, speed, etc. of the vehicle, the position for searching for the cylinder for the next measurement is narrowed down to shorten the measurement time.
10) Return to 1) and repeat the measurement.

以上の手順によって、移動物体の指標位置への相対角度及び位置計測が可能となる。本発明では、原理的に2つの円柱がレーザレンジファインダから同じ角度上に並んでおり、1つの距離しか計測できない場合は、正確な計測は困難である。しかし、このような場合が連続しない状態での連続した移動の中での計測では、計測が可能であった過去の位置状態と、片方の円柱の位置などから、ある程度の位置変化を予測することは可能である。   By the above procedure, the relative angle and position of the moving object to the index position can be measured. In the present invention, in principle, two cylinders are aligned at the same angle from the laser range finder, and if only one distance can be measured, accurate measurement is difficult. However, in such a case where measurement is performed in a continuous movement in a non-continuous state, a certain amount of position change can be predicted from the past position state where measurement was possible and the position of one cylinder. Is possible.

図２は、駐車スペースに対する相対位置計測を説明する図である。駐車すべき車両の所定位置（例えば後部中央）には、レーザレンジファインダが取り付けられている。レーザレンジファインダは、水平方向にレーザを一定角度毎に照射し、その距離を算出するものを利用する。また目印となる指標として、直径及び間隔が既知の2つの円柱を利用する。このため、図２に示すように、目標駐車スペースの後方両端に、指標となる２つの円柱が置かれている。円柱としては、カラーコーンや弾性車止めポール、パイプなど、円柱状の様々なものを移動指標として利用することが可能である。計測対象が円柱状であれば計測方向に左右されないという利点がある。目標となる移動に対して計測対象の位置が既知であるものが２つ以上同時にLRFで計測できれば、位置と方位を精度良く検出できることになる。さらに、円柱として、既存の構造物を用いることも可能で、上述した円柱と同様に、計測したい移動範囲内から、特徴を持って観測できれば、それらを利用して、相対位置を算出することが可能となる。例えば、駐車に関して考えると、昇降式駐車場や昇降横行式駐車場などの駐車パレットの周囲の柱を利用することで、駐車スペースとの相対位置を計測することも可能となる。さらに、目標駐車スペースの後方に移動指標を置くだけでなく、目標駐車スペースの左右の駐車車両を、相対位置計測の指標に用いるなど、様々な移動指標や配置などが考えられる。これらの場合において、指標探索の条件が異なることになるが、構造物の特徴を用いて検出の条件とすることで、同じように指標の検出が可能となり、相対位置の検出を行うことができる。   FIG. 2 is a diagram illustrating relative position measurement with respect to a parking space. A laser range finder is attached to a predetermined position (for example, rear center) of the vehicle to be parked. The laser range finder uses a laser that irradiates a laser at a certain angle in the horizontal direction and calculates the distance. In addition, two cylinders with known diameters and intervals are used as indicators for the marks. For this reason, as shown in FIG. 2, the two cylinders used as a parameter | index are placed in the back both ends of the target parking space. As the cylinder, various cylindrical objects such as a color cone, an elastic wheel stop pole, and a pipe can be used as a movement index. If the measurement target is cylindrical, there is an advantage that it is not affected by the measurement direction. If two or more objects whose measurement target positions are known with respect to the target movement can be measured simultaneously by the LRF, the position and orientation can be detected with high accuracy. Furthermore, it is also possible to use an existing structure as a cylinder, and like the above-described cylinder, if it can be observed with characteristics from within the movement range to be measured, the relative position can be calculated using them. It becomes possible. For example, when considering parking, it is possible to measure a relative position with respect to a parking space by using a pillar around a parking pallet such as an elevating parking lot or an elevating / lowering parking lot. Furthermore, not only a movement index is placed behind the target parking space, but also various movement indexes and arrangements such as using the left and right parked vehicles in the target parking space as the relative position measurement index are conceivable. In these cases, the index search conditions differ, but by using the characteristics of the structure as the detection conditions, the index can be detected in the same manner, and the relative position can be detected. .

駐車スペースに対して、2つの円柱を駐車に邪魔にならず、かつ計測が可能な位置に置き、その位置が目標駐車スペースに対してどのような位置に設置してあるかが既知であれば、その目標駐車スペースと車両との相対的な位置関係を常に計測することが可能となる。これにより、目標駐車スペースと車両との位置関係をドライバに提示することや、位置関係を基に自動駐車することも可能となる。   If the two cylinders are placed in a position where they can be measured without interfering with the parking space, and the position is known relative to the target parking space The relative positional relationship between the target parking space and the vehicle can always be measured. As a result, the positional relationship between the target parking space and the vehicle can be presented to the driver, and automatic parking can be performed based on the positional relationship.

先に述べたように計測指標は、様々なものが考えられるため、指標自体は固定する必要はなく、パイプなどを指標に利用すればトランクなどに入れ持ち運び、目標駐車スペースが決まった時点で、指標を設置して相対位置に基づいた駐車支援を行わせることなどが考えられる。このとき、指標の設置に関して、その間隔は、2つをある既知の長さの紐などでつないでおき、その長さに置くようにすれば、簡単に設置できる。また、目標駐車スペースの寸法を正確に計測する必要は無く、指標を駐車スペースの最後部の中央付近に設置することにあらかじめ設定すれば、駐車スペースには駐車時に余裕があることから、一般的な駐車スペースと車両の大きさなどから、目標駐車スペースを仮想して、相対位置を基にした誘導を行うことが可能である。   As described above, there are various measurement indicators, so it is not necessary to fix the indicators themselves.If pipes are used as indicators, they can be carried in the trunk and the target parking space is determined. It is conceivable to install an index and provide parking support based on the relative position. At this time, with respect to the setting of the index, the interval can be easily set by connecting the two with a string of a certain known length and placing it at that length. In addition, it is not necessary to measure the size of the target parking space accurately, and if the indicator is set to be set near the center of the rearmost part of the parking space, the parking space has room for parking. It is possible to virtually guide the target parking space based on the relative position based on the size of the parking space and the size of the vehicle.

また、レーザレンジファインダが常に目標駐車スペースに向かう移動方向を検出しているため、移動経路上の障害物の有無も同時に検出することが可能であり、障害物の存在によるドライバへの注意警告や自動停止を行うことも可能となる。このレーザレンジファインダは、駐車時だけでなく、他の用途にも用いることが可能であり、例えば、高速道路などでの車線変更において、後方車両の接近を検出することが可能である。   In addition, since the laser range finder always detects the moving direction toward the target parking space, it is possible to detect the presence or absence of obstacles on the moving route at the same time. It is also possible to perform automatic stop. The laser range finder can be used not only for parking but also for other purposes. For example, it is possible to detect the approach of a rear vehicle when changing lanes on a highway or the like.

図３は、自動制御による駐車支援システムの構成を例示する図である。駐車支援システムは、レーザレンジファインダを用いて車両の駐車スペースとの相対位置や向きなどの状態推定を行いながら、制御処理用ＰＣに搭載の駐車制御アルゴリズムに従って、目標駐車スペースに収まるように、目標操舵角及び目標速度を算出し、車両のアクチュエータ（操舵制御アクチュエータ、速度制御アクチュエータ）を制御する。このとき、制御遅れを考慮して車両状態を予測した制御量を算出している。操舵制御に関しては、目標駐車スペースと自車との位置関係から駐車制御アルゴリズムによって常に制御が更新されるため、また、制御遅れを考慮しているため、操舵角の情報は必ずしも必要としない。速度制御に必要な車両速度は、レーザレンジファインダを利用した状態推定の時系列変化から推定することが可能であり、また、車載の速度センサからの情報を利用することも可能である。   FIG. 3 is a diagram illustrating a configuration of a parking support system by automatic control. The parking assist system uses the laser range finder to estimate the state of the vehicle relative to the parking space, and in accordance with the parking control algorithm installed in the control processing PC, A steering angle and a target speed are calculated, and a vehicle actuator (steering control actuator, speed control actuator) is controlled. At this time, the control amount that predicts the vehicle state in consideration of the control delay is calculated. Regarding the steering control, since the control is constantly updated by the parking control algorithm based on the positional relationship between the target parking space and the host vehicle, and the control delay is taken into consideration, the information on the steering angle is not necessarily required. The vehicle speed necessary for speed control can be estimated from a time series change of state estimation using a laser range finder, and information from an in-vehicle speed sensor can also be used.

このように、駐車支援システムとして、車両と目標駐車スペースの位置や向きの相対関係を利用して、精度良く駐車を行うための操舵変化量、駆動制動量を制御アルゴリズムから算出し、操作誘導情報として提供することが可能となる。車両の駐車制御アルゴリズムは、非特許文献１で用いられている制御手法を用いて操舵変化量の算出を行うことができる。この制御手法の特徴は、車体のホイールベース等の幾何的なパラメータやコーナリングパワー等の力学的パラメータに依存しないという特徴があるため、実際に不特定多数の車両に対応できる可能性がある。図示の例では、駐車スペースの位置と向きの情報は、車両上の駐車支援システムが地図データベースなどにより、既知としている。被誘導車両の位置に関して、非特許文献１では、重心位置を利用しているが、通常、重心位置の計測は困難であるため、簡易的に中心位置を利用することができる。この駐車制御アルゴリズムでは、中心位置に対して多少の誤差（数十[cm]程度）がある場合にも、駐車スペース内に収まるように車両を誘導できることが、シミュレーションにより示されている（非特許文献２）。速度制御は、駐車支援開始から極低速を保持させ、駐車スペースに入った後は、ブレーキをかけるようにすれば良いこととなる。   In this way, as a parking assistance system, the steering change amount and driving braking amount for accurately parking are calculated from the control algorithm using the relative relationship between the position and orientation of the vehicle and the target parking space, and the operation guidance information It becomes possible to provide as. The vehicle parking control algorithm can calculate the steering change amount using the control method used in Non-Patent Document 1. The characteristic of this control method is that it does not depend on geometric parameters such as the wheel base of the vehicle body and mechanical parameters such as cornering power, and therefore, there is a possibility that it can actually handle a large number of unspecified vehicles. In the example shown in the figure, the parking space position and orientation information is known by the parking support system on the vehicle from a map database or the like. Regarding the position of the guided vehicle, Non-Patent Document 1 uses the position of the center of gravity, but since it is usually difficult to measure the position of the center of gravity, the center position can be easily used. Simulations have shown that with this parking control algorithm, the vehicle can be guided within the parking space even if there is a slight error (about several tens of centimeters) with respect to the center position (Non-patented) Reference 2). The speed control may be performed by holding a very low speed from the start of parking support and applying a brake after entering the parking space.

図４は、運転支援による駐車支援システムの構成を例示する図である。また、図５は、自動駐車及びドライバへの操作支援における駐車支援システムの処理の流れを示す図である。駐車支援システムが車両の相対位置推定の結果に基づいて、車両のドライバに対する位置の情報提示や運転操作指示のみを行い、ドライバがその情報に基づいて、車両をマニュアル運転により駐車することができる。ドライバは、周囲を見て車両と駐車スペースとの位置関係を確認することなく、駐車支援システムからの情報提示による位置確認と、運転操作指示に従った運転操作を行うことにより駐車が可能となる。ドライバに対する運転操作の指示については、伝達やドライバの操作の遅れを考慮し、遅れ時間後の車両状態を予測しつつ、目標操舵量及び目標速度を運転操作の指示として、提示する。ドライバへの提示方法としては、車両のモニタ上に目標となる操舵角や速度を示すバーグラフを示し、その指示に応じた音声をスピーカから流すことができる。また、駐車スペースとの車両の位置関係も図示して情報提示を行うことができる。ドライバの操作に合わせて、運転指示を与えることができ、精度良く目標駐車スペースに駐車が可能となる。図示の構成により実験した結果によれば、ドライバの運転操作に対し、変化する車両の位置や方向の微妙な修正を行う指示も実現したことで、目標駐車スペースに安全に、かつ、切り返しなどをすることなく効率よく駐車することが可能な運転操作指示を与えることができた。   FIG. 4 is a diagram illustrating a configuration of a parking assistance system based on driving assistance. FIG. 5 is a diagram showing a flow of processing of the parking assistance system in automatic parking and operation assistance to the driver. Based on the result of the relative position estimation of the vehicle, the parking support system only presents position information and driving operation instructions to the driver of the vehicle, and the driver can park the vehicle by manual driving based on the information. The driver can park by checking the position by presenting information from the parking support system and performing the driving operation according to the driving operation instruction without checking the positional relationship between the vehicle and the parking space by looking around. . In regard to the instruction for driving operation to the driver, the target steering amount and the target speed are presented as instructions for driving operation while predicting the vehicle state after the delay time in consideration of transmission and delay of the driver's operation. As a method of presentation to the driver, a bar graph indicating the target steering angle and speed can be shown on the vehicle monitor, and sound corresponding to the instruction can be played from the speaker. In addition, information can be presented by illustrating the positional relationship of the vehicle with the parking space. Driving instructions can be given in accordance with the operation of the driver, and parking in the target parking space can be performed with high accuracy. According to the result of the experiment with the configuration shown in the figure, an instruction to make a delicate correction of the position and direction of the changing vehicle is realized for the driving operation of the driver. It was possible to give a driving operation instruction that can be parked efficiently without doing.

図６に示すように、指標として、カラーコーンを2つ用いて2m間隔に置いて相対位置計測の基礎実験を行った。計測部分は、高さ約41cm部分で、直径約15cmである。実験は、指標となる円柱に対して、横1[m]付近、横2．5[m]付近、正面からの移動の3方向からの接近に対する相対位置の計測を試みた。レーザレンジファインダには、SICK製のLMS291を用い、180度を0．5度毎に距離計測を行わせた。このレーザレンジファインダを4輪の電動車椅子を改造した車両に、高さ約41cmの水平面が計測位置となるように設置した。移動速度は極低速とした。また、精度の検証のために、この電動車両に静止精度が約2[cm]以内のRTK-GPS（Novatel OEM4-G2）を装着し、GPSアンテナをLRFの計測位置の上部になるように設置し、移動位置を計測した。   As shown in FIG. 6, a basic experiment of relative position measurement was performed using two color cones as an index at intervals of 2 m. The measurement part is about 41 cm high and about 15 cm in diameter. In the experiment, we tried to measure the relative position with respect to the approach from the three directions of the movement from the front, near the horizontal 1 [m], the horizontal 2.5 [m], and the cylinder. For the laser range finder, SICK LMS291 was used, and the distance was measured every 0.5 degrees at 180 degrees. This laser range finder was installed on a vehicle with a modified four-wheeled electric wheelchair so that a horizontal plane of about 41 cm in height would be the measurement position. The moving speed was extremely low. In addition, for verification of accuracy, this electric vehicle is equipped with RTK-GPS (Novatel OEM4-G2) with a stationary accuracy within about 2 [cm], and the GPS antenna is placed above the LRF measurement position. Then, the moving position was measured.

実験結果を図７〜図１２に示す。今回の実験では、電動車を正確に直進させておらず、運転者の操作によるものもある。基礎実験のため、正確なキャリブレーションを行わなかったため、多少の誤差があるが、これらは、キャリブレーションを行うことで、かなり、削減可能と考える。また、正面からの計測で誤差が大きいが、これは、計測環境の路面に多少の起伏があり、LRFの方向が上下に変化することで、カラーコーンの計測が安定していなかったためと考えられる。これらの実験データからは、連続的に、相対位置を計測できることが検証された。誤差に対しては、路面の状態に影響を受けたが、駐車誘導などでは、充分な精度での計測が可能であることがわかる。   Experimental results are shown in FIGS. In this experiment, the electric car was not driven straight ahead, and some were driven by the driver. Since accurate calibration was not performed for the basic experiment, there are some errors, but these can be considerably reduced by performing calibration. In addition, there is a large error in the measurement from the front, but this is thought to be because the measurement of the color cone was not stable because there was some undulation on the road surface of the measurement environment and the LRF direction changed up and down. . From these experimental data, it was verified that the relative position could be measured continuously. Although the error was affected by the road surface condition, it can be seen that the parking guidance or the like can be measured with sufficient accuracy.

パイプを利用した指標のポールを用いて、距離計測に関する基礎実験を行った。実験では、移動体に取り付けられたLRFを用いて、前方のパイプの指標ポールを計測し、その中点までの距離を算出させた。パイプは、Φ27mmのものを用いて、50cmの間隔で立てている。LRFの計測位置と、指標の中点との距離をメジャーで計測し、垂直に3mから１m毎に１ｍまで近づいたときの距離計測の結果を図１３に示す。この結果より、計測した範囲内の距離は精度良く連続して検出できていることがわかる。   A basic experiment on distance measurement was conducted using a pole of an index using a pipe. In the experiment, the index pole of the front pipe was measured using the LRF attached to the moving body, and the distance to the midpoint was calculated. The pipes are erected with a diameter of 50 cm using Φ27 mm. FIG. 13 shows the results of distance measurement when the distance between the LRF measurement position and the midpoint of the index is measured with a measure and the distance is approached vertically from 3 m to 1 m every 1 m. From this result, it can be seen that the distance within the measured range can be detected continuously with high accuracy.

図１４は、角度分解能の間隔幅を示したものであるが、距離に応じて間隔幅は大きくなるため、指標となる円柱の直径によっては、検出が困難になることがわかる。今回の実験は、0．5度毎の検出で、約10m以内では指標としてカラーコーンの直径約15cmを利用し、約3m以内では指標としてパイプの直径約3cmを使用している。この図から、カラーコーンの直径での検出に対して、間隔幅は、10mでも充分に小さいが、パイプの検出に対しては、間隔幅は、3m付近でパイプの直径と同程度となるため、これ以上の遠距離の計測は不安定になると考えられる。   FIG. 14 shows the interval width of the angular resolution. However, since the interval width increases according to the distance, it can be seen that detection is difficult depending on the diameter of the cylinder serving as an index. In this experiment, the detection is performed every 0.5 degrees, and the diameter of the color cone is about 15cm within about 10m and the diameter of the pipe is about 3cm within about 3m. From this figure, the interval width is sufficiently small even at 10m for detection with the diameter of the color cone, but for detection of the pipe, the interval width is about the same as the pipe diameter at around 3m. It is thought that the measurement of the long distance beyond this becomes unstable.

車両は、駐車支援システムからの制御指示に従って、自動制御されることで駐車スペースまで自動駐車される。車両には、自動制御が可能な超小型の一人乗り電気自動車（EV）を用い、かつ移動指標用円柱として弾性車止めポールを用いて実験した結果、ドライバが自動駐車の開始を選択した後は、ドライバの運転操作は全く不要となり、乗車の必要は無かった。図１５は、車両の中心の移動位置として、RTK-GPSによる計測値を基にした自動制御時の移動軌跡を示している。また、図１６はRTK-GPSの計測値を真値として、推定位置の誤差を示している。実験結果より、非常にスムーズに車両の相対位置を検出できていることがわかる。推定誤差は、ほぼ0．3[m]以内で推移しており、駐車支援に十分な位置推定精度を保ちながら、自動誘導制御が行われていることがわかる。これらの結果より、車両の相対位置推定は、駐車支援においては、充分な精度であるといえる。   The vehicle is automatically parked to the parking space by being automatically controlled in accordance with a control instruction from the parking support system. As a result of an experiment using an ultra-compact single-seat electric vehicle (EV) that can be automatically controlled and an elastic vehicle stop pole as a movement indicator cylinder, after the driver chooses to start automatic parking, The driver's driving operation was completely unnecessary, and there was no need for a ride. FIG. 15 shows a movement locus at the time of automatic control based on a measurement value obtained by RTK-GPS as a movement position of the center of the vehicle. FIG. 16 shows the error of the estimated position with the measured value of RTK-GPS as a true value. From the experimental results, it can be seen that the relative position of the vehicle can be detected very smoothly. The estimation error changes within approximately 0.3 [m], and it can be seen that automatic guidance control is performed while maintaining sufficient position estimation accuracy for parking assistance. From these results, it can be said that the relative position estimation of the vehicle is sufficiently accurate in parking assistance.

相対位置計測の原理を示す図である。It is a figure which shows the principle of relative position measurement. 駐車スペースに対する相対位置計測を説明する図である。It is a figure explaining relative position measurement to a parking space. 自動制御による駐車支援システムの構成を示す図である。It is a figure which shows the structure of the parking assistance system by automatic control. 運転支援による駐車支援システムの構成を示す図である。It is a figure which shows the structure of the parking assistance system by driving assistance. 駐車支援システムの処理の流れを示す図である。It is a figure which shows the flow of a process of a parking assistance system. 実験の様子（カラーコーン利用の指標検出を示す図である。）State of experiment (a diagram showing index detection using a color cone) 横１[m]付近の移動時の推定移動位置を示す図である。It is a figure which shows the presumed movement position at the time of the movement of horizontal 1 [m] vicinity. 横1[m]付近の移動時のＸ軸距離とRTK-GPSの計測値との比較誤差（距離）を示す図である。It is a figure which shows the comparison error (distance) with the X-axis distance at the time of a movement of 1 [m] side, and the measured value of RTK-GPS. 横2.5[m]付近の移動時の推定移動位置を示す図である。It is a figure which shows the presumed movement position at the time of a movement of 2.5 [m] vicinity. 横2.5[m]付近の移動時のＸ軸距離とRTK-GPSの計測値との比較誤差（距離）を示す図である。It is a figure which shows the comparison error (distance) of the X-axis distance at the time of the movement of width 2.5 [m] vicinity, and the measured value of RTK-GPS. 正面からの接近時の推定移動位置を示す図である。It is a figure which shows the presumed movement position at the time of approach from the front. 正面からの接近時のＸ軸距離とRTK-GPSの計測値の比較誤差（距離）を示す図である。It is a figure which shows the comparison error (distance) of the X-axis distance at the time of approach from the front, and the measured value of RTK-GPS. 距離計測の結果を示す図である。It is a figure which shows the result of distance measurement. 角度分解能の間隔幅と計測距離を示す図である。It is a figure which shows the space | interval width and measurement distance of angular resolution. ＧＰＳ基準座標で自動駐車車両の移動軌跡を示す図である。It is a figure which shows the movement locus | trajectory of an automatic parking vehicle by GPS reference | standard coordinate. 相対位置計測誤差を示す図である。It is a figure which shows a relative position measurement error.

Claims (5)

対象となる環境に既知の目印として、径及び間隔が既知の２つの指標を配置し、
水平方向にレーザを一定角度毎に照射し、その距離を算出することのできるレーザレンジファインダを、移動物体に固定し、
前記指標を前記レーザレンジファインダで計測した距離と角度の値から、前記２つの指標の置かれた位置との相対的な角度と位置を算出することから成る移動物体の指標位置への相対角度及び位置計測方法。 As a known marker in the target environment, two indicators with a known diameter and interval are placed,
A laser range finder that can irradiate the laser at a certain angle in the horizontal direction and calculate the distance is fixed to the moving object,
Relative angle to the index position of the moving object comprising calculating the relative angle and position with the position where the two indices are placed from the distance and angle values measured by the laser range finder. Position measurement method. 前記レーザレンジファインダの前記移動物体上の設置方向より、該移動物体の方向を推定する請求項１に記載の移動物体の指標位置への相対位置計測方法。   The method for measuring a relative position of a moving object to an index position according to claim 1, wherein the direction of the moving object is estimated from an installation direction of the laser range finder on the moving object. 対象となる環境に既知の目印として、径及び間隔が既知の２つの指標を目標駐車スペースに配置し、
水平方向にレーザを一定角度毎に照射し、その距離を算出することのできるレーザレンジファインダを、車両に固定し、
前記指標を前記レーザレンジファインダで計測した距離と角度の値から、前記２つの指標の置かれた位置との相対的な角度と位置を算出して、車両の誘導を行うことから成る駐車支援方法。 Two markers with known diameters and intervals are placed in the target parking space as known markers in the target environment,
A laser range finder capable of irradiating a laser at a certain angle in the horizontal direction and calculating the distance is fixed to the vehicle,
A parking assistance method comprising guiding a vehicle by calculating a relative angle and position with respect to a position where the two indexes are placed from a distance and an angle value measured by the laser range finder. . 対象となる環境に既知の目印として、径及び間隔が既知の２つの指標を目標駐車スペースに配置し、
水平方向にレーザを一定角度毎に照射し、その距離を算出することのできるレーザレンジファインダを、車両に固定し、
前記指標を前記レーザレンジファインダで計測した距離と角度の値から、前記２つの指標の置かれた位置との相対的な角度と位置を算出して、目標駐車スペースに収まるように、車両位置の情報提示或いは運転操作指示を行うことから成る駐車支援システム。 Place two indicators with known diameters and intervals in the target parking space as known markers in the target environment,
A laser range finder that can irradiate the laser horizontally at a certain angle and calculate the distance is fixed to the vehicle,
From the distance and angle values measured by the laser range finder, the relative angle and position of the two indices are calculated and the vehicle position of the vehicle is adjusted so that it is within the target parking space. A parking assistance system comprising information presentation or driving operation instruction. 対象となる環境に既知の目印として、径及び間隔が既知の２つの指標を目標駐車スペース配置し、
水平方向にレーザを一定角度毎に照射し、その距離を算出することのできるレーザレンジファインダを、車両に固定し、
前記指標を前記レーザレンジファインダで計測した距離と角度の値から、前記２つの指標の置かれた位置との相対的な角度と位置を算出して、目標駐車スペースに収まるように、車両の目標操舵角及び目標速度算出し、車両のアクチュエータを制御することから成る駐車支援システム。
As a known marker for the target environment, two indicators with known diameters and intervals are placed in the target parking space,
A laser range finder capable of irradiating a laser at a certain angle in the horizontal direction and calculating the distance is fixed to the vehicle,
A target angle of the vehicle is calculated so that the relative angle and position between the two indices and the position where the two indices are placed are calculated from the distance and angle values measured by the laser range finder. A parking assist system comprising calculating a steering angle and a target speed and controlling an actuator of a vehicle.