JP2009168472A - Calibration device and calibration method of laser scanner - Google Patents
Calibration device and calibration method of laser scanner Download PDFInfo
- Publication number
- JP2009168472A JP2009168472A JP2008003737A JP2008003737A JP2009168472A JP 2009168472 A JP2009168472 A JP 2009168472A JP 2008003737 A JP2008003737 A JP 2008003737A JP 2008003737 A JP2008003737 A JP 2008003737A JP 2009168472 A JP2009168472 A JP 2009168472A
- Authority
- JP
- Japan
- Prior art keywords
- vertical plane
- point
- measurement
- laser scanner
- stations
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Instructional Devices (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
Description
本発明は、レーザースキャナのキャリブレーション技術に関し、特に、レーザースキャナによる測量を行う前段階として、計測原点及び測量の基準となる図根点の直交座標値を決定しその後の測量値の較正の基準値を確定する技術に関する。 TECHNICAL FIELD The present invention relates to a laser scanner calibration technique, and in particular, as a pre-stage for performing a survey by a laser scanner, a rectangular coordinate value of a figure origin serving as a measurement origin and a survey reference is determined, and a standard for subsequent calibration of the survey value It relates to a technique for determining a value.
近年、携帯電話やモバイル端末を利用した歩行者に対するナビゲーションが注目されている。これに伴って、地下街や駅構内などの屋内の地図データが必要とされている。このような屋内の地図データの整備方法として、従来から、トータルステーション(電子式測角測距儀)や電子平板などを利用した測量技術が広く用いられている。しかしながら、屋内の地図に必要なデータは広域かつ詳細であるため、このような従来の測量を行ったのでは大変なコストと時間を要することになる。 In recent years, navigation for pedestrians using mobile phones and mobile terminals has attracted attention. Along with this, indoor map data such as underground malls and station premises is required. Conventionally, a surveying technique using a total station (electronic angle measuring finder) or an electronic flat plate has been widely used as a method for maintaining such indoor map data. However, since the data required for the indoor map is wide and detailed, such a conventional survey would require a great deal of cost and time.
そこで、地図データを整備する手法として、レーザースキャナを用いた測定方法が研究・開発されている。 Therefore, a measurement method using a laser scanner has been researched and developed as a method for preparing map data.
レーザースキャナとは、光波測距儀の一種であり、レーザーヘッダ内部の回転ミラーにより照射方向を回転させながら近赤外線のパルス・レーザービームを照射して、計測対象点で反射した反射光を検出し、レーザー光のパルス伝搬時間を位相比較法(非特許文献1参照)等により検出することで計測対象点までの距離を計測し、同時にパルス・レーザービームを照射した方向を計測することで、計測対象点の座標を取得する計測機器をいう。照射されたパルス・レーザービームは、計測対象点にある対象物に当たると反射される。この反射光は、レーザースキャナの受光部で検出される。パルスの投光と受光との間の時間差は、変調周波数の位相差などにより検出される。この時間差は、レーザースキャナと対象物との間の距離に比例するため、この時間差から計測対象点までの距離を求めることができる。また、パルス・レーザービームは、レーザースキャナ内部の回転ミラーにより逐次方向が変えられ、周囲のエリアを所定の角度分解能で扇形に走査する。角分解能は機種によって区々であるが、現在、高角度分解能のものでは0.01〜0.5°の角度分解能の機種も開発されている。1回の扇形走査で、レーザービームの軌跡が描く二次元平面内でのレーザー距離画像を表す点群データが得られる。 A laser scanner is a type of optical wave rangefinder that detects the reflected light reflected from the measurement target point by irradiating a near-infrared pulse laser beam while rotating the irradiation direction with a rotating mirror inside the laser header. By measuring the pulse propagation time of the laser beam by the phase comparison method (see Non-Patent Document 1), etc., the distance to the measurement target point is measured, and at the same time, the direction in which the pulse laser beam is irradiated is measured. A measuring device that acquires the coordinates of a target point. The irradiated pulse laser beam is reflected when it hits an object at a measurement target point. This reflected light is detected by the light receiving portion of the laser scanner. The time difference between the light projecting and receiving of the pulse is detected by the phase difference of the modulation frequency. Since this time difference is proportional to the distance between the laser scanner and the object, the distance to the measurement target point can be obtained from this time difference. The direction of the pulse laser beam is sequentially changed by a rotating mirror inside the laser scanner, and the surrounding area is scanned in a fan shape with a predetermined angular resolution. Angular resolution varies from model to model. Currently, models with an angular resolution of 0.01 to 0.5 ° have been developed for high angular resolutions. Point cloud data representing a laser distance image in a two-dimensional plane drawn by the trajectory of the laser beam can be obtained by one sector scan.
レーザースキャナを用いた地図データの手法では、レーザースキャナを移動させながら計測を行い、レーザースキャナから得られる時系列の点群データを重ね合わせることによって1つの地図データを作成する。このとき、レーザースキャナから得られた時系列の点群データを基に、計測装置の位置と方向を推定する。これを自己位置推定という。 In a map data method using a laser scanner, measurement is performed while moving the laser scanner, and one map data is created by superimposing time-series point cloud data obtained from the laser scanner. At this time, the position and direction of the measuring device are estimated based on time-series point cloud data obtained from the laser scanner. This is called self-position estimation.
屋外の測定では、自己位置推定にGPSが広く使用されている(非特許文献2,3参照)。しかし、屋内での測定においてはGPSが利用できないため、自己位置推定には慣性計測装置(IMU:Inertial Measurement Unit)を利用する方法(非特許文献4参照)、スキャンマッチングによる方法(非特許文献5−7参照)などが用いられる。スキャンマッチングによる方法では、レーザースキャナにより時系列に取得された点群データを重ね合わせていくことで実行される。実際には、レーザースキャナを搭載した台車を計測したい場所を移動させながら連続的に測定を行い、時系列の点群データを取得する。これらの取得された時系列点群データを重ね合わせていくことによって、1つの地図点群データを作成する。この重ね合わせの方法に関しては、各種の方法が考案されている(非特許文献5−7参照)。例えば、非特許文献7の方法では、ある時刻で得られた点群データを1つ前の時刻の点群データに平行移動及び回転を用いた変換(ヘルマート変換)で重ね合わせていくことで実行される。
In outdoor measurement, GPS is widely used for self-position estimation (see Non-Patent
レーザースキャナで取得される点群データは、レーザースキャナを中心とした座標である。そのため、各計測ごとに計測開始位置やレーザースキャナの姿勢が異なると、各計測ごとに異なる座標系の点群データが得られる。そのため、複数回の計測で得られた点群データを合成して地図データを作成しようとした場合、それぞれ計測ごとの絶対的な位置座標の情報がなければ正しく合成することができない。また、一般に、レーザースキャナには、温度や場所などによる測定値のずれや、大気の影響などによる誤差が発生する。そのため、レーザースキャナによる測定では、レーザースキャナを水平に設置した後、キャリブレーション(較正)を行わなければならない。 The point cloud data acquired by the laser scanner is coordinates centered on the laser scanner. Therefore, if the measurement start position and the orientation of the laser scanner are different for each measurement, point group data of a different coordinate system is obtained for each measurement. Therefore, when trying to create map data by synthesizing point cloud data obtained by a plurality of measurements, it is not possible to synthesize correctly without information on absolute position coordinates for each measurement. In general, laser scanners generate errors in measured values due to temperature, location, etc., and errors due to atmospheric influences. Therefore, in the measurement by the laser scanner, it is necessary to perform calibration after the laser scanner is horizontally installed.
レーザースキャナのキャリブレーションでは、実際の計測対象の寸法と計測値とを比較し、計測値に対して補正をかける。通常、キャリブレーションにおいては、計測を開始する位置において走査を行い、座標値が既知のいくつかの計測対象点を利用して、測定を開始する際のレーザーヘッダ(計測原点)及びレーザーヘッダの正面方向における計測対象点(注視点)の測地座標を確定する。そして、レーザースキャナから得られる点群データと計測原点及び注視点の位置座標との関係から、位置姿勢の較正が行われる。 In the calibration of the laser scanner, the actual measurement target dimension is compared with the measurement value, and the measurement value is corrected. Usually, in calibration, scanning is performed at the position where measurement is started, and several measurement target points whose coordinate values are known are used to start the laser header (measurement origin) and the front of the laser header. Determine the geodetic coordinates of the measurement target point (gazing point) in the direction. Then, the position and orientation are calibrated based on the relationship between the point cloud data obtained from the laser scanner and the position coordinates of the measurement origin and gazing point.
レーザースキャナのキャリブレーション方法としては、非特許文献8,9に記載のものが公知である。
As a laser scanner calibration method, those described in
非特許文献8に記載の方法は、垂直に立てたガラス面にターゲットとしてCoBit(Compact Battery-less Information Terminal)を貼り付け、このCoBitによりレーザースキャナのキャリブレーションを行う方法が記載されている。 The method described in Non-Patent Document 8 describes a method in which a CoBit (Compact Battery-less Information Terminal) is pasted as a target on a vertically standing glass surface, and a laser scanner is calibrated using this CoBit.
この手法では、レーザービームがガラス面を透過するという点に着目し、基準点となるターゲットをガラス面に貼る。基準点を正確に捉えるために、レーザービームのスポット径の中心とガラス面に貼ったターゲットの中心が一致する必要がある。レーザービームは不可視であり、距離とともにスポット径が大きくなるため肉眼ではレーザービームのスポットを確認することはできない。 In this method, paying attention to the point that the laser beam is transmitted through the glass surface, a target serving as a reference point is attached to the glass surface. In order to accurately capture the reference point, it is necessary that the center of the spot diameter of the laser beam coincides with the center of the target attached to the glass surface. Since the laser beam is invisible and the spot diameter increases with distance, the spot of the laser beam cannot be confirmed with the naked eye.
そこで、レーザービームのスポットをとらえるのにCoBitを利用する。CoBitは、太陽電池に直結したイヤホンで音を聞くことができる装置である。CoBitをターゲットとして使用することで、レーザービームのスポットの中心ほどレーザー光が強く、発生する音も大きくなる。この性質を利用してスポットの中心を捉える。次に、レーザースポットの中心にあたるように設置された複数の基準点を計測し、レーザースキャナ座標系における各基準点の座標(Xl,Yl,Zl)を求める。ここで、レーザーの軌跡は直線であるため、Zlの値はすべて0とする。次に、各基準点の位置座標の真値(絶対値)を求めるため、各基準点についてトータルステーションによる位置座標の計測を行い、測地座標系における各基準点の座標(Xt,Yt,Zt)を求める。これらの結果から、レーザースキャナ座標系から測地座標系への変換式を求める。具体的には、3次元の回転、原点の平行移動、及び縮尺を補正するヘルマート変換の変換パラメータを求める。ヘルマート変換は次式によって表される。 Therefore, CoBit is used to capture the spot of the laser beam. CoBit is a device that allows you to listen to sound with earphones directly connected to solar cells. By using CoBit as a target, the laser beam is stronger at the center of the laser beam spot, and the generated sound is larger. This feature is used to capture the center of the spot. Next, a plurality of reference points installed so as to be in the center of the laser spot are measured, and the coordinates (X l , Y l , Z l ) of each reference point in the laser scanner coordinate system are obtained. Here, since the locus of the laser is a straight line, the values of Zl are all 0. Next, in order to obtain the true value (absolute value) of the position coordinates of each reference point, the position coordinates of each reference point are measured by the total station, and the coordinates (X t , Y t , Z) of each reference point in the geodetic coordinate system are measured. t ). From these results, a conversion formula from the laser scanner coordinate system to the geodetic coordinate system is obtained. Specifically, the transformation parameters of the Helmat transform for correcting the three-dimensional rotation, the translation of the origin, and the scale are obtained. The Helmat transform is expressed by the following equation.
また、非特許文献9には、計測対象の地物上に4点以上の基準点を設定し、それらの基準点に反射シートを設置しておき、これらの反射シートによりレーザースキャナのキャリブレーションを行う方法が記載されている。この方法においても、各基準点の位置座標をトータルステーションで計測して決定するとともに、レーザースキャナで計測する、そして、レーザースキャナ座標系における各基準点の座標とトータルステーションで計測した測地座標系における各基準点の座標とに基づいて、レーザースキャナ座標系から測地座標系に変換するアフィン変換パラメータを求めることによって較正を行う。
しかしながら、上述のようなCoBit又は反射板を使用して較正を行う場合、計測を行う度にCoBit又は反射板やトータルステーションなどのキャリブレーション専用の特殊な機器を用意する必要があるため不便である。 However, when the calibration is performed using the CoBit or the reflection plate as described above, it is inconvenient because it is necessary to prepare a special device dedicated for calibration such as the CoBit or the reflection plate or the total station every time measurement is performed.
そこで、本発明の目的は、キャリブレーション専用の特殊な機器を使用することなくレーザースキャナのキャリブレーションを行う技術を提供することにある。 Accordingly, an object of the present invention is to provide a technique for calibrating a laser scanner without using a special device dedicated for calibration.
レーザースキャナのキャリブレーション装置に係る本発明の第1の構成は、左右両側辺が平行かつ垂直な垂直平面を有するターゲットを、前記垂直平面の前方の計測原点Omからレーザースキャナにより水平走査して得られる、M個(Mは整数)の測点に対する前記計測原点Omを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記垂直平面の左右両側の端部の測点(以下「端測点」という。)A,Bを特定し、前記端測点A,Bを含む前記端測点A,B間のm個の測点(以下「有効測点」という。)Pi(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出手段と、
前記レーザースキャナの光軸の軌跡が前記垂直平面を切る線である走査線E1E2を基準に測地座標系を設定し、前記走査線E1E2の一方の端点E1から前記端測点Aまでの距離dA、前記走査線E1E2の他方の端点E2から前記端測点Bまでの距離dB、及び前記端測点A,B以外の前記各有効測点Pi(i=n+1,…,n+m−2)から前記走査線E1E2までの距離diの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定手段と、を備えたことを特徴とする。
A first configuration of the present invention according to the calibration apparatus of a laser scanner, the target left and right sides sides with parallel and perpendicular vertical plane, and the horizontal scanning by the front of the measuring laser scanner from the origin O m of the vertical plane Point cloud data storage means for storing point cloud data consisting of relative coordinates based on the measurement origin O m for the M measurement points (M is an integer) obtained;
The end points including the end points A and B are identified from the point cloud data by specifying end points (hereinafter referred to as “end points”) A and B on the left and right sides of the vertical plane. Effective station extraction means for extracting relative coordinates of m stations between A and B (hereinafter referred to as “effective stations”) P i (i = n,..., N + m−1);
A geodetic coordinate system is set with reference to a scanning line E 1 E 2 in which the locus of the optical axis of the laser scanner cuts the vertical plane, and the end measurement is performed from one end point E 1 of the scanning line E 1 E 2. the distance d a to the point a, the distance d B from the other end point E 2 of the
この構成によれば、レーザースキャナのキャリブレーションに使用するターゲットとして、左右両側辺が平行かつ垂直な垂直平面を有する物体があればよい。従って、例えば垂直に立てられた角柱形の建物の柱などをターゲットとして利用することができる。従って、従来のようにキャリブレーション専用の特殊な機器を用いることなくレーザースキャナのキャリブレーションを行うことが可能となる。 According to this configuration, an object having a vertical plane in which both left and right sides are parallel and vertical may be used as a target used for laser scanner calibration. Therefore, for example, a prism of a prismatic building standing upright can be used as a target. Therefore, the laser scanner can be calibrated without using a special device dedicated to calibration as in the prior art.
また、相対座標を測地座標へ関係づける関係パラメータを決定する際に、最小化する凸評価関数Jとして、距離dA、距離dB、及び距離di(i=n+1,…,n+m−2)の和 Further, when determining the relational parameter relating the relative coordinates to the geodetic coordinates, the distance d A , the distance d B , and the distance d i (i = n + 1,..., N + m−2) are used as the convex evaluation function J to be minimized. Sum of
ここで、「垂直平面」は、左右両側辺が平行かつ垂直な平面であればよく、上下辺の形状は問わない。但し、垂直平面の両辺は凸角(convex angle)となっているものとする。「計測原点」とは、レーザースキャナのレーザー光の光軸の回動中心の点をいう。「測点」とは、レーザースキャナにより座標測定を行なう空間点をいう。測点の数Mは特に限定はされず、レーザースキャナの角度解像度と走査角とにより決まる値である。ここで、「角度解像度」とは、隣接する測点間の方位角の差をいう。「走査角」とは、レーザースキャナが1回の走査において走査を開始する光軸の方位角と走査を終了する光軸の方位角との差角をいう。「計測原点Omを基準とする相対座標」とは、計測原点を原点としてレーザースキャナに固定された座標をいう。相対座標は、直交座標、極座標、円柱座標などの座標表現を用いることができるが、レーザースキャナが直接測定する値は、測点の方位角φと測定原点から測点までの距離lなので、通常は相対座標は極座標表現(l,φ)が用いられる。「測地座標系」とは、レーザースキャナの光軸の軌跡が垂直平面を切る線(走査線E1E2)を基準に設定された座標系をいう。ターゲットは、計測空間の所定の位置に固定されているため、測地座標系は計測空間に固定された座標系である。測地座標系の座標表現は特に限定されないが、地図作成の際の利便性を考慮して、通常は直交座標表現が用いられる。「端測点」とは、測定対象である平面の端部の測点をいう。ここで、レーザースキャナの走査においては各測点間の方位角は離散的であるため、一般には、端測点は測定対象である平面の端部とは正確には一致しない。「相対座標を測地座標へ関係づける関係パラメータ」とは、相対座標を測地座標に対応づけるパラメータをいう。対応付けのパラメータの取り方は任意であるが、例えば、測地座標系における計測原点Omの位置座標(xO,yO)と、注視点G(走査角度範囲の中心方向の光軸上の測点)の位置座標(xG,yG)を用いることができる。 Here, the “vertical plane” may be a plane in which the left and right sides are parallel and vertical, and the shape of the upper and lower sides is not limited. However, it is assumed that both sides of the vertical plane have convex angles. “Measurement origin” refers to the point of the rotation center of the optical axis of the laser beam of the laser scanner. “Measurement point” refers to a spatial point at which coordinate measurement is performed by a laser scanner. The number M of measurement points is not particularly limited, and is a value determined by the angular resolution and scanning angle of the laser scanner. Here, “angular resolution” refers to a difference in azimuth between adjacent measurement points. “Scanning angle” refers to the difference angle between the azimuth angle of the optical axis at which the laser scanner starts scanning in one scan and the azimuth angle of the optical axis at which scanning ends. “Relative coordinates with reference to the measurement origin O m ” refers to coordinates fixed to the laser scanner with the measurement origin as the origin. Relative coordinates can be expressed in terms of coordinates such as Cartesian coordinates, polar coordinates, cylindrical coordinates, etc. However, since the values directly measured by the laser scanner are the azimuth angle φ of the measurement point and the distance l from the measurement origin to the measurement point, For the relative coordinates, polar coordinate representation (1, φ) is used. The “geodetic coordinate system” refers to a coordinate system in which the locus of the optical axis of the laser scanner is set based on a line (scanning line E 1 E 2 ) that cuts a vertical plane. Since the target is fixed at a predetermined position in the measurement space, the geodetic coordinate system is a coordinate system fixed in the measurement space. The coordinate representation of the geodetic coordinate system is not particularly limited, but orthogonal coordinate representation is usually used in consideration of convenience in creating a map. “End measurement point” refers to a measurement point at the end of a plane to be measured. Here, since the azimuth angle between each measurement point is discrete in the scanning of the laser scanner, in general, the end measurement point does not exactly coincide with the end of the plane to be measured. “Relational parameters that relate relative coordinates to geodetic coordinates” refer to parameters that associate relative coordinates with geodetic coordinates. Although the method of taking the parameters of the correspondence is arbitrary, for example, the position coordinates (x O , y O ) of the measurement origin O m in the geodetic coordinate system and the gazing point G (on the optical axis in the center direction of the scanning angle range) Position coordinates (x G , y G ) can be used.
レーザースキャナのキャリブレーション装置に係る本発明の第2の構成は、前記第1の構成において、前記座標決定手段が、
前記端測点A,Bが前記走査線E1E2上に位置し、かつ端点E1から端測点Aまでの距離と端点E2から端測点Bまでの距離とが等しくなるように、前記測地座標系における前記端測点A,Bの位置座標の初期値を算出する第1の初期化手段と、
前記端測点A,Bの位置座標の初期値及び前記有効測点の相対座標に基づき、前記端測点A,B以外の前記有効測点Pi(i=n+1,…,n+m−2)及び前記計測原点Omの前記測地座標系における位置座標の初期値を算出する第2の初期化手段と、
前記距離dA、前記距離dB、及び前記距離di(i=n+1,…,n+m−2)の和又は自乗和を評価関数として、前記計測原点Om及び前記端測点A,Bを含む前記各有効測点Pi(i=n,…,n+m−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点Om及び前記各有効測点Piの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する変換パラメータ算出手段と、
算出された前記各変換パラメータにより前記計測原点Omの位置座標の初期値をヘルマート変換し、前記計測原点Omの前記測地座標系における位置座標を算出する原点座標確定手段と、
所定の角度範囲を回転走査する前記レーザースキャナの走査開始方向と走査終了方向の2つの方向間の走査角の二等分角方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Omの前記測地座標系における位置座標とに基づいて、前記注視点Gの前記測地座標系における位置座標を算出する注視点座標確定手段と、を備えていることを特徴とする。
According to a second configuration of the present invention relating to a laser scanner calibration apparatus, in the first configuration, the coordinate determining means includes:
The end points A and B are located on the scanning line E 1 E 2 , and the distance from the end point E 1 to the end point A is equal to the distance from the end point E 2 to the end point B. First initialization means for calculating initial values of the position coordinates of the end stations A and B in the geodetic coordinate system;
Based on the initial value of the position coordinates of the end stations A and B and the relative coordinates of the effective stations, the effective stations P i other than the end stations A and B (i = n + 1,..., N + m−2). and a second initialization means for calculating the initial value of the position coordinates in the geodetic coordinate system of the measurement origin O m,
Using the sum or square sum of the distance d A , the distance d B , and the distance d i (i = n + 1,..., N + m−2) as an evaluation function, the measurement origin O m and the end measurement points A and B are Starting from the initial value of the position coordinates of each of the effective measurement points P i (i = n,..., N + m−1) including the measurement origin O m and each of the evaluation functions so that the value of the evaluation function is minimized. Conversion parameter calculation means for calculating each conversion parameter of Helmert conversion that performs rotation and translation of the effective measuring point P i by an iterative method;
Origin coordinate determining means for performing a Helmart transform on the initial value of the position coordinate of the measurement origin O m using the calculated conversion parameters, and calculating the position coordinate of the measurement origin O m in the geodetic coordinate system;
The relative coordinates of the gazing point G, which is a measurement point on the optical axis in the bisecting direction of the scanning angle between the two directions of the scanning start direction and the scanning end direction of the laser scanner that rotationally scans a predetermined angle range, are described above. extracted from the point cloud data, on the basis of the position coordinates in the geodetic coordinate system and the relative coordinates of the noted viewpoints G the measurement origin O m, gazing point for calculating the position coordinates in the geodetic coordinate system of the gaze point G And a coordinate determination means.
この構成によれば、まず第1の初期化手段が端測点A,Bの位置座標の初期値を設定する。尚、本明細書においては、「位置座標」というときは、特に断らない限りは測地座標系における位置座標をいうものとする。端測点A,Bの相対座標は点群データにより既知であるので、端測点A,Bの間の距離rABも既知である。従って、端測点A,Bは、走査線E1E2の中点から距離rAB/2だけ離れた走査線E1E2上に配置される。次に、第2の初期化手段は、有効測点Pi(i=n+1,…,n+m−2)及び計測原点Omの位置座標の初期値を算出する。端測点A,Bに対する有効測点Pi及び計測原点Omの相対座標も点群データにより既知であるので、端測点A,Bの位置座標の初期値が定まれば有効測点Pi及び計測原点Omの位置座標の初期値も一意的に定まる。次に、変換パラメータ算出手段は、計測原点Om及び各有効測点Pi(i=n,…,n+m−1)を、ヘルマート変換により最適な位置に移動する。この移動の際のヘルマート変換パラメータは、前述の式(2)又は式(3)で表される距離の和又は自乗和を評価関数Jとして用いて、反復法により求められる。式(2)又は式(3)は凸関数なので、反復法における収束性は保証される。次に、原点座標確定手段は、関係パラメータの一つとして、計測原点Omの測地座標系における位置座標を算出する。最後に、注視点座標確定手段は、もう一つの関係パラメータとして、注視点Gの測地座標系における位置座標を算出する。以上のようにして、関係パラメータとして計測原点Om及び注視点Gの測地座標系における位置座標が求めれば、他の測点の相対座標も絶対座標系に変換できる。また、レーザースキャナをターゲットの前から他所へ移動しながら繰り返し走査を行って点群データを取得した場合、前に走査して得た点群データに重ね合わせながら測地座標系における位置座標を定めていくことができる。 According to this configuration, first, the first initialization means sets initial values of the position coordinates of the end measuring points A and B. In this specification, “positional coordinates” refers to positional coordinates in the geodetic coordinate system unless otherwise specified. Since the relative coordinates of the end stations A and B are known from the point cloud data, the distance r AB between the end stations A and B is also known. Therefore, the end measurement points A and B are arranged on the scanning line E 1 E 2 that is separated from the midpoint of the scanning line E 1 E 2 by the distance r AB / 2. Next, the second initialization means calculates the initial values of the position coordinates of the effective measurement point P i (i = n + 1,..., N + m−2) and the measurement origin O m . End measurement point A, the relative coordinates of the effective measurement point P i and the measurement origin O m to B is also known by the point cloud data, the end measurement point A, the effective measurement point P if the initial value of the position coordinates Sadamare of B the initial value of the position coordinates of the i and the measurement origin O m also uniquely determined. Next, the conversion parameter calculation means moves the measurement origin O m and each effective measurement point P i (i = n,..., N + m−1) to an optimal position by Helmert conversion. The Helmat transform parameter at the time of this movement is obtained by an iterative method using the sum of the distances or the sum of squares expressed by the above formula (2) or (3) as the evaluation function J. Since Expression (2) or Expression (3) is a convex function, convergence in the iterative method is guaranteed. Next, the origin coordinate defining means, as one of the relevant parameters, and calculates the position coordinates in geodetic coordinate system of the measuring origin O m. Finally, the gazing point coordinate determining means calculates the position coordinates of the gazing point G in the geodetic coordinate system as another related parameter. As described above, if the position coordinates of the measurement origin O m and the gazing point G in the geodetic coordinate system are obtained as the related parameters, the relative coordinates of other measurement points can be converted into the absolute coordinate system. In addition, when point cloud data is acquired by repeatedly scanning while moving the laser scanner from the front of the target to another location, the position coordinates in the geodetic coordinate system are determined while superimposing the point cloud data obtained by the previous scanning. I can go.
ここで、「反復法」のアルゴリズムとしては、最急降下法、ヤコビ法、ガウス・ザイデル法、SOR(Successive Over Relaxation)法等の各種公知の方法を使用することができる。 Here, as the algorithm of the “iterative method”, various known methods such as the steepest descent method, the Jacobian method, the Gauss-Seidel method, and the SOR (Successive Over Relaxation) method can be used.
レーザースキャナのキャリブレーション装置に係る本発明の第3の構成は、前記第1の構成において、前記点群データ記憶手段は、左右両側辺が平行かつ垂直な垂直平面を複数有し、各垂直平面は互いに平行であるターゲットを、前記各垂直平面の前方の計測原点Omからレーザースキャナにより水平走査して得られる、M個(Mは2より大きい整数)の測点に対する前記計測原点Omを基準とする相対座標からなる点群データを記憶するものであり、
前記有効測点抽出手段は、前記各垂直平面に対して、両端の端測点Aj,Bj(jは前記各垂直平面を区別する添字)を特定し、前記各有効測点Pj,iの相対座標を抽出するものであり、
前記座標決定手段は、前記レーザースキャナの光軸が前記各垂直平面を切る線である走査線Ep,1Ep,2を基準に測地座標系を設定し、前記各垂直平面における、前記走査線Ej,1Ej,2の一方の端点Ej,1から前記端測点Ajまでの距離dj,A、前記走査線Ej,1Ej,2の他方の端点Ej,2から前記端測点Bjまでの距離dj,B、及び前記両端測点Aj,Bj以外の前記各有効測点Pj,i(i=nj+1,…,nj+mj−2)から前記走査線Ej,1Ej,2までの距離dj,iの和又は自乗和を、すべての前記垂直平面について足し合わせた量が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定するものであることを特徴とする。
According to a third configuration of the present invention relating to a laser scanner calibration apparatus, in the first configuration, the point cloud data storage means includes a plurality of vertical planes whose left and right sides are parallel and perpendicular to each other. the target are parallel to each other, wherein the front of the measuring laser scanner from the origin O m of the vertical plane obtained by horizontally scanning, the measurement origin O m for measurement point M (M is an integer greater than 2) It stores point cloud data consisting of relative coordinates as a reference,
The effective station extraction means specifies end stations A j and B j (j is a subscript for distinguishing each vertical plane) for each vertical plane, and each effective station P j, extract the relative coordinates of i ,
The coordinate determination means sets a geodetic coordinate system based on scanning lines E p, 1 E p, 2 in which the optical axis of the laser scanner cuts the vertical planes, and the scanning in the vertical planes line E j, 1 E j, the distance 2 of one end point E j, from 1 to the end stations a j d j, a, the scan lines E j, 1 E j, 2 of the other end point E j, distance from 2 to the end stations B j d j, B, and said end stations a j, wherein each active stations P j other than B j, i (i = n j + 1, ..., n j + m j −2) to the scanning lines E j, 1 E j, 2 , the relative coordinates are set so that the sum of the distances d j, i or sums of squares of all the vertical planes is minimized. It is characterized in that a relation parameter related to the geodetic coordinates is determined.
この構成によれば、ターゲットの垂直平面が同一平面上に複数あるような場合でも、前記第1の構成の場合と同様にしてレーザースキャナのキャリブレーションを行うことができる。 According to this configuration, even when the target has a plurality of vertical planes on the same plane, the laser scanner can be calibrated in the same manner as in the first configuration.
レーザースキャナのキャリブレーション装置に係る本発明の第4の構成は、左側辺が垂直な直線で且つ右側辺が傾斜した直線又は曲線である左垂直平面と、右側辺が垂直な直線で且つ左側辺が前記左垂直平面の右側辺と平行な傾斜直線又は傾斜曲線である右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つ同一平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Omからレーザースキャナにより走査して得られた、M個(Mは2より大きい整数)の測点の計測原点Omを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CL間の水平幅rL及び前記端測点B,CR間の水平幅rRを算出する幅算出手段と、
高さzにおける前記左垂直平面の水平幅をfL(z)、前記右垂直平面の水平幅をfR(z)、fL(z),fR(z)の逆関数をそれぞれfL −1(x),fR −1(x)としたとき、前記レーザースキャナの計測原点Omの高さHを、高さfL −1(r’L)又は高さfR −1(r’R)の何れか若しくは高さfL −1(rL)と高さfR −1(rR)の平均値として算出する高さ算出手段と、
を備えたことを特徴とする。
The fourth configuration of the present invention relating to the laser scanner calibration apparatus is that the left side is a straight line or curved line whose left side is vertical and the right side is inclined, and the left side is a straight line whose right side is vertical and the left side. A right vertical plane that is an inclined straight line or an inclined curve parallel to the right side of the left vertical plane, and the left vertical plane and the right vertical plane are parallel and coplanar, It was obtained by scanning a target whose right side and the left side of the right vertical plane are separated by a certain horizontal width from a measurement origin O m in front of the left vertical plane and the right vertical plane with a laser scanner. Point cloud data storage means for storing point cloud data composed of relative coordinates based on the measurement origin O m of M measurement points (M is an integer greater than 2);
From the point cloud data, the left end point (hereinafter referred to as “end point”) A and right end point C L of the left vertical plane, and the right end point of the right vertical plane are measured. identify the point B and the left end measuring point C R, the end stations a, horizontal width between C L r L and the end stations B, a width calculation means for calculating the horizontal width r R between C R ,
The horizontal width of the left vertical plane at height z is f L (z), the horizontal width of the right vertical plane is f R (z), and the inverse functions of f L (z) and f R (z) are f L , respectively. −1 (x), f R −1 (x), the height H of the measurement origin O m of the laser scanner is set to a height f L −1 (r ′ L ) or a height f R −1 ( any one of r ′ R ) or a height calculating means for calculating an average value of the height f L −1 (r L ) and the height f R −1 (r R );
It is provided with.
この構成によれば、レーザースキャナのキャリブレーションに使用するターゲットとして、上述のような左垂直平面及び右垂直平面を有する物体があればよい。このようなものとしては、例えば、2枚の合同な直角三角形の板(木板や厚紙、金属板など)を、斜辺を平行に同一平面上に並べ合わせた状態で一定の間隔だけ離して固定しこれを床面に垂直に立てたような形状のターゲットを使用することができる。このようなターゲットは、特殊な材料を用いることなく容易に作ることができるため、従来のようにキャリブレーション専用の特殊な機器を用いることなくレーザースキャナの計測原点Omの高さHのキャリブレーションを行うことが可能となる。 According to this configuration, an object having the left vertical plane and the right vertical plane as described above may be used as a target used for calibration of the laser scanner. For example, two congruent right triangle plates (wood board, cardboard, metal plate, etc.) are fixed with a fixed distance apart with their hypotenuses aligned in parallel on the same plane. It is possible to use a target having such a shape that it stands vertically with respect to the floor surface. Such targets, it is possible to make easily without using a special material, calibration of the height H of the measurement origin O m of the laser scanner without using a conventional special instrument calibration only as Can be performed.
レーザースキャナのキャリブレーション装置に係る本発明の第5の構成は、前記第4の構成において、前記左垂直平面の右側辺と前記右垂直平面の左側辺との間の水平幅をr0、前記左垂直平面の左側辺と前記右垂直平面の右側辺との間の水平幅をr+r0としたとき、前記計測原点で計測された水平幅rL,rRを、それぞれ式(4a),(4b)により補正して補正水平幅r’L,r’Rを算出する水平幅補正手段を備え、
前記高さ算出手段は、前記レーザースキャナの計測原点Omの高さHを、高さfL −1(r’L)又は高さfR −1(r’R)の何れか若しくは高さfL −1(r’L)と高さfR −1(r’R)の平均値として算出することを特徴とする。
According to a fifth configuration of the present invention relating to a laser scanner calibration apparatus, in the fourth configuration, the horizontal width between the right side of the left vertical plane and the left side of the right vertical plane is r 0 , When the horizontal width between the left side of the left vertical plane and the right side of the right vertical plane is r + r 0 , the horizontal widths r L and r R measured at the measurement origin are expressed by equations (4a) and (4), respectively. 4b) comprising horizontal width correcting means for calculating corrected horizontal widths r ′ L and r ′ R by correcting
The height calculation means, the height H of the measurement origin O m of the laser scanner, one or heights of f L -1 (r 'L) or the height f R -1 (r' R) It is calculated as an average value of f L −1 (r ′ L ) and height f R −1 (r ′ R ).
この構成によれば、端測点A,CL間の水平幅rL及び端測点B,CR間の水平幅rRを式(4a),(4b)により、rL+rR=rとなるように補正することで、走査時における測定方位角の離散化による量子化誤差の影響を低減させることができ、より精度の高い計測原点Omの高さHのキャリブレーションを行うことが可能となる。 According to this arrangement, the end measurement point A, the horizontal width between C L r L and Tanhaka point B, wherein a horizontal width r R between C R (4a), by (4b), r L + r R = r by correcting such that, it is possible to reduce the influence of quantization errors due to discretization of the measured azimuth angle during scanning, is possible to perform calibration of the height H of the more accurate the measurement origin O m It becomes possible.
レーザースキャナのキャリブレーション装置に係る本発明の第6の構成は、前記第4又は5の構成において、前記点群データ記憶手段は、前記左垂直平面及び前記右垂直平面の前方にあり高さが同一で且つ水平面上の位置が異なるN箇所の前記計測原点から測定されたN組の前記点群データを記憶するものであり、
前記幅算出手段は、N組の前記点群データについて、それぞれ前記端測点A,CL間の水平幅及び前記端測点B,CR間の水平幅を算出するとともに、前記各点群データについての前記端測点A,CL間の水平幅の平均値を前記水平幅rL、前記各点群データについての前記端測点B,CR間の水平幅の平均値を前記水平幅rRとして算出するものであることを特徴とする。
According to a sixth configuration of the present invention relating to a laser scanner calibration apparatus, in the fourth or fifth configuration, the point cloud data storage means is in front of the left vertical plane and the right vertical plane and has a height. N points of the point cloud data measured from the measurement origins of N points that are the same and have different positions on the horizontal plane are stored.
Said width calculating means, for N sets of the point group data, each of the end stations A, horizontal width between C L and the end stations B, calculates a horizontal width between C R, wherein each point group said end stations a for data, C the average value of the horizontal width between L horizontal width r L, the said end stations B for each point cloud data, the average value of the horizontal width horizontal between C R and characterized in that to calculate the width r R.
この構成により、レーザースキャナを水平移動させて複数の計測原点Omからの走査で出られた点群データに基づき計測原点Omの高さHのキャリブレーションを行うことで、より精度の高い計測原点Omの高さHのキャリブレーションを行うことが可能となる。 With this configuration, by performing the calibration of the height H of the measurement origin O m based on the point cloud data which is output by the scanning from the laser scanner is moved horizontally a plurality of measurement origin O m, more accurate measurement it is possible to calibrate the height H of the origin O m.
レーザースキャナのキャリブレーション装置に係る本発明の第7の構成は、水平幅が高さzの単調関数fL(z)に従って変化する左垂直平面と、水平幅が高さzの単調関数fR(z)に従って変化する右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Omからレーザースキャナにより走査して得られた、M個(Mは2より大きい整数)の測点の計測原点Omを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CL間の水平幅rL及び前記端測点B,CR間の水平幅rRを算出する幅算出手段と、
前記関数fL(z),fR(z)の逆関数をそれぞれfL −1(x),fR −1(x)としたとき、前記左垂直平面における走査線の高さhLをfL −1(rL)、前記右垂直平面における走査線の高さhRをfL −1(rR)として算出する高さ算出手段と、
前記高さhL、前記高さhR、及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(5)により算出する仰角算出手段と、
を備えたことを特徴とする。
The seventh configuration of the present invention relating to the laser scanner calibration apparatus is a left vertical plane whose horizontal width changes according to a monotonic function f L (z) whose height is z, and a monotone function f R whose horizontal width is a height z. A right vertical plane that varies according to (z), the left vertical plane and the right vertical plane being parallel and spaced apart from each other by a fixed distance d, and the right side of the left vertical plane and the right vertical plane M targets obtained by scanning a target separated from the left side of the right vertical plane by a certain horizontal width from the measurement origin O m in front of the left vertical plane and the right vertical plane with a laser scanner ( Point cloud data storage means for storing point cloud data composed of relative coordinates with reference to the measurement origin O m of the measurement point of M (an integer greater than 2);
From the point cloud data, the left end point (hereinafter referred to as “end point”) A and right end point C L of the left vertical plane, and the right end point of the right vertical plane are measured. identify the point B and the left end measuring point C R, the end stations a, horizontal width between C L r L and the end stations B, a width calculation means for calculating the horizontal width r R between C R ,
When the inverse functions of the functions f L (z) and f R (z) are f L −1 (x) and f R −1 (x), respectively, the height h L of the scanning line in the left vertical plane is f L −1 (r L ), a height calculating means for calculating the height h R of the scanning line in the right vertical plane as f L −1 (r R );
An elevation angle calculating means for calculating an elevation angle θ of the optical axis of the racer scanner based on the height h L , the height h R , and the distance d, using Equation (5);
It is provided with.
この構成によれば、レーザースキャナのキャリブレーションに使用するターゲットとして、上述のような左垂直平面及び右垂直平面を有する物体があればよい。このようなものとしては、例えば、2枚の合同な直角三角形の板(木板や厚紙、金属板など)を、斜辺を平行に、前後にずらして並べ合わせた状態で一定の間隔だけ離して固定しこれを床面に垂直に立てたような形状のターゲットを使用することができる。このようなターゲットは、特殊な材料を用いることなく容易に作ることができるため、従来のようにキャリブレーション専用の特殊な機器を用いることなくレーザースキャナの光軸の仰角のキャリブレーションを行うことが可能となる。 According to this configuration, an object having the left vertical plane and the right vertical plane as described above may be used as a target used for calibration of the laser scanner. As such, for example, two congruent right triangle plates (wood board, cardboard, metal plate, etc.) are fixed with a certain distance apart with their hypotenuses parallel and shifted back and forth. However, it is possible to use a target having such a shape that it stands vertically to the floor surface. Since such a target can be easily made without using a special material, the elevation angle of the optical axis of the laser scanner can be calibrated without using a special instrument dedicated for calibration as in the past. It becomes possible.
レーザースキャナのキャリブレーション装置に係る本発明の第8の構成は、左側辺及び右側辺が垂直且つ平行な左垂直平面と、左側辺及び右側辺が垂直且つ平行な右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Omからレーザースキャナにより走査して得られた、M個(Mは2より大きい整数)の測点の計測原点Omを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CLを含む前記端測点A,CL間のmL個の測点(以下「左有効測点」という。)Pi(i=nL,…,nL+mL−1)の相対座標、及び前記端測点B,CRを含む前記端測点B,CR間のmR個の測点(以下「右有効測点」という。)Pi(i=nR,…,nR+mR−1)の相対座標を抽出する有効測点抽出手段と、
前記各左有効測点及び前記各右有効測点の相対座標に基づき、互いに平行な2つの走査線LL及びLRの傾き及び切片を、前記走査線LLから前記各左有効測点Pi(i=nL,…,nL+mL−1)までの距離の和に、前記走査線LRから前記各右有効測点Pi(i=nR,…,nR+mR−1)までの距離の和を加えた値が最小となるように、最小自乗法により算出する走査線算出手段と、
前記走査線LLから前記走査線LRまでの距離d’を算出する走査線間距離算出手段と、
前記距離d’及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(6)により算出する仰角算出手段と、
を備えたことを特徴とする。
The eighth configuration of the present invention relating to the laser scanner calibration apparatus comprises a left vertical plane whose left side and right side are vertical and parallel, and a right vertical plane whose left side and right side are vertical and parallel, The left vertical plane and the right vertical plane are parallel to each other and separated from each other by a fixed distance d, and the right side of the left vertical plane and the left side of the right vertical plane are separated by a fixed horizontal width. was to have targeted, the obtained by scanning by the left vertical plane and in front of the measuring laser scanner from the origin O m of the right vertical plane, M (M is an integer greater than 2) measurement origin O of the measuring points point cloud data storage means for storing point cloud data consisting of relative coordinates based on m ;
From the point cloud data, the left end point (hereinafter referred to as “end point”) A and right end point C L of the left vertical plane, and the right end point of the right vertical plane are measured. identify the point B and the left end measuring point C R, the end stations a, the end stations a containing C L, m L-number of stations between C L (hereinafter referred to as "left effective stations". ) P i (i = n L , ..., n L + m L -1) of relative coordinates, and said end stations B, said end stations B, m R-number of stations between C R containing C R ( Hereinafter referred to as “right effective station”.) Effective station extracting means for extracting relative coordinates of P i (i = n R ,..., N R + m R −1);
Based on said relative coordinates of each left effective stations and the respective right enabled stations, two parallel slope and intercept of the scanning line L L and L R together from said scanning line L L each left enabled stations P i (i = n L, ... , n L + m L -1) to the sum of the distance to, from said scanning line L R each right effective measurement point P i (i = n R, ..., n R + m R - Scanning line calculation means for calculating by a least square method so that the sum of the distances up to 1) is minimized;
A scan line distance calculation means for calculating a distance d 'from the scanning line L L to the scanning line L R,
An elevation angle calculating means for calculating an elevation angle θ of the optical axis of the racer scanner based on the distance d ′ and the distance d by the equation (6);
It is provided with.
この構成によれば、レーザースキャナのキャリブレーションに使用するターゲットとして、上述のような左垂直平面及び右垂直平面を有する物体があればよい。このようなものとしては、例えば、長方形の板(木板や厚紙、金属板など)を、一側辺を平行に並べ合わせた状態で一定の間隔だけ離して固定しこれを床面に垂直に立てたような形状のターゲットを使用することができる。このようなターゲットは、特殊な材料を用いることなく容易に作ることができるため、従来のようにキャリブレーション専用の特殊な機器を用いることなくレーザースキャナの光軸の仰角のキャリブレーションを行うことが可能となる。 According to this configuration, an object having the left vertical plane and the right vertical plane as described above may be used as a target used for calibration of the laser scanner. For example, a rectangular plate (wood board, cardboard, metal plate, etc.) is fixed with a certain distance apart with one side aligned in parallel, and this is placed vertically on the floor. Targets with different shapes can be used. Since such a target can be easily made without using a special material, the elevation angle of the optical axis of the laser scanner can be calibrated without using a special instrument dedicated for calibration as in the past. It becomes possible.
レーザースキャナのキャリブレーション装置に係る本発明の第9の構成は、前記第8の構成において、前記点群データ記憶手段は、前記左垂直平面及び前記右垂直平面の前方にあり高さが同一で且つ水平面上の位置が異なるN箇所の前記計測原点から測定されたN組の前記点群データを記憶するものであり、
前記有効測点抽出手段は、前記各点群データに対してそれぞれ前記左有効測点の相対座標及び前記右有効測点の相対座標を抽出し、
前記走査線算出手段は、前記各点群データに対してそれぞれ前記走査線LL及び前記走査線LRの傾き及び切片を算出し、
前記走査線間距離算出手段は、前記各点群データに対してそれぞれ前記走査線LLから前記走査線LRまでの距離d’を算出し、
前記仰角算出手段は、前記各点群データに対してそれぞれレーサースキャナの光軸の前記仰角θを算出するものであり、
前記仰角算出手段が算出する前記仰角θの平均値を、レーサースキャナの光軸の仰角として出力する平均化手段を備えたことを特徴とする。
According to a ninth configuration of the present invention relating to a laser scanner calibration apparatus, in the eighth configuration, the point cloud data storage means is in front of the left vertical plane and the right vertical plane and has the same height. And N sets of the point cloud data measured from the N measurement origins at different positions on the horizontal plane,
The effective point extraction means extracts the relative coordinates of the left effective point and the right effective point for each point cloud data,
The scanning line calculation means calculates the slope and intercept of each of the scanning line L L and the scanning line L R wherein for each point cloud data,
The scanning line distance calculation means calculates a distance d 'of the from each of the scanning line L L for each point cloud data to the scanning line L R,
The elevation angle calculating means calculates the elevation angle θ of the optical axis of the racer scanner for each point cloud data,
An averaging means is provided for outputting the average value of the elevation angle θ calculated by the elevation angle calculation means as the elevation angle of the optical axis of the racer scanner.
この構成により、複数の計測原点から測定した仰角θの平均値を、レーサースキャナの光軸の仰角とすることで、レーザースキャナの走査の際の量子化誤差などの影響が提言され、より正確な仰角θのキャリブレーションを行うことができる。 With this configuration, the average value of the elevation angle θ measured from a plurality of measurement origins is used as the elevation angle of the optical axis of the racer scanner, so that influences such as quantization errors during scanning of the laser scanner are proposed, and more accurate The elevation angle θ can be calibrated.
レーザースキャナのキャリブレーション装置に係る本発明の第10の構成は、長方形の凸出した垂直平面ABCDを有するターゲットを、前記垂直平面の前方の計測原点Omからレーザースキャナにより三次元的に走査して得られる、M×N個(M,Nは整数)の測点に対する前記計測原点Omを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記垂直平面ABCDの4隅の頂点A,B,C,Dに最も近い測点(以下「隅測点」という。)PA,PB,PC,PDを特定し、前記隅測点PA,PB,PC,PDを含む、前記隅測点PA,PB,PC,PDを頂点とする四角形で囲まれた領域内のm×n個の測点(以下「有効測点」という。)Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)の相対座標を抽出する有効測点抽出手段と、
前記垂直平面ABCDの4隅の頂点A,B,C,Dを基準に測地座標系を設定し、前記頂点Aと前記隅測点PAとの間の距離dA、前記頂点Bと前記隅測点PBとの間の距離dB、前記頂点Cと前記隅測点PCとの間の距離dC、前記頂点Dと前記隅測点PDとの間の距離dD、及び前記隅測点PA,PB,PC,PD以外の前記各有効測点Pi,jから前記垂直平面ABCDまでの距離di,jの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定手段と、
を備えたことを特徴とする。
In the tenth aspect of the invention according to the calibration apparatus of a laser scanner, a target having a vertical plane ABCD that issued rectangular convex, three-dimensionally scanned by the laser scanner from the front of the measurement origin O m of the vertical plane Point cloud data storage means for storing point cloud data composed of relative coordinates based on the measurement origin O m with respect to M × N measurement points (M and N are integers) obtained,
Of the point cloud data, the stations closest to the vertices A, B, C, D at the four corners of the vertical plane ABCD (hereinafter referred to as “corner stations”) P A , P B , P C , P D And m in a region surrounded by a rectangle including the corner measuring points P A , P B , P C , and P D including the corner measuring points P A , P B , P C , and P D. Relative coordinates of n stations (hereinafter referred to as “effective stations”) P i, j (i = m 0 ,..., M 0 + m−1, j = n 0 ,..., N 0 + n−1) Effective station extraction means for extracting
4 corners of the vertex A of the vertical plane ABCD, B, C, and set standards geodetic coordinate system D, the distance d A between the vertex A and the corner measurement point P A, the said vertex B corner measurement point P B and the distance d B between the distance d C between the apex C and the corner measurement point P C, the distance d D between the vertex D and the corner measurement point P D, and the The sum or the square sum of the distances d i, j from each of the effective measurement points P i, j other than the corner measurement points P A , P B , P C , P D to the vertical plane ABCD is minimized. Coordinate determining means for determining a relationship parameter relating a relative coordinate to the geodetic coordinate;
It is provided with.
この構成によれば、3次元レーザースキャナのキャリブレーションに使用するターゲットとして、長方形の凸出した垂直平面ABCDを有する物体があればよい。従って、従来のようにキャリブレーション専用の特殊な機器を用いることなく三次元レーザースキャナのキャリブレーションを行うことが可能となる。 According to this configuration, an object having a rectangular protruding vertical plane ABCD may be used as a target used for calibration of the three-dimensional laser scanner. Therefore, the calibration of the three-dimensional laser scanner can be performed without using a special device dedicated for calibration as in the prior art.
レーザースキャナのキャリブレーション装置に係る本発明の第11の構成は、前記第10の構成において、前記座標決定手段は、前記測地座標系における前記隅測点PA,PB,PC,PDの位置座標の初期値を設定する第1の初期化手段と、
前記隅測点PA,PB,PC,PDの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記隅測点PA,PB,PC,PD以外の前記各有効測点Pi,j及び前記計測原点Omの前記測地座標系における位置座標の初期値を算出する第2の初期化手段と、
前記距離dA,dB,dC,dD、及び前記各距離di,jの和又は自乗和を評価関数として、前記計測原点Om及び前記隅測点PA,PB,PC,PDを含む前記各有効測点Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点Om及び前記各有効測点Pi,jの回転及び平行移動を行う幾何変換の各変換パラメータを、反復法により算出する変換パラメータ算出手段と、
算出された前記各変換パラメータにより前記計測原点Omの位置座標の初期値をヘルマート変換し、前記計測原点Omの前記測地座標系における位置座標を算出する原点座標確定手段と、
所定の方位角範囲及び仰角範囲を回転走査する前記レーザースキャナの走査範囲の中心方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Omの前記測地座標系における位置座標とに基づいて、前記注視点Gの前記測地座標系における位置座標を算出する注視点座標確定手段と、
を備えていることを特徴とする。
According to an eleventh configuration of the present invention relating to a laser scanner calibration apparatus, in the tenth configuration, the coordinate determining means is the corner measuring points P A , P B , P C , P D in the geodetic coordinate system. First initialization means for setting an initial value of the position coordinates of
The corner measurement point P A, P B, on the basis of the P C, the initial value and the relative coordinates of each active stations coordinates of P D, the corner measurement point P A, P B, P C , other than P D Second initialization means for calculating initial values of position coordinates in the geodetic coordinate system of each of the effective measurement points P i, j and the measurement origin O m ;
The distance d A, d B, d C , d D, and the respective distances d i, as the evaluation function the sum or square sum of j, the measurement origin O m and the corner measurement point P A, P B, P C , each valid stations including P D P i, j (i =
Origin coordinate determining means for performing a Helmart transform on the initial value of the position coordinate of the measurement origin O m using the calculated conversion parameters, and calculating the position coordinate of the measurement origin O m in the geodetic coordinate system;
Relative coordinates of the gazing point G, which is a measuring point on the optical axis in the central direction of the scanning range of the laser scanner that rotates and scans a predetermined azimuth angle range and elevation angle range, are extracted from the point cloud data, and based on the position coordinates in the relative coordinates and the geodetic coordinate system of the measurement origin O m, and gazing point coordinate defining means for calculating the position coordinates in the geodetic coordinate system of the gaze point G,
It is characterized by having.
レーザースキャナのキャリブレーション方法に係る本発明の第1の構成は、コンピュータによりレーザースキャナのキャリブレーションを行うキャリブレーション方法であって、
左右両側辺が平行かつ垂直な垂直平面を有するターゲットを、前記垂直平面の前方の計測原点Omからレーザースキャナにより水平走査し、M個(Mは整数)の測点に対する前記計測原点Omを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記垂直平面の左右両側の端部の測点(以下「端測点」という。)A,Bを特定し、前記端測点A,Bを含む前記端測点A,B間のm個の測点(以下「有効測点」という。)Pi(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出ステップと、
前記レーザースキャナの光軸の軌跡が前記垂直平面を切る線である走査線E1E2を基準に測地座標系を設定し、前記走査線E1E2の一方の端点E1から前記端測点Aまでの距離dA、前記走査線E1E2の他方の端点E2から前記端測点Bまでの距離dB、及び前記端測点A,B以外の前記各有効測点Pi(i=n+1,…,n+m−2)から前記走査線E1E2までの距離diの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定ステップとを実行することを特徴とする。
A first configuration of the present invention relating to a laser scanner calibration method is a calibration method for calibrating a laser scanner by a computer,
The target to which the left and right sides sides with parallel and perpendicular vertical plane, the horizontal scanning by the laser scanner from the front of the measurement origin O m of the vertical plane, the measurement origin O m for measuring points of M (M is an integer) A scanning step of capturing point cloud data consisting of relative coordinates as a reference into a computer and storing it in a storage device;
From the point cloud data stored in the storage device, the measurement points A and B (hereinafter referred to as “edge measurement points”) A and B on both the left and right sides of the vertical plane are specified. Effective station extraction for extracting the relative coordinates of m stations (hereinafter referred to as “effective stations”) P i (i = n,..., N + m−1) between the end stations A and B including B Steps,
A geodetic coordinate system is set with reference to a scanning line E 1 E 2 in which the locus of the optical axis of the laser scanner cuts the vertical plane, and the end measurement is performed from one end point E 1 of the scanning line E 1 E 2. the distance d a to the point a, the distance d B from the other end point E 2 of the
レーザースキャナのキャリブレーション方法に係る本発明の第2の構成は、前記第1の構成において、前記座標決定ステップにおいては、
前記端測点A,Bが前記走査線E1E2上に位置し、かつ端点E1から前記端測点Aまでの距離と端点E2から前記端測点Bまでの距離とが等しくなるように、前記測地座標系における前記端測点A,Bの位置座標の初期値を算出する第1の初期化ステップと、
前記端測点A,Bの位置座標の初期値及び前記有効測点の相対座標に基づき、前記端測点A,B以外の前記有効測点Pi(i=n+1,…,n+m−2)及び前記計測原点Omの前記測地座標系における位置座標の初期値を算出する第2の初期化ステップと、
前記距離dA、前記距離dB、及び前記距離di(i=n+1,…,n+m−2)の和又は自乗和を評価関数として、前記計測原点Om及び前記端測点A,Bを含む前記各有効測点Pi(i=n,…,n+m−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点Om及び前記各有効測点Piの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する変換パラメータ算出ステップと、
算出された前記各変換パラメータにより前記計測原点Omの位置座標の初期値をヘルマート変換し、前記計測原点Omの前記測地座標系における位置座標を算出する原点座標確定ステップと、
所定の角度範囲を回転走査する前記レーザースキャナの走査開始方向と走査終了方向の2つの方向間の走査角の二等分角方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Omの前記測地座標系における位置座標とに基づいて、前記注視点Gの前記測地座標系における位置座標を算出する注視点座標確定ステップと、を実行することを特徴とする。
According to a second configuration of the present invention relating to a laser scanner calibration method, in the first configuration, in the coordinate determination step,
The end measuring points A and B are located on the scanning line E 1 E 2 , and the distance from the end point E 1 to the end measuring point A is equal to the distance from the end point E 2 to the end measuring point B. A first initialization step of calculating initial values of the position coordinates of the end stations A and B in the geodetic coordinate system,
Based on the initial value of the position coordinates of the end stations A and B and the relative coordinates of the effective stations, the effective stations P i other than the end stations A and B (i = n + 1,..., N + m−2). and a second initializing step of calculating the initial value of the position coordinates in the geodetic coordinate system of the measurement origin O m,
Using the sum or square sum of the distance d A , the distance d B , and the distance d i (i = n + 1,..., N + m−2) as an evaluation function, the measurement origin O m and the end measurement points A and B are Starting from the initial value of the position coordinates of each of the effective measurement points P i (i = n,..., N + m−1) including the measurement origin O m and each of the evaluation functions so that the value of the evaluation function is minimized. each transformation parameters Helmert transformation for rotating and translation of the active stations P i, a conversion parameter calculating step of calculating iteratively,
An origin coordinate determination step of performing Helmart transform on the initial value of the position coordinate of the measurement origin O m by the calculated conversion parameters and calculating the position coordinate of the measurement origin O m in the geodetic coordinate system;
The relative coordinates of the gazing point G, which is a measurement point on the optical axis in the bisecting direction of the scanning angle between the two directions of the scanning start direction and the scanning end direction of the laser scanner that rotationally scans a predetermined angle range, are extracted from the point cloud data, on the basis of the position coordinates in the geodetic coordinate system and the relative coordinates of the noted viewpoints G the measurement origin O m, gazing point for calculating the position coordinates in the geodetic coordinate system of the gaze point G And a coordinate determining step.
レーザースキャナのキャリブレーション方法に係る本発明の第3の構成は、前記第1の構成において、前記走査ステップにおいては、左右両側辺が平行かつ垂直な垂直平面を複数有し、各垂直平面は互いに平行であるターゲットを、前記各垂直平面の前方の計測原点Omからレーザースキャナにより水平走査して得られる、M個(Mは2より大きい整数)の測点に対する前記計測原点Omを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存し、
前記有効測点抽出ステップにおいては、前記各垂直平面に対して、両端の端測点Aj,Bj(jは前記各垂直平面を区別する添字)を特定し、前記各有効測点Pj,iの相対座標を抽出し、
前記座標決定ステップにおいては、前記レーザースキャナの光軸が前記各垂直平面を切る線である走査線Ep,1Ep,2を基準に測地座標系を設定し、前記各垂直平面における、前記走査線Ej,1Ej,2の一方の端点Ej,1から前記端測点Ajまでの距離dj,A、前記走査線Ej,1Ej,2の他方の端点Ej,2から前記端測点Bjまでの距離dj,B、及び前記両端測点Aj,Bj以外の前記各有効測点Pj,i(i=nj+1,…,nj+mj−2)から前記走査線Ej,1Ej,2までの距離dj,iの和又は自乗和を、すべての前記垂直平面について足し合わせた量が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定することを特徴とする。
According to a third configuration of the present invention relating to a laser scanner calibration method, in the first configuration, the scanning step includes a plurality of vertical planes whose left and right sides are parallel and perpendicular to each other. the target is parallel, the obtained by horizontal scanning by the laser scanner from the front of the measurement origin O m of the vertical plane, M (M is an integer greater than 2) and relative to the measurement origin O m for measurement points Point cloud data consisting of relative coordinates to be captured in a computer and stored in a storage device,
In the effective station extraction step, end stations A j and B j (j is a subscript for distinguishing each vertical plane) are specified for each vertical plane, and each effective station P j is specified. , I to extract the relative coordinates,
In the coordinate determination step, a geodetic coordinate system is set with reference to scanning lines E p, 1 E p, 2 in which the optical axis of the laser scanner cuts the vertical planes. scan line E j, 1 E j, 2 for one end point E j, 1 from the distance d j to the end stations a j, a, the scan lines E j, 1 E j, 2 of the other end point E j , the distance from 2 to the end stations B j d j, B, and said end stations a j, B j other than the respective effective stations P j, i (i = n j + 1, ..., n j + m j- 2) to the scanning lines E j, 1 E j, 2 , the relative coordinates such that the sum of the distances d j, i or sums of squares of all the vertical planes is minimized. Determining a relational parameter relating the to the geodetic coordinates.
レーザースキャナのキャリブレーション方法に係る本発明の第4の構成は、コンピュータによりレーザースキャナのキャリブレーションを行うキャリブレーション方法であって、
左側辺が垂直な直線で且つ右側辺が傾斜した直線又は曲線である左垂直平面と、右側辺が垂直な直線で且つ左側辺が前記左垂直平面の右側辺と平行な傾斜直線又は傾斜曲線である右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つ同一平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Omからレーザースキャナにより走査して、M個(Mは2より大きい整数)の測点の計測原点Omを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CL間の水平幅rL及び前記端測点B,CR間の水平幅rRを算出する幅算出ステップと、
高さzにおける前記左垂直平面の水平幅をfL(z)、前記右垂直平面の水平幅をfR(z)、fL(z),fR(z)の逆関数をそれぞれfL −1(x),fR −1(x)としたとき、前記レーザースキャナの計測原点Omの高さHを、高さfL −1(r’L)又は高さfR −1(r’R)の何れか若しくは高さfL −1(rL)と高さfR −1(rR)の平均値として算出する高さ算出ステップと、
を実行することを特徴とする。
A fourth configuration of the present invention relating to a laser scanner calibration method is a calibration method for calibrating a laser scanner by a computer,
A left vertical plane that is a straight line or a curved line whose left side is vertical and whose right side is inclined; and a straight line or a curved line whose right side is vertical and whose left side is parallel to the right side of the left vertical plane. A right vertical plane, and the left vertical plane and the right vertical plane are parallel and coplanar, and the right side of the left vertical plane and the left side of the right vertical plane have a certain horizontal width. the spaced apart from being a target, the scanning by the left vertical plane and in front of the measurement origin O m from the laser scanner of the right vertical plane, of the measuring points of M (M is an integer greater than 2) the measurement origin O m A scanning step of capturing point cloud data consisting of relative coordinates as a reference into a computer and storing it in a storage device;
Among the point cloud data stored in the storage device, the left end point (hereinafter referred to as “end point”) A and the right end point C L of the left vertical plane, and the right identify right end measuring point B and the left end measuring point C R of the vertical plane, the end stations a, C horizontal width between L r L and the end stations B, horizontal width between C R r R A width calculating step for calculating
The horizontal width of the left vertical plane at height z is f L (z), the horizontal width of the right vertical plane is f R (z), and the inverse functions of f L (z) and f R (z) are f L , respectively. −1 (x), f R −1 (x), the height H of the measurement origin O m of the laser scanner is set to a height f L −1 (r ′ L ) or a height f R −1 ( any one of r ′ R ) or a height calculating step for calculating as an average value of the height f L −1 (r L ) and the height f R −1 (r R );
It is characterized by performing.
レーザースキャナのキャリブレーション方法に係る本発明の第5の構成は、前記第4の構成において、前記幅算出ステップを実行した後に、前記左垂直平面の右側辺と前記右垂直平面の左側辺との間の水平幅をr0、前記左垂直平面の左側辺と前記右垂直平面の右側辺との間の水平幅をr+r0としたとき、前記計測原点で計測された水平幅rL,rRを、それぞれ式(4a),(4b)により補正して補正水平幅r’L,r’Rを算出する水平幅補正ステップを実行し、
前記高さ算出ステップにおいては、前記レーザースキャナの計測原点Omの高さHを、高さfL −1(r’L)又は高さfR −1(r’R)の何れか若しくは高さfL −1(r’L)と高さfR −1(r’R)の平均値として算出することを特徴とする。
According to a fifth configuration of the present invention relating to a laser scanner calibration method, in the fourth configuration, after executing the width calculating step, the right side of the left vertical plane and the left side of the right vertical plane r 0 the horizontal width between said when the horizontal width between the left vertical plane of the left side and the right side of the right vertical plane was r + r 0, wherein measured by the measuring origin horizontal width r L, r R Are corrected by equations (4a) and (4b), respectively, and a horizontal width correction step for calculating corrected horizontal widths r ′ L and r ′ R is executed,
Wherein the height calculation step, the height H of the measurement origin O m of the laser scanner, one or height of the height f L -1 (r 'L) or the height f R -1 (r' R) It is calculated as an average value of the height f L −1 (r ′ L ) and the height f R −1 (r ′ R ).
レーザースキャナのキャリブレーション方法に係る本発明の第6の構成は、前記第4又は5の構成において、前記走査ステップにおいては、前記左垂直平面及び前記右垂直平面の前方にあり高さが同一で且つ水平面上の位置が異なるN箇所の前記計測原点から、レーザースキャナにより水平走査を行い、N組の前記点群データをコンピュータに取り込み記憶装置に保存し、
前記幅算出ステップにおいては、前記記憶装置に保存されたN組の前記点群データについて、それぞれ前記端測点A,CL間の水平幅及び前記端測点B,CR間の水平幅を算出するとともに、前記各点群データについての前記端測点A,CL間の水平幅の平均値を前記水平幅rL、前記各点群データについての前記端測点B,CR間の水平幅の平均値を前記水平幅rRとして算出することを特徴とする。
According to a sixth configuration of the present invention relating to a laser scanner calibration method, in the fourth or fifth configuration, in the scanning step, the height is the same in front of the left vertical plane and the right vertical plane. In addition, horizontal scanning is performed by a laser scanner from N measurement origins at different positions on the horizontal plane, and N sets of the point cloud data are captured in a computer and stored in a storage device.
In the width calculation step, the N sets of the point group data stored in the storage device, each said end stations A, horizontal width between C L and the end stations B, and horizontal width between C R to calculate, the said end stations a for each point group data, C L between the average value of the horizontal width of the horizontal width r L, the said end stations B for each point cloud data, between C R and calculates an average value of the horizontal width as the horizontal width r R.
レーザースキャナのキャリブレーション方法に係る本発明の第7の構成は、コンピュータによりレーザースキャナのキャリブレーションを行うキャリブレーション方法であって、
水平幅が高さzの単調関数fL(z)に従って変化する左垂直平面と、水平幅が高さzの単調関数fR(z)に従って変化する右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Omからレーザースキャナにより走査し、M個(Mは整数)の測点の計測原点Omを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CL間の水平幅rL及び前記端測点B,CR間の水平幅rRを算出する幅算出ステップと、
前記関数fL(z),fR(z)の逆関数をそれぞれfL −1(x),fR −1(x)としたとき、前記左垂直平面における走査線の高さhLをfL −1(rL)、前記右垂直平面における走査線の高さhRをfL −1(rR)として算出する高さ算出ステップと、
前記高さhL、前記高さhR、及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(5)により算出する仰角算出ステップと、
を実行することを特徴とする。
A seventh configuration of the present invention relating to a laser scanner calibration method is a calibration method for calibrating a laser scanner by a computer,
A left vertical plane whose horizontal width changes according to a monotonic function f L (z) having a height z, and a right vertical plane whose horizontal width changes according to a monotone function f R (z) whose height is z; The plane and the right vertical plane are parallel to each other and are separated from each other by a certain distance d, and the right side of the left vertical plane and the left side of the right vertical plane are separated by a certain horizontal width. The target is scanned with a laser scanner from the measurement origin O m in front of the left vertical plane and the right vertical plane, and the target is composed of relative coordinates based on the measurement origins O m of M (M is an integer) measurement points. A scanning step of capturing group data into a computer and storing it in a storage device;
Among the point cloud data stored in the storage device, the left end point (hereinafter referred to as “end point”) A and the right end point C L of the left vertical plane, and the right identify right end measuring point B and the left end measuring point C R of the vertical plane, the end stations a, C horizontal width between L r L and the end stations B, horizontal width between C R r R A width calculating step for calculating
When the inverse functions of the functions f L (z) and f R (z) are f L −1 (x) and f R −1 (x), respectively, the height h L of the scanning line in the left vertical plane is f L −1 (r L ), a height calculating step for calculating the height h R of the scanning line in the right vertical plane as f L −1 (r R );
An elevation angle calculating step for calculating an elevation angle θ of the optical axis of the racer scanner based on the height h L , the height h R , and the distance d, according to Equation (5);
It is characterized by performing.
レーザースキャナのキャリブレーション方法に係る本発明の第8の構成は、コンピュータによりレーザースキャナのキャリブレーションを行うキャリブレーション方法であって、
左側辺及び右側辺が垂直且つ平行な左垂直平面と、左側辺及び右側辺が垂直且つ平行な右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Omからレーザースキャナにより走査し、M個(Mは整数)の測点の計測原点Omを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CLを含む前記端測点A,CL間のmL個の測点(以下「左有効測点」という。)Pi(i=nL,…,nL+mL−1)の相対座標、及び前記端測点B,CRを含む前記端測点B,CR間のmR個の測点(以下「右有効測点」という。)Pi(i=nR,…,nR+mR−1)の相対座標を抽出する有効測点抽出ステップと、
前記各左有効測点及び前記各右有効測点の相対座標に基づき、互いに平行な2つの走査線LL及びLRの傾き及び切片を、前記走査線LLから前記各左有効測点Pi(i=nL,…,nL+mL−1)までの距離の和に、前記走査線LRから前記各右有効測点Pi(i=nR,…,nR+mR−1)までの距離の和を加えた値が最小となるように、最小自乗法により算出する走査線算出ステップと、
前記走査線LLから前記走査線LRまでの距離d’を算出する走査線間距離算出ステップと、
前記距離d’及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(6)により算出する仰角算出ステップと、を備えたことを特徴とする。
An eighth configuration of the present invention relating to a laser scanner calibration method is a calibration method for calibrating a laser scanner by a computer,
A left vertical plane whose left side and right side are vertical and parallel; and a right vertical plane whose left side and right side are vertical and parallel. The left vertical plane and the right vertical plane are parallel and constant with each other. A target that is on a plane separated by a distance d and separated by a certain horizontal width from the right side of the left vertical plane and the left side of the right vertical plane is positioned in front of the left vertical plane and the right vertical plane. of scanning by the laser scanner from the measurement origin O m, M (M is an integer) as a step of storing in the storage device takes in the point group data composed of relative coordinates relative to the measurement origin O m of measuring points in the computer ,
Among the point cloud data stored in the storage device, the left end point (hereinafter referred to as “end point”) A and the right end point C L of the left vertical plane, and the right identify right end measuring point B and the left end measuring point C R of the vertical plane, the end stations a, the end stations a containing C L, m L-number of stations between C L (hereinafter " left enable stations "hereinafter.) P i (i = n L, ..., n L + m relative coordinates L -1), and said end stations B, said end stations B containing C R, between C R an effective point extraction step of extracting relative coordinates of m R points (hereinafter referred to as “right effective points”) P i (i = n R ,..., n R + m R −1);
Based on said relative coordinates of each left effective stations and the respective right enabled stations, two parallel slope and intercept of the scanning line L L and L R together from said scanning line L L each left enabled stations P i (i = n L, ... , n L + m L -1) to the sum of the distance to, from said scanning line L R each right effective measurement point P i (i = n R, ..., n R + m R - A scanning line calculation step of calculating by a least square method so that the sum of the distances up to 1) is minimized;
A scanning line distance calculating step of calculating a distance d ′ from the scanning line L L to the scanning line LR ;
And an elevation angle calculating step of calculating an elevation angle θ of the optical axis of the racer scanner based on the distance d ′ and the distance d by the equation (6).
レーザースキャナのキャリブレーション方法に係る本発明の第9の構成は、前記第8の構成において、前記走査ステップにおいては、前記左垂直平面及び前記右垂直平面の前方にあり高さが同一で且つ水平面上の位置が異なるN箇所の前記計測原点からレーザースキャナにより水平走査し、N組の前記点群データをコンピュータに取り込み記憶装置に保存し、
前記有効測点抽出ステップにおいては、前記各点群データに対してそれぞれ前記左有効測点の相対座標及び前記右有効測点の相対座標を抽出し、
前記走査線算出ステップにおいては、前記各点群データに対してそれぞれ前記走査線LL及び前記走査線LRの傾き及び切片を算出し、
前記走査線間距離算出ステップにおいては、前記各点群データに対してそれぞれ前記走査線LLから前記走査線LRまでの距離d’を算出し、
前記仰角算出ステップにおいては、前記各点群データに対してそれぞれレーサースキャナの光軸の前記仰角θを算出し、
その後、前記仰角算出ステップにおいて算出される前記仰角θの平均値を算出し、レーサースキャナの光軸の仰角として出力する平均化ステップを実行することを特徴とする。
According to a ninth configuration of the present invention relating to a laser scanner calibration method, in the eighth configuration, in the scanning step, the height is the same in front of the left vertical plane and the right vertical plane and has a horizontal plane. A horizontal scanning is performed by a laser scanner from N measurement origins at different positions on the upper position, and N sets of the point cloud data are captured in a computer and stored in a storage device.
In the effective point extraction step, the relative coordinates of the left effective point and the right effective point are extracted for each point cloud data,
Wherein in the scanning line calculating step, and calculates the slope and intercept of each of the scanning line L L and the scanning line L R wherein for each point cloud data,
Wherein the distance calculation step between the scan lines, and calculates the distance d 'of the from respectively each point cloud data of the scanning lines L L to the scanning line L R,
In the elevation angle calculating step, the elevation angle θ of the optical axis of the racer scanner is calculated for each point cloud data,
Thereafter, an averaging step is performed in which an average value of the elevation angle θ calculated in the elevation angle calculation step is calculated and output as an elevation angle of the optical axis of the racer scanner.
レーザースキャナのキャリブレーション方法に係る本発明の第10の構成は、コンピュータによりレーザースキャナのキャリブレーションを行うキャリブレーション方法であって、
長方形の凸出した垂直平面ABCDを有するターゲットを、前記垂直平面の前方の計測原点Omからレーザースキャナにより三次元的に走査し、M×N個(M,Nは整数)の測点に対する前記計測原点Omを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記垂直平面ABCDの4隅の頂点A,B,C,Dに最も近い測点(以下「隅測点」という。)PA,PB,PC,PDを特定し、前記隅測点PA,PB,PC,PDを含む、前記隅測点PA,PB,PC,PDを頂点とする四角形で囲まれた領域内のm×n個の測点(以下「有効測点」という。)Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)の相対座標を抽出する有効測点抽出ステップと、
前記垂直平面ABCDの4隅の頂点A,B,C,Dを基準に測地座標系を設定し、前記頂点Aと前記隅測点PAとの間の距離dA、前記頂点Bと前記隅測点PBとの間の距離dB、前記頂点Cと前記隅測点PCとの間の距離dC、前記頂点Dと前記隅測点PDとの間の距離dD、及び前記隅測点PA,PB,PC,PD以外の前記各有効測点Pi,jから前記垂直平面ABCDまでの距離di,jの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定ステップと、
を実行することを特徴とする。
A tenth configuration of the present invention relating to a laser scanner calibration method is a calibration method for calibrating a laser scanner by a computer,
A target having a rectangular protruding vertical plane ABCD is three-dimensionally scanned from a measurement origin O m in front of the vertical plane by a laser scanner, and the above-mentioned measurement points for M × N (M and N are integers) are measured. a scanning step of storing the point cloud data consisting of relative coordinates as a reference to the storage device takes in the computer measurement origin O m,
From among the point cloud data stored in the storage device, the four corners of the vertex A of the vertical plane ABCD, B, C, nearest stations (hereinafter referred to as "corner measuring point".) To D P A, P B , P C , P D are specified, and the corner measuring points P A , P B , P C , P D including the corner measuring points P A , P B , P C , P D M × n measuring points (hereinafter referred to as “effective measuring points”) P i, j (i = m 0 ,..., M 0 + m−1, j = n 0 ,..., N 0 in the enclosed area. An effective station extraction step of extracting the relative coordinates of + n-1);
4 corners of the vertex A of the vertical plane ABCD, B, C, and set standards geodetic coordinate system D, the distance d A between the vertex A and the corner measurement point P A, the said vertex B corner measurement point P B and the distance d B between the distance d C between the apex C and the corner measurement point P C, the distance d D between the vertex D and the corner measurement point P D, and the The sum or the square sum of the distances d i, j from each of the effective measurement points P i, j other than the corner measurement points P A , P B , P C , P D to the vertical plane ABCD is minimized. A coordinate determination step for determining a relationship parameter relating a relative coordinate to the geodetic coordinate;
It is characterized by performing.
レーザースキャナのキャリブレーション方法に係る本発明の第11の構成は、前記第10の構成において、前記座標決定ステップにおいては、前記測地座標系における前記隅測点PA,PB,PC,PDの位置座標の初期値を設定する第1の初期化ステップと、
前記隅測点PA,PB,PC,PDの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記隅測点PA,PB,PC,PD以外の前記各有効測点Pi,j及び前記計測原点Omの前記測地座標系における位置座標の初期値を算出する第2の初期化ステップと、
前記距離dA,dB,dC,dD、及び前記各距離di,jの和又は自乗和を評価関数として、前記計測原点Om及び前記隅測点PA,PB,PC,PDを含む前記各有効測点Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点Om及び前記各有効測点Pi,jの回転及び平行移動を行う幾何変換の各変換パラメータを、反復法により算出する変換パラメータ算出ステップと、
算出された前記各変換パラメータにより前記計測原点Omの位置座標の初期値をヘルマート変換し、前記計測原点Omの前記測地座標系における位置座標を算出する原点座標確定ステップと、
所定の方位角範囲及び仰角範囲を回転走査する前記レーザースキャナの走査範囲の中心方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Omの前記測地座標系における位置座標とに基づいて、前記注視点Gの前記測地座標系における位置座標を算出する注視点座標確定ステップと、
を実行することを特徴とする。
According to an eleventh configuration of the present invention relating to a laser scanner calibration method, in the tenth configuration, in the coordinate determining step, the corner measurement points P A , P B , P C , P in the geodetic coordinate system are used. A first initialization step for setting an initial value of a position coordinate of D ;
The corner measurement point P A, P B, on the basis of the P C, the initial value and the relative coordinates of each active stations coordinates of P D, the corner measurement point P A, P B, P C , other than P D A second initialization step of calculating initial values of position coordinates in the geodetic coordinate system of each of the effective measurement points P i, j and the measurement origin O m ;
The distance d A, d B, d C , d D, and the respective distances d i, as the evaluation function the sum or square sum of j, the measurement origin O m and the corner measurement point P A, P B, P C , each valid stations including P D P i, j (i =
An origin coordinate determination step of performing Helmart transform on the initial value of the position coordinate of the measurement origin O m by the calculated conversion parameters and calculating the position coordinate of the measurement origin O m in the geodetic coordinate system;
Relative coordinates of the gazing point G, which is a measuring point on the optical axis in the central direction of the scanning range of the laser scanner that rotates and scans a predetermined azimuth angle range and elevation angle range, are extracted from the point cloud data, and based on the position coordinates in the relative coordinates and the geodetic coordinate system of the measurement origin O m, and the gazing point coordinate determination step of calculating the position coordinates of the geodetic coordinate system of the gaze point G,
It is characterized by performing.
以上のように、本発明によれば、レーザースキャナのキャリブレーションに使用するターゲットとして、建物の柱や特定の形状の垂直板などを使用し、このターゲットを1回乃至数回走査するだけでよいため、キャリブレーション専用の特殊な機器を使用することなくレーザースキャナのキャリブレーションを行うことが可能となる。 As described above, according to the present invention, as a target used for calibration of a laser scanner, a pillar of a building, a vertical plate with a specific shape, or the like is used, and this target only needs to be scanned once or several times. Therefore, it becomes possible to calibrate the laser scanner without using a special device dedicated for calibration.
以下、本発明を実施するための最良の形態について、図面を参照しながら説明する。 The best mode for carrying out the present invention will be described below with reference to the drawings.
図1は、台車に接地された本発明の実施例1に係るレーザースキャナ1の外観図である。レーザースキャナ1は、台車2の前方に水平に取り付けられている。台車2は手押し式4輪台車であり、この台車を手で押してレーザースキャナ1を移動させながら周辺の地物の走査を行うことができる。また、台車2の上面には、コンピュータ3が設置されている。レーザースキャナ1が走査して得た点群データは、接続ケーブルを介してコンピュータ3に転送され、コンピュータ3の内部の記憶装置に保存される。コンピュータ3には、レーザースキャナ1のキャリブレーション用のプログラムがインストールされており、このプログラムを実行させることによって、コンピュータ3は本発明の実施例1に係るレーザースキャナのキャリブレーション装置として機能する。
FIG. 1 is an external view of a
図2は、本発明の実施例1に係るレーザースキャナのキャリブレーション装置10の機能的な構成を示すブロック図である。図2において、レーザースキャナ1及びコンピュータ3は図1と同様である。コンピュータ3は、通信インタフェース9、キャリブレーション装置10、及びキャリブレーションパラメータ記憶部11を備えている。実際には、キャリブレーション装置10は、キャリブレーション・プログラムとして提供され、そのキャリブレーション・プログラムをコンピュータ3で実行させることにより機能的に実現されている。また、キャリブレーションパラメータ記憶部11は、コンピュータ3内部の記憶装置(磁気ディスク装置等)により構成されている。
FIG. 2 is a block diagram illustrating a functional configuration of the laser
キャリブレーション装置10は、点群データ記憶部12、有効測点抽出部13、及び座標決定部14を備えている。点群データ記憶部12は、レーザースキャナ1からコンピュータ3に取り込まれた点群データを記憶する。点群データ記憶部12は、磁気ディスクやRAM(ランダム・アクセス・メモリ)などの記憶装置により構成される。有効測点抽出部13は、点群データ記憶部12に保存された点群データの中から、キャリブレーション計算に必要な有効測点を抽出する。座標決定部14は、レーザースキャナの光軸の軌跡が前記垂直平面を切る線である走査線E1E2を基準に測地座標系を設定し、レーザースキャナの計測原点Omを基準とする相対座標を前記測地座標へ関係づける関係パラメータを決定する。
The
また、上記座標決定部14は、第1初期化部16、第2初期化部17、変換パラメータ算出部18、原点座標確定部19、及び注視点座標確定部20を備えている。これら各部の機能については、以下の動作説明と併せて説明する。
The coordinate
次に、図2のキャリブレーション装置10によるレーザースキャナのキャリブレーション方法について説明する。
Next, a laser scanner calibration method using the
図3は、本発明の実施例1に係るレーザースキャナのキャリブレーション方法で使用するターゲットの外観斜視図である。ターゲットT1は、左右両側辺が平行かつ垂直な垂直平面S1を有している。垂直平面S1の水平幅はr1である。垂直平面S1の左右両側辺は直角となっている。尚、使用可能なターゲットの両側辺の折れ曲がり角度は、必ずしも直角である必要はなく、凸角(convex angle)であればよい。 FIG. 3 is an external perspective view of a target used in the laser scanner calibration method according to the first embodiment of the present invention. The target T 1 has a vertical plane S 1 whose left and right sides are parallel and vertical. Horizontal width of the vertical plane S 1 is r 1. Left and right side edges of the vertical plane S 1 has a right angle. It should be noted that the bend angle on both sides of the usable target is not necessarily a right angle, but may be a convex angle.
このようなターゲットT1としては、例えば、建物内の柱などを用いることができる。もちろん、キャリブレーション用に、図3のような形状の箱を用意してそれを使用してもよい。ターゲットT1は簡単な形状であるため、例えば、段ボールや板を用いて容易に作成することができる。 Such targets T 1, for example, can be used as pillars in a building. Of course, a box having a shape as shown in FIG. 3 may be prepared and used for calibration. Since the target T 1 is a simple shape, for example, it can be readily prepared using cardboard and plate.
このターゲットT1に対して、レーザースキャナ1により水平に走査を行う。このとき、レーザースキャナ1が照射するレーザービームの光軸の軌跡面(扇形状に広がる水平平面)Slocusが垂直平面S1を切る線分を「走査線」といい、E1E2と記す。また、レーザースキャナの光軸の回動中心点を「計測原点」といいOmと記す。レーザースキャナ1が1回の走査において走査を開始する光軸の方位角と走査を終了する光軸の方位角との差角を「走査角」といい、θと記す。レーザースキャナ1の走査角度範囲の中心方向の光軸上の測点を「注視点」といい、Gと記す。ターゲットT1,垂直平面S1,走査線E1E2,計測原点Om,光軸の軌跡面Slocus,走査角θ,及び注視点Gの関係は、図3に示した通りである。
The target T 1 is scanned horizontally by the
キャリブレーションにおいては、ターゲットT1に固定した測地座標系における計測原点Om及び注視点Gの位置座標を確定する。ここで測地座標系は、原点Oを走査線E1E2の左側の端点E1とし、走査線方向をx軸、走査線方向に垂直で光軸の軌跡面Slocus内の方向をy軸、垂直上方をz軸として設定する。 In the calibration, the position coordinates of the measurement origin O m and the gazing point G in the geodetic coordinate system fixed to the target T 1 are determined. Here, in the geodetic coordinate system, the origin O is the end point E 1 on the left side of the scanning line E 1 E 2 , the scanning line direction is the x axis, the direction perpendicular to the scanning line direction and within the locus plane S locus of the optical axis is the y axis. , The vertical upper direction is set as the z axis.
図4は、本発明の実施例1に係るレーザースキャナのキャリブレーション方法のフローチャートである。 FIG. 4 is a flowchart of the laser scanner calibration method according to the first embodiment of the present invention.
まず、ステップS1で、レーザースキャナ1が搭載された台車3を、ターゲットT1の垂直平面S1前方の水平な床面に設置し、水準器等を用いて走査の際の光軸の軌跡面Slocusが水平となるように調節する。レーザースキャナ1の計測原点の高さも、あらかじめ矩尺等により計測しておく。レーザースキャナ1の内部構造は設計図により既知であるため、この高さは正確に測定することができる。また、ターゲットT1の垂直平面S1の水平幅rも、あらかじめ矩尺などにより計測し、コンピュータ3に入力しておく。
First, in step S1, the
そして、レーザースキャナ1により、垂直平面S1を含む範囲を走査する。レーザースキャナ1は、スキャンヘッドを一定の方位角範囲で回動させながら走査を行う。従って、レーザービームの光軸は水平面内で回動し、一定の回転角ごとに測点までの距離情報がサンプリングされる。サンプリングにより得られる点群データは、コンピュータ3に転送され、点群データ記憶部12に保存される。
Then, by the
図5に、ターゲットT1の走査により得られる各測点Pi(i=1,2,…,M)と計測原点Omとの位置関係を示す。1回の走査におけるサンプリング数をMとする。レーザースキャナ1のサンプリング間隔(方位角間隔)を「角分解能」といい、θsと記す。レーザースキャナ1は、方位角θ1から走査を開始する。i番目(i=1,2,…,M)のサンプリング方向における方位角θiは
FIG. 5 shows the positional relationship between each measurement point P i (i = 1, 2,..., M) obtained by scanning the target T 1 and the measurement origin O m . Let M be the number of samples in one scan. The sampling interval (azimuth angle interval) of the
また、光軸が走査線E1E2と交差するサンプリング方向における測点を「有効測点」という。図5において、n番目から(n+m−1)番目の測点Pj(j=n,n+1,…,n+m−1)が有効測点である。すべての有効測点のうち右端及び左端のものを「端測点」といい、それぞれA,Bと記す。A=Pn,B=Pn+m−1である。また、計測原点Qmから各A,B端への距離をlA=ln,lB=ln+m−1と記す。 A measuring point in the sampling direction in which the optical axis intersects with the scanning lines E 1 E 2 is referred to as an “effective measuring point”. In FIG. 5, the n-th to (n + m−1) -th station P j (j = n, n + 1,..., N + m−1) is an effective station. Of all effective stations, those at the right end and the left end are referred to as “end stations” and denoted as A and B, respectively. A = P n and B = P n + m−1 . In addition, the distance from the measurement origin Qm to each of the A and B ends is denoted as l A = ln, l B = ln + m−1 .
レーザースキャナ1は、1回の走査により点群データ{(li,θi)|i=1,2,…,M}を取得する。この点群データ{(li,θi)|i=1,2,…,M}が点群データ記憶部12に保存される。
The
次に、ステップS2で、有効測点抽出部13は、上記点群データ{(li,θi)|i=1,2,…,M}の中から、垂直平面S1の左右両側の端部の端測点A,Bを特定し、端測点A,B間のm個の有効測点Pj(j=n,…,n+m−1)の相対座標{(lj,θj)|j=n,n+1,…,n+m−1}を抽出する。
Next, in step S2, the effective measurement
図5から分かるように、計測原点Omから各測点Piまでの距離liは、垂直平面S1の左右両側の凸角部において不連続となるので、距離データ{li}の差分を閾値判定するなどしてこの不連続点を抽出することによって、端測点A,Bは容易に抽出することができる。 As it can be seen from FIG. 5, the distance l i from the measurement origin O m to each measuring point P i is the difference since discontinuous in the lateral sides of the projecting angle of the vertical plane S 1, the distance data {l i} By extracting this discontinuous point, for example, by determining a threshold value, the end measurement points A and B can be easily extracted.
尚、端測点A,Bの抽出については、点群データをコンピュータ3のディスプレイに表示させ、作業者がポインティングデバイス等の入力装置によって端測点A,Bを直接指定するように構成してもよい。
The extraction of the end points A and B is configured such that the point cloud data is displayed on the display of the
次に、ステップS3で、第1初期化部16は、測地座標系における端測点A,Bの位置座標の初期値を決定する。 Next, in step S3, the first initialization unit 16 determines initial values of the position coordinates of the end stations A and B in the geodetic coordinate system.
ここで、測地座標系における走査線E1E2の端点E1,E2の位置座標は、(0,0)及び(r、0)である(尚、z座標は光軸の軌跡面Slocus上ではすべて等しいので、以下省略する)。一方、実際にレーザースキャナ1から出力される点群データは、計測距離及び計測角が離散化されることによって生じる量子化誤差により、図6のように、走査線E1E2から若干外れたものとなる。また、端測点A,Bは、必ずしも走査線の端点E1,E2と正確に一致するとは限られない。そこで、端測点A,Bの位置座標の初期値は、図7に示したように、端測点A,Bが走査線E1E2上に位置し、かつ端点E1から端測点Aまでの距離と端点E2から端測点Bまでの距離とが等しくなるように設定する。
Here, the position coordinates of the end points E 1 and E 2 of the scanning line E 1 E 2 in the geodetic coordinate system are (0, 0) and (r, 0) (note that the z coordinate is the locus plane S of the optical axis. Since they are all equal on the locus , they are omitted below). On the other hand, the point cloud data actually output from the
いま、端測点A,Bのレーザースキャナ座標系における座標値を Now, the coordinate values of the edge measuring points A and B in the laser scanner coordinate system
余弦定理により、(x’A,y’A),(x’B,y’B)は次式により算出することができる。 According to the cosine theorem, (x ′ A , y ′ A ) and (x ′ B , y ′ B ) can be calculated by the following equations.
次に、ステップS4で、第2初期化部17は、端測点A,Bの位置座標の初期値(x’A,y’A),(x’B,y’B)に基づき、計測原点Omの測地座標系における位置座標の初期値(x’O,y’O)を算出する。以下、計測原点Omの位置座標の初期値(x’O,y’O)により特定される位置の点をOm’と記す。計測原点Om’は、端測点A’を中心とする半径lAの円と、端測点B’を中心とする半径lBの円との2つの交点のうちの一つである。従って、次のような連立方程式が成り立つ。 Next, in step S4, the second initialization unit 17 performs measurement based on the initial values (x ′ A , y ′ A ) and (x ′ B , y ′ B ) of the position coordinates of the end measurement points A and B. An initial value (x ′ O , y ′ O ) of position coordinates in the geodetic coordinate system of the origin O m is calculated. Hereinafter, the point of the position specified by the initial value (x ′ O , y ′ O ) of the position coordinates of the measurement origin O m is denoted as O m ′. The measurement origin O m ′ is one of two intersections of a circle with a radius l A centered on the end measurement point A ′ and a circle with a radius l B centered on the end measurement point B ′. Therefore, the following simultaneous equations hold.
いま、測地座標系は図3のように設定したのでyO’<0である。従って、計測原点Omの位置座標の初期値(x’O,y’O)は、式(12a),(12b)により次のように求められる。 Now, since the geodetic coordinate system is set as shown in FIG. 3, y O ′ <0. Accordingly, the initial values (x ′ O , y ′ O ) of the position coordinates of the measurement origin O m are obtained as follows using the equations (12a) and (12b).
更に、第2初期化部17は、端測点A,B以外の有効測点Pj(j=n+1,…,n+m−2)の測地座標系における位置座標の初期値(x’j,y’j)を算出する。端測点B=Pnの方位角は、次式で表される。 Further, the second initialization unit 17 initializes the position coordinates in the geodetic coordinate system (x ′ j , y) of the effective stations P j (j = n + 1,..., N + m−2) other than the end stations A and B. ' j ) is calculated. The azimuth angle of the end measuring point B = Pn is expressed by the following equation.
従って、有効測点Pj(j=n+1,…,n+m−2)の測地座標系における位置座標の初期値(x’j,y’j)は、次式により算出される。 Therefore, the initial value (x ′ j , y ′ j ) of the position coordinates in the geodetic coordinate system of the effective measurement point P j (j = n + 1,..., N + m−2) is calculated by the following equation.
次に、ステップS5で、変換パラメータ算出部18は、距離dA、距離dB、及び距離dj(j=n+1,…,n+m−2)の自乗和を評価関数fとして、計測原点Om及び各有効測点Pj(j=n,…,n+m−1)の位置座標の初期値から開始して、評価関数fの値が最小となるように、計測原点Om及び各有効測点Pjの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する。ここで、距離dAは走査線E1E2の端点E1から端測点Aまでの距離、距離dBは走査線E1E2の端点E2から端測点Bまでの距離、距離djは走査線E1E2から有効測点Pjまでの距離である(図9参照)。
Next, in step S5, the conversion
この計算は、次のようにして行うことができる。今、初期値として測地座標が設定された測点A’,B’,Pj’(j=n+1,n+2,…,n+m−2)を、原点O=(0,0)を中心に回転移動した後に平行移動する変換(ヘルマート変換)を行うとする。回転移動の回転量をΔθ,平行移動の移動量を(Δx,Δy)とする。測点A’,B’,Pj’をヘルマート変換により移動した点をそれぞれA”,B”,Pj”と記す。移動後の測点A”,B”,Pj”の座標は、それぞれ次のように表される。 This calculation can be performed as follows. Now, the rotational points A ′, B ′, P j ′ (j = n + 1, n + 2,..., N + m−2) having geodetic coordinates set as initial values are rotated around the origin O = (0, 0). After that, it is assumed that a parallel translation (Helmart transform) is performed. The rotation amount of the rotational movement is Δθ, and the movement amount of the parallel movement is (Δx, Δy). The points where the stations A ′, B ′, P j ′ are moved by the Helmert transformation are denoted as A ″, B ″, P j ″ respectively. The coordinates of the stations A ″, B ″, P j ″ after the movement are Each is expressed as follows.
従って、距離dA、距離dB、及び距離dj(j=n+1,…,n+m−2)は、次式のように表される。 Therefore, the distance d A , the distance d B , and the distance d j (j = n + 1,..., N + m−2) are expressed by the following equations.
従って、最小化すべき評価関数f(Δx,Δy,Δθ)は次式で表される。 Therefore, the evaluation function f (Δx, Δy, Δθ) to be minimized is expressed by the following equation.
ここで、 here,
この評価関数fの最小化を反復解法により行う。ここでは、最急降下法を使用する。すなわち、評価関数fを、それぞれΔx,Δy,a,bで偏微分した結果を0とすることにより、各パラメータの漸化式が次式のように求められる。ここで、ηは反復回数である。 The evaluation function f is minimized by an iterative solution. Here, the steepest descent method is used. That is, by making the result of partial differentiation of the evaluation function f by Δx, Δy, a, and b to be 0, a recurrence formula for each parameter is obtained as follows. Here, η is the number of iterations.
尚、本実施例では、計算を簡単化するために、評価関数fは距離dA、距離dB、及び距離dj(j=n+1,…,n+m−2)の自乗和としたが、評価関数fとしてはこれらの距離の和を用いてもよい。 In this embodiment, in order to simplify the calculation, the evaluation function f is the sum of squares of the distance d A , the distance d B , and the distance d j (j = n + 1,..., N + m−2). The sum of these distances may be used as the function f.
次に、ステップS6で、原点座標確定部19は、算出された各変換パラメータΔx,Δy,a,bにより計測原点Omの位置座標の初期値(x’O,y’O)をヘルマート変換し、計測原点Omの測地座標系における最終的な位置座標(xO,yO)を算出する。算出された位置座標(xO,yO)は、キャリブレーションパラメータ記憶部11に保存される。ここで、位置座標(xO,yO)は次式のようにして計算することができる。
Next, in step S6, the origin coordinate
最後に、ステップS7で、注視点座標確定部20は、レーザースキャナの走査角度範囲の中心方向の光軸上の測点である注視点Gの相対座標(lG,θG)を点群データから抽出し、該注視点Gの相対座標(lG,θG)と計測原点Omの測地座標系における最終的な位置座標(xO,yO)とに基づいて、注視点Gの測地座標系における位置座標(xG,yG)を算出する。算出された位置座標(xG,yG)は、キャリブレーションパラメータ記憶部11に保存される。ここで、位置座標(xG,yG)は次式のようにして計算することができる。
Finally, in step S7, the gazing point coordinate
以上のような処理により、キャリブレーションデータとして、測地座標系における計測原点Omの位置座標(xO,yO)及び注視点Gの位置座標(xG,yG)が確定される。この確定された位置座標を基準にして、他の測定データの測地座標系における位置座標も逐次確定していくことができる。 Through the above processing, the position coordinates (x O , y O ) of the measurement origin O m and the position coordinates (x G , y G ) of the gazing point G in the geodetic coordinate system are determined as calibration data. Based on the determined position coordinates, the position coordinates of other measurement data in the geodetic coordinate system can also be sequentially determined.
図10は、本発明の実施例2に係るレーザースキャナのキャリブレーション方法で使用するターゲットの外観斜視図である。尚、本実施例で使用するレーザースキャナ及びそのキャリブレーション装置の構成は図1,図2と同様である。 FIG. 10 is an external perspective view of a target used in the laser scanner calibration method according to the second embodiment of the present invention. The configurations of the laser scanner and the calibration device used in this embodiment are the same as those shown in FIGS.
図10のターゲットT2は、左右両側辺が平行かつ垂直な垂直平面S1,S2を有している。各垂直平面S1,S2は互いに平行である。尚、本実施例では、説明を簡単化するため、垂直平面の数は2つとしたが、垂直平面の数は3つ以上あってもよい。 The target T 2 in FIG. 10 has vertical planes S 1 and S 2 whose left and right sides are parallel and vertical. The vertical planes S 1 and S 2 are parallel to each other. In this embodiment, the number of vertical planes is two in order to simplify the description, but the number of vertical planes may be three or more.
このターゲットT2に対して、レーザースキャナ1により水平に走査を行う。垂直平面S1,S2上の走査線を、それぞれE1,1E1,2,E2,1E2,2と記す。測地座標系の原点Oを走査線E1,1E1,2の左側の端点E1,1とし、走査線E1,1E1,2方向をx軸、走査線E1,1E1,2方向に垂直で光軸の軌跡面Slocus内の方向をy軸、垂直上方をz軸とする。垂直平面S1,S2の幅をr1,r2とする。また、y軸から垂直平面Sk(k=1,2)の左端までの距離をxk,0、x軸から垂直平面Skまでの距離をDkとする。
The target T 2 is scanned horizontally by the
本実施例のレーザースキャナのキャリブレーション方法の処理の流れは、基本的には実施例1と同様であるので、図4のフローチャートに沿って説明する。 The processing flow of the laser scanner calibration method of the present embodiment is basically the same as that of the first embodiment, and will be described with reference to the flowchart of FIG.
ステップS1におけるレーザースキャナ1の設置、レーザースキャナ1による走査及び点群データのコンピュータ3への取り込みは、実施例1と同様である。この場合、ターゲットT2の走査により得られる各測点Pi(i=1,2,…,M)と計測原点Omとの位置関係は図11のようになる。
Installation of the
次に、ステップS2で、有効測点抽出部13は、垂直平面S1,S2の左右両側の端部の端測点(A1,B1),(A2,B2)を特定し、端測点(A1,B1)間のm1個の有効測点Pj(j=n1,…,n1+m1−1)の相対座標{(lj,θj)|j=n1,n1+1,…,n1+m1−1}、及び端測点(A2,B2)間のm2個の有効測点Pj(j=n2,…,n2+m2−1)の相対座標{(lj,θj)|j=n2,n2+1,…,n2+m2−1}を抽出する。抽出の方法は、実施例1の場合と同様である。
Next, in step S2, the effective measurement
次に、ステップS3で、第1初期化部16は、測地座標系における端測点(A1,B1),(A2,B2)の位置座標の初期値を決定する。垂直平面S1,S2における各端測点のレーザースキャナ座標系における座標値、測地座標系における位置座標、及び走査線の長さを、実施例1と同様に次式のようにおく。 Next, in step S3, the first initialization unit 16 determines initial values of the position coordinates of the end stations (A 1 , B 1 ), (A 2 , B 2 ) in the geodetic coordinate system. The coordinate values in the laser scanner coordinate system, the position coordinates in the geodetic coordinate system, and the length of the scanning line at each end point on the vertical planes S 1 and S 2 are set as in the following equation, as in the first embodiment.
尚、[rA1B2]xは、最も左側の端測点A1から最も右側の端測点B2までのx軸上の距離である。 Incidentally, [r A1B2] x is the distance on the x-axis from the leftmost end measuring point A 1 to the most right end measuring point B 2.
r=x2,0+r2とすれば、測地座標系における位置座標の初期値(x’k,A,y’k,A),(x’k,B,y’k,B)(k=1,2)は、実施例1と同様の計算により、次式のように算出することができる。 If r = x 2,0 + r 2 , the initial position coordinates (x ′ k, A , y ′ k, A ), (x ′ k, B , y ′ k, B ) (k = 1, 2) can be calculated by the same calculation as in the first embodiment as shown in the following equation.
ここで、端点E1,1から端測点A’1までの距離をd1,A、端点E2,2から端測点B’2までの距離d2,Bとすると、d1,A=d2,Bとなるように各端測点の位置座標を決定した。 Here, if the distance from the end point E 1,1 to the end station A ′ 1 is d 1, A and the distance d 2, B from the end point E 2,2 to the end station B ′ 2 is d 1, A. = Position coordinates of each end point were determined so as to be d2 , B.
次に、ステップS4で、第2初期化部17は、計測原点Omの測地座標系における位置座標の初期値(x’O,y’O)を算出する。この計算は、実施例1の式(13a)(13b)と同様に、次式により行うことができる。 Next, in step S4, the second initialization unit 17 calculates initial values (x ′ O , y ′ O ) of position coordinates in the geodetic coordinate system of the measurement origin O m . Similar to the equations (13a) and (13b) of the first embodiment, this calculation can be performed by the following equation.
また、第2初期化部17は、端測点(A1,B1),(A2,B2)以外の有効測点Pj(j=n2+1,…,n2+m2−2,n1+1,…,n1+m1−2)の測地座標系における位置座標の初期値(x’j,y’j)を算出する。この計算は、実施例1の式(16a)(16b)と同様、次式により行うことができる。 In addition, the second initialization unit 17 uses the effective measurement points P j (j = n 2 +1,..., N 2 + m 2 −2) other than the end measurement points (A 1 , B 1 ) and (A 2 , B 2 ). , N 1 +1,..., N 1 + m 1 -2), the initial position coordinates (x ′ j , y ′ j ) in the geodetic coordinate system are calculated. Similar to the equations (16a) and (16b) of the first embodiment, this calculation can be performed by the following equation.
次に、ステップS5で、変換パラメータ算出部18は、距離d1,A,d1,B,d2,A,d2,B及び距離dj(j=n2+1,…,n2+m2−2,n1+1,…,n1+m1−2)の自乗和を評価関数fとして、計測原点Om及び各有効測点Pj(j=n2,…,n2+m2−1,n1,…,n1+m1−1)の位置座標の初期値から開始して、評価関数fの値が最小となるように、計測原点Om及び各有効測点Pjの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する。ここで、距離dk,A(k=1,2)は走査線Ek,1Ek,2の端点Ek,1から端測点Akまでの距離、距離dk,Bは走査線Ek,1Ek,2の端点Ek,2から端測点Bkまでの距離、距離dk,j(j=nk,…,nk+mk−1)は走査線Ek,1Ek,2から有効測点Pjまでの距離である(図11参照)。この場合の距離dk,A,dk,B,dk,j及び評価関数fは以下のようになる。
Next, in step S5, the conversion
次に、ステップS6で、原点座標確定部19は、算出された各変換パラメータΔx,Δy,a,bにより計測原点Omの位置座標の初期値(x’O,y’O)をヘルマート変換し、計測原点Omの測地座標系における最終的な位置座標(xO,yO)を算出する。算出された位置座標(xO,yO)は、キャリブレーションパラメータ記憶部11に保存される。
Next, in step S6, the origin coordinate
最後に、ステップS7で、注視点座標確定部20は、レーザースキャナの走査角度範囲の中心方向の光軸上の測点である注視点Gの相対座標(lG,θG)を点群データから抽出し、該注視点Gの相対座標(lG,θG)と計測原点Omの測地座標系における最終的な位置座標(xO,yO)とに基づいて、注視点Gの測地座標系における位置座標(xG,yG)を算出する。算出された位置座標(xG,yG)は、キャリブレーションパラメータ記憶部11に保存される。
Finally, in step S7, the gazing point coordinate
図12は、本発明の実施例3に係るレーザースキャナのキャリブレーション装置の機能的な構成を示すブロック図である。尚、本実施例で使用するレーザースキャナは図1と同様である。また、図12において、図2と同様の構成部分については、同符号を付して説明は省略する。 FIG. 12 is a block diagram illustrating a functional configuration of a laser scanner calibration apparatus according to the third embodiment of the present invention. The laser scanner used in this embodiment is the same as that shown in FIG. In FIG. 12, the same components as those in FIG. 2 are denoted by the same reference numerals and description thereof is omitted.
本実施例のキャリブレーション装置10は、点群データ記憶部12、幅算出部25、水平幅補正部26、及び高さ算出部27を備えている。このキャリブレーション装置10は、レーザースキャナ1の計測原点Omの正確な高さHが未知の場合に、その高さHのキャリブレーションを行う。
The
次に、図12のキャリブレーション装置10によるレーザースキャナのキャリブレーション方法について説明する。
Next, a laser scanner calibration method using the
図13は、本発明の実施例3に係るレーザースキャナのキャリブレーション方法で使用するターゲットの外観斜視図である。ターゲットT3は、左側辺が垂直な直線で且つ右側辺が傾斜した直線である左垂直平面SLと、右側辺が垂直な直線で且つ左側辺が左垂直平面SLの右側辺と平行な傾斜直線である右垂直平面SRとを備えている。左垂直平面SLと右垂直平面SRは平行で且つ同一平面上にある。左垂直平面SLの右側辺と右垂直平面SRの左側辺とは一定の水平幅r0だけ離隔している。 FIG. 13 is an external perspective view of a target used in the laser scanner calibration method according to the third embodiment of the present invention. Target T 3 is a left vertical plane S L left side is a straight line and the right side is inclined in a vertical straight line and the left side the right side is a vertical straight line parallel to the right side of the left vertical plane S L and a right vertical plane S R is an inclined straight line. The left vertical plane S L and the right vertical plane S R are parallel and on the same plane. The right side of the left vertical plane S L and the left side of the right vertical plane S R are separated by a certain horizontal width r 0 .
右垂直平面SRは底辺r、高さhの直角三角形であり、左垂直平面SLは右垂直平面SRと合同で180°回転させた直角三角形である。従って、高さzにおける右垂直平面SRの水平幅fR、左垂直平面SLの水平幅fLは、次式で表される。 The right vertical plane S R is a right triangle with a base r and a height h, and the left vertical plane S L is a right triangle that is rotated by 180 ° jointly with the right vertical plane S R. Therefore, the horizontal width f R, the horizontal width f L of the left vertical plane S L of the right vertical plane S R at a height z is expressed by the following equation.
図14は、本発明の実施例3に係るレーザースキャナのキャリブレーション方法のフローチャートである。 FIG. 14 is a flowchart of the laser scanner calibration method according to the third embodiment of the present invention.
まず、ステップS11で、レーザースキャナ1が搭載された台車3を、ターゲットT1の垂直平面S1前方の水平な床面に設置し、水準器等を用いて走査の際の光軸の軌跡面Slocusが水平となるように調節する。そして、レーザースキャナ1により、ターゲットT3の走査を行う。レーザースキャナ1は、スキャンヘッドを一定の方位角範囲で回動させながら走査を行う。従って、レーザービームの光軸は水平面内で回動し、一定の回転角ごとに測点までの距離情報がサンプリングされる。サンプリングにより得られる点群データは、コンピュータ3に転送され、点群データ記憶部12に保存される。
First, in step S11, the
このとき、レーザースキャナ1が照射するレーザービームの光軸の軌跡面(扇形状に広がる水平平面)Slocusが左垂直平面SLを切る線分を走査線EL1EL2、軌跡面Slocusが右垂直平面SRを切る線分を走査線ER1ER2と呼ぶ(図13参照)。
At this time, S locus scan line segment is cut left vertical plane S L E L1 E L2 (horizontal plane extends in a fan shape) the locus plane of the optical axis of the laser
次に、ステップS12で、幅算出部25は、点群データ記憶部12に保存された点群データの中から、左垂直平面SLの左側の端測点A及び右側の端測点CLを抽出し、端測点A,CL間の距離rLを算出する。距離rLを計算は、式(11e)と同様にして行うことができる。
Next, in step S12, the
次に、ステップS13で、幅算出部25は、点群データ記憶部12に保存された点群データの中から、右垂直平面SRの左側の端測点CR及び右側の端測点Bを抽出し、端測点CR,B間の距離rRを算出する。距離rRを計算は、式(11e)と同様にして行うことができる。
Next, in step S13, the
次に、ステップS14で、水平幅補正部26は、計測された水平幅rL,rRを、それぞれ次式により補正して補正水平幅r’L,r’Rを算出する。
Next, in step S14, the horizontal
最後に、ステップS15で、高さ算出手段27は、レーザースキャナの計測原点Omの高さHを、次式により算出し、キャリブレーションパラメータ記憶部11に保存する。ここで、fL −1(x),fR −1(x)は、それぞれ、前記関数fL(z),fR(z)の逆関数である。
Finally, in step S15, the height calculation means 27, the height H of the measurement origin O m of the laser scanner, was calculated by the following equation, is stored in the calibration
以上の処理により、レーザースキャナの計測原点Omの高さのキャリブレーションパラメータの算出を行うことができる。 By the above processing, it is possible to calculate the calibration parameters in the height of the measurement origin O m of the laser scanner.
尚、本実施例において、ターゲットT3の左垂直平面SLの右側辺と右垂直平面SRの左側辺との間の間隙は直線状の間隙としたが、図15に示したような、曲線状であってもよい。この場合、高さzにおける左垂直平面SL,右垂直平面SRの水平幅を関数fL(z),fR(z)で表すと、fL(z)=r−fR(z)の関係となり、fR(z)た単調減少関数又は単調増加関数である必要がある。このようなターゲットT3を使用した場合、fR(z),fL(z)の形は上記図13の場合と異なるが、それ以外は同様である。 In the present embodiment, as is the gap between the left edge of the right side and a right vertical plane S R of the left vertical plane S L of the target T 3 and a linear gap, shown in FIG. 15, It may be curved. In this case, when the horizontal widths of the left vertical plane S L and the right vertical plane S R at the height z are expressed by functions f L (z) and f R (z), f L (z) = r−f R (z ) And needs to be a monotonically decreasing function or a monotonically increasing function with f R (z). When such a target T 3 is used, the shapes of f R (z) and f L (z) are different from those in the case of FIG. 13, but are otherwise the same.
図16は、実施例4に係るレーザースキャナのキャリブレーション方法のフローチャートである。尚、本実施例で使用するレーザースキャナ1は図1と同様であり、レーザースキャナのキャリブレーション装置10のブロック図は図12と同様である。このキャリブレーション装置10は、実施例3と同様、レーザースキャナ1の計測原点Omの正確な高さHが未知の場合に、その高さHのキャリブレーションを行う。
FIG. 16 is a flowchart of a laser scanner calibration method according to the fourth embodiment. The
まず、ステップS21で、レーザースキャナ1が搭載された台車3を、ターゲットT1の垂直平面S1前方の水平な床面に設置し、水準器等を用いて走査の際の光軸の軌跡面Slocusが水平となるように調節する。そして、レーザースキャナ1により、図13や図15に示したようなターゲットT3の走査を行う。走査の結果、サンプリングにより得られる点群データは、コンピュータ3に転送され、点群データ記憶部12に保存される。
First, in step S21, the
次に、ステップS22で、N回目の測定が終了していなければ、ステップS24でレーザースキャナ1の設置位置を移動させ、再びステップS21に戻る。ここで、レーザースキャナ1の設置位置は、ターゲットT3の前方で且つターゲットT3の横幅が走査の際の光軸の軌跡面Slocusに含まれる位置であればどこでもよいが、ターゲットT3からレーザースキャナ1までの距離を変えることが好ましい。ステップS22で、N回目の測定が終了した場合には、次のステップS24に進む。
Next, if the Nth measurement is not completed in step S22, the installation position of the
ステップS24で、幅算出部25は、点群データ記憶部12に保存されたN組の点群データの中から、1番目の点群データから順次読み出す。ここでは、読み出された点群データをk番目(k∈{1,…,N})の点群データとして{(lk,i,θk,i)|i=1,2,…,M}と記す。ここで、(lk,i,θk,i)は、k組目の点群データにおけるi番目の測点Pk,iのレーザースキャナ座標系における極座標である。
In step S <b> 24, the
次に、ステップS25で、幅算出部25は、点群データ{(lk,i,θk,i)|i=1,2,…,M}の中から、左垂直平面SLの左側の端測点A及び右側の端測点CLを抽出し、端測点A,CL間の距離rL,kを算出する。距離rL,kの計算は、式(11e)と同様にして行うことができる。
Next, in step S25, the
次に、ステップS26で、幅算出部25は、点群データ{(lk,i,θk,i)|i=1,2,…,M}の中から、右垂直平面SRの左側の端測点CR及び右側の端測点Bを抽出し、端測点CR,B間の距離rR,kを算出する。距離rR,kを計算は、式(11e)と同様にして行うことができる。
Next, in step S26, the
次に、ステップS27で、水平幅補正部26は、計測された水平幅rL,k,rR,kを、それぞれ式(31a),(31b)と同様の計算により補正して補正水平幅r’L,k,r’R,kを算出する。
Next, in step S27, the horizontal
最後に、ステップS28で、高さ算出手段27は、レーザースキャナの計測原点Omの高さHkを、式(32)と同様の計算により算出する。算出した高さHkは、キャリブレーションパラメータ記憶部11に保存される。
Finally, in step S28, the height calculation means 27, the height H k of the measurement origin O m of the laser scanner, is calculated by a calculation similar to that of equation (32). The calculated height H k is stored in the calibration
ステップS29で、上記ステップS24〜S28の処理が、点群データ記憶部12に保存されたN組の点群データのすべてについて終わっていなければ、再びステップS24に戻る。終わっていれば、ステップS30に移行する。
In step S29, if the processes of steps S24 to S28 are not completed for all the N sets of point cloud data stored in the point cloud
ステップS30で、高さ算出手段27は、キャリブレーションパラメータ記憶部11に保存されたN個の高さHk(k=1,…,N)を読み出し、その平均値Hを算出し、これを最終的な計測原点Omの高さとしてキャリブレーションパラメータ記憶部11に保存する。
In step S30, the
以上の処理により、レーザースキャナの計測原点Omの高さのキャリブレーションパラメータの算出を行うことができる。また、N回の測定の平均を行うことで、より誤差の少ない計測原点Omの高さのキャリブレーションを行うことができる。 By the above processing, it is possible to calculate the calibration parameters in the height of the measurement origin O m of the laser scanner. Further, by performing the average of the N measurements can be performed more calibration of the height of the small measurement origin O m of error.
図17は、本発明の実施例5に係るレーザースキャナのキャリブレーション装置の機能的な構成を示すブロック図である。尚、本実施例で使用するレーザースキャナは図1と同様である。また、図17において、図2と同様の構成部分については、同符号を付して説明は省略する。 FIG. 17 is a block diagram illustrating a functional configuration of a laser scanner calibration apparatus according to the fifth embodiment of the present invention. The laser scanner used in this embodiment is the same as that shown in FIG. In FIG. 17, the same components as those in FIG.
本実施例のキャリブレーション装置10は、点群データ記憶部12、幅算出部30、高さ算出部31、及び仰角算出部32を備えている。このキャリブレーション装置10は、レーザースキャナ1のレーザービームの光軸方向が水平からずれている場合に、その仰角φのキャリブレーションを行う。
The
次に、図12のキャリブレーション装置10によるレーザースキャナのキャリブレーション方法について説明する。
Next, a laser scanner calibration method using the
図18は、本発明の実施例5に係るレーザースキャナのキャリブレーション方法で使用するターゲットT4の外観斜視図である。ターゲットT4は、水平幅が高さzの単調関数fL(z)に従って変化する左垂直平面SLと、水平幅が高さzの単調関数fR(z)に従って変化する右垂直平面SRとを備えている。本実施例では、一例として、左垂直平面SLと右垂直平面SRは合同な直角三角形とし、右垂直平面SRの直角三角形は、鈎の長さがr、股の長さがhで、鈎が水平な床面に沿って置かれ、股が床面に垂直となるように配置されている。左垂直平面SLは、右垂直平面SRを180°回転させた直角三角形であり、股と弦との間の頂点で床面に接し、股が床面に垂直、鈎が床面に水平となるように配置されている。左垂直平面SLと右垂直平面SRは平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にある。また、左垂直平面SKの右側辺(弦)と右垂直平面SRの左側辺(弦)とは一定の水平幅r0だけ離隔して配されている。従って、左垂直平面SLの高さzにおける幅fL(z)と、左垂直平面SRの高さzにおける幅fR(z)は次式のようになる。 Figure 18 is an external perspective view of a target T 4 used in the calibration method of the laser scanner according to Example 5 of the present invention. Target T 4 includes a left vertical plane S L that varies in accordance with monotonic function f L of the horizontal width height z (z), the right vertical plane changes the horizontal width according monotonic function f R (z) of the height z S R. In this embodiment, as an example, the left vertical plane S L and the right vertical plane S R and congruent right-angled triangles, right triangle right vertical plane S R, the length of the hook is r, the length of the crotch is in h , The heel is placed along a horizontal floor, and the crotch is arranged perpendicular to the floor. The left vertical plane S L is a right triangle obtained by rotating the right vertical plane S R 180 °, touches the floor at the apex between the crotch and the string, the crotch is perpendicular to the floor, and the heel is horizontal to the floor. It is arranged to become. The left vertical plane S L and the right vertical plane S R are parallel to each other and are separated from each other by a certain distance d. Moreover, are arranged spaced apart by a predetermined horizontal width r 0 is the right side of the left vertical plane S K (chord) and the right vertical plane S R of the left side (chord). Accordingly, the width f L (z) at the height z of the left vertical plane S L and the width f R (z) at the height z of the left vertical plane S R are expressed by the following equations.
図19は、実施例5に係るレーザースキャナのキャリブレーション方法のフローチャートである。 FIG. 19 is a flowchart of a laser scanner calibration method according to the fifth embodiment.
まず、ステップS31で、レーザースキャナ1が搭載された台車3を、ターゲットT4の左垂直平面SL及び右垂直平面SR前方の水平な床面に設置し、水準器等を用いて走査の際の光軸の軌跡面Slocusが水平となるように調節する。そして、レーザースキャナ1により、ターゲットT4の走査を行う。走査により得られる点群データは、コンピュータ3に転送され、点群データ記憶部12に保存される。
First, in step S31, the
このとき、レーザースキャナ1が照射するレーザービームの光軸の軌跡面Slocusが左垂直平面SLを切る線分を走査線EL1EL2、軌跡面Slocusが右垂直平面SRを切る線分を走査線ER1ER2と呼び、軌跡面Slocusの水平面からの仰角をφと記す(図18参照)。
At this time, the line locus surface S locus of the optical axis of the laser
次に、ステップS32で、幅算出部30は、点群データ記憶部12に保存された点群データの中から、左垂直平面SLの左側の端測点A及び右側の端測点CLを抽出し、端測点A,CL間の水平幅rLを算出する。水平幅rLを計算は、式(11e)と同様にして行うことができる。
Next, in step S32, the
次に、ステップS33で、幅算出部30は、点群データ記憶部12に保存された点群データの中から、右垂直平面SRの左側の端測点CR及び右側の端測点Bを抽出し、端測点CR,B間の水平幅rRを算出する。水平幅rRを計算は、式(11e)と同様にして行うことができる。
Next, in step S33, the
次に、ステップS34で、高さ算出部31は、水平幅rL,rRに基づいて、次式により左垂直平面SLを切る走査線EL1EL2の高さhL及び右垂直平面SRを切る走査線ER1ER2の高さhRを算出する。
Next, in step S34, the
最後に、ステップS35で、仰角算出部32は、前記高さhL,hR、及び左垂直平面SLと右垂直平面SRの距離dに基づき、レーサースキャナ1の光軸の仰角φを式(35)により算出し、キャリブレーションパラメータ記憶部11に保存する。
Finally, in step S35, the elevation
以上の処理により、レーザースキャナの光軸の仰角φのキャリブレーションパラメータの算出を行うことができる。 With the above processing, the calibration parameter of the elevation angle φ of the optical axis of the laser scanner can be calculated.
図20は、本発明の実施例6に係るレーザースキャナのキャリブレーション装置の機能的な構成を示すブロック図である。尚、本実施例で使用するレーザースキャナは図1と同様である。また、図20において、図2と同様の構成部分については、同符号を付して説明は省略する。 FIG. 20 is a block diagram illustrating a functional configuration of a laser scanner calibration apparatus according to the sixth embodiment of the present invention. The laser scanner used in this embodiment is the same as that shown in FIG. Further, in FIG. 20, the same components as those in FIG.
本実施例のキャリブレーション装置10は、点群データ記憶部12、有効測点抽出部41、走査線算出部42、走査線間距離算出部43、仰角算出部44、及び平均化部45を備えている。このキャリブレーション装置10は、レーザースキャナ1のレーザービームの光軸方向が水平からずれている場合に、その仰角φのキャリブレーションを行う。
The
次に、図20のキャリブレーション装置10によるレーザースキャナのキャリブレーション方法について説明する。
Next, a laser scanner calibration method using the
図21は、本発明の実施例6に係るレーザースキャナのキャリブレーション方法で使用するターゲットT5の外観斜視図である。ターゲットT5は、左側辺及び右側辺が垂直且つ平行な左垂直平面SLと、左側辺及び右側辺が垂直且つ平行な右垂直平面SRとを備えている。左垂直平面SLを含む平面と右垂直平面SRを含む平面とは、平行で且つそれぞれ互いに一定の距離dだけ離隔している。図21のターゲットT5は、左垂直平面SLと右垂直平面SRは水平幅が同幅とされており、両者の水平幅をrと記す。また、左垂直平面SLと右垂直平面SRは水平距離でr0だけ離隔している。 Figure 21 is an external perspective view of a target T 5 for use in the calibration method of the laser scanner according to Example 6 of the present invention. Target T 5 includes a left side and a right side vertical and parallel left vertical plane S L, left side and right side is a perpendicular and parallel right vertical plane S R. The plane including the left vertical plane S L and the plane including the right vertical plane S R are parallel and separated from each other by a certain distance d. Target T 5 in FIG. 21, the left vertical plane S L and the right vertical plane S R are the same width horizontal width, it referred to the horizontal width of both the r. Further, the left vertical plane S L and the right vertical plane S R are separated by r 0 in the horizontal distance.
図22は、実施例6に係るレーザースキャナのキャリブレーション方法のフローチャートである。 FIG. 22 is a flowchart of a laser scanner calibration method according to the sixth embodiment.
まず、ステップS41で、レーザースキャナ1が搭載された台車3を、ターゲットT5の左垂直平面SL及び右垂直平面SR前方の水平な床面に設置し、水準器等を用いて走査の際の光軸の軌跡面Slocusが水平となるように調節する。そして、レーザースキャナ1により、ターゲットT5の走査を行う。走査により得られる点群データ{(lk,i,θk,i)|i=1,2,…,M}(k∈{1,…,N})は、コンピュータ3に転送され、点群データ記憶部12に保存される。
First, in step S41, the
このとき、レーザースキャナ1が照射するレーザービームの光軸の軌跡面Slocusが左垂直平面SLを切る線分を走査線LL、軌跡面Slocusが右垂直平面SRを切る線分を走査線LRと呼び、軌跡面Slocusの水平面からの仰角をφと記す(図21参照)。
At this time, a line segment laser beam scan line a line segment locus surface S locus of the optical axis cut left vertical plane S L L L the
ステップS42において、N回目の測定が終了していなければ、ステップS43でレーザースキャナ1の設置位置を移動させ、再びステップS41に戻る。ここで、レーザースキャナ1の設置位置は、ターゲットT5の前方で且つターゲットT5の横幅が走査の際の光軸の軌跡面Slocusに含まれる位置であればどこでもよいが、ターゲットT5からレーザースキャナ1までの距離を変えることが好ましい。ステップS42で、N回目の測定が終了した場合には、次のステップS44に進む。
If the Nth measurement is not completed in step S42, the installation position of the
ステップS44で、有効測点抽出部41は、点群データ記憶部12に保存されたN組の点群データの中から、1番目の点群データから順次読み出す。ここでは、読み出された点群データをk番目(k∈{1,…,N})の点群データとして{(lk,i,θk,i)|i=1,2,…,M}と記す。ここで、(lk,i,θk,i)は、k組目の点群データにおけるi番目の測点Pk,iのレーザースキャナ座標系における極座標である。
In step S <b> 44, the effective point extraction unit 41 sequentially reads out the first point cloud data from the N sets of point cloud data stored in the point cloud
次に、ステップS45で、有効測点抽出部41は、上記点群データ{(lk,i,θk,i)|i=1,2,…,M}の中から、垂直平面SLの左右両側の端部の端測点Ak,Ck,Lを特定し、端測点Ak,Ck,L間のmk,L個の有効測点Pk,i(i=nk,L,…,nk,L+mk,L−1)の相対極座標{(lk,i,θk,i)|i=nk,L,nk,L+1,…,nk,L+mk,L−1}を抽出する。ここで、「相対極座標」とは、レーザスキャナ座標系における極座標のことをいう。また、左垂直平面SL上の有効測点を「左有効測点」という。 Next, in step S45, the effective point extraction unit 41 selects the vertical plane S L from the point cloud data {(l k, i , θ k, i ) | i = 1, 2,..., M}. end measurement point a k of the left and right opposite ends of, C k, identifies L, and the end measurement point a k, C k, m k , L -number of effective measurement point P k between L, i (i = n k, L, ..., n k , L + m k, L relative polar coordinates {(l k of -1), i, θ k, i) | i = n k, L, n k, L + 1, ..., n k , L + m k, L −1}. Here, “relative polar coordinates” refers to polar coordinates in the laser scanner coordinate system. In addition, the effective stations on the left vertical plane S L referred to as "left Enable stations".
次に、ステップS46で、有効測点抽出部41は、上記点群データ{(lk,i,θk,i)|i=1,2,…,M}の中から、垂直平面SRの左右両側の端部の端測点Ck,R,Bkを特定し、端測点Ck,R,Bk間のmk,R個の有効測点Pk,i(i=nk,R,…,nk,R+mk,R−1)の相対極座標{(lk,i,θk,i)|i=nk,R,nk,R+1,…,nk,R+mk,R−1}を抽出する。以下、右垂直平面SR上の有効測点を「右有効測点」という。 Next, in step S46, the effective point extraction unit 41 selects the vertical plane S R from the point cloud data {(l k, i , θ k, i ) | i = 1, 2,..., M}. End points C k, R , B k at the left and right ends of the image are identified, and m k, R effective points P k, i (i = n) between the end points C k, R , B k k, R 1 ,..., n k, R + m k, R −1) relative polar coordinates {(l k, i , θ k, i ) | i = n k, R , n k, R +1 ,. , R + m k, R −1}. Below, the effective stations on the right vertical plane S R that "right Enable stations".
次に、ステップS47で、走査線算出部42は、各左有効測点及び各右有効測点の相対座標に基づき、互いに平行な2つの走査線Lk,L,Lk,Rの傾き及び切片を算出する。ここで、計測原点Ok,mを原点とし、軌跡面Slocus内の直交する二方向をx軸,y軸、x軸及びz軸と垂直な方向をz軸とする直交座標系を想定し、これを「相対直交座標系」という。相対直交座標系における走査線Lk,L,Lk,Rの傾きをpk、走査線Lk,Lの切片をqk,L,走査線Lk,Rの切片をqk,Rとおく。走査線算出部42は、傾きpk、切片qk,L,qk,Rを、走査線Lk,Lから各左有効測点Pk,i(i=nk,L,…,nk,L+mk,L−1)までの距離の和に、走査線Lk,Rから各右有効測点Pi(i=nk,R,…,nk,R+mk,R−1)までの距離の和gk(pk,qk,L,qk,R)を加えた値が最小となるように、最小自乗法により算出する。
Next, in step S47, the scanning
相対直交座標系における測点Pk,iの位置座標(以下、単に「位置座標」という。)を(xk,i,yk,i)とすると、 If the position coordinates (hereinafter simply referred to as “position coordinates”) of the measuring points P k, i in the relative orthogonal coordinate system are (x k, i , y k, i ),
次に、ステップS48で、走査線間距離算出部43は、走査線Lk,Lから走査線Lk,Rまでの距離d’kを次式により算出する。
Next, in step S48, the inter-scan line
最後に、ステップS49で、仰角算出部44は、距離d’k及び距離dkに基づき、レーサースキャナ1の光軸の仰角φkを次式により算出すし、キャリブレーションパラメータ記憶部11に保存する。
Finally, in step S49, the elevation
ステップS50で、上記ステップS44〜S49の処理が、点群データ記憶部12に保存されたN組の点群データのすべてについて終わっていなければ、再びステップS44に戻る。終わっていれば、ステップS51に移行する。
If it is determined in step S50 that the processes in steps S44 to S49 have not been completed for all the N sets of point cloud data stored in the point cloud
ステップS51で、平均化部45は、キャリブレーションパラメータ記憶部11に保存されたN個の仰角φk(k=1,…,N)を読み出し、その平均値φを算出し、これを最終的なレーザースキャナ1の光軸の仰角φとしてキャリブレーションパラメータ記憶部11に保存する。
In step S51, the averaging
以上の処理により、レーザースキャナ1の光軸の仰角φのキャリブレーションパラメータの算出を行うことができる。また、N回の測定の平均を行うことで、より誤差の少ないレーザースキャナ1の光軸の仰角φのキャリブレーションを行うことができる。
With the above processing, the calibration parameter of the elevation angle φ of the optical axis of the
本実施例では、レーザースキャナ1が三次元レーザスキャナである場合のキャリブレーション方法について説明する。本実施例のキャリブレーション方法で使用するキャリブレーション装置の機能的な構成は、図2と同様である。また、図23は、実施例7に係るレーザースキャナのキャリブレーション方法で使用するターゲットの外観斜視図である。本実施例で使用するキャリブレーション用のターゲットは、長方形の凸出した垂直平面ABCDを有する。この垂直平面ABCDの幅をr、高さをsとする。
In this embodiment, a calibration method when the
本実施例において、レーザースキャナ1は、三次元レーザースキャナである。三次元レーザースキャナとは、光軸の仰角を段階的に変えながら水平走査を行うことによって、三次元的な走査を行うレーザースキャナである。従って、レーザースキャナ1で得られる点群データは、二次元的に配列された点群であり各測点はPi,jと表される。ここで、iは水平方向(方位角方向)の走査の順番を表すインデックス、jは垂直方向(仰角方向)の走査の順番を表すインデックスである。実際にレーザースキャナ1から出力されるデータは、測点Pi,jの水平方向を表す方位角φi,j、測点Pi,jの垂直方向を表す仰角θi,j、及び計測原点Omから測点Piまでの距離(光軸の長さ)をli,jの組(φi,j,θi,j,li,j)である。尚、計測原点Omは、レーザースキャナから出力される光軸の原点である。
In this embodiment, the
点群データ記憶部12には、上述のような三次元レーザスキャナにより測定されたM×N個の測点の点群データ{Pi,j=(φi,j,θi,j,li,j)|i=1,…,M,j=1,…,N}が保存される。
The point cloud
まず、有効測点抽出部13は、前記点群データ{Pi,j}の中から、垂直平面ABCDの4隅の頂点A,B,C,Dに最も近い測点PA,PB,PC,PDを特定する。これらの測点PA,PB,PC,PDを「隅測点」と呼ぶ。さらに有効測点抽出部13は、隅測点PA,PB,PC,PDを頂点とする四角形で囲まれた領域内のm×n個の測点Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)(隅測点PA,PB,PC,PDを含む。)の相対座標{Pi,j=(φi,j,θi,j,li,j)|i=m0,…,m0+m−1,j=n0,…,n0+n−1}を抽出する。これらの抽出された測点Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)を「有効測点」という。
First, the effective
図24に隅測点PA,PB,PC,PDと抽出されたすべての有効測点Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)の例を示す。 In FIG. 24, the corner measurement points P A , P B , P C , P D and all the effective measurement points P i, j (i = m 0 ,..., M 0 + m−1, j = n 0 ,. , N 0 + n−1).
本実施例のキャリブレーション装置では、測地座標系は垂直平面ABCDの4隅の頂点A,B,C,Dを基準に設定される。頂点A,B,C,Dの測地座標を、それぞれ(0,0,0),(0,0,s),(r,0,s),(r,0,0)とする(図24参照)。頂点Aと隅測点PAとの間の距離をdA、頂点Bと隅測点PBとの間の距離をdB、頂点Cと隅測点PCとの間の距離をdC、頂点Dと隅測点PDとの間の距離をdDとする。また、隅測点PA,PB,PC,PD以外の各有効測点Pi,jから垂直平面ABCDまでの距離をdi,jとする。 In the calibration apparatus of the present embodiment, the geodetic coordinate system is set based on the vertices A, B, C, and D at the four corners of the vertical plane ABCD. The geodetic coordinates of the vertices A, B, C, and D are (0, 0, 0), (0, 0, s), (r, 0, s), and (r, 0, 0), respectively (FIG. 24). reference). Distance d A between the vertex A and the Sumihaka point P A, distance d B between the vertex B and Sumihaka point P B, the distance d C between vertices C and Sumihaka point P C , the distance between the vertex D and Sumihaka point P D and d D. Further, the distances from the effective measurement points P i, j other than the corner measurement points P A , P B , P C , P D to the vertical plane ABCD are defined as d i, j .
次に、座標決定手段14は、距離dA,dB,dC,dD及び各距離di,jの和又は自乗和が最小となるように、相対座標を測地座標へ関係づける関係パラメータを決定する。この座標決定手段14は、第1初期化部16、第2初期化部17、変換パラメータ算出部18、原点座標確定部19、及び注視点座標確定部20を備えている。
Next, the coordinate
次に、第1初期化部16は、測地座標系における隅測点PA,PB,PC,PDの位置座標の初期値を設定する。第2初期化部17は、隅測点PA,PB,PC,PDの位置座標の初期値及び各有効測点の相対座標に基づいて、隅測点PA,PB,PC,PD以外の各有効測点Pi,j及び計測原点Omの測地座標系における位置座標の初期値を算出する。 Next, the first initialization unit 16 sets initial values of the position coordinates of the corner measurement points P A , P B , P C , and P D in the geodetic coordinate system. The second initialization unit 17 is based on the initial values of the position coordinates of the corner measurement points P A , P B , P C , P D and the relative coordinates of each effective measurement point, and the corner measurement points P A , P B , P The initial value of the position coordinate in the geodetic coordinate system of each effective measurement point P i, j other than C 1 , P D and measurement origin O m is calculated.
次に、変換パラメータ算出部18は、計測原点Om及び隅測点PA,PB,PC,PDを含む各有効測点Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)の位置座標の初期値から開始して、評価関数の値が最小となるように、計測原点Om及び各有効測点Pi,jの回転及び平行移動を行う幾何変換の各変換パラメータを、反復法により算出する。このとき、評価関数として、距離dA,dB,dC,dD、及び各距離di,jの和又は自乗和が使用される。例えば、自乗和を評価関数に使用する場合には、幾何変換の回転量(オイラー角で表示する。)を(ω,δ,κ)、平行移動量を(Δx,Δy,Δz)として、評価関数f(ω,δ,κ,Δx,Δy,Δz)は次式(40)のように表される。
Next, the conversion
次に、原点座標確定部19は、変換パラメータ算出部18により算出された各変換パラメータ(ω,δ,κ,Δx,Δy,Δz)によって、計測原点Omの位置座標の初期値を幾何変換し、計測原点Omの測地座標系における位置座標を算出する。
Next, the origin coordinate
最後に、注視点座標確定部20は、注視点Gの相対座標を点群データ{P i,j}から抽出し、該注視点Gの相対座標と計測原点Omの測地座標系における位置座標とに基づいて、注視点Gの測地座標系における位置座標を算出する。ここで、注視点Gは、三次元レーザスキャナの場合には、走査範囲(方位角方向の走査範囲及び仰角方向の走査範囲)の中心方向の光軸上の測点である。
Finally, the gazing point coordinate
以上の計算処理によって、三次元レーザスキャナの測地座標系における位置と方向が定められる。 Through the above calculation process, the position and direction of the three-dimensional laser scanner in the geodetic coordinate system are determined.
1 レーザースキャナ
2 台車
3 コンピュータ
9 通信インタフェース
10 キャリブレーション装置
11 キャリブレーションパラメータ記憶部
12 点群データ記憶部
13 有効測点抽出部
14 座標決定部
16 第1初期化部
17 第2初期化部
18 変換パラメータ算出部
19 原点座標確定部
20 注視点座標確定部
T1 ターゲット
S1 垂直平面
E1E2 走査線
Om 計測原点
Slocus 光軸の軌跡面
θ 走査角
G 注視点
25 幅算出部
26 水平幅補正部
27 高さ算出部
30 幅算出部
31 高さ算出部
32 仰角算出部
41 有効測点抽出部
42 走査線算出部
43 走査線間距離算出部
44 仰角算出部
45 平均化部
DESCRIPTION OF
Claims (22)
前記点群データの中から、前記垂直平面の左右両側の端部の測点(以下「端測点」という。)A,Bを特定し、前記端測点A,Bを含む前記端測点A,B間のm個の測点(以下「有効測点」という。)Pi(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出手段と、
前記レーザースキャナの光軸の軌跡が前記垂直平面を切る線である走査線E1E2を基準に測地座標系を設定し、前記走査線E1E2の一方の端点E1から前記端測点Aまでの距離dA、前記走査線E1E2の他方の端点E2から前記端測点Bまでの距離dB、及び前記端測点A,B以外の前記各有効測点Pi(i=n+1,…,n+m−2)から前記走査線E1E2までの距離diの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定手段と、
を備えたことを特徴とするレーザースキャナのキャリブレーション装置。 The measurement origins for M (M is an integer) measurement points obtained by horizontally scanning a target having a vertical plane whose left and right sides are parallel and vertical with a laser scanner from the measurement origin O m in front of the vertical plane. a point group data memory means for storing point group data composed of relative coordinates relative to the O m,
The end points including the end points A and B are identified from the point cloud data by specifying end points (hereinafter referred to as “end points”) A and B on the left and right sides of the vertical plane. Effective station extraction means for extracting relative coordinates of m stations between A and B (hereinafter referred to as “effective stations”) P i (i = n,..., N + m−1);
A geodetic coordinate system is set with reference to a scanning line E 1 E 2 in which the locus of the optical axis of the laser scanner cuts the vertical plane, and the end measurement is performed from one end point E 1 of the scanning line E 1 E 2. the distance d a to the point a, the distance d B from the other end point E 2 of the scanning lines E 1 E 2 to the end stations B, and the end stations a, wherein each active stations P i other than B A relation parameter that relates the relative coordinate to the geodetic coordinate is determined so that the sum or square sum of the distances d i from (i = n + 1,..., N + m−2) to the scanning line E 1 E 2 is minimized. Coordinate determining means for
A laser scanner calibration apparatus comprising:
前記端測点A,Bが前記走査線E1E2上に位置し、かつ端点E1から端測点Aまでの距離と端点E2から端測点Bまでの距離とが等しくなるように、前記測地座標系における前記端測点A,Bの位置座標の初期値を算出する第1の初期化手段と、
前記端測点A,Bの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記端測点A,B以外の前記各有効測点Pi(i=n+1,…,n+m−2)及び前記計測原点Omの前記測地座標系における位置座標の初期値を算出する第2の初期化手段と、
前記距離dA、前記距離dB、及び前記距離di(i=n+1,…,n+m−2)の和又は自乗和を評価関数として、前記計測原点Om及び前記端測点A,Bを含む前記各有効測点Pi(i=n,…,n+m−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点Om及び前記各有効測点Piの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する変換パラメータ算出手段と、
算出された前記各変換パラメータにより前記計測原点Omの位置座標の初期値をヘルマート変換し、前記計測原点Omの前記測地座標系における位置座標を算出する原点座標確定手段と、
所定の角度範囲を回転走査する前記レーザースキャナの走査開始方向と走査終了方向の2つの方向間の走査角の二等分角方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Omの前記測地座標系における位置座標とに基づいて、前記注視点Gの前記測地座標系における位置座標を算出する注視点座標確定手段と、
を備えていることを特徴とする請求項1記載のレーザースキャナのキャリブレーション装置。 The coordinate determining means includes
The end points A and B are located on the scanning line E 1 E 2 , and the distance from the end point E 1 to the end point A is equal to the distance from the end point E 2 to the end point B. First initialization means for calculating initial values of the position coordinates of the end stations A and B in the geodetic coordinate system;
Based on the initial values of the position coordinates of the end stations A and B and the relative coordinates of the effective stations, the effective stations P i (i = n + 1,..., N + m−) other than the end stations A and B are used. a second initialization means for calculating the initial value of the position coordinates in 2) and the geodetic coordinate system of the measurement origin O m,
Using the sum or square sum of the distance d A , the distance d B , and the distance d i (i = n + 1,..., N + m−2) as an evaluation function, the measurement origin O m and the end measurement points A and B are Starting from the initial value of the position coordinates of each of the effective measurement points P i (i = n,..., N + m−1) including the measurement origin O m and each of the evaluation functions so that the value of the evaluation function is minimized. Conversion parameter calculation means for calculating each conversion parameter of Helmert conversion that performs rotation and translation of the effective measuring point P i by an iterative method;
Origin coordinate determining means for performing a Helmart transform on the initial value of the position coordinate of the measurement origin O m using the calculated conversion parameters, and calculating the position coordinate of the measurement origin O m in the geodetic coordinate system;
The relative coordinates of the gazing point G, which is a measurement point on the optical axis in the bisecting direction of the scanning angle between the two directions of the scanning start direction and the scanning end direction of the laser scanner that rotationally scans a predetermined angle range, are described above. extracted from the point cloud data, on the basis of the position coordinates in the geodetic coordinate system and the relative coordinates of the noted viewpoints G the measurement origin O m, gazing point for calculating the position coordinates in the geodetic coordinate system of the gaze point G Coordinate determination means;
The laser scanner calibration apparatus according to claim 1, further comprising:
前記有効測点抽出手段は、前記各垂直平面に対して、両端の端測点Aj,Bj(jは前記各垂直平面を区別する添字)を特定し、前記各有効測点Pj,iの相対座標を抽出するものであり、
前記座標決定手段は、前記レーザースキャナの光軸が前記各垂直平面を切る線である走査線Ep,1Ep,2を基準に測地座標系を設定し、前記各垂直平面における、前記走査線Ej,1Ej,2の一方の端点Ej,1から前記端測点Ajまでの距離dj,A、前記走査線Ej,1Ej,2の他方の端点Ej,2から前記端測点Bjまでの距離dj,B、及び前記両端測点Aj,Bj以外の前記各有効測点Pj,i(i=nj+1,…,nj+mj−2)から前記走査線Ej,1Ej,2までの距離dj,iの和又は自乗和を、すべての前記垂直平面について足し合わせた量が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定するものであることを特徴とする請求項1記載のレーザースキャナのキャリブレーション装置。 It said point group data memory means, right and left side edges has a plurality of parallel and perpendicular vertical plane, each vertical plane are parallel to each other target, horizontally by the laser scanner from the front of the measurement origin O m of the respective vertical plane Storing point cloud data composed of relative coordinates based on the measurement origin O m with respect to M (M is an integer greater than 2) measurement points obtained by scanning;
The effective station extraction means specifies end stations A j and B j (j is a subscript for distinguishing each vertical plane) for each vertical plane, and each effective station P j, extract the relative coordinates of i ,
The coordinate determination means sets a geodetic coordinate system based on scanning lines E p, 1 E p, 2 in which the optical axis of the laser scanner cuts the vertical planes, and the scanning in the vertical planes line E j, 1 E j, the distance 2 of one end point E j, from 1 to the end stations a j d j, a, the scan lines E j, 1 E j, 2 of the other end point E j, distance from 2 to the end stations B j d j, B, and said end stations a j, wherein each active stations P j other than B j, i (i = n j + 1, ..., n j + m j −2) to the scanning lines E j, 1 E j, 2 , the relative coordinates are set so that the sum of the distances d j, i or sums of squares of all the vertical planes is minimized. The laser parameter according to claim 1, wherein a relation parameter related to the geodetic coordinates is determined. Canner calibration device.
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CL間の水平幅rL及び前記端測点B,CR間の水平幅rRを算出する幅算出手段と、
高さzにおける前記左垂直平面の水平幅をfL(z)、前記右垂直平面の水平幅をfR(z)、fL(z),fR(z)の逆関数をそれぞれfL −1(x),fR −1(x)としたとき、前記レーザースキャナの計測原点Omの高さHを、高さfL −1(r’L)又は高さfR −1(r’R)の何れか若しくは高さfL −1(rL)と高さfR −1(rR)の平均値として算出する高さ算出手段と、
を備えたことを特徴とするレーザースキャナのキャリブレーション装置。 A left vertical plane that is a straight line or a curved line whose left side is vertical and whose right side is inclined; and a straight line or a curved line whose right side is vertical and whose left side is parallel to the right side of the left vertical plane. A right vertical plane, and the left vertical plane and the right vertical plane are parallel and coplanar, and the right side of the left vertical plane and the left side of the right vertical plane have a certain horizontal width. Measurement origins of M (M is an integer greater than 2) measurement points obtained by scanning a separated target with a laser scanner from measurement origins O m in front of the left vertical plane and the right vertical plane Point cloud data storage means for storing point cloud data composed of relative coordinates based on O m ;
From the point cloud data, the left end point (hereinafter referred to as “end point”) A and right end point C L of the left vertical plane, and the right end point of the right vertical plane are measured. identify the point B and the left end measuring point C R, the end stations a, horizontal width between C L r L and the end stations B, a width calculation means for calculating the horizontal width r R between C R ,
The horizontal width of the left vertical plane at height z is f L (z), the horizontal width of the right vertical plane is f R (z), and the inverse functions of f L (z) and f R (z) are f L , respectively. −1 (x), f R −1 (x), the height H of the measurement origin O m of the laser scanner is set to a height f L −1 (r ′ L ) or a height f R −1 ( any one of r ′ R ) or a height calculating means for calculating an average value of the height f L −1 (r L ) and the height f R −1 (r R );
A laser scanner calibration apparatus comprising:
前記高さ算出手段は、前記レーザースキャナの計測原点Omの高さHを、高さfL −1(r’L)又は高さfR −1(r’R)の何れか若しくは高さfL −1(r’L)と高さfR −1(r’R)の平均値として算出することを特徴とする請求項4記載のレーザースキャナのキャリブレーション装置。
The height calculation means, the height H of the measurement origin O m of the laser scanner, one or heights of f L -1 (r 'L) or the height f R -1 (r' R) The laser scanner calibration apparatus according to claim 4, wherein the calibration value is calculated as an average value of f L −1 (r ′ L ) and height f R −1 (r ′ R ).
前記幅算出手段は、N組の前記点群データについて、それぞれ前記端測点A,CL間の水平幅及び前記端測点B,CR間の水平幅を算出するとともに、前記各点群データについての前記端測点A,CL間の水平幅の平均値を前記水平幅rL、前記各点群データについての前記端測点B,CR間の水平幅の平均値を前記水平幅rRとして算出するものであることを特徴とする請求項4又は5記載のレーザースキャナのキャリブレーション装置。 The point group data storage means includes N sets of point group data measured from N measurement origins at N positions in front of the left vertical plane and the right vertical plane and having the same height and different positions on the horizontal plane. Is memorized,
Said width calculating means, for N sets of the point group data, each of the end stations A, horizontal width between C L and the end stations B, calculates a horizontal width between C R, wherein each point group said end stations a for data, C the average value of the horizontal width between L horizontal width r L, the said end stations B for each point cloud data, the average value of the horizontal width horizontal between C R calibration apparatus of a laser scanner according to claim 4 or 5, wherein the and calculates the width r R.
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CL間の水平幅rL及び前記端測点B,CR間の水平幅rRを算出する幅算出手段と、
前記関数fL(z),fR(z)の逆関数をそれぞれfL −1(x),fR −1(x)としたとき、前記左垂直平面における走査線の高さhLをfL −1(rL)、前記右垂直平面における走査線の高さhRをfL −1(rR)として算出する高さ算出手段と、
前記高さhL、前記高さhR、及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(2)により算出する仰角算出手段と、
を備えたことを特徴とするレーザースキャナのキャリブレーション装置。
From the point cloud data, the left end point (hereinafter referred to as “end point”) A and right end point C L of the left vertical plane, and the right end point of the right vertical plane are measured. identify the point B and the left end measuring point C R, the end stations a, horizontal width between C L r L and the end stations B, a width calculation means for calculating the horizontal width r R between C R ,
When the inverse functions of the functions f L (z) and f R (z) are f L −1 (x) and f R −1 (x), respectively, the height h L of the scanning line in the left vertical plane is f L −1 (r L ), a height calculating means for calculating the height h R of the scanning line in the right vertical plane as f L −1 (r R );
An elevation angle calculating means for calculating an elevation angle θ of the optical axis of the racer scanner based on the height h L , the height h R , and the distance d, using Equation (2);
A laser scanner calibration apparatus comprising:
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CLを含む前記端測点A,CL間のmL個の測点(以下「左有効測点」という。)Pi(i=nL,…,nL+mL−1)の相対座標、及び前記端測点B,CRを含む前記端測点B,CR間のmR個の測点(以下「右有効測点」という。)Pi(i=nR,…,nR+mR−1)の相対座標を抽出する有効測点抽出手段と、
前記各左有効測点及び前記各右有効測点の相対座標に基づき、互いに平行な2つの走査線LL及びLRの傾き及び切片を、前記走査線LLから前記各左有効測点Pi(i=nL,…,nL+mL−1)までの距離の和に、前記走査線LRから前記各右有効測点Pi(i=nR,…,nR+mR−1)までの距離の和を加えた値が最小となるように、最小自乗法により算出する走査線算出手段と、
前記走査線LLから前記走査線LRまでの距離d’を算出する走査線間距離算出手段と、
前記距離d’及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(3)により算出する仰角算出手段と、
を備えたことを特徴とするレーザースキャナのキャリブレーション装置。
From the point cloud data, the left end point (hereinafter referred to as “end point”) A and right end point C L of the left vertical plane, and the right end point of the right vertical plane are measured. identify the point B and the left end measuring point C R, the end stations a, the end stations a containing C L, m L-number of stations between C L (hereinafter referred to as "left effective stations". ) P i (i = n L , ..., n L + m L -1) of relative coordinates, and said end stations B, said end stations B, m R-number of stations between C R containing C R ( Hereinafter referred to as “right effective station”.) Effective station extracting means for extracting relative coordinates of P i (i = n R ,..., N R + m R −1);
Based on said relative coordinates of each left effective stations and the respective right enabled stations, two parallel slope and intercept of the scanning line L L and L R together from said scanning line L L each left enabled stations P i (i = n L, ... , n L + m L -1) to the sum of the distance to, from said scanning line L R each right effective measurement point P i (i = n R, ..., n R + m R - Scanning line calculation means for calculating by a least square method so that the sum of the distances up to 1) is minimized;
A scan line distance calculation means for calculating a distance d 'from the scanning line L L to the scanning line L R,
Elevation angle calculating means for calculating the elevation angle θ of the optical axis of the racer scanner based on the distance d ′ and the distance d by the equation (3);
A laser scanner calibration apparatus comprising:
前記有効測点抽出手段は、前記各点群データに対してそれぞれ前記左有効測点の相対座標及び前記右有効測点の相対座標を抽出し、
前記走査線算出手段は、前記各点群データに対してそれぞれ前記走査線LL及び前記走査線LRの傾き及び切片を算出し、
前記走査線間距離算出手段は、前記各点群データに対してそれぞれ前記走査線LLから前記走査線LRまでの距離d’を算出し、
前記仰角算出手段は、前記各点群データに対してそれぞれレーサースキャナの光軸の前記仰角θを算出するものであり、
前記仰角算出手段が算出する前記仰角θの平均値を、レーサースキャナの光軸の仰角として出力する平均化手段を備えたことを特徴とする請求項8記載のレーザースキャナのキャリブレーション装置。 The point group data storage means includes N sets of point group data measured from N measurement origins at N positions in front of the left vertical plane and the right vertical plane and having the same height and different positions on the horizontal plane. Is memorized,
The effective point extraction means extracts the relative coordinates of the left effective point and the right effective point for each point cloud data,
The scanning line calculation means calculates the slope and intercept of each of the scanning line L L and the scanning line L R wherein for each point cloud data,
The scanning line distance calculation means calculates a distance d 'of the from each of the scanning line L L for each point cloud data to the scanning line L R,
The elevation angle calculating means calculates the elevation angle θ of the optical axis of the racer scanner for each point cloud data,
9. The laser scanner calibration apparatus according to claim 8, further comprising: averaging means for outputting an average value of the elevation angle θ calculated by the elevation angle calculation means as an elevation angle of the optical axis of the racer scanner.
前記点群データの中から、前記垂直平面ABCDの4隅の頂点A,B,C,Dに最も近い測点(以下「隅測点」という。)PA,PB,PC,PDを特定し、前記隅測点PA,PB,PC,PDを含む、前記隅測点PA,PB,PC,PDを頂点とする四角形で囲まれた領域内のm×n個の測点(以下「有効測点」という。)Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)の相対座標を抽出する有効測点抽出手段と、
前記垂直平面ABCDの4隅の頂点A,B,C,Dを基準に測地座標系を設定し、前記頂点Aと前記隅測点PAとの間の距離dA、前記頂点Bと前記隅測点PBとの間の距離dB、前記頂点Cと前記隅測点PCとの間の距離dC、前記頂点Dと前記隅測点PDとの間の距離dD、及び前記隅測点PA,PB,PC,PD以外の前記各有効測点Pi,jから前記垂直平面ABCDまでの距離di,jの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定手段と、
を備えたことを特徴とするレーザースキャナのキャリブレーション装置。 M × N (M and N are integers) measurements obtained by three-dimensionally scanning a target having a rectangular protruding vertical plane ABCD with a laser scanner from the measurement origin O m in front of the vertical plane. Point cloud data storage means for storing point cloud data composed of relative coordinates with respect to the measurement origin O m as a reference;
Of the point cloud data, the stations closest to the vertices A, B, C, D at the four corners of the vertical plane ABCD (hereinafter referred to as “corner stations”) P A , P B , P C , P D And m in a region surrounded by a rectangle including the corner measuring points P A , P B , P C , and P D including the corner measuring points P A , P B , P C , and P D. Relative coordinates of n stations (hereinafter referred to as “effective stations”) P i, j (i = m 0 ,..., M 0 + m−1, j = n 0 ,..., N 0 + n−1) Effective station extraction means for extracting
4 corners of the vertex A of the vertical plane ABCD, B, C, and set standards geodetic coordinate system D, the distance d A between the vertex A and the corner measurement point P A, the said vertex B corner measurement point P B and the distance d B between the distance d C between the apex C and the corner measurement point P C, the distance d D between the vertex D and the corner measurement point P D, and the The sum or the square sum of the distances d i, j from each of the effective measurement points P i, j other than the corner measurement points P A , P B , P C , P D to the vertical plane ABCD is minimized. Coordinate determining means for determining a relationship parameter relating a relative coordinate to the geodetic coordinate;
A laser scanner calibration apparatus comprising:
前記隅測点PA,PB,PC,PDの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記隅測点PA,PB,PC,PD以外の前記各有効測点Pi,j(及び前記計測原点Omの前記測地座標系における位置座標の初期値を算出する第2の初期化手段と、
前記距離dA,dB,dC,dD、及び前記各距離di,jの和又は自乗和を評価関数として、前記計測原点Om及び前記隅測点PA,PB,PC,PDを含む前記各有効測点Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点Om及び前記各有効測点Pi,jの回転及び平行移動を行う幾何変換の各変換パラメータを、反復法により算出する変換パラメータ算出手段と、
算出された前記各変換パラメータにより前記計測原点Omの位置座標の初期値をヘルマート変換し、前記計測原点Omの前記測地座標系における位置座標を算出する原点座標確定手段と、
所定の方位角範囲及び仰角範囲を回転走査する前記レーザースキャナの走査範囲の中心方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Omの前記測地座標系における位置座標とに基づいて、前記注視点Gの前記測地座標系における位置座標を算出する注視点座標確定手段と、
を備えていることを特徴とする請求項10記載のレーザースキャナのキャリブレーション装置。 It said coordinate determining means, wherein in the geodetic coordinate system corner measurement point P A, P B, P C , a first initialization means for setting an initial value of the position coordinates of P D,
The corner measurement point P A, P B, on the basis of the P C, the initial value and the relative coordinates of each active stations coordinates of P D, the corner measurement point P A, P B, P C , other than P D A second initializing means for calculating an initial value of a position coordinate in the geodetic coordinate system of each effective measurement point P i, j (and the measurement origin O m ;
The distance d A, d B, d C , d D, and the respective distances d i, as the evaluation function the sum or square sum of j, the measurement origin O m and the corner measurement point P A, P B, P C , each valid stations including P D P i, j (i = m 0, ..., m 0 + m-1, j = n 0, ..., n 0 + n-1) starting from an initial value of the position coordinates of the Thus, transformation parameters for calculating the transformation parameters for geometric transformation for rotating and translating the measurement origin O m and the effective measurement points P i, j so that the value of the evaluation function is minimized Parameter calculation means;
Origin coordinate determining means for performing a Helmart transform on the initial value of the position coordinate of the measurement origin O m using the calculated conversion parameters, and calculating the position coordinate of the measurement origin O m in the geodetic coordinate system;
Relative coordinates of the gazing point G, which is a measuring point on the optical axis in the central direction of the scanning range of the laser scanner that rotates and scans a predetermined azimuth angle range and elevation angle range, are extracted from the point cloud data, and based on the position coordinates in the relative coordinates and the geodetic coordinate system of the measurement origin O m, and gazing point coordinate defining means for calculating the position coordinates in the geodetic coordinate system of the gaze point G,
The laser scanner calibration apparatus according to claim 10, further comprising:
左右両側辺が平行かつ垂直な垂直平面を有するターゲットを、前記垂直平面の前方の計測原点Omからレーザースキャナにより水平走査し、M個(Mは整数)の測点に対する前記計測原点Omを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記垂直平面の左右両側の端部の測点(以下「端測点」という。)A,Bを特定し、前記端測点A,Bを含む前記端測点A,B間のm個の測点(以下「有効測点」という。)Pi(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出ステップと、
前記レーザースキャナの光軸の軌跡が前記垂直平面を切る線である走査線E1E2を基準に測地座標系を設定し、前記走査線E1E2の一方の端点E1から前記端測点Aまでの距離dA、前記走査線E1E2の他方の端点E2から前記端測点Bまでの距離dB、及び前記端測点A,B以外の前記各有効測点Pi(i=n+1,…,n+m−2)から前記走査線E1E2までの距離diの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定ステップと、
を実行することを特徴とするレーザースキャナのキャリブレーション方法。 A calibration method for calibrating a laser scanner by a computer,
The target to which the left and right sides sides with parallel and perpendicular vertical plane, the horizontal scanning by the laser scanner from the front of the measurement origin O m of the vertical plane, the measurement origin O m for measuring points of M (M is an integer) A scanning step of capturing point cloud data consisting of relative coordinates as a reference into a computer and storing it in a storage device;
From the point cloud data stored in the storage device, the measurement points A and B (hereinafter referred to as “edge measurement points”) A and B on both the left and right sides of the vertical plane are specified. Effective station extraction for extracting the relative coordinates of m stations (hereinafter referred to as “effective stations”) P i (i = n,..., N + m−1) between the end stations A and B including B Steps,
A geodetic coordinate system is set with reference to a scanning line E 1 E 2 in which the locus of the optical axis of the laser scanner cuts the vertical plane, and the end measurement is performed from one end point E 1 of the scanning line E 1 E 2. the distance d a to the point a, the distance d B from the other end point E 2 of the scanning lines E 1 E 2 to the end stations B, and the end stations a, wherein each active stations P i other than B A relation parameter that relates the relative coordinate to the geodetic coordinate is determined so that the sum or square sum of the distances d i from (i = n + 1,..., N + m−2) to the scanning line E 1 E 2 is minimized. A coordinate determination step to perform,
A method for calibrating a laser scanner, comprising:
前記端測点A,Bが前記走査線E1E2上に位置し、かつ端点E1から前記端測点Aまでの距離と端点E2から前記端測点Bまでの距離とが等しくなるように、前記測地座標系における前記端測点A,Bの位置座標の初期値を算出する第1の初期化ステップと、
前記端測点A,Bの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記端測点A,B以外の前記各有効測点Pi(i=n+1,…,n+m−2)及び前記計測原点Omの前記測地座標系における位置座標の初期値を算出する第2の初期化ステップと、
前記距離dA、前記距離dB、及び前記距離di(i=n+1,…,n+m−2)の和又は自乗和を評価関数として、前記計測原点Om及び前記端測点A,Bを含む前記各有効測点Pi(i=n,…,n+m−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点Om及び前記各有効測点Piの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する変換パラメータ算出ステップと、
算出された前記各変換パラメータにより前記計測原点Omの位置座標の初期値をヘルマート変換し、前記計測原点Omの前記測地座標系における位置座標を算出する原点座標確定ステップと、
所定の角度範囲を回転走査する前記レーザースキャナの走査開始方向と走査終了方向の2つの方向間の走査角の二等分角方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Omの前記測地座標系における位置座標とに基づいて、前記注視点Gの前記測地座標系における位置座標を算出する注視点座標確定ステップと、
を実行することを特徴とする請求項12記載のレーザースキャナのキャリブレーション方法。 In the coordinate determination step,
The end measuring points A and B are located on the scanning line E 1 E 2 , and the distance from the end point E 1 to the end measuring point A is equal to the distance from the end point E 2 to the end measuring point B. A first initialization step of calculating initial values of the position coordinates of the end stations A and B in the geodetic coordinate system,
Said end stations A, based on the initial value and the respective effective stations of relative coordinates of the position coordinates of B, said end stations A, the non-B each active stations P i (i = n + 1 , ..., n + m- a second initialization step of calculating the initial value of the position coordinates in 2) and the geodetic coordinate system of the measurement origin O m,
Using the sum or square sum of the distance d A , the distance d B , and the distance d i (i = n + 1,..., N + m−2) as an evaluation function, the measurement origin O m and the end measurement points A and B are Starting from the initial value of the position coordinates of each of the effective measurement points P i (i = n,..., N + m−1) including the measurement origin O m and each of the evaluation functions so that the value of the evaluation function is minimized. each transformation parameters Helmert transformation for rotating and translation of the active stations P i, a conversion parameter calculating step of calculating iteratively,
An origin coordinate determination step of performing Helmart transform on the initial value of the position coordinate of the measurement origin O m by the calculated conversion parameters and calculating the position coordinate of the measurement origin O m in the geodetic coordinate system;
The relative coordinates of the gazing point G, which is a measurement point on the optical axis in the bisecting direction of the scanning angle between the two directions of the scanning start direction and the scanning end direction of the laser scanner that rotationally scans a predetermined angle range, are described above. extracted from the point cloud data, on the basis of the position coordinates in the geodetic coordinate system and the relative coordinates of the noted viewpoints G the measurement origin O m, gazing point for calculating the position coordinates in the geodetic coordinate system of the gaze point G Coordinate confirmation step;
The laser scanner calibration method according to claim 12, wherein:
前記有効測点抽出ステップにおいては、前記各垂直平面に対して、両端の端測点Aj,Bj(jは前記各垂直平面を区別する添字)を特定し、前記各有効測点Pj,iの相対座標を抽出し、
前記座標決定ステップにおいては、前記レーザースキャナの光軸が前記各垂直平面を切る線である走査線Ep,1Ep,2を基準に測地座標系を設定し、前記各垂直平面における、前記走査線Ej,1Ej,2の一方の端点Ej,1から前記端測点Ajまでの距離dj,A、前記走査線Ej,1Ej,2の他方の端点Ej,2から前記端測点Bjまでの距離dj,B、及び前記両端測点Aj,Bj以外の前記各有効測点Pj,i(i=nj+1,…,nj+mj−2)から前記走査線Ej,1Ej,2までの距離dj,iの和又は自乗和を、すべての前記垂直平面について足し合わせた量が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定することを特徴とする請求項12記載のレーザースキャナのキャリブレーション方法。 In the scanning step, a plurality of the left and right both sides parallel and perpendicular vertical plane, the target each vertical plane are parallel to each other, and the horizontal scanning by the laser scanner from the front of the measurement origin O m of the respective vertical plane Point cloud data consisting of relative coordinates based on the measurement origin O m for M (M is an integer greater than 2) measurement points obtained in a computer and stored in a storage device;
In the effective station extraction step, end stations A j and B j (j is a subscript for distinguishing each vertical plane) are specified for each vertical plane, and each effective station P j is specified. , I to extract the relative coordinates,
In the coordinate determination step, a geodetic coordinate system is set with reference to scanning lines E p, 1 E p, 2 in which the optical axis of the laser scanner cuts the vertical planes. scan line E j, 1 E j, 2 for one end point E j, 1 from the distance d j to the end stations a j, a, the scan lines E j, 1 E j, 2 of the other end point E j , the distance from 2 to the end stations B j d j, B, and said end stations a j, B j other than the respective effective stations P j, i (i = n j + 1, ..., n j + m j- 2) to the scanning lines E j, 1 E j, 2 , the relative coordinates such that the sum of the distances d j, i or sums of squares of all the vertical planes is minimized. 13. A laser as claimed in claim 12, characterized in that a relational parameter relating the position to the geodetic coordinates is determined. -How to calibrate the scanner.
左側辺が垂直な直線で且つ右側辺が傾斜した直線又は曲線である左垂直平面と、右側辺が垂直な直線で且つ左側辺が前記左垂直平面の右側辺と平行な傾斜直線又は傾斜曲線である右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つ同一平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Omからレーザースキャナにより走査して、M個(Mは2より大きい整数)の測点の計測原点Omを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CL間の水平幅rL及び前記端測点B,CR間の水平幅rRを算出する幅算出ステップと、
高さzにおける前記左垂直平面の水平幅をfL(z)、前記右垂直平面の水平幅をfR(z)、fL(z),fR(z)の逆関数をそれぞれfL −1(x),fR −1(x)としたとき、前記レーザースキャナの計測原点Omの高さHを、高さfL −1(r’L)又は高さfR −1(r’R)の何れか若しくは高さfL −1(rL)と高さfR −1(rR)の平均値として算出する高さ算出ステップと、
を実行することを特徴とするレーザースキャナのキャリブレーション方法。 A calibration method for calibrating a laser scanner by a computer,
A left vertical plane that is a straight line or a curved line whose left side is vertical and whose right side is inclined; and a straight line or a curved line whose right side is vertical and whose left side is parallel to the right side of the left vertical plane. A right vertical plane, and the left vertical plane and the right vertical plane are parallel and coplanar, and the right side of the left vertical plane and the left side of the right vertical plane have a certain horizontal width. the spaced apart from being a target, the scanning by the left vertical plane and in front of the measurement origin O m from the laser scanner of the right vertical plane, of the measuring points of M (M is an integer greater than 2) the measurement origin O m A scanning step of capturing point cloud data consisting of relative coordinates as a reference into a computer and storing it in a storage device;
Among the point cloud data stored in the storage device, the left end point (hereinafter referred to as “end point”) A and the right end point C L of the left vertical plane, and the right identify right end measuring point B and the left end measuring point C R of the vertical plane, the end stations a, C horizontal width between L r L and the end stations B, horizontal width between C R r R A width calculating step for calculating
The horizontal width of the left vertical plane at height z is f L (z), the horizontal width of the right vertical plane is f R (z), and the inverse functions of f L (z) and f R (z) are f L , respectively. −1 (x), f R −1 (x), the height H of the measurement origin O m of the laser scanner is set to a height f L −1 (r ′ L ) or a height f R −1 ( any one of r ′ R ) or a height calculating step for calculating as an average value of the height f L −1 (r L ) and the height f R −1 (r R );
A method for calibrating a laser scanner, comprising:
前記高さ算出ステップにおいては、前記レーザースキャナの計測原点Omの高さHを、高さfL −1(r’L)又は高さfR −1(r’R)の何れか若しくは高さfL −1(r’L)と高さfR −1(r’R)の平均値として算出することを特徴とする請求項15記載のレーザースキャナのキャリブレーション方法。
Wherein the height calculation step, the height H of the measurement origin O m of the laser scanner, one or height of the height f L -1 (r 'L) or the height f R -1 (r' R) The laser scanner calibration method according to claim 15, wherein the laser scanner is calculated as an average value of the height f L −1 (r ′ L ) and the height f R −1 (r ′ R ).
前記幅算出ステップにおいては、前記記憶装置に保存されたN組の前記点群データについて、それぞれ前記端測点A,CL間の水平幅及び前記端測点B,CR間の水平幅を算出するとともに、前記各点群データについての前記端測点A,CL間の水平幅の平均値を前記水平幅rL、前記各点群データについての前記端測点B,CR間の水平幅の平均値を前記水平幅rRとして算出することを特徴とする請求項15又は16記載のレーザースキャナのキャリブレーション方法。 In the scanning step, horizontal scanning is performed by a laser scanner from N measurement origins at N positions which are in front of the left vertical plane and the right vertical plane and have the same height and different positions on the horizontal plane, The point cloud data is captured in a computer and stored in a storage device,
In the width calculation step, the N sets of the point group data stored in the storage device, each said end stations A, horizontal width between C L and the end stations B, and horizontal width between C R to calculate, the said end stations a for each point group data, C L between the average value of the horizontal width of the horizontal width r L, the said end stations B for each point cloud data, between C R calibration method for laser scanner according to claim 15 or 16, wherein calculating an average value of the horizontal width as the horizontal width r R.
水平幅が高さzの単調関数fL(z)に従って変化する左垂直平面と、水平幅が高さzの単調関数fR(z)に従って変化する右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Omからレーザースキャナにより走査し、M個(Mは整数)の測点の計測原点Omを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CL間の水平幅rL及び前記端測点B,CR間の水平幅rRを算出する幅算出ステップと、
前記関数fL(z),fR(z)の逆関数をそれぞれfL −1(x),fR −1(x)としたとき、前記左垂直平面における走査線の高さhLをfL −1(rL)、前記右垂直平面における走査線の高さhRをfL −1(rR)として算出する高さ算出ステップと、
前記高さhL、前記高さhR、及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(5)により算出する仰角算出ステップと、
を実行することを特徴とするレーザースキャナのキャリブレーション方法。
A left vertical plane whose horizontal width changes according to a monotonic function f L (z) having a height z, and a right vertical plane whose horizontal width changes according to a monotone function f R (z) whose height is z; The plane and the right vertical plane are parallel to each other and are separated from each other by a certain distance d, and the right side of the left vertical plane and the left side of the right vertical plane are separated by a certain horizontal width. The target is scanned with a laser scanner from the measurement origin O m in front of the left vertical plane and the right vertical plane, and the target is composed of relative coordinates based on the measurement origins O m of M (M is an integer) measurement points. A scanning step of capturing group data into a computer and storing it in a storage device;
Among the point cloud data stored in the storage device, the left end point (hereinafter referred to as “end point”) A and the right end point C L of the left vertical plane, and the right identify right end measuring point B and the left end measuring point C R of the vertical plane, the end stations a, C horizontal width between L r L and the end stations B, horizontal width between C R r R A width calculating step for calculating
When the inverse functions of the functions f L (z) and f R (z) are f L −1 (x) and f R −1 (x), respectively, the height h L of the scanning line in the left vertical plane is f L −1 (r L ), a height calculating step for calculating the height h R of the scanning line in the right vertical plane as f L −1 (r R );
An elevation angle calculating step for calculating an elevation angle θ of the optical axis of the racer scanner based on the height h L , the height h R , and the distance d, according to Equation (5);
A method for calibrating a laser scanner, comprising:
左側辺及び右側辺が垂直且つ平行な左垂直平面と、左側辺及び右側辺が垂直且つ平行な右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Omからレーザースキャナにより走査し、M個(Mは整数)の測点の計測原点Omを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点CL、並びに前記右垂直平面の右側の端測点B及び左側の端測点CRを特定し、前記端測点A,CLを含む前記端測点A,CL間のmL個の測点(以下「左有効測点」という。)Pi(i=nL,…,nL+mL−1)の相対座標、及び前記端測点B,CRを含む前記端測点B,CR間のmR個の測点(以下「右有効測点」という。)Pi(i=nR,…,nR+mR−1)の相対座標を抽出する有効測点抽出ステップと、
前記各左有効測点及び前記各右有効測点の相対座標に基づき、互いに平行な2つの走査線LL及びLRの傾き及び切片を、前記走査線LLから前記各左有効測点Pi(i=nL,…,nL+mL−1)までの距離の和に、前記走査線LRから前記各右有効測点Pi(i=nR,…,nR+mR−1)までの距離の和を加えた値が最小となるように、最小自乗法により算出する走査線算出ステップと、
前記走査線LLから前記走査線LRまでの距離d’を算出する走査線間距離算出ステップと、
前記距離d’及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(6)により算出する仰角算出ステップと、
を備えたことを特徴とするレーザースキャナのキャリブレーション方法。
A left vertical plane whose left side and right side are vertical and parallel; and a right vertical plane whose left side and right side are vertical and parallel. The left vertical plane and the right vertical plane are parallel and constant with each other. A target that is on a plane separated by a distance d and separated by a certain horizontal width from the right side of the left vertical plane and the left side of the right vertical plane is positioned in front of the left vertical plane and the right vertical plane. of scanning by the laser scanner from the measurement origin O m, M (M is an integer) as a step of storing in the storage device takes in the point group data composed of relative coordinates relative to the measurement origin O m of measuring points in the computer ,
Among the point cloud data stored in the storage device, the left end point (hereinafter referred to as “end point”) A and the right end point C L of the left vertical plane, and the right identify right end measuring point B and the left end measuring point C R of the vertical plane, the end stations a, the end stations a containing C L, m L-number of stations between C L (hereinafter " left enable stations "hereinafter.) P i (i = n L, ..., n L + m relative coordinates L -1), and said end stations B, said end stations B containing C R, between C R an effective point extraction step of extracting relative coordinates of m R points (hereinafter referred to as “right effective points”) P i (i = n R ,..., n R + m R −1);
Based on said relative coordinates of each left effective stations and the respective right enabled stations, two parallel slope and intercept of the scanning line L L and L R together from said scanning line L L each left enabled stations P i (i = n L, ... , n L + m L -1) to the sum of the distance to, from said scanning line L R each right effective measurement point P i (i = n R, ..., n R + m R - A scanning line calculation step of calculating by a least square method so that the sum of the distances up to 1) is minimized;
A scanning line distance calculating step of calculating a distance d ′ from the scanning line L L to the scanning line LR ;
An elevation angle calculating step of calculating an elevation angle θ of the optical axis of the racer scanner based on the distance d ′ and the distance d by Equation (6);
A calibration method for a laser scanner, comprising:
前記有効測点抽出ステップにおいては、前記各点群データに対してそれぞれ前記左有効測点の相対座標及び前記右有効測点の相対座標を抽出し、
前記走査線算出ステップにおいては、前記各点群データに対してそれぞれ前記走査線LL及び前記走査線LRの傾き及び切片を算出し、
前記走査線間距離算出ステップにおいては、前記各点群データに対してそれぞれ前記走査線LLから前記走査線LRまでの距離d’を算出し、
前記仰角算出ステップにおいては、前記各点群データに対してそれぞれレーサースキャナの光軸の前記仰角θを算出し、
その後、前記仰角算出ステップにおいて算出される前記仰角θの平均値を算出し、レーサースキャナの光軸の仰角として出力する平均化ステップを実行することを特徴とする請求項19記載のレーザースキャナのキャリブレーション方法。 In the scanning step, a horizontal scanning is performed by a laser scanner from N measurement origins at N positions which are in front of the left vertical plane and the right vertical plane and have the same height and different positions on the horizontal plane, and N sets of the points The group data is imported into a computer and stored in a storage device.
In the effective point extraction step, the relative coordinates of the left effective point and the right effective point are extracted for each point cloud data,
Wherein in the scanning line calculating step, and calculates the slope and intercept of each of the scanning line L L and the scanning line L R wherein for each point cloud data,
Wherein the distance calculation step between the scan lines, and calculates the distance d 'of the from respectively each point cloud data of the scanning lines L L to the scanning line L R,
In the elevation angle calculating step, the elevation angle θ of the optical axis of the racer scanner is calculated for each point cloud data,
The laser scanner calibration according to claim 19, further comprising: an averaging step of calculating an average value of the elevation angle θ calculated in the elevation angle calculating step and outputting the average value as an elevation angle of the optical axis of the racer scanner. Method.
長方形の凸出した垂直平面ABCDを有するターゲットを、前記垂直平面の前方の計測原点Omからレーザースキャナにより三次元的に走査し、M×N個(M,Nは整数)の測点に対する前記計測原点Omを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記垂直平面ABCDの4隅の頂点A,B,C,Dに最も近い測点(以下「隅測点」という。)PA,PB,PC,PDを特定し、前記隅測点PA,PB,PC,PDを含む、前記隅測点PA,PB,PC,PDを頂点とする四角形で囲まれた領域内のm×n個の測点(以下「有効測点」という。)Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)の相対座標を抽出する有効測点抽出ステップと、
前記垂直平面ABCDの4隅の頂点A,B,C,Dを基準に測地座標系を設定し、前記頂点Aと前記隅測点PAとの間の距離dA、前記頂点Bと前記隅測点PBとの間の距離dB、前記頂点Cと前記隅測点PCとの間の距離dC、前記頂点Dと前記隅測点PDとの間の距離dD、及び前記隅測点PA,PB,PC,PD以外の前記各有効測点Pi,jから前記垂直平面ABCDまでの距離di,jの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定ステップと、
を実行することを特徴とするレーザースキャナのキャリブレーション方法。 A calibration method for calibrating a laser scanner by a computer,
A target having a rectangular protruding vertical plane ABCD is three-dimensionally scanned from a measurement origin O m in front of the vertical plane by a laser scanner, and the above-mentioned measurement points for M × N (M and N are integers) are measured. a scanning step of storing the point cloud data consisting of relative coordinates as a reference to the storage device takes in the computer measurement origin O m,
From among the point cloud data stored in the storage device, the four corners of the vertex A of the vertical plane ABCD, B, C, nearest stations (hereinafter referred to as "corner measuring point".) To D P A, P B , P C , P D are specified, and the corner measuring points P A , P B , P C , P D including the corner measuring points P A , P B , P C , P D M × n measuring points (hereinafter referred to as “effective measuring points”) P i, j (i = m 0 ,..., M 0 + m−1, j = n 0 ,..., N 0 in the enclosed area. An effective station extraction step of extracting the relative coordinates of + n-1);
4 corners of the vertex A of the vertical plane ABCD, B, C, and set standards geodetic coordinate system D, the distance d A between the vertex A and the corner measurement point P A, the said vertex B corner measurement point P B and the distance d B between the distance d C between the apex C and the corner measurement point P C, the distance d D between the vertex D and the corner measurement point P D, and the The sum or the square sum of the distances d i, j from each of the effective measurement points P i, j other than the corner measurement points P A , P B , P C , P D to the vertical plane ABCD is minimized. A coordinate determination step for determining a relationship parameter relating a relative coordinate to the geodetic coordinate;
A method for calibrating a laser scanner, comprising:
前記隅測点PA,PB,PC,PDの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記隅測点PA,PB,PC,PD以外の前記各有効測点Pi,j及び前記計測原点Omの前記測地座標系における位置座標の初期値を算出する第2の初期化ステップと、
前記距離dA,dB,dC,dD、及び前記各距離di,jの和又は自乗和を評価関数として、前記計測原点Om及び前記隅測点PA,PB,PC,PDを含む前記各有効測点Pi,j(i=m0,…,m0+m−1,j=n0,…,n0+n−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点Om及び前記各有効測点Pi,jの回転及び平行移動を行う幾何変換の各変換パラメータを、反復法により算出する変換パラメータ算出ステップと、
算出された前記各変換パラメータにより前記計測原点Omの位置座標の初期値をヘルマート変換し、前記計測原点Omの前記測地座標系における位置座標を算出する原点座標確定ステップと、
所定の方位角範囲及び仰角範囲を回転走査する前記レーザースキャナの走査範囲の中心方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Omの前記測地座標系における位置座標とに基づいて、前記注視点Gの前記測地座標系における位置座標を算出する注視点座標確定ステップと、
を実行することを特徴とする請求項21記載のレーザースキャナのキャリブレーション方法。 In the coordinate determination step, a first initialization step of setting initial values of position coordinates of the corner measurement points P A , P B , P C , and P D in the geodetic coordinate system;
The corner measurement point P A, P B, on the basis of the P C, the initial value and the relative coordinates of each active stations coordinates of P D, the corner measurement point P A, P B, P C , other than P D A second initialization step of calculating initial values of position coordinates in the geodetic coordinate system of each of the effective measurement points P i, j and the measurement origin O m ;
The distance d A, d B, d C , d D, and the respective distances d i, as the evaluation function the sum or square sum of j, the measurement origin O m and the corner measurement point P A, P B, P C , each valid stations including P D P i, j (i = m 0, ..., m 0 + m-1, j = n 0, ..., n 0 + n-1) starting from an initial value of the position coordinates of the Thus, transformation parameters for calculating the transformation parameters for geometric transformation for rotating and translating the measurement origin O m and the effective measurement points P i, j so that the value of the evaluation function is minimized A parameter calculation step;
An origin coordinate determination step of performing Helmart transform on the initial value of the position coordinate of the measurement origin O m by the calculated conversion parameters and calculating the position coordinate of the measurement origin O m in the geodetic coordinate system;
Relative coordinates of the gazing point G, which is a measuring point on the optical axis in the central direction of the scanning range of the laser scanner that rotates and scans a predetermined azimuth angle range and elevation angle range, are extracted from the point cloud data, and based on the position coordinates in the relative coordinates and the geodetic coordinate system of the measurement origin O m, and the gazing point coordinate determination step of calculating the position coordinates of the geodetic coordinate system of the gaze point G,
The laser scanner calibration method according to claim 21, wherein:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008003737A JP2009168472A (en) | 2008-01-10 | 2008-01-10 | Calibration device and calibration method of laser scanner |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008003737A JP2009168472A (en) | 2008-01-10 | 2008-01-10 | Calibration device and calibration method of laser scanner |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2009168472A true JP2009168472A (en) | 2009-07-30 |
Family
ID=40969829
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008003737A Pending JP2009168472A (en) | 2008-01-10 | 2008-01-10 | Calibration device and calibration method of laser scanner |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2009168472A (en) |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010175423A (en) * | 2009-01-30 | 2010-08-12 | Mitsubishi Electric Corp | Measuring device, method for correcting position and posture value of laser in measuring device, and laser position/posture value correcting program |
JP2011099742A (en) * | 2009-11-05 | 2011-05-19 | Mitsubishi Heavy Ind Ltd | Object detecting device and object detection method |
JP2011242277A (en) * | 2010-05-19 | 2011-12-01 | Ihi Aerospace Co Ltd | Travel area determination device and travel area determination method of mobile robot |
JP2012141265A (en) * | 2011-01-06 | 2012-07-26 | Nippon Signal Co Ltd:The | Optical range finder |
CN103063135A (en) * | 2012-12-26 | 2013-04-24 | 北京矿冶研究总院 | Three-dimensional laser scanner posture high-precision calibration method and device |
KR101272422B1 (en) | 2012-02-29 | 2013-06-07 | 부산대학교 산학협력단 | Device and method for locationing using laser scanner and landmark matching |
EP2680030A1 (en) * | 2012-06-29 | 2014-01-01 | Ricoh Company, Ltd. | Optical axis adjusting apparatus and optical axis adjusting method for laser apparatus |
JP2017026551A (en) * | 2015-07-27 | 2017-02-02 | 日産自動車株式会社 | Calibration target and calibration method |
JP2019086332A (en) * | 2017-11-02 | 2019-06-06 | 株式会社トプコン | Reflection prism, measurement object equipped with reflection prism, surveying instrument, coordinate comparison unit, surveying method, and program for survey processing |
WO2020031950A1 (en) * | 2018-08-07 | 2020-02-13 | 日本電信電話株式会社 | Measurement calibration device, measurement calibration method, and program |
JP2020061125A (en) * | 2018-10-11 | 2020-04-16 | バイドゥ ユーエスエイ エルエルシーBaidu USA LLC | Automatic lidar calibration based on cross validation for autonomous driving |
CN111044991A (en) * | 2018-10-12 | 2020-04-21 | 百度(美国)有限责任公司 | Automatic LIDAR calibration based on pre-collected static reflectometry for autonomous driving |
US20200183007A1 (en) * | 2017-08-18 | 2020-06-11 | Koito Manufacturing Co., Ltd. | Recognition sensor and control method thereof, automobile, automotive lamp, object recognition system, and object recognition method |
CN112150610A (en) * | 2020-09-15 | 2020-12-29 | 广联达科技股份有限公司 | Retaining wall modeling method and system based on dimension marking |
CN113158121A (en) * | 2021-04-23 | 2021-07-23 | 上海鹏太科技有限公司 | Alignment algorithm for two or more high-precision laser line scanners |
WO2021170292A1 (en) * | 2020-02-27 | 2021-09-02 | Sew-Eurodrive Gmbh & Co. Kg | Device and method for calibrating a laser scanner |
CN114674226A (en) * | 2022-03-25 | 2022-06-28 | 北京城建设计发展集团股份有限公司 | Method for scanning and rapidly capturing boundary of prefabricated component |
DE102021005980A1 (en) | 2021-01-14 | 2022-07-14 | Sew-Eurodrive Gmbh & Co Kg | Process for calibrating a laser scanner and technical systems |
WO2022229067A1 (en) * | 2021-04-29 | 2022-11-03 | Valeo Schalter Und Sensoren Gmbh | Calibration object and method for determining the position of an individual object on a scanning plane of a lidar-based surroundings sensor |
WO2022229062A1 (en) * | 2021-04-29 | 2022-11-03 | Valeo Schalter Und Sensoren Gmbh | Determination of a vertical position of a calibration object using a lidar-based surroundings sensor and calibration of a lidar-based surroundings sensor having a scanning plane |
-
2008
- 2008-01-10 JP JP2008003737A patent/JP2009168472A/en active Pending
Cited By (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010175423A (en) * | 2009-01-30 | 2010-08-12 | Mitsubishi Electric Corp | Measuring device, method for correcting position and posture value of laser in measuring device, and laser position/posture value correcting program |
JP2011099742A (en) * | 2009-11-05 | 2011-05-19 | Mitsubishi Heavy Ind Ltd | Object detecting device and object detection method |
JP2011242277A (en) * | 2010-05-19 | 2011-12-01 | Ihi Aerospace Co Ltd | Travel area determination device and travel area determination method of mobile robot |
JP2012141265A (en) * | 2011-01-06 | 2012-07-26 | Nippon Signal Co Ltd:The | Optical range finder |
KR101272422B1 (en) | 2012-02-29 | 2013-06-07 | 부산대학교 산학협력단 | Device and method for locationing using laser scanner and landmark matching |
EP2680030A1 (en) * | 2012-06-29 | 2014-01-01 | Ricoh Company, Ltd. | Optical axis adjusting apparatus and optical axis adjusting method for laser apparatus |
CN103063135A (en) * | 2012-12-26 | 2013-04-24 | 北京矿冶研究总院 | Three-dimensional laser scanner posture high-precision calibration method and device |
JP2017026551A (en) * | 2015-07-27 | 2017-02-02 | 日産自動車株式会社 | Calibration target and calibration method |
US20200183007A1 (en) * | 2017-08-18 | 2020-06-11 | Koito Manufacturing Co., Ltd. | Recognition sensor and control method thereof, automobile, automotive lamp, object recognition system, and object recognition method |
US11754714B2 (en) * | 2017-08-18 | 2023-09-12 | Koito Manufacturing Co., Ltd. | Recognition sensor and control method thereof, automobile, automotive lamp, object recognition system, and object recognition method |
JP2019086332A (en) * | 2017-11-02 | 2019-06-06 | 株式会社トプコン | Reflection prism, measurement object equipped with reflection prism, surveying instrument, coordinate comparison unit, surveying method, and program for survey processing |
WO2020031950A1 (en) * | 2018-08-07 | 2020-02-13 | 日本電信電話株式会社 | Measurement calibration device, measurement calibration method, and program |
JP2020061125A (en) * | 2018-10-11 | 2020-04-16 | バイドゥ ユーエスエイ エルエルシーBaidu USA LLC | Automatic lidar calibration based on cross validation for autonomous driving |
CN111044992A (en) * | 2018-10-11 | 2020-04-21 | 百度(美国)有限责任公司 | Automatic LIDAR calibration based on cross-validation for autonomous driving |
CN111044992B (en) * | 2018-10-11 | 2023-12-26 | 百度(美国)有限责任公司 | Cross-validation based automatic LIDAR calibration for autopilot |
US11428817B2 (en) | 2018-10-11 | 2022-08-30 | Baidu Usa Llc | Automatic LIDAR calibration based on cross validation for autonomous driving |
CN111044991A (en) * | 2018-10-12 | 2020-04-21 | 百度(美国)有限责任公司 | Automatic LIDAR calibration based on pre-collected static reflectometry for autonomous driving |
US11841437B2 (en) | 2018-10-12 | 2023-12-12 | Baidu Usa Llc | Automatic lidar calibration based on pre-collected static reflection map for autonomous driving |
CN111044991B (en) * | 2018-10-12 | 2023-09-05 | 百度(美国)有限责任公司 | LIDAR calibration method based on pre-collected static reflection map for automatic driving |
WO2021170292A1 (en) * | 2020-02-27 | 2021-09-02 | Sew-Eurodrive Gmbh & Co. Kg | Device and method for calibrating a laser scanner |
CN112150610A (en) * | 2020-09-15 | 2020-12-29 | 广联达科技股份有限公司 | Retaining wall modeling method and system based on dimension marking |
WO2022152463A1 (en) | 2021-01-14 | 2022-07-21 | Sew-Eurodrive Gmbh & Co. Kg | Method for calibrating a laser scanner, and technical apparatus |
DE102021005980A1 (en) | 2021-01-14 | 2022-07-14 | Sew-Eurodrive Gmbh & Co Kg | Process for calibrating a laser scanner and technical systems |
CN113158121A (en) * | 2021-04-23 | 2021-07-23 | 上海鹏太科技有限公司 | Alignment algorithm for two or more high-precision laser line scanners |
WO2022229067A1 (en) * | 2021-04-29 | 2022-11-03 | Valeo Schalter Und Sensoren Gmbh | Calibration object and method for determining the position of an individual object on a scanning plane of a lidar-based surroundings sensor |
WO2022229062A1 (en) * | 2021-04-29 | 2022-11-03 | Valeo Schalter Und Sensoren Gmbh | Determination of a vertical position of a calibration object using a lidar-based surroundings sensor and calibration of a lidar-based surroundings sensor having a scanning plane |
CN114674226B (en) * | 2022-03-25 | 2022-12-13 | 北京城建设计发展集团股份有限公司 | Method for scanning and rapidly capturing boundary of prefabricated component |
CN114674226A (en) * | 2022-03-25 | 2022-06-28 | 北京城建设计发展集团股份有限公司 | Method for scanning and rapidly capturing boundary of prefabricated component |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2009168472A (en) | Calibration device and calibration method of laser scanner | |
EP2990828B1 (en) | Point cloud position data processing device, point cloud position data processing system, point cloud position data processing method, and program therefor | |
CN105547305B (en) | A kind of pose calculation method based on wireless location and laser map match | |
US9470511B2 (en) | Point-to-point measurements using a handheld device | |
US9562971B2 (en) | Point-cloud fusion | |
US6759979B2 (en) | GPS-enhanced system and method for automatically capturing and co-registering virtual models of a site | |
CN110703268B (en) | Air route planning method and device for autonomous positioning navigation | |
CN111121754A (en) | Mobile robot positioning navigation method and device, mobile robot and storage medium | |
US11727582B2 (en) | Correction of current scan data using pre-existing data | |
JP6910511B2 (en) | Laser measurement method, laser measurement sign, and coordinate calculation program | |
US20090154793A1 (en) | Digital photogrammetric method and apparatus using intergrated modeling of different types of sensors | |
CN104574406A (en) | Joint calibration method between 360-degree panorama laser and multiple visual systems | |
US20220101601A1 (en) | System and method of scanning an environment and generating two dimensional images of the environment | |
WO2017154061A1 (en) | Map making device and map making method | |
US10546419B2 (en) | System and method of on-site documentation enhancement through augmented reality | |
JP6095369B2 (en) | CAD information generation system, CAD information generation program, and CAD information generation method | |
Kersting | Quality assurance of multi-sensor systems | |
JP2009198382A (en) | Environment map acquiring device | |
JP2008089307A (en) | Measuring carriage, layer thickness measuring apparatus, method and program of layer thickness measurement of the same, and layer thickness measuring method of layer thickness measuring system | |
Masiero et al. | Aiding indoor photogrammetry with UWB sensors | |
US20220406005A1 (en) | Targetless tracking of measurement device during capture of surrounding data | |
US11936843B2 (en) | Generating textured three-dimensional meshes using two-dimensional scanner and panoramic camera | |
Makkonen et al. | The applicability of the rapid handheld laser scanner to underground tunnel surveying | |
Shi et al. | Reference-plane-based approach for accuracy assessment of mobile mapping point clouds | |
KR101714700B1 (en) | Apparatus for registration of scan data |