JP2009168472A - Calibration device and calibration method of laser scanner - Google Patents

Calibration device and calibration method of laser scanner Download PDF

Info

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
Application number
JP2008003737A
Other languages
Japanese (ja)
Inventor
Toru Hiraoka
透 平岡
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zenrin Co Ltd
Original Assignee
Zenrin Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Zenrin Co Ltd filed Critical Zenrin Co Ltd
Priority to JP2008003737A priority Critical patent/JP2009168472A/en
Publication of JP2009168472A publication Critical patent/JP2009168472A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Instructional Devices (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide a technology for calibrating a laser scanner without using any special apparatus. <P>SOLUTION: A target having a vertical plane S<SB>1</SB>whose both right-and-left sides are parallel and vertical is scanned horizontally by the laser scanner 1 from a measuring origin O<SB>m</SB>in front of the vertical plane S<SB>1</SB>, to thereby obtained point group data to measuring points to the number of M. An effective measuring point extraction part 13 specifies end measuring points A, B on the ends of both right-and-left sides of the vertical plane S<SB>1</SB>among the point group data, and extracts a relative coordinate of effective measuring points to the number of m between the end measuring points A, B. A coordinate determination means 14 sets a geodetic coordinate system based on a line (scanning line E<SB>1</SB>E<SB>2</SB>) cutting the vertical plane S<SB>1</SB>by a locus of an optical axis, and determines a relation parameter for relating the relative coordinate to a geodetic coordinate so that the square sum of a distance d<SB>A</SB>from an endpoint E<SB>1</SB>to the end measuring point A, a distance d<SB>B</SB>from an endpoint E<SB>2</SB>to the end measuring point B, and each distance d<SB>i</SB>from each effective measuring point P<SB>i</SB>other than the end measuring points A, B to the scanning line E<SB>1</SB>E<SB>2</SB>becomes minimum. <P>COPYRIGHT: (C)2009,JPO&INPIT

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 Documents 2 and 3). However, since GPS cannot be used for indoor measurement, a method using an inertial measurement unit (IMU: Inertial Measurement Unit) (see Non-Patent Document 4) and a method using scan matching (Non-Patent Document 5) -7) is used. The scan matching method is executed by superimposing point cloud data acquired in time series by a laser scanner. In practice, the time series point cloud data is acquired by continuously measuring while moving the place where the carriage equipped with the laser scanner is to be measured. One map point cloud data is created by superimposing these acquired time series point cloud data. Various methods have been devised for this superposition method (see Non-Patent Documents 5-7). For example, in the method of Non-Patent Document 7, execution is performed by superimposing point cloud data obtained at a certain time on point cloud data at the previous time by transformation (Helmart transformation) using translation and rotation. Is done.

レーザースキャナで取得される点群データは、レーザースキャナを中心とした座標である。そのため、各計測ごとに計測開始位置やレーザースキャナの姿勢が異なると、各計測ごとに異なる座標系の点群データが得られる。そのため、複数回の計測で得られた点群データを合成して地図データを作成しようとした場合、それぞれ計測ごとの絶対的な位置座標の情報がなければ正しく合成することができない。また、一般に、レーザースキャナには、温度や場所などによる測定値のずれや、大気の影響などによる誤差が発生する。そのため、レーザースキャナによる測定では、レーザースキャナを水平に設置した後、キャリブレーション(較正)を行わなければならない。   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 Non-Patent Documents 8 and 9 are known.

非特許文献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をターゲットとして使用することで、レーザービームのスポットの中心ほどレーザー光が強く、発生する音も大きくなる。この性質を利用してスポットの中心を捉える。次に、レーザースポットの中心にあたるように設置された複数の基準点を計測し、レーザースキャナ座標系における各基準点の座標(X,Y,Z)を求める。ここで、レーザーの軌跡は直線であるため、Zlの値はすべて0とする。次に、各基準点の位置座標の真値(絶対値)を求めるため、各基準点についてトータルステーションによる位置座標の計測を行い、測地座標系における各基準点の座標(X,Y,Z)を求める。これらの結果から、レーザースキャナ座標系から測地座標系への変換式を求める。具体的には、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.

Figure 2009168472
ここで、Rは三次元回転行列、sは縮尺、(T,T,Tは平行移動量である。
Figure 2009168472
Here, R is a three-dimensional rotation matrix, s is a scale, and (T x , T y , T z ) t is a translation amount.

また、非特許文献9には、計測対象の地物上に4点以上の基準点を設定し、それらの基準点に反射シートを設置しておき、これらの反射シートによりレーザースキャナのキャリブレーションを行う方法が記載されている。この方法においても、各基準点の位置座標をトータルステーションで計測して決定するとともに、レーザースキャナで計測する、そして、レーザースキャナ座標系における各基準点の座標とトータルステーションで計測した測地座標系における各基準点の座標とに基づいて、レーザースキャナ座標系から測地座標系に変換するアフィン変換パラメータを求めることによって較正を行う。
大嶋太市,「測量学<基礎編>」,初版,共立出版株式会社,1997年4月10日,pp.152−158. 趙卉菁,柴崎亮介,「車両搭載型レーザレンジセンサによる3次元都市空間モデルの自動構築」,第8回画像センシングシンポジウム,2002年,pp.121-126. H. Zhao and R. Shibasaki, "A Vehicle-borne Urban 3D Acquisition System using Single-row Laser Range Scanners", IEEE Trans. SMC Part B: Cybernetics, 2003, Vol.33, No.4, pp.. 長井正彦他,「IMUを用いたレーザースキャナとCCDセンサの統合による3次元モデルの構築」,日本写真測量学会平成16年度年次学術講演会論文集,日本写真測量学会,2004年,pp.5-8. P.J.Besl and N.D.Mckay, "A Method for Registration of 3-D Shapes", IEEE Transaction on Pattern Analysis and Maching Intelligence, 1992, Vol.14, No.2, pp.239-256. 中本琢実,山下淳,金子透,「レーザーレンジファインダ搭載移動ロボットによる動的環境の3次元地図作成」,映像メディア学会技術報告,2006年,Vol.30, No.36, pp.263-271. 平岡透,若松浩二,尾崎直人,「屋内地図作成のための時系列レーザースキャナデータのロバストな重ね合わせ」,写真測量とリモートセンシング,2007年,Vol.46, No.2, pp.37-41. 長井正彦,マナンダ・ディネッシュ,柴崎亮介,「“Cobit”によるレーザースキャナのキャリブレーション手法に関する研究」,日本写真測量学会平成16年度次学術講演会発表論文集,2004年,pp.1-4. 氏家康二,「レーザースキャナを用いたオブジェクトマッチングによる地すべり変位追跡」,高知工科大学2004(平成16)年度修士論文,[online],2005年1月,高知工科大学付属図書館,[平成19年10月1日検索],インターネット<http://www.kochi-tech.ac.jp/library/ron/2004/g9/M/1075013.pdf>
In Non-Patent Document 9, four or more reference points are set on the feature to be measured, reflection sheets are set at the reference points, and the laser scanner is calibrated with these reflection sheets. The method of doing is described. Also in this method, the position coordinates of each reference point are measured and determined by the total station, measured by the laser scanner, and the coordinates of each reference point in the laser scanner coordinate system and each reference in the geodetic coordinate system measured by the total station. Calibration is performed by obtaining affine transformation parameters for transforming from the laser scanner coordinate system to the geodetic coordinate system based on the coordinates of the points.
Oshima Taichi, “Surveying Science <Basics>”, first edition, Kyoritsu Publishing Co., Ltd., April 10, 1997, pp. 152-158. Tsuji, Ryosuke Shibasaki, “Automatic construction of 3D urban space model using vehicle-mounted laser range sensor”, 8th Symposium on Image Sensing, 2002, pp.121-126. H. Zhao and R. Shibasaki, "A Vehicle-borne Urban 3D Acquisition System using Single-row Laser Range Scanners", IEEE Trans.SMC Part B: Cybernetics, 2003, Vol.33, No.4, pp .. Masahiko Nagai et al., “Construction of 3D model by integrating laser scanner and CCD sensor using IMU”, Photographic Society of Japan Annual Meeting 2004, Photogrammetric Society of Japan, 2004, pp.5 -8. PJBesl and NDMckay, "A Method for Registration of 3-D Shapes", IEEE Transaction on Pattern Analysis and Maching Intelligence, 1992, Vol.14, No.2, pp.239-256. Atsumi Nakamoto, Atsushi Yamashita, Toru Kaneko, “Creating a three-dimensional map of a dynamic environment using a mobile robot equipped with a laser range finder”, Technical Report of ITE, 2006, Vol.30, No.36, pp.263-271 . Toru Hiraoka, Koji Wakamatsu, Naoto Ozaki, “Robust Superposition of Time Series Laser Scanner Data for Indoor Mapping”, Photogrammetry and Remote Sensing, 2007, Vol.46, No.2, pp.37-41 . Masahiko Nagai, Mananda Dinesh, Ryosuke Shibasaki, “Research on Laser Scanner Calibration Method Using“ Cobit ””, Proceedings of 2004 Annual Conference of the Japan Society of Photogrammetry, 2004, pp.1-4. Koji Ujiie, “Tracking landslide displacement by object matching using laser scanner”, Kochi University of Technology 2004 (2004) Master thesis, [online], January 2005, Kochi University of Technology Library, [2007 October Search on the 1st of the month], Internet <http://www.kochi-tech.ac.jp/library/ron/2004/g9/M/1075013.pdf>

しかしながら、上述のような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の構成は、左右両側辺が平行かつ垂直な垂直平面を有するターゲットを、前記垂直平面の前方の計測原点Oからレーザースキャナにより水平走査して得られる、M個(Mは整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記垂直平面の左右両側の端部の測点(以下「端測点」という。)A,Bを特定し、前記端測点A,Bを含む前記端測点A,B間のm個の測点(以下「有効測点」という。)P(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出手段と、
前記レーザースキャナの光軸の軌跡が前記垂直平面を切る線である走査線Eを基準に測地座標系を設定し、前記走査線Eの一方の端点Eから前記端測点Aまでの距離d、前記走査線Eの他方の端点Eから前記端測点Bまでの距離d、及び前記端測点A,B以外の前記各有効測点P(i=n+1,…,n+m−2)から前記走査線Eまでの距離dの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定手段と、を備えたことを特徴とする。
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 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. And a coordinate determining means.

この構成によれば、レーザースキャナのキャリブレーションに使用するターゲットとして、左右両側辺が平行かつ垂直な垂直平面を有する物体があればよい。従って、例えば垂直に立てられた角柱形の建物の柱などをターゲットとして利用することができる。従って、従来のようにキャリブレーション専用の特殊な機器を用いることなくレーザースキャナのキャリブレーションを行うことが可能となる。   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として、距離d、距離d、及び距離d(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

Figure 2009168472
又は自乗和
Figure 2009168472
Or square sum

Figure 2009168472
を用いることで、走査時における測定方位角の離散化による量子化誤差の影響を最小限に抑えることができる。
Figure 2009168472
By using, it is possible to minimize the influence of quantization error due to discretization of the measurement azimuth angle during scanning.

ここで、「垂直平面」は、左右両側辺が平行かつ垂直な平面であればよく、上下辺の形状は問わない。但し、垂直平面の両辺は凸角(convex angle)となっているものとする。「計測原点」とは、レーザースキャナのレーザー光の光軸の回動中心の点をいう。「測点」とは、レーザースキャナにより座標測定を行なう空間点をいう。測点の数Mは特に限定はされず、レーザースキャナの角度解像度と走査角とにより決まる値である。ここで、「角度解像度」とは、隣接する測点間の方位角の差をいう。「走査角」とは、レーザースキャナが1回の走査において走査を開始する光軸の方位角と走査を終了する光軸の方位角との差角をいう。「計測原点Oを基準とする相対座標」とは、計測原点を原点としてレーザースキャナに固定された座標をいう。相対座標は、直交座標、極座標、円柱座標などの座標表現を用いることができるが、レーザースキャナが直接測定する値は、測点の方位角φと測定原点から測点までの距離lなので、通常は相対座標は極座標表現(l,φ)が用いられる。「測地座標系」とは、レーザースキャナの光軸の軌跡が垂直平面を切る線(走査線E)を基準に設定された座標系をいう。ターゲットは、計測空間の所定の位置に固定されているため、測地座標系は計測空間に固定された座標系である。測地座標系の座標表現は特に限定されないが、地図作成の際の利便性を考慮して、通常は直交座標表現が用いられる。「端測点」とは、測定対象である平面の端部の測点をいう。ここで、レーザースキャナの走査においては各測点間の方位角は離散的であるため、一般には、端測点は測定対象である平面の端部とは正確には一致しない。「相対座標を測地座標へ関係づける関係パラメータ」とは、相対座標を測地座標に対応づけるパラメータをいう。対応付けのパラメータの取り方は任意であるが、例えば、測地座標系における計測原点Oの位置座標(x,y)と、注視点G(走査角度範囲の中心方向の光軸上の測点)の位置座標(x,y)を用いることができる。 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が前記走査線E上に位置し、かつ端点Eから端測点Aまでの距離と端点Eから端測点Bまでの距離とが等しくなるように、前記測地座標系における前記端測点A,Bの位置座標の初期値を算出する第1の初期化手段と、
前記端測点A,Bの位置座標の初期値及び前記有効測点の相対座標に基づき、前記端測点A,B以外の前記有効測点P(i=n+1,…,n+m−2)及び前記計測原点Oの前記測地座標系における位置座標の初期値を算出する第2の初期化手段と、
前記距離d、前記距離d、及び前記距離d(i=n+1,…,n+m−2)の和又は自乗和を評価関数として、前記計測原点O及び前記端測点A,Bを含む前記各有効測点P(i=n,…,n+m−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点O及び前記各有効測点Pの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する変換パラメータ算出手段と、
算出された前記各変換パラメータにより前記計測原点Oの位置座標の初期値をヘルマート変換し、前記計測原点Oの前記測地座標系における位置座標を算出する原点座標確定手段と、
所定の角度範囲を回転走査する前記レーザースキャナの走査開始方向と走査終了方向の2つの方向間の走査角の二等分角方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Oの前記測地座標系における位置座標とに基づいて、前記注視点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は、走査線Eの中点から距離rAB/2だけ離れた走査線E上に配置される。次に、第2の初期化手段は、有効測点P(i=n+1,…,n+m−2)及び計測原点Oの位置座標の初期値を算出する。端測点A,Bに対する有効測点P及び計測原点Oの相対座標も点群データにより既知であるので、端測点A,Bの位置座標の初期値が定まれば有効測点P及び計測原点Oの位置座標の初期値も一意的に定まる。次に、変換パラメータ算出手段は、計測原点O及び各有効測点P(i=n,…,n+m−1)を、ヘルマート変換により最適な位置に移動する。この移動の際のヘルマート変換パラメータは、前述の式(2)又は式(3)で表される距離の和又は自乗和を評価関数Jとして用いて、反復法により求められる。式(2)又は式(3)は凸関数なので、反復法における収束性は保証される。次に、原点座標確定手段は、関係パラメータの一つとして、計測原点Oの測地座標系における位置座標を算出する。最後に、注視点座標確定手段は、もう一つの関係パラメータとして、注視点Gの測地座標系における位置座標を算出する。以上のようにして、関係パラメータとして計測原点O及び注視点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の構成において、前記点群データ記憶手段は、左右両側辺が平行かつ垂直な垂直平面を複数有し、各垂直平面は互いに平行であるターゲットを、前記各垂直平面の前方の計測原点Oからレーザースキャナにより水平走査して得られる、M個(Mは2より大きい整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データを記憶するものであり、
前記有効測点抽出手段は、前記各垂直平面に対して、両端の端測点A,B(jは前記各垂直平面を区別する添字)を特定し、前記各有効測点Pj,iの相対座標を抽出するものであり、
前記座標決定手段は、前記レーザースキャナの光軸が前記各垂直平面を切る線である走査線Ep,1p,2を基準に測地座標系を設定し、前記各垂直平面における、前記走査線Ej,1j,2の一方の端点Ej,1から前記端測点Aまでの距離dj,A、前記走査線Ej,1j,2の他方の端点Ej,2から前記端測点Bまでの距離dj,B、及び前記両端測点A,B以外の前記各有効測点Pj,i(i=n+1,…,n+m−2)から前記走査線Ej,1j,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の構成は、左側辺が垂直な直線で且つ右側辺が傾斜した直線又は曲線である左垂直平面と、右側辺が垂直な直線で且つ左側辺が前記左垂直平面の右側辺と平行な傾斜直線又は傾斜曲線である右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つ同一平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査して得られた、M個(Mは2より大きい整数)の測点の計測原点Oを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,C間の水平幅r及び前記端測点B,C間の水平幅rを算出する幅算出手段と、
高さzにおける前記左垂直平面の水平幅をf(z)、前記右垂直平面の水平幅をf(z)、f(z),f(z)の逆関数をそれぞれf −1(x),f −1(x)としたとき、前記レーザースキャナの計測原点Oの高さHを、高さf −1(r’)又は高さf −1(r’)の何れか若しくは高さf −1(r)と高さf −1(r)の平均値として算出する高さ算出手段と、
を備えたことを特徴とする。
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枚の合同な直角三角形の板(木板や厚紙、金属板など)を、斜辺を平行に同一平面上に並べ合わせた状態で一定の間隔だけ離して固定しこれを床面に垂直に立てたような形状のターゲットを使用することができる。このようなターゲットは、特殊な材料を用いることなく容易に作ることができるため、従来のようにキャリブレーション専用の特殊な機器を用いることなくレーザースキャナの計測原点Oの高さ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の構成において、前記左垂直平面の右側辺と前記右垂直平面の左側辺との間の水平幅をr、前記左垂直平面の左側辺と前記右垂直平面の右側辺との間の水平幅をr+rとしたとき、前記計測原点で計測された水平幅r,rを、それぞれ式(4a),(4b)により補正して補正水平幅r’,r’を算出する水平幅補正手段を備え、
前記高さ算出手段は、前記レーザースキャナの計測原点Oの高さHを、高さf −1(r’)又は高さf −1(r’)の何れか若しくは高さf −1(r’)と高さf −1(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 ).

Figure 2009168472
Figure 2009168472

この構成によれば、端測点A,C間の水平幅r及び端測点B,C間の水平幅rを式(4a),(4b)により、r+r=rとなるように補正することで、走査時における測定方位角の離散化による量子化誤差の影響を低減させることができ、より精度の高い計測原点Oの高さ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,C間の水平幅及び前記端測点B,C間の水平幅を算出するとともに、前記各点群データについての前記端測点A,C間の水平幅の平均値を前記水平幅r、前記各点群データについての前記端測点B,C間の水平幅の平均値を前記水平幅rとして算出するものであることを特徴とする。
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.

この構成により、レーザースキャナを水平移動させて複数の計測原点Oからの走査で出られた点群データに基づき計測原点Oの高さHのキャリブレーションを行うことで、より精度の高い計測原点Oの高さ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の単調関数f(z)に従って変化する左垂直平面と、水平幅が高さzの単調関数f(z)に従って変化する右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査して得られた、M個(Mは2より大きい整数)の測点の計測原点Oを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,C間の水平幅r及び前記端測点B,C間の水平幅rを算出する幅算出手段と、
前記関数f(z),f(z)の逆関数をそれぞれf −1(x),f −1(x)としたとき、前記左垂直平面における走査線の高さhをf −1(r)、前記右垂直平面における走査線の高さhをf −1(r)として算出する高さ算出手段と、
前記高さh、前記高さh、及び前記距離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.

Figure 2009168472
Figure 2009168472

この構成によれば、レーザースキャナのキャリブレーションに使用するターゲットとして、上述のような左垂直平面及び右垂直平面を有する物体があればよい。このようなものとしては、例えば、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だけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査して得られた、M個(Mは2より大きい整数)の測点の計測原点Oを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,Cを含む前記端測点A,C間のm個の測点(以下「左有効測点」という。)P(i=n,…,n+m−1)の相対座標、及び前記端測点B,Cを含む前記端測点B,C間のm個の測点(以下「右有効測点」という。)P(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出手段と、
前記各左有効測点及び前記各右有効測点の相対座標に基づき、互いに平行な2つの走査線L及びLの傾き及び切片を、前記走査線Lから前記各左有効測点P(i=n,…,n+m−1)までの距離の和に、前記走査線Lから前記各右有効測点P(i=n,…,n+m−1)までの距離の和を加えた値が最小となるように、最小自乗法により算出する走査線算出手段と、
前記走査線Lから前記走査線Lまでの距離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.

Figure 2009168472
Figure 2009168472

この構成によれば、レーザースキャナのキャリブレーションに使用するターゲットとして、上述のような左垂直平面及び右垂直平面を有する物体があればよい。このようなものとしては、例えば、長方形の板(木板や厚紙、金属板など)を、一側辺を平行に並べ合わせた状態で一定の間隔だけ離して固定しこれを床面に垂直に立てたような形状のターゲットを使用することができる。このようなターゲットは、特殊な材料を用いることなく容易に作ることができるため、従来のようにキャリブレーション専用の特殊な機器を用いることなくレーザースキャナの光軸の仰角のキャリブレーションを行うことが可能となる。   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組の前記点群データを記憶するものであり、
前記有効測点抽出手段は、前記各点群データに対してそれぞれ前記左有効測点の相対座標及び前記右有効測点の相対座標を抽出し、
前記走査線算出手段は、前記各点群データに対してそれぞれ前記走査線L及び前記走査線Lの傾き及び切片を算出し、
前記走査線間距離算出手段は、前記各点群データに対してそれぞれ前記走査線Lから前記走査線Lまでの距離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を有するターゲットを、前記垂直平面の前方の計測原点Oからレーザースキャナにより三次元的に走査して得られる、M×N個(M,Nは整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記垂直平面ABCDの4隅の頂点A,B,C,Dに最も近い測点(以下「隅測点」という。)P,P,P,Pを特定し、前記隅測点P,P,P,Pを含む、前記隅測点P,P,P,Pを頂点とする四角形で囲まれた領域内のm×n個の測点(以下「有効測点」という。)Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)の相対座標を抽出する有効測点抽出手段と、
前記垂直平面ABCDの4隅の頂点A,B,C,Dを基準に測地座標系を設定し、前記頂点Aと前記隅測点Pとの間の距離d、前記頂点Bと前記隅測点Pとの間の距離d、前記頂点Cと前記隅測点Pとの間の距離d、前記頂点Dと前記隅測点Pとの間の距離d、及び前記隅測点P,P,P,P以外の前記各有効測点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の構成において、前記座標決定手段は、前記測地座標系における前記隅測点P,P,P,Pの位置座標の初期値を設定する第1の初期化手段と、
前記隅測点P,P,P,Pの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記隅測点P,P,P,P以外の前記各有効測点Pi,j及び前記計測原点Oの前記測地座標系における位置座標の初期値を算出する第2の初期化手段と、
前記距離d,d,d,d、及び前記各距離di,jの和又は自乗和を評価関数として、前記計測原点O及び前記隅測点P,P,P,Pを含む前記各有効測点Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点O及び前記各有効測点Pi,jの回転及び平行移動を行う幾何変換の各変換パラメータを、反復法により算出する変換パラメータ算出手段と、
算出された前記各変換パラメータにより前記計測原点Oの位置座標の初期値をヘルマート変換し、前記計測原点Oの前記測地座標系における位置座標を算出する原点座標確定手段と、
所定の方位角範囲及び仰角範囲を回転走査する前記レーザースキャナの走査範囲の中心方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Oの前記測地座標系における位置座標とに基づいて、前記注視点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 = 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,
It is characterized by having.

レーザースキャナのキャリブレーション方法に係る本発明の第1の構成は、コンピュータによりレーザースキャナのキャリブレーションを行うキャリブレーション方法であって、
左右両側辺が平行かつ垂直な垂直平面を有するターゲットを、前記垂直平面の前方の計測原点Oからレーザースキャナにより水平走査し、M個(Mは整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記垂直平面の左右両側の端部の測点(以下「端測点」という。)A,Bを特定し、前記端測点A,Bを含む前記端測点A,B間のm個の測点(以下「有効測点」という。)P(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出ステップと、
前記レーザースキャナの光軸の軌跡が前記垂直平面を切る線である走査線Eを基準に測地座標系を設定し、前記走査線Eの一方の端点Eから前記端測点Aまでの距離d、前記走査線Eの他方の端点Eから前記端測点Bまでの距離d、及び前記端測点A,B以外の前記各有効測点P(i=n+1,…,n+m−2)から前記走査線Eまでの距離dの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定ステップとを実行することを特徴とする。
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 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 determining step is performed.

レーザースキャナのキャリブレーション方法に係る本発明の第2の構成は、前記第1の構成において、前記座標決定ステップにおいては、
前記端測点A,Bが前記走査線E上に位置し、かつ端点Eから前記端測点Aまでの距離と端点Eから前記端測点Bまでの距離とが等しくなるように、前記測地座標系における前記端測点A,Bの位置座標の初期値を算出する第1の初期化ステップと、
前記端測点A,Bの位置座標の初期値及び前記有効測点の相対座標に基づき、前記端測点A,B以外の前記有効測点P(i=n+1,…,n+m−2)及び前記計測原点Oの前記測地座標系における位置座標の初期値を算出する第2の初期化ステップと、
前記距離d、前記距離d、及び前記距離d(i=n+1,…,n+m−2)の和又は自乗和を評価関数として、前記計測原点O及び前記端測点A,Bを含む前記各有効測点P(i=n,…,n+m−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点O及び前記各有効測点Pの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する変換パラメータ算出ステップと、
算出された前記各変換パラメータにより前記計測原点Oの位置座標の初期値をヘルマート変換し、前記計測原点Oの前記測地座標系における位置座標を算出する原点座標確定ステップと、
所定の角度範囲を回転走査する前記レーザースキャナの走査開始方向と走査終了方向の2つの方向間の走査角の二等分角方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Oの前記測地座標系における位置座標とに基づいて、前記注視点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の構成において、前記走査ステップにおいては、左右両側辺が平行かつ垂直な垂直平面を複数有し、各垂直平面は互いに平行であるターゲットを、前記各垂直平面の前方の計測原点Oからレーザースキャナにより水平走査して得られる、M個(Mは2より大きい整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存し、
前記有効測点抽出ステップにおいては、前記各垂直平面に対して、両端の端測点A,B(jは前記各垂直平面を区別する添字)を特定し、前記各有効測点Pj,iの相対座標を抽出し、
前記座標決定ステップにおいては、前記レーザースキャナの光軸が前記各垂直平面を切る線である走査線Ep,1p,2を基準に測地座標系を設定し、前記各垂直平面における、前記走査線Ej,1j,2の一方の端点Ej,1から前記端測点Aまでの距離dj,A、前記走査線Ej,1j,2の他方の端点Ej,2から前記端測点Bまでの距離dj,B、及び前記両端測点A,B以外の前記各有効測点Pj,i(i=n+1,…,n+m−2)から前記走査線Ej,1j,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の構成は、コンピュータによりレーザースキャナのキャリブレーションを行うキャリブレーション方法であって、
左側辺が垂直な直線で且つ右側辺が傾斜した直線又は曲線である左垂直平面と、右側辺が垂直な直線で且つ左側辺が前記左垂直平面の右側辺と平行な傾斜直線又は傾斜曲線である右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つ同一平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査して、M個(Mは2より大きい整数)の測点の計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,C間の水平幅r及び前記端測点B,C間の水平幅rを算出する幅算出ステップと、
高さzにおける前記左垂直平面の水平幅をf(z)、前記右垂直平面の水平幅をf(z)、f(z),f(z)の逆関数をそれぞれf −1(x),f −1(x)としたとき、前記レーザースキャナの計測原点Oの高さHを、高さf −1(r’)又は高さf −1(r’)の何れか若しくは高さf −1(r)と高さf −1(r)の平均値として算出する高さ算出ステップと、
を実行することを特徴とする。
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の構成において、前記幅算出ステップを実行した後に、前記左垂直平面の右側辺と前記右垂直平面の左側辺との間の水平幅をr、前記左垂直平面の左側辺と前記右垂直平面の右側辺との間の水平幅をr+rとしたとき、前記計測原点で計測された水平幅r,rを、それぞれ式(4a),(4b)により補正して補正水平幅r’,r’を算出する水平幅補正ステップを実行し、
前記高さ算出ステップにおいては、前記レーザースキャナの計測原点Oの高さHを、高さf −1(r’)又は高さf −1(r’)の何れか若しくは高さf −1(r’)と高さf −1(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,C間の水平幅及び前記端測点B,C間の水平幅を算出するとともに、前記各点群データについての前記端測点A,C間の水平幅の平均値を前記水平幅r、前記各点群データについての前記端測点B,C間の水平幅の平均値を前記水平幅rとして算出することを特徴とする。
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の単調関数f(z)に従って変化する左垂直平面と、水平幅が高さzの単調関数f(z)に従って変化する右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査し、M個(Mは整数)の測点の計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,C間の水平幅r及び前記端測点B,C間の水平幅rを算出する幅算出ステップと、
前記関数f(z),f(z)の逆関数をそれぞれf −1(x),f −1(x)としたとき、前記左垂直平面における走査線の高さhをf −1(r)、前記右垂直平面における走査線の高さhをf −1(r)として算出する高さ算出ステップと、
前記高さh、前記高さh、及び前記距離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だけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査し、M個(Mは整数)の測点の計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,Cを含む前記端測点A,C間のm個の測点(以下「左有効測点」という。)P(i=n,…,n+m−1)の相対座標、及び前記端測点B,Cを含む前記端測点B,C間のm個の測点(以下「右有効測点」という。)P(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出ステップと、
前記各左有効測点及び前記各右有効測点の相対座標に基づき、互いに平行な2つの走査線L及びLの傾き及び切片を、前記走査線Lから前記各左有効測点P(i=n,…,n+m−1)までの距離の和に、前記走査線Lから前記各右有効測点P(i=n,…,n+m−1)までの距離の和を加えた値が最小となるように、最小自乗法により算出する走査線算出ステップと、
前記走査線Lから前記走査線Lまでの距離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組の前記点群データをコンピュータに取り込み記憶装置に保存し、
前記有効測点抽出ステップにおいては、前記各点群データに対してそれぞれ前記左有効測点の相対座標及び前記右有効測点の相対座標を抽出し、
前記走査線算出ステップにおいては、前記各点群データに対してそれぞれ前記走査線L及び前記走査線Lの傾き及び切片を算出し、
前記走査線間距離算出ステップにおいては、前記各点群データに対してそれぞれ前記走査線Lから前記走査線Lまでの距離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を有するターゲットを、前記垂直平面の前方の計測原点Oからレーザースキャナにより三次元的に走査し、M×N個(M,Nは整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記垂直平面ABCDの4隅の頂点A,B,C,Dに最も近い測点(以下「隅測点」という。)P,P,P,Pを特定し、前記隅測点P,P,P,Pを含む、前記隅測点P,P,P,Pを頂点とする四角形で囲まれた領域内のm×n個の測点(以下「有効測点」という。)Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)の相対座標を抽出する有効測点抽出ステップと、
前記垂直平面ABCDの4隅の頂点A,B,C,Dを基準に測地座標系を設定し、前記頂点Aと前記隅測点Pとの間の距離d、前記頂点Bと前記隅測点Pとの間の距離d、前記頂点Cと前記隅測点Pとの間の距離d、前記頂点Dと前記隅測点Pとの間の距離d、及び前記隅測点P,P,P,P以外の前記各有効測点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の構成において、前記座標決定ステップにおいては、前記測地座標系における前記隅測点P,P,P,Pの位置座標の初期値を設定する第1の初期化ステップと、
前記隅測点P,P,P,Pの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記隅測点P,P,P,P以外の前記各有効測点Pi,j及び前記計測原点Oの前記測地座標系における位置座標の初期値を算出する第2の初期化ステップと、
前記距離d,d,d,d、及び前記各距離di,jの和又は自乗和を評価関数として、前記計測原点O及び前記隅測点P,P,P,Pを含む前記各有効測点Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点O及び前記各有効測点Pi,jの回転及び平行移動を行う幾何変換の各変換パラメータを、反復法により算出する変換パラメータ算出ステップと、
算出された前記各変換パラメータにより前記計測原点Oの位置座標の初期値をヘルマート変換し、前記計測原点Oの前記測地座標系における位置座標を算出する原点座標確定ステップと、
所定の方位角範囲及び仰角範囲を回転走査する前記レーザースキャナの走査範囲の中心方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Oの前記測地座標系における位置座標とに基づいて、前記注視点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 = 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,
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 laser scanner 1 according to Embodiment 1 of the present invention that is grounded to a carriage. The laser scanner 1 is mounted horizontally in front of the carriage 2. The cart 2 is a hand-held four-wheel cart, and it is possible to scan surrounding features while moving the laser scanner 1 by pushing the cart manually. A computer 3 is installed on the upper surface of the carriage 2. The point cloud data obtained by scanning with the laser scanner 1 is transferred to the computer 3 via the connection cable and stored in a storage device inside the computer 3. The computer 3 is installed with a calibration program for the laser scanner 1. By executing this program, the computer 3 functions as a laser scanner calibration apparatus according to the first embodiment of the present invention.

図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 scanner calibration apparatus 10 according to the first embodiment of the present invention. In FIG. 2, the laser scanner 1 and the computer 3 are the same as those in FIG. The computer 3 includes a communication interface 9, a calibration device 10, and a calibration parameter storage unit 11. Actually, the calibration apparatus 10 is provided as a calibration program, and is functionally realized by causing the computer 3 to execute the calibration program. The calibration parameter storage unit 11 is configured by a storage device (such as a magnetic disk device) inside the computer 3.

キャリブレーション装置10は、点群データ記憶部12、有効測点抽出部13、及び座標決定部14を備えている。点群データ記憶部12は、レーザースキャナ1からコンピュータ3に取り込まれた点群データを記憶する。点群データ記憶部12は、磁気ディスクやRAM(ランダム・アクセス・メモリ)などの記憶装置により構成される。有効測点抽出部13は、点群データ記憶部12に保存された点群データの中から、キャリブレーション計算に必要な有効測点を抽出する。座標決定部14は、レーザースキャナの光軸の軌跡が前記垂直平面を切る線である走査線Eを基準に測地座標系を設定し、レーザースキャナの計測原点Oを基準とする相対座標を前記測地座標へ関係づける関係パラメータを決定する。 The calibration apparatus 10 includes a point cloud data storage unit 12, an effective measurement point extraction unit 13, and a coordinate determination unit 14. The point cloud data storage unit 12 stores the point cloud data taken into the computer 3 from the laser scanner 1. The point cloud data storage unit 12 is configured by a storage device such as a magnetic disk or a RAM (Random Access Memory). The effective measurement point extraction unit 13 extracts effective measurement points necessary for calibration calculation from the point cloud data stored in the point cloud data storage unit 12. The coordinate determination unit 14 sets a geodetic coordinate system based on the scanning line E 1 E 2 , which is a line in which the locus of the optical axis of the laser scanner cuts the vertical plane, and is relative to the measurement origin O m of the laser scanner. A relational parameter relating the coordinates to the geodetic coordinates is determined.

また、上記座標決定部14は、第1初期化部16、第2初期化部17、変換パラメータ算出部18、原点座標確定部19、及び注視点座標確定部20を備えている。これら各部の機能については、以下の動作説明と併せて説明する。   The coordinate determination unit 14 includes a first initialization unit 16, a second initialization unit 17, a conversion parameter calculation unit 18, an origin coordinate determination unit 19, and a gazing point coordinate determination unit 20. The functions of these units will be described together with the following operation description.

次に、図2のキャリブレーション装置10によるレーザースキャナのキャリブレーション方法について説明する。   Next, a laser scanner calibration method using the calibration apparatus 10 of FIG. 2 will be described.

図3は、本発明の実施例1に係るレーザースキャナのキャリブレーション方法で使用するターゲットの外観斜視図である。ターゲットTは、左右両側辺が平行かつ垂直な垂直平面Sを有している。垂直平面Sの水平幅はrである。垂直平面Sの左右両側辺は直角となっている。尚、使用可能なターゲットの両側辺の折れ曲がり角度は、必ずしも直角である必要はなく、凸角(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.

このようなターゲットTとしては、例えば、建物内の柱などを用いることができる。もちろん、キャリブレーション用に、図3のような形状の箱を用意してそれを使用してもよい。ターゲットTは簡単な形状であるため、例えば、段ボールや板を用いて容易に作成することができる。 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.

このターゲットTに対して、レーザースキャナ1により水平に走査を行う。このとき、レーザースキャナ1が照射するレーザービームの光軸の軌跡面(扇形状に広がる水平平面)Slocusが垂直平面Sを切る線分を「走査線」といい、Eと記す。また、レーザースキャナの光軸の回動中心点を「計測原点」といいOと記す。レーザースキャナ1が1回の走査において走査を開始する光軸の方位角と走査を終了する光軸の方位角との差角を「走査角」といい、θと記す。レーザースキャナ1の走査角度範囲の中心方向の光軸上の測点を「注視点」といい、Gと記す。ターゲットT,垂直平面S,走査線E,計測原点O,光軸の軌跡面Slocus,走査角θ,及び注視点Gの関係は、図3に示した通りである。 The target T 1 is scanned horizontally by the laser scanner 1. At this time, the line segment where the locus plane (horizontal plane spreading in a fan shape) S locus of the laser beam irradiated by the laser scanner 1 cuts the vertical plane S 1 is referred to as “scanning line” and is denoted as E 1 E 2. . The rotation center point of the optical axis of the laser scanner is called “measurement origin” and is denoted as O m . The difference angle between the azimuth angle of the optical axis at which the laser scanner 1 starts scanning in one scan and the azimuth angle of the optical axis at which scanning ends is referred to as “scan angle” and is denoted as θ. A measuring point on the optical axis in the center direction of the scanning angle range of the laser scanner 1 is referred to as a “gaze point” and is denoted as G. The relationship among the target T 1 , the vertical plane S 1 , the scanning line E 1 E 2 , the measurement origin O m , the optical axis locus plane S locus , the scanning angle θ, and the gaze point G is as shown in FIG.

キャリブレーションにおいては、ターゲットTに固定した測地座標系における計測原点O及び注視点Gの位置座標を確定する。ここで測地座標系は、原点Oを走査線Eの左側の端点Eとし、走査線方向を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を、ターゲットTの垂直平面S前方の水平な床面に設置し、水準器等を用いて走査の際の光軸の軌跡面Slocusが水平となるように調節する。レーザースキャナ1の計測原点の高さも、あらかじめ矩尺等により計測しておく。レーザースキャナ1の内部構造は設計図により既知であるため、この高さは正確に測定することができる。また、ターゲットTの垂直平面Sの水平幅rも、あらかじめ矩尺などにより計測し、コンピュータ3に入力しておく。 First, in step S1, the carriage 3 the laser scanner 1 is mounted, is placed on level surface of the vertical plane S 1 in front of the target T 1, the trajectory plane of the optical axis during the scanning with a level or the like Adjust so that the S locus is horizontal. The height of the measurement origin of the laser scanner 1 is also measured in advance with a rectangular scale or the like. Since the internal structure of the laser scanner 1 is known from the design drawing, this height can be measured accurately. Further, the horizontal width r of the vertical plane S 1 of the target T 1 is also measured in advance with a rectangular scale or the like and input to the computer 3.

そして、レーザースキャナ1により、垂直平面Sを含む範囲を走査する。レーザースキャナ1は、スキャンヘッドを一定の方位角範囲で回動させながら走査を行う。従って、レーザービームの光軸は水平面内で回動し、一定の回転角ごとに測点までの距離情報がサンプリングされる。サンプリングにより得られる点群データは、コンピュータ3に転送され、点群データ記憶部12に保存される。 Then, by the laser scanner 1 to scan a range including a vertical plane S 1. The laser scanner 1 performs scanning while rotating the scan head within a certain azimuth range. Therefore, the optical axis of the laser beam rotates in a horizontal plane, and distance information to the measurement point is sampled at every fixed rotation angle. The point cloud data obtained by sampling is transferred to the computer 3 and stored in the point cloud data storage unit 12.

図5に、ターゲットTの走査により得られる各測点P(i=1,2,…,M)と計測原点Oとの位置関係を示す。1回の走査におけるサンプリング数をMとする。レーザースキャナ1のサンプリング間隔(方位角間隔)を「角分解能」といい、θと記す。レーザースキャナ1は、方位角θから走査を開始する。i番目(i=1,2,…,M)のサンプリング方向における方位角θ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 laser scanner 1 is referred to as “angular resolution” and is denoted as θ s . Laser scanner 1 starts scanning from the azimuth angle theta 1. The azimuth angle θ i in the i-th (i = 1, 2,..., M) sampling direction is

Figure 2009168472
である。また、各サンプリング方向の光軸が計測対象物に当たりレーザービームが反射される点を「測点」といい、Pと記す。また、計測原点Oから測点Pまでの距離(光軸の長さ)をlと記す。
Figure 2009168472
It is. Also, the point at which the optical axis of each sampling direction the laser beam is reflected Upon measurement object called "survey point", referred to as P i. The distance from the measurement origin O m to stations P i (the length of the optical axis) denoted as l i.

また、光軸が走査線Eと交差するサンプリング方向における測点を「有効測点」という。図5において、n番目から(n+m−1)番目の測点P(j=n,n+1,…,n+m−1)が有効測点である。すべての有効測点のうち右端及び左端のものを「端測点」といい、それぞれA,Bと記す。A=P,B=Pn+m−1である。また、計測原点Qmから各A,B端への距離をl=l,l=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回の走査により点群データ{(l,θ)|i=1,2,…,M}を取得する。この点群データ{(l,θ)|i=1,2,…,M}が点群データ記憶部12に保存される。 The laser scanner 1 acquires point cloud data {(l i , θ i ) | i = 1, 2,..., M} by one scan. The point cloud data {(l i , θ i ) | i = 1, 2,..., M} is stored in the point cloud data storage unit 12.

次に、ステップS2で、有効測点抽出部13は、上記点群データ{(l,θ)|i=1,2,…,M}の中から、垂直平面Sの左右両側の端部の端測点A,Bを特定し、端測点A,B間のm個の有効測点P(j=n,…,n+m−1)の相対座標{(l,θ)|j=n,n+1,…,n+m−1}を抽出する。 Next, in step S2, the effective measurement point extraction unit 13, the point cloud data {(l i, θ i) | i = 1,2, ..., M} from the, vertical plane S 1 left and right sides of the End stations A and B are identified, and relative coordinates {(l j , θ j ) of m effective stations P j (j = n,..., N + m−1) between the end stations A and B are specified. ) | J = n, n + 1,..., N + m−1} is extracted.

図5から分かるように、計測原点Oから各測点Pまでの距離lは、垂直平面Sの左右両側の凸角部において不連続となるので、距離データ{l}の差分を閾値判定するなどしてこの不連続点を抽出することによって、端測点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 computer 3 and the operator directly designates the end points A and B by an input device such as a pointing device. Also good.

次に、ステップ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.

ここで、測地座標系における走査線Eの端点E,Eの位置座標は、(0,0)及び(r、0)である(尚、z座標は光軸の軌跡面Slocus上ではすべて等しいので、以下省略する)。一方、実際にレーザースキャナ1から出力される点群データは、計測距離及び計測角が離散化されることによって生じる量子化誤差により、図6のように、走査線Eから若干外れたものとなる。また、端測点A,Bは、必ずしも走査線の端点E,Eと正確に一致するとは限られない。そこで、端測点A,Bの位置座標の初期値は、図7に示したように、端測点A,Bが走査線E上に位置し、かつ端点Eから端測点Aまでの距離と端点Eから端測点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 laser scanner 1 slightly deviated from the scanning lines E 1 E 2 as shown in FIG. 6 due to quantization errors caused by discretizing the measurement distance and the measurement angle. It will be a thing. Further, the end measurement points A and B are not necessarily exactly coincident with the end points E 1 and E 2 of the scanning line. Therefore, as shown in FIG. 7, the initial values of the position coordinates of the end stations A and B are as follows. The end stations A and B are located on the scanning line E 1 E 2 and the end stations E 1 to the end stations. is the distance from the distance and the end point E 2 from a to the end measuring point B is set to be equal.

いま、端測点A,Bのレーザースキャナ座標系における座標値を   Now, the coordinate values of the edge measuring points A and B in the laser scanner coordinate system

Figure 2009168472
とする。光軸OAと光軸OBとがなす角θ’はθAB=|θ−θ|である。また、測地座標系における端測点A,Bの位置座標の初期値をそれぞれ、
Figure 2009168472
And An angle θ ′ formed by the optical axis O m A and the optical axis O m B is θ AB = | θ A −θ B |. In addition, the initial values of the position coordinates of the end stations A and B in the geodetic coordinate system are respectively

Figure 2009168472
とする。ここで、A’,B’は測地座標系の初期位置に配置された端測点A,Bを表している。端点Eから端測点A’までの距離をd、端点Eから端測点B’までの距離dと記す。いま、d=dなので、x’=r−x’の関係が成り立つ。また、端測点A’,B’は走査線E上なので、y=y=0である。端測点Aと端測点Bとの間の距離をrABとする。
Figure 2009168472
And Here, A ′ and B ′ represent end stations A and B arranged at the initial position of the geodetic coordinate system. 'The distance to the d A, from the end point E 2 end measuring point B' from the end point E 1 end measuring point A referred to the distance d B to. Now, since d A = d B , the relationship x ′ A = r−x ′ B holds. Further, since the end measurement points A ′ and B ′ are on the scanning line E 1 E 2 , y A = y B = 0. The distance between the end measurement point A and the Tanhaka point B and r AB.

Figure 2009168472
Figure 2009168472

余弦定理により、(x’,y’),(x’,y’)は次式により算出することができる。 According to the cosine theorem, (x ′ A , y ′ A ) and (x ′ B , y ′ B ) can be calculated by the following equations.

Figure 2009168472
Figure 2009168472

次に、ステップS4で、第2初期化部17は、端測点A,Bの位置座標の初期値(x’,y’),(x’,y’)に基づき、計測原点Oの測地座標系における位置座標の初期値(x’,y’)を算出する。以下、計測原点Oの位置座標の初期値(x’,y’)により特定される位置の点をO’と記す。計測原点O’は、端測点A’を中心とする半径lの円と、端測点B’を中心とする半径lの円との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.

Figure 2009168472
Figure 2009168472

いま、測地座標系は図3のように設定したのでy’<0である。従って、計測原点Oの位置座標の初期値(x’,y’)は、式(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).

Figure 2009168472
Figure 2009168472

更に、第2初期化部17は、端測点A,B以外の有効測点P(j=n+1,…,n+m−2)の測地座標系における位置座標の初期値(x’,y’)を算出する。端測点B=Pの方位角は、次式で表される。 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.

Figure 2009168472
計測原点Oから有効測点Pに向かう光軸Oの方位角θは式(7)と同様に表される。従って、次式が成り立つ(図8参照)。
Figure 2009168472
The azimuth angle θ j of the optical axis O m P j from the measurement origin O m toward the effective measurement point P j is expressed in the same manner as in the equation (7). Therefore, the following equation holds (see FIG. 8).

Figure 2009168472
Figure 2009168472

従って、有効測点P(j=n+1,…,n+m−2)の測地座標系における位置座標の初期値(x’,y’)は、次式により算出される。 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.

Figure 2009168472
Figure 2009168472

次に、ステップS5で、変換パラメータ算出部18は、距離d、距離d、及び距離d(j=n+1,…,n+m−2)の自乗和を評価関数fとして、計測原点O及び各有効測点P(j=n,…,n+m−1)の位置座標の初期値から開始して、評価関数fの値が最小となるように、計測原点O及び各有効測点Pの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する。ここで、距離dは走査線Eの端点Eから端測点Aまでの距離、距離dは走査線Eの端点Eから端測点Bまでの距離、距離dは走査線Eから有効測点Pまでの距離である(図9参照)。 Next, in step S5, the conversion parameter calculation unit 18 uses the sum of squares of the distance d A , the distance d B , and the distance d j (j = n + 1,..., N + m−2) as the evaluation function f, and then the measurement origin O m Starting from the initial value of the position coordinates of each effective measurement point P j (j = n,..., N + m−1), the measurement origin O m and each effective measurement point are set so that the value of the evaluation function f is minimized. Each transformation parameter of Helmert transformation that performs rotation and translation of P j is calculated by an iterative method. Here, the distance d A is the distance from the end point E 1 of the scanning line E 1 E 2 to the end measuring point A, and the distance d B is the distance from the end point E 2 to the end measuring point B of the scanning line E 1 E 2. d j is a distance from the scanning line E 1 E 2 to the effective measuring point P j (see FIG. 9).

この計算は、次のようにして行うことができる。今、初期値として測地座標が設定された測点A’,B’,P’(j=n+1,n+2,…,n+m−2)を、原点O=(0,0)を中心に回転移動した後に平行移動する変換(ヘルマート変換)を行うとする。回転移動の回転量をΔθ,平行移動の移動量を(Δx,Δy)とする。測点A’,B’,P’をヘルマート変換により移動した点をそれぞれA”,B”,P”と記す。移動後の測点A”,B”,P”の座標は、それぞれ次のように表される。 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.

Figure 2009168472
Figure 2009168472

従って、距離d、距離d、及び距離d(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.

Figure 2009168472
Figure 2009168472

従って、最小化すべき評価関数f(Δx,Δy,Δθ)は次式で表される。   Therefore, the evaluation function f (Δx, Δy, Δθ) to be minimized is expressed by the following equation.

Figure 2009168472
Figure 2009168472

ここで、   here,

Figure 2009168472
とおくと、上記評価関数fは次式のように書き直すことができる。
Figure 2009168472
Then, the evaluation function f can be rewritten as the following equation.

Figure 2009168472
Figure 2009168472

この評価関数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.

Figure 2009168472
Figure 2009168472

尚、本実施例では、計算を簡単化するために、評価関数fは距離d、距離d、及び距離d(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により計測原点Oの位置座標の初期値(x’,y’)をヘルマート変換し、計測原点Oの測地座標系における最終的な位置座標(x,y)を算出する。算出された位置座標(x,y)は、キャリブレーションパラメータ記憶部11に保存される。ここで、位置座標(x,y)は次式のようにして計算することができる。 Next, in step S6, the origin coordinate determination unit 19 performs Helmart transformation on the initial value (x ′ O , y ′ O ) of the position coordinate of the measurement origin O m by the calculated conversion parameters Δx, Δy, a, b. Then, the final position coordinates (x O , y O ) in the geodetic coordinate system of the measurement origin O m are calculated. The calculated position coordinates (x O , y O ) are stored in the calibration parameter storage unit 11. Here, the position coordinates (x O , y O ) can be calculated as follows.

Figure 2009168472
Figure 2009168472

最後に、ステップS7で、注視点座標確定部20は、レーザースキャナの走査角度範囲の中心方向の光軸上の測点である注視点Gの相対座標(l,θ)を点群データから抽出し、該注視点Gの相対座標(l,θ)と計測原点Oの測地座標系における最終的な位置座標(x,y)とに基づいて、注視点Gの測地座標系における位置座標(x,y)を算出する。算出された位置座標(x,y)は、キャリブレーションパラメータ記憶部11に保存される。ここで、位置座標(x,y)は次式のようにして計算することができる。 Finally, in step S7, the gazing point coordinate determination unit 20 uses the relative coordinates (l G , θ G ) of the gazing point G, which is a measurement point on the optical axis in the center direction of the scanning angle range of the laser scanner, as point cloud data. Based on the relative coordinates (l G , θ G ) of the gazing point G and the final position coordinates (x O , y O ) in the geodetic coordinate system of the measurement origin O m. The position coordinates (x G , y G ) in the coordinate system are calculated. The calculated position coordinates (x G , y G ) are stored in the calibration parameter storage unit 11. Here, the position coordinates (x G , y G ) can be calculated as follows.

Figure 2009168472
Figure 2009168472

以上のような処理により、キャリブレーションデータとして、測地座標系における計測原点Oの位置座標(x,y)及び注視点Gの位置座標(x,y)が確定される。この確定された位置座標を基準にして、他の測定データの測地座標系における位置座標も逐次確定していくことができる。 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のターゲットTは、左右両側辺が平行かつ垂直な垂直平面S,Sを有している。各垂直平面S,Sは互いに平行である。尚、本実施例では、説明を簡単化するため、垂直平面の数は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.

このターゲットTに対して、レーザースキャナ1により水平に走査を行う。垂直平面S,S上の走査線を、それぞれE1,11,2,E2,12,2と記す。測地座標系の原点Oを走査線E1,11,2の左側の端点E1,1とし、走査線E1,11,2方向をx軸、走査線E1,11,2方向に垂直で光軸の軌跡面Slocus内の方向をy軸、垂直上方をz軸とする。垂直平面S,Sの幅をr,rとする。また、y軸から垂直平面S(k=1,2)の左端までの距離をxk,0、x軸から垂直平面Sまでの距離をDとする。 The target T 2 is scanned horizontally by the laser scanner 1. The scanning line on the vertical plane S 1, S 2, respectively E 1,1 E 1,2, referred to as E 2,1 E 2,2. The origin O of the geodetic coordinate system and the left end point E 1, 1 scan line E 1, 1 E 1, 2, the scanning lines E 1, 1 E 1, 2 direction x-axis, scanning lines E 1, 1 E 1 , The direction in the locus plane S locus of the optical axis perpendicular to the two directions is the y-axis, and the upper vertical direction is the z-axis. The widths of the vertical planes S 1 and S 2 are r 1 and r 2 . Further, the distance from the y axis to the left end of the vertical plane S k (k = 1, 2) is x k, 0 , and the distance from the x axis to the vertical plane S k is D k .

本実施例のレーザースキャナのキャリブレーション方法の処理の流れは、基本的には実施例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と同様である。この場合、ターゲットTの走査により得られる各測点P(i=1,2,…,M)と計測原点Oとの位置関係は図11のようになる。 Installation of the laser scanner 1 in step S1, scanning by the laser scanner 1, and taking in point cloud data into the computer 3 are the same as in the first embodiment. In this case, the positional relationship between each measurement point P i (i = 1, 2,..., M) obtained by scanning the target T 2 and the measurement origin O m is as shown in FIG.

次に、ステップS2で、有効測点抽出部13は、垂直平面S,Sの左右両側の端部の端測点(A,B),(A,B)を特定し、端測点(A,B)間のm個の有効測点P(j=n,…,n+m−1)の相対座標{(l,θ)|j=n,n+1,…,n+m−1}、及び端測点(A,B)間のm個の有効測点P(j=n,…,n+m−1)の相対座標{(l,θ)|j=n,n+1,…,n+m−1}を抽出する。抽出の方法は、実施例1の場合と同様である。 Next, in step S2, the effective measurement point extraction unit 13 specifies the end measurement points (A 1 , B 1 ) and (A 2 , B 2 ) at the left and right ends of the vertical planes S 1 and S 2. , Relative coordinates {(l j , θ j ) | j of m 1 effective measurement points P j (j = n 1 ,..., N 1 + m 1 −1) between end stations (A 1 , B 1 ) = N 1 , n 1 +1,..., N 1 + m 1 -1} and m 2 effective measuring points P j (j = n 2 ,..., N 2 ) between the end measuring points (A 2 , B 2 ) + M 2 −1) relative coordinates {(l j , θ j ) | j = n 2 , n 2 +1,..., N 2 + m 2 −1} are extracted. The extraction method is the same as in the first embodiment.

次に、ステップS3で、第1初期化部16は、測地座標系における端測点(A,B),(A,B)の位置座標の初期値を決定する。垂直平面S,Sにおける各端測点のレーザースキャナ座標系における座標値、測地座標系における位置座標、及び走査線の長さを、実施例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.

Figure 2009168472
Figure 2009168472

尚、[rA1B2は、最も左側の端測点Aから最も右側の端測点Bまでの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+rとすれば、測地座標系における位置座標の初期値(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.

Figure 2009168472
Figure 2009168472

ここで、端点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は、計測原点Oの測地座標系における位置座標の初期値(x’,y’)を算出する。この計算は、実施例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.

Figure 2009168472
Figure 2009168472

また、第2初期化部17は、端測点(A,B),(A,B)以外の有効測点P(j=n+1,…,n+m−2,n+1,…,n+m−2)の測地座標系における位置座標の初期値(x’,y’)を算出する。この計算は、実施例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.

Figure 2009168472
Figure 2009168472

次に、ステップS5で、変換パラメータ算出部18は、距離d1,A,d1,B,d2,A,d2,B及び距離d(j=n+1,…,n+m−2,n+1,…,n+m−2)の自乗和を評価関数fとして、計測原点O及び各有効測点P(j=n,…,n+m−1,n,…,n+m−1)の位置座標の初期値から開始して、評価関数fの値が最小となるように、計測原点O及び各有効測点Pの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する。ここで、距離dk,A(k=1,2)は走査線Ek,1k,2の端点Ek,1から端測点Aまでの距離、距離dk,Bは走査線Ek,1k,2の端点Ek,2から端測点Bまでの距離、距離dk,j(j=nk,…,nk+mk−1)は走査線Ek,1k,2から有効測点Pまでの距離である(図11参照)。この場合の距離dk,A,dk,B,dk,j及び評価関数fは以下のようになる。 Next, in step S5, the conversion parameter calculation unit 18, a distance d 1, A, d 1, B, d 2, A, d 2, B and the distance d j (j = n 2 + 1, ..., n 2 + m 2 -2, n 1 + 1, ..., n 1 + m 1 the sum of squares of -2) as the evaluation function f, the measurement origin O m and each active stations P j (j = n 2, ..., n 2 + m 2 - 1, n 1 ,..., N 1 + m 1 −1), starting from the initial position coordinates, and rotating the measurement origin O m and each effective measurement point P j so that the value of the evaluation function f is minimized. And each transformation parameter of the Helmat transform that performs translation is calculated by an iterative method. Here, the distance d k, A (k = 1,2 ) is the distance from the scanning line E k, 1 E k, 2 of the end point E k, 1 to the end measurement point A k, the distance d k, B scan line A distance d k, j (j = n k ,..., N k + m k −1) from the end point E k, 2 of E k, 1 E k, 2 to the end measuring point B k is the scanning line E k, The distance from 1 E k, 2 to the effective measuring point P j (see FIG. 11). The distances d k, A , d k, B , d k, j and the evaluation function f in this case are as follows.

Figure 2009168472
反復法の計算も、評価関数の形が若干異なるが、実施例1と同様にして行うことができる。
Figure 2009168472
Calculation of the iterative method can be performed in the same manner as in the first embodiment, although the shape of the evaluation function is slightly different.

次に、ステップS6で、原点座標確定部19は、算出された各変換パラメータΔx,Δy,a,bにより計測原点Oの位置座標の初期値(x’,y’)をヘルマート変換し、計測原点Oの測地座標系における最終的な位置座標(x,y)を算出する。算出された位置座標(x,y)は、キャリブレーションパラメータ記憶部11に保存される。 Next, in step S6, the origin coordinate determination unit 19 performs Helmart transformation on the initial value (x ′ O , y ′ O ) of the position coordinate of the measurement origin O m by the calculated conversion parameters Δx, Δy, a, b. Then, the final position coordinates (x O , y O ) in the geodetic coordinate system of the measurement origin O m are calculated. The calculated position coordinates (x O , y O ) are stored in the calibration parameter storage unit 11.

最後に、ステップS7で、注視点座標確定部20は、レーザースキャナの走査角度範囲の中心方向の光軸上の測点である注視点Gの相対座標(l,θ)を点群データから抽出し、該注視点Gの相対座標(l,θ)と計測原点Oの測地座標系における最終的な位置座標(x,y)とに基づいて、注視点Gの測地座標系における位置座標(x,y)を算出する。算出された位置座標(x,y)は、キャリブレーションパラメータ記憶部11に保存される。 Finally, in step S7, the gazing point coordinate determination unit 20 uses the relative coordinates (l G , θ G ) of the gazing point G, which is a measurement point on the optical axis in the center direction of the scanning angle range of the laser scanner, as point cloud data. Based on the relative coordinates (l G , θ G ) of the gazing point G and the final position coordinates (x O , y O ) in the geodetic coordinate system of the measurement origin O m. The position coordinates (x G , y G ) in the coordinate system are calculated. The calculated position coordinates (x G , y G ) are stored in the calibration parameter storage unit 11.

図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の計測原点Oの正確な高さHが未知の場合に、その高さHのキャリブレーションを行う。 The calibration apparatus 10 of this embodiment includes a point cloud data storage unit 12, a width calculation unit 25, a horizontal width correction unit 26, and a height calculation unit 27. The calibration apparatus 10, when exact height H of the measurement origin O m of the laser scanner 1 is unknown, calibration of the height H.

次に、図12のキャリブレーション装置10によるレーザースキャナのキャリブレーション方法について説明する。   Next, a laser scanner calibration method using the calibration apparatus 10 of FIG. 12 will be described.

図13は、本発明の実施例3に係るレーザースキャナのキャリブレーション方法で使用するターゲットの外観斜視図である。ターゲットTは、左側辺が垂直な直線で且つ右側辺が傾斜した直線である左垂直平面Sと、右側辺が垂直な直線で且つ左側辺が左垂直平面Sの右側辺と平行な傾斜直線である右垂直平面Sとを備えている。左垂直平面Sと右垂直平面Sは平行で且つ同一平面上にある。左垂直平面Sの右側辺と右垂直平面Sの左側辺とは一定の水平幅rだけ離隔している。 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 .

右垂直平面Sは底辺r、高さhの直角三角形であり、左垂直平面Sは右垂直平面Sと合同で180°回転させた直角三角形である。従って、高さzにおける右垂直平面Sの水平幅f、左垂直平面Sの水平幅fは、次式で表される。 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.

Figure 2009168472
Figure 2009168472

図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を、ターゲットTの垂直平面S前方の水平な床面に設置し、水準器等を用いて走査の際の光軸の軌跡面Slocusが水平となるように調節する。そして、レーザースキャナ1により、ターゲットTの走査を行う。レーザースキャナ1は、スキャンヘッドを一定の方位角範囲で回動させながら走査を行う。従って、レーザービームの光軸は水平面内で回動し、一定の回転角ごとに測点までの距離情報がサンプリングされる。サンプリングにより得られる点群データは、コンピュータ3に転送され、点群データ記憶部12に保存される。 First, in step S11, the carriage 3 the laser scanner 1 is mounted, is placed on level surface of the vertical plane S 1 in front of the target T 1, the trajectory plane of the optical axis during the scanning with a level or the like Adjust so that the S locus is horizontal. Then, the target T 3 is scanned by the laser scanner 1. The laser scanner 1 performs scanning while rotating the scan head within a certain azimuth range. Therefore, the optical axis of the laser beam rotates in a horizontal plane, and distance information to the measurement point is sampled at every fixed rotation angle. The point cloud data obtained by sampling is transferred to the computer 3 and stored in the point cloud data storage unit 12.

このとき、レーザースキャナ1が照射するレーザービームの光軸の軌跡面(扇形状に広がる水平平面)Slocusが左垂直平面Sを切る線分を走査線EL1L2、軌跡面Slocusが右垂直平面Sを切る線分を走査線ER1R2と呼ぶ(図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 beam laser scanner 1 is irradiated, is the locus surface S locus A line segment that cuts the right vertical plane S R is called a scanning line E R1 E R2 (see FIG. 13).

次に、ステップS12で、幅算出部25は、点群データ記憶部12に保存された点群データの中から、左垂直平面Sの左側の端測点A及び右側の端測点Cを抽出し、端測点A,C間の距離rを算出する。距離rを計算は、式(11e)と同様にして行うことができる。 Next, in step S12, the width calculation unit 25 selects the left end point A and the right end point C L of the left vertical plane SL from the point cloud data stored in the point cloud data storage unit 12. extract the end measurement point a, and calculates the distance r L between C L. The calculation of the distance r L can be performed in the same manner as the equation (11e).

次に、ステップS13で、幅算出部25は、点群データ記憶部12に保存された点群データの中から、右垂直平面Sの左側の端測点C及び右側の端測点Bを抽出し、端測点C,B間の距離rを算出する。距離rを計算は、式(11e)と同様にして行うことができる。 Next, in step S13, the width calculating unit 25, from the point group data stored in the point cloud data storage unit 12, point measuring left end of the right vertical plane S R C R and right end measuring point B And the distance r R between the end points C R and B is calculated. The distance r R calculations may be performed in the same manner as in the formula (11e).

次に、ステップS14で、水平幅補正部26は、計測された水平幅r,rを、それぞれ次式により補正して補正水平幅r’,r’を算出する。 Next, in step S14, the horizontal width correction unit 26 calculates the corrected horizontal widths r ′ L and r ′ R by correcting the measured horizontal widths r L and r R according to the following equations, respectively.

Figure 2009168472
Figure 2009168472

最後に、ステップS15で、高さ算出手段27は、レーザースキャナの計測原点Oの高さHを、次式により算出し、キャリブレーションパラメータ記憶部11に保存する。ここで、f −1(x),f −1(x)は、それぞれ、前記関数f(z),f(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 parameter storage unit 11. Here, f L −1 (x) and f R −1 (x) are inverse functions of the functions f L (z) and f R (z), respectively.

Figure 2009168472
Figure 2009168472

以上の処理により、レーザースキャナの計測原点Oの高さのキャリブレーションパラメータの算出を行うことができる。 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.

尚、本実施例において、ターゲットTの左垂直平面Sの右側辺と右垂直平面Sの左側辺との間の間隙は直線状の間隙としたが、図15に示したような、曲線状であってもよい。この場合、高さzにおける左垂直平面S,右垂直平面Sの水平幅を関数f(z),f(z)で表すと、f(z)=r−f(z)の関係となり、f(z)た単調減少関数又は単調増加関数である必要がある。このようなターゲットTを使用した場合、f(z),f(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の計測原点Oの正確な高さHが未知の場合に、その高さHのキャリブレーションを行う。 FIG. 16 is a flowchart of a laser scanner calibration method according to the fourth embodiment. The laser scanner 1 used in this embodiment is the same as that shown in FIG. 1, and the block diagram of the laser scanner calibration device 10 is the same as that shown in FIG. The calibration apparatus 10, similarly to Example 3, when exact height H of the measurement origin O m of the laser scanner 1 is unknown, calibration of the height H.

まず、ステップS21で、レーザースキャナ1が搭載された台車3を、ターゲットTの垂直平面S前方の水平な床面に設置し、水準器等を用いて走査の際の光軸の軌跡面Slocusが水平となるように調節する。そして、レーザースキャナ1により、図13や図15に示したようなターゲットTの走査を行う。走査の結果、サンプリングにより得られる点群データは、コンピュータ3に転送され、点群データ記憶部12に保存される。 First, in step S21, the carriage 3 the laser scanner 1 is mounted, is placed on level surface of the vertical plane S 1 in front of the target T 1, the trajectory plane of the optical axis during the scanning with a level or the like Adjust so that the S locus is horizontal. Then, by the laser scanner 1, to scan the target T 3 as shown in FIGS. 13 and 15. Point cloud data obtained by sampling as a result of scanning is transferred to the computer 3 and stored in the point cloud data storage unit 12.

次に、ステップS22で、N回目の測定が終了していなければ、ステップS24でレーザースキャナ1の設置位置を移動させ、再びステップS21に戻る。ここで、レーザースキャナ1の設置位置は、ターゲットTの前方で且つターゲットTの横幅が走査の際の光軸の軌跡面Slocusに含まれる位置であればどこでもよいが、ターゲットTからレーザースキャナ1までの距離を変えることが好ましい。ステップS22で、N回目の測定が終了した場合には、次のステップS24に進む。 Next, if the Nth measurement is not completed in step S22, the installation position of the laser scanner 1 is moved in step S24, and the process returns to step S21 again. Here, the installation position of the laser scanner 1 is good anywhere in position and width of the target T 3 in front of the target T 3 is included in the track surface S locus of the optical axis during the scanning, from the target T 3 It is preferable to change the distance to the laser scanner 1. If the Nth measurement is completed in step S22, the process proceeds to the next step S24.

ステップ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 width calculation unit 25 sequentially reads from the first point group data from among the N sets of point group data stored in the point group data storage unit 12. Here, the read point cloud data is set as the k-th (kε {1,..., N}) point cloud data {(l k, i , θ k, i ) | i = 1, 2,. M}. Here, (l k, i , θ k, i ) is polar coordinates in the laser scanner coordinate system of the i-th measurement point P k, i in the k- th point group data.

次に、ステップS25で、幅算出部25は、点群データ{(lk,i,θk,i)|i=1,2,…,M}の中から、左垂直平面Sの左側の端測点A及び右側の端測点Cを抽出し、端測点A,C間の距離rL,kを算出する。距離rL,kの計算は、式(11e)と同様にして行うことができる。 Next, in step S25, the width calculating unit 25, the point group data {(l k, i, θ k, i) | i = 1,2, ..., M} from the left of the left vertical plane S L The end point A and the right end point C L are extracted, and the distance r L, k between the end points A and C L is calculated. The calculation of the distance r L, k can be performed in the same manner as in the equation (11e).

次に、ステップS26で、幅算出部25は、点群データ{(lk,i,θk,i)|i=1,2,…,M}の中から、右垂直平面Sの左側の端測点C及び右側の端測点Bを抽出し、端測点C,B間の距離rR,kを算出する。距離rR,kを計算は、式(11e)と同様にして行うことができる。 Next, in step S26, the width calculating unit 25, the point group data {(l k, i, θ k, i) | i = 1,2, ..., M} from the left of the right vertical plane S R end extracts measurement points C R and right end measurement point B, and calculates the edge measuring point C R, the distance between B r R, a k. The distance r R, k can be calculated in the same manner as in the equation (11e).

次に、ステップS27で、水平幅補正部26は、計測された水平幅rL,k,rR,kを、それぞれ式(31a),(31b)と同様の計算により補正して補正水平幅r’L,k,r’R,kを算出する。 Next, in step S27, the horizontal width correction unit 26 corrects the measured horizontal widths r L, k , r R, k by calculation similar to the equations (31a) and (31b), respectively, and corrects the horizontal width. r ′ L, k and r ′ R, k are calculated.

最後に、ステップS28で、高さ算出手段27は、レーザースキャナの計測原点Oの高さHを、式(32)と同様の計算により算出する。算出した高さHは、キャリブレーションパラメータ記憶部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 parameter storage unit 11.

ステップ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 data storage unit 12, the process returns to step S24 again. If completed, the process proceeds to step S30.

ステップS30で、高さ算出手段27は、キャリブレーションパラメータ記憶部11に保存されたN個の高さH(k=1,…,N)を読み出し、その平均値Hを算出し、これを最終的な計測原点Oの高さとしてキャリブレーションパラメータ記憶部11に保存する。 In step S30, the height calculating unit 27 reads N heights H k (k = 1,..., N) stored in the calibration parameter storage unit 11, calculates an average value H thereof, and calculates this. to save the calibration parameter storage unit 11 as the height of the final measurement origin O m.

以上の処理により、レーザースキャナの計測原点Oの高さのキャリブレーションパラメータの算出を行うことができる。また、N回の測定の平均を行うことで、より誤差の少ない計測原点Oの高さのキャリブレーションを行うことができる。 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 calibration apparatus 10 of this embodiment includes a point cloud data storage unit 12, a width calculation unit 30, a height calculation unit 31, and an elevation angle calculation unit 32. The calibration device 10 calibrates the elevation angle φ when the optical axis direction of the laser beam of the laser scanner 1 is deviated from the horizontal.

次に、図12のキャリブレーション装置10によるレーザースキャナのキャリブレーション方法について説明する。   Next, a laser scanner calibration method using the calibration apparatus 10 of FIG. 12 will be described.

図18は、本発明の実施例5に係るレーザースキャナのキャリブレーション方法で使用するターゲットTの外観斜視図である。ターゲットTは、水平幅が高さzの単調関数f(z)に従って変化する左垂直平面Sと、水平幅が高さzの単調関数f(z)に従って変化する右垂直平面Sとを備えている。本実施例では、一例として、左垂直平面Sと右垂直平面Sは合同な直角三角形とし、右垂直平面Sの直角三角形は、鈎の長さがr、股の長さがhで、鈎が水平な床面に沿って置かれ、股が床面に垂直となるように配置されている。左垂直平面Sは、右垂直平面Sを180°回転させた直角三角形であり、股と弦との間の頂点で床面に接し、股が床面に垂直、鈎が床面に水平となるように配置されている。左垂直平面Sと右垂直平面Sは平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にある。また、左垂直平面Sの右側辺(弦)と右垂直平面Sの左側辺(弦)とは一定の水平幅rだけ離隔して配されている。従って、左垂直平面Sの高さzにおける幅f(z)と、左垂直平面Sの高さzにおける幅f(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.

Figure 2009168472
Figure 2009168472

図19は、実施例5に係るレーザースキャナのキャリブレーション方法のフローチャートである。   FIG. 19 is a flowchart of a laser scanner calibration method according to the fifth embodiment.

まず、ステップS31で、レーザースキャナ1が搭載された台車3を、ターゲットTの左垂直平面S及び右垂直平面S前方の水平な床面に設置し、水準器等を用いて走査の際の光軸の軌跡面Slocusが水平となるように調節する。そして、レーザースキャナ1により、ターゲットTの走査を行う。走査により得られる点群データは、コンピュータ3に転送され、点群データ記憶部12に保存される。 First, in step S31, the carriage 3 the laser scanner 1 is mounted, is placed on level surface of the left vertical plane S L and the right vertical plane S R in front of the target T 4, the scan using a spirit level or the like The locus surface S locus of the optical axis is adjusted so as to be horizontal. Then, the target T 4 is scanned by the laser scanner 1. The point cloud data obtained by scanning is transferred to the computer 3 and stored in the point cloud data storage unit 12.

このとき、レーザースキャナ1が照射するレーザービームの光軸の軌跡面Slocusが左垂直平面Sを切る線分を走査線EL1L2、軌跡面Slocusが右垂直平面Sを切る線分を走査線ER1R2と呼び、軌跡面Slocusの水平面からの仰角をφと記す(図18参照)。 At this time, the line locus surface S locus of the optical axis of the laser beam laser scanner 1 is irradiated left vertical plane S scan line segment to cut L E L1 E L2, the trajectory plane S locus off right vertical plane S R The minute is called a scanning line E R1 E R2, and the elevation angle of the locus plane S locus from the horizontal plane is denoted by φ (see FIG. 18).

次に、ステップS32で、幅算出部30は、点群データ記憶部12に保存された点群データの中から、左垂直平面Sの左側の端測点A及び右側の端測点Cを抽出し、端測点A,C間の水平幅rを算出する。水平幅rを計算は、式(11e)と同様にして行うことができる。 Next, in step S32, the width calculation unit 30 selects the left end point A and the right end point C L of the left vertical plane SL from the point cloud data stored in the point cloud data storage unit 12. extract the end measurement point a, to calculate the horizontal width r L between C L. The calculation of the horizontal width r L can be performed in the same manner as in the equation (11e).

次に、ステップS33で、幅算出部30は、点群データ記憶部12に保存された点群データの中から、右垂直平面Sの左側の端測点C及び右側の端測点Bを抽出し、端測点C,B間の水平幅rを算出する。水平幅rを計算は、式(11e)と同様にして行うことができる。 Next, in step S33, the width calculating unit 30, from the point group data stored in the point cloud data storage unit 12, point measuring left end of the right vertical plane S R C R and right end measuring point B And a horizontal width r R between the end points C R and B is calculated. The horizontal width r R calculations may be performed in the same manner as in the formula (11e).

次に、ステップS34で、高さ算出部31は、水平幅r,rに基づいて、次式により左垂直平面Sを切る走査線EL1L2の高さh及び右垂直平面Sを切る走査線ER1R2の高さhを算出する。 Next, in step S34, the height calculation unit 31 determines the height h L and the right vertical plane of the scanning line E L1 E L2 that cuts the left vertical plane S L according to the following equation based on the horizontal widths r L and r R. The height h R of the scanning line E R1 E R2 that cuts S R is calculated.

Figure 2009168472
Figure 2009168472

最後に、ステップS35で、仰角算出部32は、前記高さh,h、及び左垂直平面Sと右垂直平面Sの距離dに基づき、レーサースキャナ1の光軸の仰角φを式(35)により算出し、キャリブレーションパラメータ記憶部11に保存する。 Finally, in step S35, the elevation angle calculating unit 32, the height h L, h R, and based on the distance d of the left vertical plane S L and the right vertical plane S R, the elevation angle φ of the optical axis of the racer scanner 1 It is calculated by equation (35) and stored in the calibration parameter storage unit 11.

Figure 2009168472
Figure 2009168472

以上の処理により、レーザースキャナの光軸の仰角φのキャリブレーションパラメータの算出を行うことができる。   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 calibration apparatus 10 of this embodiment includes a point cloud data storage unit 12, an effective measurement point extraction unit 41, a scanning line calculation unit 42, a scanning line distance calculation unit 43, an elevation angle calculation unit 44, and an averaging unit 45. ing. The calibration device 10 calibrates the elevation angle φ when the optical axis direction of the laser beam of the laser scanner 1 is deviated from the horizontal.

次に、図20のキャリブレーション装置10によるレーザースキャナのキャリブレーション方法について説明する。   Next, a laser scanner calibration method using the calibration apparatus 10 of FIG. 20 will be described.

図21は、本発明の実施例6に係るレーザースキャナのキャリブレーション方法で使用するターゲットTの外観斜視図である。ターゲットTは、左側辺及び右側辺が垂直且つ平行な左垂直平面Sと、左側辺及び右側辺が垂直且つ平行な右垂直平面Sとを備えている。左垂直平面Sを含む平面と右垂直平面Sを含む平面とは、平行で且つそれぞれ互いに一定の距離dだけ離隔している。図21のターゲットTは、左垂直平面Sと右垂直平面Sは水平幅が同幅とされており、両者の水平幅をrと記す。また、左垂直平面Sと右垂直平面Sは水平距離でrだけ離隔している。 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を、ターゲットTの左垂直平面S及び右垂直平面S前方の水平な床面に設置し、水準器等を用いて走査の際の光軸の軌跡面Slocusが水平となるように調節する。そして、レーザースキャナ1により、ターゲットTの走査を行う。走査により得られる点群データ{(lk,i,θk,i)|i=1,2,…,M}(k∈{1,…,N})は、コンピュータ3に転送され、点群データ記憶部12に保存される。 First, in step S41, the carriage 3 the laser scanner 1 is mounted, it is placed to the left vertical plane S L and level surface of the right vertical plane S R in front of the target T 5, the scanning using the spirit level, etc. The locus surface S locus of the optical axis is adjusted so as to be horizontal. Then, by the laser scanner 1, to scan the target T 5. The point cloud data {(l k, i , θ k, i ) | i = 1, 2,..., M} (k∈ {1,..., N}) obtained by scanning is transferred to the computer 3 and the points It is stored in the group data storage unit 12.

このとき、レーザースキャナ1が照射するレーザービームの光軸の軌跡面Slocusが左垂直平面Sを切る線分を走査線L、軌跡面Slocusが右垂直平面Sを切る線分を走査線Lと呼び、軌跡面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 laser scanner 1 is irradiated, trajectory plane S locus off right vertical plane S R referred to as a scanning line L R, referred to as the elevation angle from the horizontal plane of the trajectory plane S locus phi (see FIG. 21).

ステップS42において、N回目の測定が終了していなければ、ステップS43でレーザースキャナ1の設置位置を移動させ、再びステップS41に戻る。ここで、レーザースキャナ1の設置位置は、ターゲットTの前方で且つターゲットTの横幅が走査の際の光軸の軌跡面Slocusに含まれる位置であればどこでもよいが、ターゲットTからレーザースキャナ1までの距離を変えることが好ましい。ステップS42で、N回目の測定が終了した場合には、次のステップS44に進む。 If the Nth measurement is not completed in step S42, the installation position of the laser scanner 1 is moved in step S43, and the process returns to step S41 again. Here, the installation position of the laser scanner 1 is good anywhere in position the lateral width of and the target T 5 in front of the target T 5 is included in the track surface S locus of the optical axis during the scanning, from the target T 5 It is preferable to change the distance to the laser scanner 1. If the Nth measurement is completed in step S42, the process proceeds to the next step S44.

ステップ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 data storage unit 12. Here, the read point cloud data is set as the k-th (kε {1,..., N}) point cloud data {(l k, i , θ k, i ) | i = 1, 2,. M}. Here, (l k, i , θ k, i ) is polar coordinates in the laser scanner coordinate system of the i-th measurement point P k, i in the k- th point group data.

次に、ステップS45で、有効測点抽出部41は、上記点群データ{(lk,i,θk,i)|i=1,2,…,M}の中から、垂直平面Sの左右両側の端部の端測点A,Ck,Lを特定し、端測点A,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}を抽出する。ここで、「相対極座標」とは、レーザスキャナ座標系における極座標のことをいう。また、左垂直平面S上の有効測点を「左有効測点」という。 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}の中から、垂直平面Sの左右両側の端部の端測点Ck,R,Bを特定し、端測点Ck,R,B間の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}を抽出する。以下、右垂直平面S上の有効測点を「右有効測点」という。 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の傾きをp、走査線Lk,Lの切片をqk,L,走査線Lk,Rの切片をqk,Rとおく。走査線算出部42は、傾きp、切片qk,L,qk,Rを、走査線Lk,Lから各左有効測点Pk,i(i=nk,L,…,nk,L+mk,L−1)までの距離の和に、走査線Lk,Rから各右有効測点P(i=nk,R,…,nk,R+mk,R−1)までの距離の和g(p,qk,L,qk,R)を加えた値が最小となるように、最小自乗法により算出する。 Next, in step S47, the scanning line calculation unit 42 determines the slopes of the two parallel scanning lines L k, L , L k, R and the parallel coordinates based on the relative coordinates of each left effective point and each right effective point. Calculate the intercept. Here, an orthogonal coordinate system is assumed in which the measurement origin O k, m is the origin, the two orthogonal directions in the locus plane S locus are the x axis, the y axis, the x axis, and the z axis the direction perpendicular to the z axis. This is called a “relative orthogonal coordinate system”. In the relative orthogonal coordinate system , the inclinations of the scanning lines L k, L , L k, R are p k , the intercepts of the scanning lines L k, L are q k, L , and the intercepts of the scanning lines L k, R are q k, R deep. The scanning line calculation unit 42 sets the slope p k and the intercepts q k, L , q k, R from the scanning lines L k, L to the left effective measurement points P k, i (i = n k, L ,..., N). k, L + m k, L −1) is added to the right effective measuring points P i (i = n k, R 1 ,..., n k, R + m k, R −) from the scanning lines L k, R. It is calculated by the method of least squares so that a value obtained by adding the sum g k (p k , q k, L , q k, R ) of the distances to 1) is minimized.

相対直交座標系における測点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 ),

Figure 2009168472
である。また、走査線Lk,Lはy=px+qk,L、走査線Lk,Rはy=px+qk,Rであるので、上記距離和g(p,qk,L,qk,R)は次式により表される。
Figure 2009168472
It is. Further, since the scanning lines L k and L are y = p k x + q k, L and the scanning lines L k, R are y = p k x + q k, R , the distance sum g k (p k , q k, L , Q k, R ) is represented by the following equation.

Figure 2009168472
したがって、この距離和g(p,qk,L,qk,R)を評価関数として、最小自乗法により傾きp、切片qk,L,qk,Rを計算することができる。
Figure 2009168472
Accordingly, the slope p k and the intercepts q k, L , q k, R can be calculated by the least square method using the distance sum g k (p k , q k, L , q k, R ) as an evaluation function. .

次に、ステップS48で、走査線間距離算出部43は、走査線Lk,Lから走査線Lk,Rまでの距離d’を次式により算出する。 Next, in step S48, the inter-scan line distance calculation unit 43 calculates the distance d ′ k from the scan lines L k, L to the scan lines L k, R by the following equation.

Figure 2009168472
Figure 2009168472

最後に、ステップS49で、仰角算出部44は、距離d’及び距離dに基づき、レーサースキャナ1の光軸の仰角φを次式により算出すし、キャリブレーションパラメータ記憶部11に保存する。 Finally, in step S49, the elevation angle calculation unit 44 calculates the elevation angle φ k of the optical axis of the racer scanner 1 based on the distance d ′ k and the distance d k , and stores it in the calibration parameter storage unit 11. .

Figure 2009168472
Figure 2009168472

ステップ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 data storage unit 12, the process returns to step S44 again. If completed, the process proceeds to step S51.

ステップS51で、平均化部45は、キャリブレーションパラメータ記憶部11に保存されたN個の仰角φ(k=1,…,N)を読み出し、その平均値φを算出し、これを最終的なレーザースキャナ1の光軸の仰角φとしてキャリブレーションパラメータ記憶部11に保存する。 In step S51, the averaging unit 45 reads N elevation angles φ k (k = 1,..., N) stored in the calibration parameter storage unit 11, calculates the average value φ, and finally calculates this value φ. Is stored in the calibration parameter storage unit 11 as the elevation angle φ of the optical axis of the laser scanner 1.

以上の処理により、レーザースキャナ1の光軸の仰角φのキャリブレーションパラメータの算出を行うことができる。また、N回の測定の平均を行うことで、より誤差の少ないレーザースキャナ1の光軸の仰角φのキャリブレーションを行うことができる。   With the above processing, the calibration parameter of the elevation angle φ of the optical axis of the laser scanner 1 can be calculated. Further, by performing an average of N measurements, calibration of the elevation angle φ of the optical axis of the laser scanner 1 with fewer errors can be performed.

本実施例では、レーザースキャナ1が三次元レーザスキャナである場合のキャリブレーション方法について説明する。本実施例のキャリブレーション方法で使用するキャリブレーション装置の機能的な構成は、図2と同様である。また、図23は、実施例7に係るレーザースキャナのキャリブレーション方法で使用するターゲットの外観斜視図である。本実施例で使用するキャリブレーション用のターゲットは、長方形の凸出した垂直平面ABCDを有する。この垂直平面ABCDの幅をr、高さをsとする。   In this embodiment, a calibration method when the laser scanner 1 is a three-dimensional laser scanner will be described. The functional configuration of the calibration apparatus used in the calibration method of the present embodiment is the same as that shown in FIG. FIG. 23 is an external perspective view of a target used in the laser scanner calibration method according to the seventh embodiment. The calibration target used in this embodiment has a rectangular protruding vertical plane ABCD. The vertical plane ABCD has a width r and a height s.

本実施例において、レーザースキャナ1は、三次元レーザースキャナである。三次元レーザースキャナとは、光軸の仰角を段階的に変えながら水平走査を行うことによって、三次元的な走査を行うレーザースキャナである。従って、レーザースキャナ1で得られる点群データは、二次元的に配列された点群であり各測点はPi,jと表される。ここで、iは水平方向(方位角方向)の走査の順番を表すインデックス、jは垂直方向(仰角方向)の走査の順番を表すインデックスである。実際にレーザースキャナ1から出力されるデータは、測点Pi,jの水平方向を表す方位角φi,j、測点Pi,jの垂直方向を表す仰角θi,j、及び計測原点Oから測点Pまでの距離(光軸の長さ)をli,jの組(φi,j,θi,j,li,j)である。尚、計測原点Oは、レーザースキャナから出力される光軸の原点である。 In this embodiment, the laser scanner 1 is a three-dimensional laser scanner. A three-dimensional laser scanner is a laser scanner that performs three-dimensional scanning by performing horizontal scanning while gradually changing the elevation angle of the optical axis. Therefore, the point cloud data obtained by the laser scanner 1 is a two-dimensionally arranged point cloud, and each measurement point is represented as P i, j . Here, i is an index indicating the order of scanning in the horizontal direction (azimuth direction), and j is an index indicating the order of scanning in the vertical direction (elevation direction). Indeed data outputted from the laser scanner 1, stations P i, the azimuth angle phi i, j representing the horizontal j, stations P i, elevation represent the vertical j theta i, j, and the measurement origin A distance (length of the optical axis) from O m to the measuring point P i is a set of l i, ji, j , θ i, j , l i, j ). The measurement origin Om is the origin of the optical axis output from the laser scanner.

点群データ記憶部12には、上述のような三次元レーザスキャナにより測定されたM×N個の測点の点群データ{Pi,j=(φi,j,θi,j,li,j)|i=1,…,M,j=1,…,N}が保存される。 The point cloud data storage unit 12 stores point cloud data {P i, j = (φ i, j , θ i, j , l) of M × N measurement points measured by the three-dimensional laser scanner as described above. i, j ) | i = 1,..., M, j = 1,.

まず、有効測点抽出部13は、前記点群データ{Pi,j}の中から、垂直平面ABCDの4隅の頂点A,B,C,Dに最も近い測点P,P,P,Pを特定する。これらの測点P,P,P,Pを「隅測点」と呼ぶ。さらに有効測点抽出部13は、隅測点P,P,P,Pを頂点とする四角形で囲まれた領域内のm×n個の測点Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)(隅測点P,P,P,Pを含む。)の相対座標{Pi,j=(φi,j,θi,j,li,j)|i=m,…,m+m−1,j=n,…,n+n−1}を抽出する。これらの抽出された測点Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)を「有効測点」という。 First, the effective point extraction unit 13 selects the points P A , P B , closest to the vertices A, B, C, D at the four corners of the vertical plane ABCD from the point cloud data {P i, j }. P C, to identify the P D. These measurement points P A , P B , P C , and P D are called “corner measurement points”. Further, the effective point extraction unit 13 includes m × n number of points P i, j (i = m) in a region surrounded by a quadrangle having corner points P A , P B , P C , and P D as vertices. 0 ,..., M 0 + m−1, j = n 0 ,..., N 0 + n−1) (including corner measurement points P A , P B , P C , P D ) relative coordinates {P i, j = (Φ i, j , θ i, j , l i, j ) | i = m 0 ,..., M 0 + m−1, j = n 0 ,..., N 0 + n−1} is extracted. These extracted stations P i, j (i = m 0 ,..., M 0 + m−1, j = n 0 ,..., N 0 + n−1) are referred to as “effective stations”.

図24に隅測点P,P,P,Pと抽出されたすべての有効測点Pi,j(i=m,…,m+m−1,j=n,…,n+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と隅測点Pとの間の距離をd、頂点Bと隅測点Pとの間の距離をd、頂点Cと隅測点Pとの間の距離をd、頂点Dと隅測点Pとの間の距離をdとする。また、隅測点P,P,P,P以外の各有効測点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は、距離d,d,d,d及び各距離di,jの和又は自乗和が最小となるように、相対座標を測地座標へ関係づける関係パラメータを決定する。この座標決定手段14は、第1初期化部16、第2初期化部17、変換パラメータ算出部18、原点座標確定部19、及び注視点座標確定部20を備えている。 Next, the coordinate determination unit 14 relates the relative coordinates to the geodetic coordinates so that the sum or the square sum of the distances d A , d B , d C , d D and the distances d i, j is minimized. To decide. The coordinate determination unit 14 includes a first initialization unit 16, a second initialization unit 17, a conversion parameter calculation unit 18, an origin coordinate determination unit 19, and a gazing point coordinate determination unit 20.

次に、第1初期化部16は、測地座標系における隅測点P,P,P,Pの位置座標の初期値を設定する。第2初期化部17は、隅測点P,P,P,Pの位置座標の初期値及び各有効測点の相対座標に基づいて、隅測点P,P,P,P以外の各有効測点Pi,j及び計測原点Oの測地座標系における位置座標の初期値を算出する。 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は、計測原点O及び隅測点P,P,P,Pを含む各有効測点Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)の位置座標の初期値から開始して、評価関数の値が最小となるように、計測原点O及び各有効測点Pi,jの回転及び平行移動を行う幾何変換の各変換パラメータを、反復法により算出する。このとき、評価関数として、距離d,d,d,d、及び各距離di,jの和又は自乗和が使用される。例えば、自乗和を評価関数に使用する場合には、幾何変換の回転量(オイラー角で表示する。)を(ω,δ,κ)、平行移動量を(Δx,Δy,Δz)として、評価関数f(ω,δ,κ,Δx,Δy,Δz)は次式(40)のように表される。 Next, the conversion parameter calculation unit 18 includes the effective measurement points P i, j (i = m 0 ,..., M 0 + m) including the measurement origin O m and the corner measurement points P A , P B , P C , and P D. −1, j = n 0 ,..., N 0 + n−1), starting from the initial value of the position coordinates, the measurement origin O m and each effective measurement point P i, each transformation parameters geometric transformation for rotating and translation of j, is calculated by the iterative method. At this time, distances d A , d B , d C , d D , and the sum or square sum of the distances d i, j are used as the evaluation function. For example, when the sum of squares is used for the evaluation function, the amount of rotation of the geometric transformation (expressed in Euler angles) is (ω, δ, κ) and the amount of translation is (Δx, Δy, Δz). The function f (ω, δ, κ, Δx, Δy, Δz) is expressed as the following equation (40).

Figure 2009168472
ここで、隅測点P,P,P,Pを幾何変換して得られる隅測点P’,P’,P’,P’の測地座標を、それぞれ(x’,y’,z’),(x’,y’,z’),(x’,y’,z’),(x’,y’,z’)とし、各有効測点Pi,jを幾何変換して得られる隅測点P’ i,jの測地座標を(x’ i,j,y’ i,j,z’ i,j)とした。幾何変換後の各有効測点Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)の測地座標(x’ i,j,y’ i,j,z’ i,j)は次式(41)で表される。
Figure 2009168472
Here, the geodetic coordinates of the corner measuring points P ′ A , P ′ B , P ′ C , and P ′ D obtained by geometric transformation of the corner measuring points P A , P B , P C , and P D are respectively (x 'A, y' A, z 'A), (x' B, y 'B, z' B), (x 'C, y' C, z 'C), (x' D, y 'D, z ' D ), and the geodetic coordinates of the corner stations P' i, j obtained by geometric transformation of each effective station P i, j are (x ' i, j , y' i, j , z ' i, j ). Geodetic coordinates (x ′ i, j , y) of each effective station P i, j (i = m 0 ,..., M 0 + m−1, j = n 0 ,..., N 0 + n−1) after geometric transformation. ' i, j , z' i, j ) is expressed by the following equation (41).

Figure 2009168472
Figure 2009168472

次に、原点座標確定部19は、変換パラメータ算出部18により算出された各変換パラメータ(ω,δ,κ,Δx,Δy,Δz)によって、計測原点Oの位置座標の初期値を幾何変換し、計測原点Oの測地座標系における位置座標を算出する。 Next, the origin coordinate determination unit 19 geometrically transforms the initial value of the position coordinate of the measurement origin O m by each conversion parameter (ω, δ, κ, Δx, Δy, Δz) calculated by the conversion parameter calculation unit 18. and calculates the position coordinates in geodetic coordinate system of the measuring origin O m.

最後に、注視点座標確定部20は、注視点Gの相対座標を点群データ{P i,j}から抽出し、該注視点Gの相対座標と計測原点Oの測地座標系における位置座標とに基づいて、注視点Gの測地座標系における位置座標を算出する。ここで、注視点Gは、三次元レーザスキャナの場合には、走査範囲(方位角方向の走査範囲及び仰角方向の走査範囲)の中心方向の光軸上の測点である。 Finally, the gazing point coordinate determination unit 20 extracts the relative coordinates of the gazing point G from the point cloud data {P i, j }, and the relative coordinates of the gazing point G and the position coordinates in the geodetic coordinate system of the measurement origin O m. Based on the above, the position coordinates of the gazing point G in the geodetic coordinate system are calculated. Here, in the case of a three-dimensional laser scanner, the gazing point G is a measuring point on the optical axis in the center direction of the scanning range (scanning range in the azimuth angle direction and scanning range in the elevation angle direction).

以上の計算処理によって、三次元レーザスキャナの測地座標系における位置と方向が定められる。   Through the above calculation process, the position and direction of the three-dimensional laser scanner in the geodetic coordinate system are determined.

台車に接地された本発明の実施例1に係るレーザースキャナの外観図である。It is an external view of the laser scanner which concerns on Example 1 of this invention grounded to the trolley | bogie. 本発明の実施例1に係るレーザースキャナのキャリブレーション装置の機能的な構成を示すブロック図である。It is a block diagram which shows the functional structure of the calibration apparatus of the laser scanner which concerns on Example 1 of this invention. 本発明の実施例1に係るレーザースキャナのキャリブレーション方法で使用するターゲットの外観斜視図である。It is an external appearance perspective view of the target used with the calibration method of the laser scanner which concerns on Example 1 of this invention. 本発明の実施例1に係るレーザースキャナのキャリブレーション方法のフローチャートである。It is a flowchart of the calibration method of the laser scanner which concerns on Example 1 of this invention. ターゲットTの走査により得られる各測点Pと計測原点Oとの位置関係を示す図である。It is a diagram showing the positional relationship between each measuring point P i obtained by the scanning of the target T 1 and the measurement origin O m. 実際にレーザースキャナから出力される点群データを示す図である。It is a figure which shows the point cloud data actually output from a laser scanner. 端測点A,Bの初期値の設定を表す図である。It is a figure showing the setting of the initial value of the edge measuring points A and B. 計測原点O’,端測点A’,B’と有効測点P’の位置関係を表す図である。Measurement origin O m ', an end measuring point A', which is a diagram showing the positional relationship between B 'and effective measurement point P j'. 走査線E及び各測点の位置と距離d、距離d、及び距離d(j=n+1,…,n+m−2)の関係を表す図である。Scan lines E 1 E 2 and the position and the distance d A of each measuring point, the distance d B, and the distance d j (j = n + 1 , ..., n + m-2) is a diagram illustrating a relationship. 本発明の実施例2に係るレーザースキャナのキャリブレーション方法で使用するターゲットTの外観斜視図である。It is an external perspective view of a target T 2 to be used in the calibration method of the laser scanner according to the second embodiment of the present invention. ターゲットTの走査により得られる各測点と計測原点Oとの位置関係を示す図である。It is a diagram showing the positional relationship of the measurement points obtained by scanning the target T 2 and the measurement origin O m. 本発明の実施例3に係るレーザースキャナのキャリブレーション装置の機能的な構成を示すブロック図である。It is a block diagram which shows the functional structure of the calibration apparatus of the laser scanner which concerns on Example 3 of this invention. 本発明の実施例3に係るレーザースキャナのキャリブレーション方法で使用するターゲットTの外観斜視図である。It is an external perspective view of a target T 3 to be used in the calibration method of the laser scanner according to a third embodiment of the present invention. 本発明の実施例3に係るレーザースキャナのキャリブレーション方法のフローチャートである。It is a flowchart of the calibration method of the laser scanner which concerns on Example 3 of this invention. 本発明の実施例3に係るレーザースキャナのキャリブレーション方法で使用するターゲットTの他の例である。It is another example of the target T 3 to be used in the calibration method of the laser scanner according to a third embodiment of the present invention. 実施例4に係るレーザースキャナのキャリブレーション方法のフローチャートである。9 is a flowchart of a laser scanner calibration method according to a fourth embodiment. 本発明の実施例5に係るレーザースキャナのキャリブレーション装置の機能的な構成を示すブロック図である。It is a block diagram which shows the functional structure of the calibration apparatus of the laser scanner which concerns on Example 5 of this invention. 本発明の実施例5に係るレーザースキャナのキャリブレーション方法で使用するターゲットTの外観斜視図である。It 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. 実施例5に係るレーザースキャナのキャリブレーション方法のフローチャートである。10 is a flowchart of a laser scanner calibration method according to a fifth embodiment. 本発明の実施例6に係るレーザースキャナのキャリブレーション装置の機能的な構成を示すブロック図である。It is a block diagram which shows the functional structure of the calibration apparatus of the laser scanner which concerns on Example 6 of this invention. 本発明の実施例6に係るレーザースキャナのキャリブレーション方法で使用するターゲットTの外観斜視図である。It 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. 実施例6に係るレーザースキャナのキャリブレーション方法のフローチャートである。12 is a flowchart of a laser scanner calibration method according to a sixth embodiment. 実施例7に係るレーザースキャナのキャリブレーション方法で使用するターゲットの外観斜視図である。FIG. 10 is an external perspective view of a target used in a laser scanner calibration method according to a seventh embodiment. 隅測点P,P,P,Pと抽出されたすべての有効測点Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)の一例である。Corner measuring points P A , P B , P C , P D and all the extracted effective measuring points P i, j (i = m 0 ,..., M 0 + m−1, j = n 0 ,..., N 0 + N-1).

符号の説明Explanation of symbols

1 レーザースキャナ
2 台車
3 コンピュータ
9 通信インタフェース
10 キャリブレーション装置
11 キャリブレーションパラメータ記憶部
12 点群データ記憶部
13 有効測点抽出部
14 座標決定部
16 第1初期化部
17 第2初期化部
18 変換パラメータ算出部
19 原点座標確定部
20 注視点座標確定部
ターゲット
垂直平面
走査線
計測原点
locus 光軸の軌跡面
θ 走査角
G 注視点
25 幅算出部
26 水平幅補正部
27 高さ算出部
30 幅算出部
31 高さ算出部
32 仰角算出部
41 有効測点抽出部
42 走査線算出部
43 走査線間距離算出部
44 仰角算出部
45 平均化部
DESCRIPTION OF SYMBOLS 1 Laser scanner 2 Car 3 Computer 9 Communication interface 10 Calibration apparatus 11 Calibration parameter memory | storage part 12 Point cloud data memory | storage part 13 Effective point extraction part 14 Coordinate determination part 16 1st initialization part 17 2nd initialization part 18 Conversion Parameter calculation unit 19 Origin coordinate determination unit 20 Gaze point coordinate determination unit T 1 Target S 1 Vertical plane E 1 E 2 Scan line O m Measurement origin S locus Optical axis locus plane θ Scan angle G Gaze point 25 Width calculation unit 26 Horizontal Width correction unit 27 Height calculation unit 30 Width calculation unit 31 Height calculation unit 32 Elevation angle calculation unit 41 Effective point extraction unit 42 Scan line calculation unit 43 Inter-scan line distance calculation unit 44 Elevation angle calculation unit 45 Averaging unit

Claims (22)

左右両側辺が平行かつ垂直な垂直平面を有するターゲットを、前記垂直平面の前方の計測原点Oからレーザースキャナにより水平走査して得られる、M個(Mは整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記垂直平面の左右両側の端部の測点(以下「端測点」という。)A,Bを特定し、前記端測点A,Bを含む前記端測点A,B間のm個の測点(以下「有効測点」という。)P(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出手段と、
前記レーザースキャナの光軸の軌跡が前記垂直平面を切る線である走査線Eを基準に測地座標系を設定し、前記走査線Eの一方の端点Eから前記端測点Aまでの距離d、前記走査線Eの他方の端点Eから前記端測点Bまでの距離d、及び前記端測点A,B以外の前記各有効測点P(i=n+1,…,n+m−2)から前記走査線Eまでの距離dの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定手段と、
を備えたことを特徴とするレーザースキャナのキャリブレーション装置。
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が前記走査線E上に位置し、かつ端点Eから端測点Aまでの距離と端点Eから端測点Bまでの距離とが等しくなるように、前記測地座標系における前記端測点A,Bの位置座標の初期値を算出する第1の初期化手段と、
前記端測点A,Bの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記端測点A,B以外の前記各有効測点P(i=n+1,…,n+m−2)及び前記計測原点Oの前記測地座標系における位置座標の初期値を算出する第2の初期化手段と、
前記距離d、前記距離d、及び前記距離d(i=n+1,…,n+m−2)の和又は自乗和を評価関数として、前記計測原点O及び前記端測点A,Bを含む前記各有効測点P(i=n,…,n+m−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点O及び前記各有効測点Pの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する変換パラメータ算出手段と、
算出された前記各変換パラメータにより前記計測原点Oの位置座標の初期値をヘルマート変換し、前記計測原点Oの前記測地座標系における位置座標を算出する原点座標確定手段と、
所定の角度範囲を回転走査する前記レーザースキャナの走査開始方向と走査終了方向の2つの方向間の走査角の二等分角方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Oの前記測地座標系における位置座標とに基づいて、前記注視点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:
前記点群データ記憶手段は、左右両側辺が平行かつ垂直な垂直平面を複数有し、各垂直平面は互いに平行であるターゲットを、前記各垂直平面の前方の計測原点Oからレーザースキャナにより水平走査して得られる、M個(Mは2より大きい整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データを記憶するものであり、
前記有効測点抽出手段は、前記各垂直平面に対して、両端の端測点A,B(jは前記各垂直平面を区別する添字)を特定し、前記各有効測点Pj,iの相対座標を抽出するものであり、
前記座標決定手段は、前記レーザースキャナの光軸が前記各垂直平面を切る線である走査線Ep,1p,2を基準に測地座標系を設定し、前記各垂直平面における、前記走査線Ej,1j,2の一方の端点Ej,1から前記端測点Aまでの距離dj,A、前記走査線Ej,1j,2の他方の端点Ej,2から前記端測点Bまでの距離dj,B、及び前記両端測点A,B以外の前記各有効測点Pj,i(i=n+1,…,n+m−2)から前記走査線Ej,1j,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.
左側辺が垂直な直線で且つ右側辺が傾斜した直線又は曲線である左垂直平面と、右側辺が垂直な直線で且つ左側辺が前記左垂直平面の右側辺と平行な傾斜直線又は傾斜曲線である右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つ同一平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査して得られた、M個(Mは2より大きい整数)の測点の計測原点Oを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,C間の水平幅r及び前記端測点B,C間の水平幅rを算出する幅算出手段と、
高さzにおける前記左垂直平面の水平幅をf(z)、前記右垂直平面の水平幅をf(z)、f(z),f(z)の逆関数をそれぞれf −1(x),f −1(x)としたとき、前記レーザースキャナの計測原点Oの高さHを、高さf −1(r’)又は高さf −1(r’)の何れか若しくは高さf −1(r)と高さf −1(r)の平均値として算出する高さ算出手段と、
を備えたことを特徴とするレーザースキャナのキャリブレーション装置。
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:
前記左垂直平面の右側辺と前記右垂直平面の左側辺との間の水平幅をr、前記左垂直平面の左側辺と前記右垂直平面の右側辺との間の水平幅をr+rとしたとき、前記計測原点で計測された水平幅r,rを、それぞれ式(1a),(1b)により補正して補正水平幅r’,r’を算出する水平幅補正手段を備え、
前記高さ算出手段は、前記レーザースキャナの計測原点Oの高さHを、高さf −1(r’)又は高さf −1(r’)の何れか若しくは高さf −1(r’)と高さf −1(r’)の平均値として算出することを特徴とする請求項4記載のレーザースキャナのキャリブレーション装置。
Figure 2009168472
The horizontal width between the right side of the left vertical plane and the left side of the right vertical plane is r 0 , and 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 Horizontal width correction means for correcting the horizontal widths r L and r R measured at the measurement origin and calculating the corrected horizontal widths r ′ L and r ′ R by correcting the horizontal widths r L and r R according to equations (1a) and (1b), respectively. Prepared,
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 ).
Figure 2009168472
前記点群データ記憶手段は、前記左垂直平面及び前記右垂直平面の前方にあり高さが同一で且つ水平面上の位置が異なるN箇所の前記計測原点から測定されたN組の前記点群データを記憶するものであり、
前記幅算出手段は、N組の前記点群データについて、それぞれ前記端測点A,C間の水平幅及び前記端測点B,C間の水平幅を算出するとともに、前記各点群データについての前記端測点A,C間の水平幅の平均値を前記水平幅r、前記各点群データについての前記端測点B,C間の水平幅の平均値を前記水平幅rとして算出するものであることを特徴とする請求項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.
水平幅が高さzの単調関数f(z)に従って変化する左垂直平面と、水平幅が高さzの単調関数f(z)に従って変化する右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査して得られた、M個(Mは2より大きい整数)の測点の計測原点Oを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,C間の水平幅r及び前記端測点B,C間の水平幅rを算出する幅算出手段と、
前記関数f(z),f(z)の逆関数をそれぞれf −1(x),f −1(x)としたとき、前記左垂直平面における走査線の高さhをf −1(r)、前記右垂直平面における走査線の高さhをf −1(r)として算出する高さ算出手段と、
前記高さh、前記高さh、及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(2)により算出する仰角算出手段と、
を備えたことを特徴とするレーザースキャナのキャリブレーション装置。
Figure 2009168472
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, 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) relative to the measurement origin O m of measuring points Point cloud data storage means for storing point cloud data consisting of relative coordinates,
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:
Figure 2009168472
左側辺及び右側辺が垂直且つ平行な左垂直平面と、左側辺及び右側辺が垂直且つ平行な右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査して得られた、M個(Mは2より大きい整数)の測点の計測原点Oを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,Cを含む前記端測点A,C間のm個の測点(以下「左有効測点」という。)P(i=n,…,n+m−1)の相対座標、及び前記端測点B,Cを含む前記端測点B,C間のm個の測点(以下「右有効測点」という。)P(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出手段と、
前記各左有効測点及び前記各右有効測点の相対座標に基づき、互いに平行な2つの走査線L及びLの傾き及び切片を、前記走査線Lから前記各左有効測点P(i=n,…,n+m−1)までの距離の和に、前記走査線Lから前記各右有効測点P(i=n,…,n+m−1)までの距離の和を加えた値が最小となるように、最小自乗法により算出する走査線算出手段と、
前記走査線Lから前記走査線Lまでの距離d’を算出する走査線間距離算出手段と、
前記距離d’及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(3)により算出する仰角算出手段と、
を備えたことを特徴とするレーザースキャナのキャリブレーション装置。
Figure 2009168472
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. measurement origin O m obtained by scanning by the laser scanner from, M (M is an integer greater than 2) point group for storing point group data composed of relative coordinates relative to the measurement origin O m of measuring points Data storage means;
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:
Figure 2009168472
前記点群データ記憶手段は、前記左垂直平面及び前記右垂直平面の前方にあり高さが同一で且つ水平面上の位置が異なるN箇所の前記計測原点から測定されたN組の前記点群データを記憶するものであり、
前記有効測点抽出手段は、前記各点群データに対してそれぞれ前記左有効測点の相対座標及び前記右有効測点の相対座標を抽出し、
前記走査線算出手段は、前記各点群データに対してそれぞれ前記走査線L及び前記走査線Lの傾き及び切片を算出し、
前記走査線間距離算出手段は、前記各点群データに対してそれぞれ前記走査線Lから前記走査線Lまでの距離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を有するターゲットを、前記垂直平面の前方の計測原点Oからレーザースキャナにより三次元的に走査して得られる、M×N個(M,Nは整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データを記憶する点群データ記憶手段と、
前記点群データの中から、前記垂直平面ABCDの4隅の頂点A,B,C,Dに最も近い測点(以下「隅測点」という。)P,P,P,Pを特定し、前記隅測点P,P,P,Pを含む、前記隅測点P,P,P,Pを頂点とする四角形で囲まれた領域内のm×n個の測点(以下「有効測点」という。)Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)の相対座標を抽出する有効測点抽出手段と、
前記垂直平面ABCDの4隅の頂点A,B,C,Dを基準に測地座標系を設定し、前記頂点Aと前記隅測点Pとの間の距離d、前記頂点Bと前記隅測点Pとの間の距離d、前記頂点Cと前記隅測点Pとの間の距離d、前記頂点Dと前記隅測点Pとの間の距離d、及び前記隅測点P,P,P,P以外の前記各有効測点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:
前記座標決定手段は、前記測地座標系における前記隅測点P,P,P,Pの位置座標の初期値を設定する第1の初期化手段と、
前記隅測点P,P,P,Pの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記隅測点P,P,P,P以外の前記各有効測点Pi,j(及び前記計測原点Oの前記測地座標系における位置座標の初期値を算出する第2の初期化手段と、
前記距離d,d,d,d、及び前記各距離di,jの和又は自乗和を評価関数として、前記計測原点O及び前記隅測点P,P,P,Pを含む前記各有効測点Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点O及び前記各有効測点Pi,jの回転及び平行移動を行う幾何変換の各変換パラメータを、反復法により算出する変換パラメータ算出手段と、
算出された前記各変換パラメータにより前記計測原点Oの位置座標の初期値をヘルマート変換し、前記計測原点Oの前記測地座標系における位置座標を算出する原点座標確定手段と、
所定の方位角範囲及び仰角範囲を回転走査する前記レーザースキャナの走査範囲の中心方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Oの前記測地座標系における位置座標とに基づいて、前記注視点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:
コンピュータによりレーザースキャナのキャリブレーションを行うキャリブレーション方法であって、
左右両側辺が平行かつ垂直な垂直平面を有するターゲットを、前記垂直平面の前方の計測原点Oからレーザースキャナにより水平走査し、M個(Mは整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記垂直平面の左右両側の端部の測点(以下「端測点」という。)A,Bを特定し、前記端測点A,Bを含む前記端測点A,B間のm個の測点(以下「有効測点」という。)P(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出ステップと、
前記レーザースキャナの光軸の軌跡が前記垂直平面を切る線である走査線Eを基準に測地座標系を設定し、前記走査線Eの一方の端点Eから前記端測点Aまでの距離d、前記走査線Eの他方の端点Eから前記端測点Bまでの距離d、及び前記端測点A,B以外の前記各有効測点P(i=n+1,…,n+m−2)から前記走査線Eまでの距離dの和又は自乗和が最小となるように、前記相対座標を前記測地座標へ関係づける関係パラメータを決定する座標決定ステップと、
を実行することを特徴とするレーザースキャナのキャリブレーション方法。
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が前記走査線E上に位置し、かつ端点Eから前記端測点Aまでの距離と端点Eから前記端測点Bまでの距離とが等しくなるように、前記測地座標系における前記端測点A,Bの位置座標の初期値を算出する第1の初期化ステップと、
前記端測点A,Bの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記端測点A,B以外の前記各有効測点P(i=n+1,…,n+m−2)及び前記計測原点Oの前記測地座標系における位置座標の初期値を算出する第2の初期化ステップと、
前記距離d、前記距離d、及び前記距離d(i=n+1,…,n+m−2)の和又は自乗和を評価関数として、前記計測原点O及び前記端測点A,Bを含む前記各有効測点P(i=n,…,n+m−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点O及び前記各有効測点Pの回転及び平行移動を行うヘルマート変換の各変換パラメータを、反復法により算出する変換パラメータ算出ステップと、
算出された前記各変換パラメータにより前記計測原点Oの位置座標の初期値をヘルマート変換し、前記計測原点Oの前記測地座標系における位置座標を算出する原点座標確定ステップと、
所定の角度範囲を回転走査する前記レーザースキャナの走査開始方向と走査終了方向の2つの方向間の走査角の二等分角方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Oの前記測地座標系における位置座標とに基づいて、前記注視点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:
前記走査ステップにおいては、左右両側辺が平行かつ垂直な垂直平面を複数有し、各垂直平面は互いに平行であるターゲットを、前記各垂直平面の前方の計測原点Oからレーザースキャナにより水平走査して得られる、M個(Mは2より大きい整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存し、
前記有効測点抽出ステップにおいては、前記各垂直平面に対して、両端の端測点A,B(jは前記各垂直平面を区別する添字)を特定し、前記各有効測点Pj,iの相対座標を抽出し、
前記座標決定ステップにおいては、前記レーザースキャナの光軸が前記各垂直平面を切る線である走査線Ep,1p,2を基準に測地座標系を設定し、前記各垂直平面における、前記走査線Ej,1j,2の一方の端点Ej,1から前記端測点Aまでの距離dj,A、前記走査線Ej,1j,2の他方の端点Ej,2から前記端測点Bまでの距離dj,B、及び前記両端測点A,B以外の前記各有効測点Pj,i(i=n+1,…,n+m−2)から前記走査線Ej,1j,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.
コンピュータによりレーザースキャナのキャリブレーションを行うキャリブレーション方法であって、
左側辺が垂直な直線で且つ右側辺が傾斜した直線又は曲線である左垂直平面と、右側辺が垂直な直線で且つ左側辺が前記左垂直平面の右側辺と平行な傾斜直線又は傾斜曲線である右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つ同一平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査して、M個(Mは2より大きい整数)の測点の計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,C間の水平幅r及び前記端測点B,C間の水平幅rを算出する幅算出ステップと、
高さzにおける前記左垂直平面の水平幅をf(z)、前記右垂直平面の水平幅をf(z)、f(z),f(z)の逆関数をそれぞれf −1(x),f −1(x)としたとき、前記レーザースキャナの計測原点Oの高さHを、高さf −1(r’)又は高さf −1(r’)の何れか若しくは高さf −1(r)と高さf −1(r)の平均値として算出する高さ算出ステップと、
を実行することを特徴とするレーザースキャナのキャリブレーション方法。
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:
前記幅算出ステップを実行した後に、前記左垂直平面の右側辺と前記右垂直平面の左側辺との間の水平幅をr、前記左垂直平面の左側辺と前記右垂直平面の右側辺との間の水平幅をr+rとしたとき、前記計測原点で計測された水平幅r,rを、それぞれ式(4a),(4b)により補正して補正水平幅r’,r’を算出する水平幅補正ステップを実行し、
前記高さ算出ステップにおいては、前記レーザースキャナの計測原点Oの高さHを、高さf −1(r’)又は高さf −1(r’)の何れか若しくは高さf −1(r’)と高さf −1(r’)の平均値として算出することを特徴とする請求項15記載のレーザースキャナのキャリブレーション方法。
Figure 2009168472
After executing the width calculating step, the horizontal width between the right side of the left vertical plane and the left side of the right vertical plane is r 0 , the left side of the left vertical plane and the right side of the right vertical plane when the horizontal width between was r + r 0, wherein the measurement origin measured horizontal width r L, the r R, respectively formula (4a), the correction horizontal width r is corrected by (4b) 'L, r' Execute a horizontal width correction step to calculate R ;
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 ).
Figure 2009168472
前記走査ステップにおいては、前記左垂直平面及び前記右垂直平面の前方にあり高さが同一で且つ水平面上の位置が異なるN箇所の前記計測原点から、レーザースキャナにより水平走査を行い、N組の前記点群データをコンピュータに取り込み記憶装置に保存し、
前記幅算出ステップにおいては、前記記憶装置に保存されたN組の前記点群データについて、それぞれ前記端測点A,C間の水平幅及び前記端測点B,C間の水平幅を算出するとともに、前記各点群データについての前記端測点A,C間の水平幅の平均値を前記水平幅r、前記各点群データについての前記端測点B,C間の水平幅の平均値を前記水平幅rとして算出することを特徴とする請求項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の単調関数f(z)に従って変化する左垂直平面と、水平幅が高さzの単調関数f(z)に従って変化する右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査し、M個(Mは整数)の測点の計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,C間の水平幅r及び前記端測点B,C間の水平幅rを算出する幅算出ステップと、
前記関数f(z),f(z)の逆関数をそれぞれf −1(x),f −1(x)としたとき、前記左垂直平面における走査線の高さhをf −1(r)、前記右垂直平面における走査線の高さhをf −1(r)として算出する高さ算出ステップと、
前記高さh、前記高さh、及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(5)により算出する仰角算出ステップと、
を実行することを特徴とするレーザースキャナのキャリブレーション方法。
Figure 2009168472
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);
A method for calibrating a laser scanner, comprising:
Figure 2009168472
コンピュータによりレーザースキャナのキャリブレーションを行うキャリブレーション方法であって、
左側辺及び右側辺が垂直且つ平行な左垂直平面と、左側辺及び右側辺が垂直且つ平行な右垂直平面と、を備え、前記左垂直平面と前記右垂直平面は平行で且つそれぞれ互いに一定の距離dだけ離隔した平面上にあり、前記左垂直平面の右側辺と前記右垂直平面の左側辺とは一定の水平幅だけ離隔しているターゲットを、前記左垂直平面及び前記右垂直平面の前方の計測原点Oからレーザースキャナにより走査し、M個(Mは整数)の測点の計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記左垂直平面の左側の端部の測点(以下「端測点」という。)A及び右側の端測点C、並びに前記右垂直平面の右側の端測点B及び左側の端測点Cを特定し、前記端測点A,Cを含む前記端測点A,C間のm個の測点(以下「左有効測点」という。)P(i=n,…,n+m−1)の相対座標、及び前記端測点B,Cを含む前記端測点B,C間のm個の測点(以下「右有効測点」という。)P(i=n,…,n+m−1)の相対座標を抽出する有効測点抽出ステップと、
前記各左有効測点及び前記各右有効測点の相対座標に基づき、互いに平行な2つの走査線L及びLの傾き及び切片を、前記走査線Lから前記各左有効測点P(i=n,…,n+m−1)までの距離の和に、前記走査線Lから前記各右有効測点P(i=n,…,n+m−1)までの距離の和を加えた値が最小となるように、最小自乗法により算出する走査線算出ステップと、
前記走査線Lから前記走査線Lまでの距離d’を算出する走査線間距離算出ステップと、
前記距離d’及び前記距離dに基づき、レーサースキャナの光軸の仰角θを式(6)により算出する仰角算出ステップと、
を備えたことを特徴とするレーザースキャナのキャリブレーション方法。
Figure 2009168472
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 ;
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:
Figure 2009168472
前記走査ステップにおいては、前記左垂直平面及び前記右垂直平面の前方にあり高さが同一で且つ水平面上の位置が異なるN箇所の前記計測原点からレーザースキャナにより水平走査し、N組の前記点群データをコンピュータに取り込み記憶装置に保存し、
前記有効測点抽出ステップにおいては、前記各点群データに対してそれぞれ前記左有効測点の相対座標及び前記右有効測点の相対座標を抽出し、
前記走査線算出ステップにおいては、前記各点群データに対してそれぞれ前記走査線L及び前記走査線Lの傾き及び切片を算出し、
前記走査線間距離算出ステップにおいては、前記各点群データに対してそれぞれ前記走査線Lから前記走査線Lまでの距離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を有するターゲットを、前記垂直平面の前方の計測原点Oからレーザースキャナにより三次元的に走査し、M×N個(M,Nは整数)の測点に対する前記計測原点Oを基準とする相対座標からなる点群データをコンピュータに取り込み記憶装置に保存する走査ステップと、
前記記憶装置に保存された前記点群データの中から、前記垂直平面ABCDの4隅の頂点A,B,C,Dに最も近い測点(以下「隅測点」という。)P,P,P,Pを特定し、前記隅測点P,P,P,Pを含む、前記隅測点P,P,P,Pを頂点とする四角形で囲まれた領域内のm×n個の測点(以下「有効測点」という。)Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)の相対座標を抽出する有効測点抽出ステップと、
前記垂直平面ABCDの4隅の頂点A,B,C,Dを基準に測地座標系を設定し、前記頂点Aと前記隅測点Pとの間の距離d、前記頂点Bと前記隅測点Pとの間の距離d、前記頂点Cと前記隅測点Pとの間の距離d、前記頂点Dと前記隅測点Pとの間の距離d、及び前記隅測点P,P,P,P以外の前記各有効測点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:
前記座標決定ステップにおいては、前記測地座標系における前記隅測点P,P,P,Pの位置座標の初期値を設定する第1の初期化ステップと、
前記隅測点P,P,P,Pの位置座標の初期値及び前記各有効測点の相対座標に基づき、前記隅測点P,P,P,P以外の前記各有効測点Pi,j及び前記計測原点Oの前記測地座標系における位置座標の初期値を算出する第2の初期化ステップと、
前記距離d,d,d,d、及び前記各距離di,jの和又は自乗和を評価関数として、前記計測原点O及び前記隅測点P,P,P,Pを含む前記各有効測点Pi,j(i=m,…,m+m−1,j=n,…,n+n−1)の位置座標の初期値から開始して、前記評価関数の値が最小となるように、前記計測原点O及び前記各有効測点Pi,jの回転及び平行移動を行う幾何変換の各変換パラメータを、反復法により算出する変換パラメータ算出ステップと、
算出された前記各変換パラメータにより前記計測原点Oの位置座標の初期値をヘルマート変換し、前記計測原点Oの前記測地座標系における位置座標を算出する原点座標確定ステップと、
所定の方位角範囲及び仰角範囲を回転走査する前記レーザースキャナの走査範囲の中心方向の光軸上の測点である注視点Gの相対座標を前記点群データから抽出し、該注視点Gの相対座標と前記計測原点Oの前記測地座標系における位置座標とに基づいて、前記注視点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:
JP2008003737A 2008-01-10 2008-01-10 Calibration device and calibration method of laser scanner Pending JP2009168472A (en)

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)

* Cited by examiner, † Cited by third party
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

Cited By (28)

* Cited by examiner, † Cited by third party
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