JP2000508766A - Method and apparatus for locating a plurality of unnamed fixed reference objects for mobile overland transportation - Google Patents

Method and apparatus for locating a plurality of unnamed fixed reference objects for mobile overland transportation

Info

Publication number
JP2000508766A
JP2000508766A JP9537028A JP53702897A JP2000508766A JP 2000508766 A JP2000508766 A JP 2000508766A JP 9537028 A JP9537028 A JP 9537028A JP 53702897 A JP53702897 A JP 53702897A JP 2000508766 A JP2000508766 A JP 2000508766A
Authority
JP
Japan
Prior art keywords
uncertainty
reference object
detecting
azimuth
transport
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP9537028A
Other languages
Japanese (ja)
Other versions
JP4067567B2 (en
Inventor
オーストローム，カール―エーリック
Original Assignee
アポゲウム アーベー
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by アポゲウム アーベー filed Critical アポゲウム アーベー
Publication of JP2000508766A publication Critical patent/JP2000508766A/en
Application granted granted Critical
Publication of JP4067567B2 publication Critical patent/JP4067567B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
    • G05D1/0236—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Optics & Photonics (AREA)
  • Electromagnetism (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Control Of Conveyors (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Optical Radar Systems And Details Thereof (AREA)
  • Discharge Of Articles From Conveyors (AREA)
  • Sorting Of Articles (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

Methods and apparatus are disclosed for determining the positions of fixed reference objects for use in controlling the movement of mobile surface transportation units over a surface. The method includes detecting bearings from a measuring point on a mobile apparatus to the reference objects at predetermined times associated with movement of the mobile apparatus over the surface, storing the bearings along with the predetermined time associated therewith, and continuously computing the position of the reference objects and the degree of uncertainty associated with those positions from the bearings whereby the degree of uncertainty is reduced as the mobile apparatus moves over the surface.

Description

【発明の詳細な説明】 移動水陸路輸送のための複数の無名の固定参照物体の位置を決定する方法 およびその位置を決定する装置 技術分野： 本発明は、移動水陸路輸送ユニットのための複数の無名の（anonymous）固定 参照物体の位置を決定する方法および装置に関する。 水陸路における制御ループに従ってビークルＡＧＶを自動制御する従来の技術 は、室内の固定参照点をサーチするなどのより複雑な制御システムによって次第 に置き換えられつつある。参照点の位置を知り、これらの物体に対する複数の角 度を測定することによって、ＡＧＶの位置は決定され、ＡＧＶを所定の位置に制 御するために用いられ得る。米国特許第４、８１１、２２８号より、固定反射物 体が配置されているエリアをサーチする回転レーザが公知であり、ＡＧＶと異な る物体との間の複数の角度を測定することによって、ＡＧＶの位置が決定され得 る。 新しいＡＧＶシステムを設置するとき、固定参照物体の位置が決定されなけれ ばならない。現在まで、これは、参照物体の位置を測定し、これらの位置をＡＧ Ｖシステムが設置されるエリアを示す座標内に入れることによって手動で高度に 行われてきた。通常、座標系は、より正確には、乗り物ＡＧＶが移動しようとす る水陸路に対して平行に延びる面を示す。これまで、位置の決定は、座標系の軸 に対する参照物体の位置を物理的に測定し、その後、それらの座標を、計算され た制御システムに入力することによって行われてきた。しかし、測定は時間がか かり、実際、実行するのは困難である。なぜなら、ＡＧＶシステムが設置される 大抵の部屋は、格納棚、機械等の大きな物体をも収容するからである。 発明の要旨： 本発明の目的は、手動測定を無くすことである。 上記目的は、本発明による方法および装置によって成し遂げられ、その特徴は 、 添付の特許請求項１および４からそれぞれ明白となる。 図面の説明： 本発明を、下記の添付図面を参照して、実施形態の例示によって、以下により 詳細に説明する。 図１は、ＡＧＶが設置される部屋の概略平面図を示す。 図２は、測定された時間−角度対の図を示す。 図３は、本発明の方法のフローチャートを示す。 付録： 付録Ａは、マルチリニア状態が連続時間および不連続時間の両方でどのように 実現され得るかを示す。 好適な実施形態： 図１は、ＡＧＶシステムが設置された空間の概略平面図を示す。図示する例で は、システムは、回転レーザビームの使用について記載している米国特許第4,81 1,228号に基づいており、例えば、水平方向に、および自動制御ビークルＡＧＶ が移動するように意図される床に実質的に平行に広がる面をサーチし、このとき 回転は、ほぼ垂直な軸回りに行われる。図示する例では、問題の部屋は、４つの 壁２、３、４、５を有する正方形の部屋１として示されており、これらの壁には 複数の無名の固定参照物体６〜１６が、レーザビームのサーチ領域内であるよう な高さに配置されている。実際には、参照物体は、物体とビームとが一致するこ とがいつでも可能である程度までは垂直方向に延びる。発せられる信号が光、例 えばレーザビームなどの電磁信号である、問題のシステムでは、参照物体は、入 射ビームを反射してレーザユニットに戻すように配置される反射体組織であり、 レーザユニットでビームは方位、すなわち選択された基準角度、例えばビークル の長軸に対する回転面内の角度についての情報と共に検出される。反射体組織は 、好ましくは、入射ビームが入射方向と同じ方向に反射するようにされ、いわゆ る逆反射体である。反射体組織は、任意に選択され得る固定位置に配置される。 図 示する簡略化されたケースでは、反射体は４つの面すなわち壁に沿って配置され ているが、実際には、反射体は部屋内に不規則におよび任意に配置され得る。 実質的に同じ上述の装置が、最も簡単なケース、回転レーザを有するビークル では、反射体の位置を決定するために使用され得る。参照番号１７は、測定点ま たは紙面の垂線を示し、測定部屋１内で、例えばサーチビームがこの回りを回転 する。本発明によれば、固定参照物体６〜１６の位置、および恐らくは面内での 方向が、掃引サーチ信号によって面をサーチすることによって決定され、一方、 戻されるエコー信号が、エコー信号の方位についての情報と共に検出される。検 出は、部屋１内の測定点１７の移動中に行われ、これにより、原則的には部屋に わたって任意に配分される複数の別の測定点１８が得られる。実際には、これを 実現する最も簡単方法は、測定を繰り返す間に、装置またはビークルを部屋中で 移動または駆動させることによって行われ、「連続時間のマルチリニア制約」と 呼ばれる方法を適用することにより、回転レーザ検出器を有するビークルが移動 している間に測定を行うことが可能になる。 このようにして、連続的移動の最中に、時間的に固定された複数の角度あるい は方位を得ることができる。これらの時間−角度対を、図２に示すように示すこ とができる。図において、各座標点（ｔ，α）は測定された角度αならびに時刻 ｔに対応する。ギャップは、例えば測定すべき時刻において障害物が視線方向に ある場合の時刻を示している。規則的なパターンを形成しない小さい点は、疑似 反射を表している。 本発明はさらに、測定された角度材料の分析を記述し、結果として、全ての反 射器組織の座標が決定される。これを得るために、以下の工程を行う： Ａ．読み取り値と無名の物体との自動的対応付け： まず、同じ無名の反射器組織に対して測定された角度を識別する。これは、依 然の角度測定値を外挿補間し、続く角度測定値のうちのどれがこの外挿補間値に よく合致するかを決定することによって解決される。また、これにより反射器が 一時的にレーザビームから隠れたとしても正しい識別がなされる。結果として、 角度測定値のうちの一部が同一のものを表す部分集合として分けられ、その他の 不正な測定値は選り分けられる。 Ｂ．反射器位置および位置の不確実度の計算： 反射器の位置の粗評価およびこれにともなう多大な不確実度から開始し、乗り 物が移動して反射器に対する読み取り値がフロアのより大きな領域から得られる ようになるにつれ、Newton-Raphson法などを用いた複雑な行列計算を含む「連続 URFACES IN COMPUTATIONAL VISION」、1996年５月30日、ISBN 91-628-2022-2、I SSN 0347-8475、ISRN LUTFD2/TFMA-96/1006-SE、ISRN LUTFD2/TFMA-96/5002-SE に記載）、位置の評価値は精錬され位置の不確実度は対応して減少する。上記文 献を本出願において参考のために援用する。 これらの本質的に２つの工程は、その後、図３による外ループおよび内ループ において順に適用され得る。 図３のフローチャートはさらに、これらの上述した工程が、いかに適用される かを示す。内ループにおいて、方位および時間値がソートされ、反射器に関連づ けられる。ビークルに連続的に課される動きを考慮して、精密フィルタが用いら れる。外ループは、十分に多くの測定および／または十分に多くの追加の反射器 が追加されたときに行われる。まず、既知の反射器位置が精製され、その後これ らの新しい値が、追加の反射器の位置と不確実度を計算する基礎となる。すべて の反射器の位置が計算されて位置の不確実度が必要なレベルまで低下すると、反 射器マップは完成し、測定が終了する。 問題の実施例において、反射器組織６〜１６は、限られたリフレクション領域 を有し、その中において、検出値が得られ得る。検出値は、反射器組織９の方向 を決定し、更にそれにより、受け取られた反射が、ある反射器組織から受け取ら れたか否かを決定するために用いられ得る。測定装置は、受け取られた反射とそ の方位とに関連する測定データを収集するコンピュータを含む。 本発明の上述した実施の形態を添付の図面を参照して詳細に述べてきたが、本 発明は、特定の実施の形態に限定されるものではなく、添付の請求の範囲によっ て規定される範囲から逸脱することなく、異なる変更または改変が当業者によっ てなされ得るということが理解されるべきである。例えば、参照物体は、任意の 環境の天然の物体であり得る。 さらに、各時間値に関して、例えば、マトリクス検出器（例えば、カメラ／フ ラッシュシステム）の補助を得て同時に複数の物体の方位を検出することにより 、１を越える方位が登録され得る。 付録Ａ： 連続時間多重線形束縛条件を用いた相対運動量の計算 路程測定(odometry)またはその運動の事前知識(a priori knowledge)無しで、 車両の相対運動量を計算することが可能である。相対運動量を、方位測定値(bea ring measurements)のみから計算する。 方位測定値を同一のリフレクタ(reflector)に対応する複数のグループにグル ープ化したと仮定すると、方位(bearing)と、時間に対するその方位の初めの２ つの導関数(derivatives)とを補間して、これを見つけることが可能である。等 式（３．２３）（下記参照）は、車両の未知の相対運動量をともなうこれらの測 定された量に関する。この等式中、ｕ(0)は、方位の方向を示す単位ベクトルで あり、ｕ(1)およびｕ(2)は、この方向（方位）の時間に対する一次および二次導 関数を表す。アルゴリズム３．４．１（下記参照）を用いて、速度ベクトル（ｖ １，ｖ２）および車両の加速度ベクトル（ａ１、ａ２）、ならびに車両の角速度 （ｒ１）を計算することが可能である。これらの未知のパラメータを計算するた めには、少なくとも５つの異なるリフレクタに対する方位が必要である。これら の運動パラメータが画像測定値(image measurements)のみから得られることに留 意されたい。路程測定あるいはリフレクタ位置のいずれも不要である。実際に、 この方法を用いて、方位測定値のみから路程測定データを得ている。 従来の推測航法(dead-reckoning)を利用して、車両の角速度および位置速度を 用いて車両の運動量を計算する。車両の相対運動量が分かった後、三角分割(tri angulation)を利用してリフレクタの座標を計算する。２つの異なる位置からの リフレタに対する測定された方位を用いて、リフレクタの座標を見つける。 較正連続三線形式(calibrated continuous trilinear form) 時間に依存する較正カメラ座標ｐ（ｔ）＝（Ｒ（ｔ）ｃ（ｔ））を考える。Ｐ （０）＝（Ｉ ０）となる物体座標系を選択する。回転座標Ｒ（ｔ）およびベク トルｃ（ｔ）のテイラー展開を とする。テイラー展開ｕ（ｔ）＝ｕ(0)＋ｔｕ(1)＋ｕ(2)Ｒ(2)＋ｏ（ｔ3）の全 ての画像点ｕ（ｔ）について以下の連続較正三線束縛条件が成立しなければなら ない。 Ｒは回転座標なので、その第１の導関数の形式は、 であり、テイター展開の第２の部分の形式は、 である。 第２の部分に対する第４欄のｒ2を引くことによって、束縛条件がＲ(2)を含ま ないことが分かる。次に、束縛条件をもう少し詳細に調べる。 のように変数を導入する。 行列式(determinant)の形式は、 である。ｗ＝（ｖ1 ｖ2 ａ1 ａ2）およびｘ＝（１ ｒ1）Tを導入する。これ らを見つけるための２つの暫定的なアルゴリズムを試した。 アルゴリズム３．４．１． １．回転速度ｒ1の大凡の見当をつけること が可能かもしれない。これは、通常は、かなり低い。 ２．全ての画像方向ｕi（ｔ）について、対応Ｔ行列を計算する。ここではＴiと 記述する。ベクトルｗは、各ベクトルＴiｚに対して直交しているはずである。 ｒ1が与えられれば、座標の左側零空間としてｗを見つけることができる。 上記座標の特異値分解によってベクトルｗを見つける。 ３．同様に、ｗが大凡分かった後、ｚを、 の右側零空間として見つけることができる。 ４．ステップ２および３を繰り返し、処理が収束することを願う。 上記のアイディアは、実験的にしか試されていないが、これまでのところ成功 している。さらなる研究が必要である。 アルゴリズム３．４．２．別のアプローチは、 の右側零空間として推定して、さらなる束縛条件を課す。すると、特異値分解によって運動パラメータ（ｒ1、ｖ1、ｖ2、ａ1、ａ2 ）を見つけることができる。The present invention relates to a method for determining the position of a plurality of unnamed fixed reference objects for mobile overland transport and an apparatus for determining the location. And a method for determining the position of an anonymous fixed reference object. The prior art of automatically controlling the vehicle AGV according to a control loop on land and water is increasingly being replaced by more complex control systems, such as searching for fixed reference points in a room. By knowing the position of the reference point and measuring a plurality of angles with respect to these objects, the position of the AGV is determined and can be used to control the AGV to a predetermined position. From U.S. Pat. No. 4,811,228, a rotating laser is known which searches an area where a fixed reflecting object is located, and measures the position of the AGV by measuring a plurality of angles between the AGV and different objects. Can be determined. When installing a new AGV system, the position of the fixed reference object must be determined. Until now, this has been done manually at high altitudes by measuring the positions of the reference objects and placing these positions in coordinates indicating the area in which the AGV system will be installed. Typically, the coordinate system more accurately describes a plane that extends parallel to the amphibious road on which the vehicle AGV is to travel. Heretofore, position determination has been performed by physically measuring the position of a reference object with respect to an axis of a coordinate system, and then inputting those coordinates into a calculated control system. However, measurements are time consuming and, in fact, difficult to perform. This is because most rooms in which AGV systems are installed also accommodate large objects such as storage shelves, machines and the like. Summary of the invention: It is an object of the present invention to eliminate manual measurement. The above objective is accomplished by a method and device according to the present invention, the features of which will become apparent from the appended claims 1 and 4, respectively. Description of the drawings: The invention will be explained in more detail below, by way of example of embodiments, with reference to the accompanying drawings, in which: FIG. 1 shows a schematic plan view of a room in which an AGV is installed. FIG. 2 shows a diagram of measured time-angle pairs. FIG. 3 shows a flowchart of the method of the present invention. Appendix: Appendix A shows how multi-linear states can be realized in both continuous and discontinuous time. Preferred Embodiment: FIG. 1 shows a schematic plan view of the space in which the AGV system is installed. In the example shown, the system is based on U.S. Pat. No. 4,811,228 which describes the use of a rotating laser beam, e.g., in a horizontal direction and in which the automatic control vehicle AGV is intended to move A search is made for a surface extending substantially parallel to the floor, with the rotation occurring about a substantially vertical axis. In the example shown, the room in question is shown as a square room 1 having four walls 2, 3, 4, 5 on which a plurality of unnamed fixed reference objects 6-16 are laser It is located at a height such that it is within the beam search area. In practice, the reference object extends vertically to some extent that it is always possible for the beam to coincide with the object. In the system in question, where the signal emitted is an electromagnetic signal, such as a light beam, e.g. a laser beam, the reference object is a reflector tissue arranged to reflect the incident beam back to the laser unit, and the beam at the laser unit Is detected along with information about the azimuth, ie, the selected reference angle, for example, the angle in the plane of rotation with respect to the long axis of the vehicle. The reflector tissue is preferably such that the incident beam is reflected in the same direction as the direction of incidence, and is a so-called retroreflector. The reflector tissue is placed in a fixed position that can be selected arbitrarily. In the simplified case shown, the reflectors are arranged along four faces or walls, but in practice the reflectors can be arranged irregularly and arbitrarily in the room. Substantially the same device described above can be used to determine the position of the reflector in the simplest case, in a vehicle with a rotating laser. Reference numeral 17 indicates a measurement point or a perpendicular to the paper, around which the search beam, for example, rotates in the measurement room 1. According to the present invention, the position of the fixed reference objects 6-16, and possibly the orientation in the plane, is determined by searching the plane with the sweep search signal, while the returned echo signal is determined by the orientation of the echo signal. Is detected together with the information. The detection takes place during the movement of the measuring points 17 in the room 1, whereby in principle a plurality of further measuring points 18 are obtained which are arbitrarily distributed over the room. In practice, the easiest way to achieve this is by moving or driving the device or vehicle in the room while repeating the measurement, and applying a method called "continuous time multi-linear constraint". This allows measurements to be taken while the vehicle with the rotating laser detector is moving. In this way, a plurality of temporally fixed angles or orientations can be obtained during continuous movement. These time-angle pairs can be shown as shown in FIG. In the figure, each coordinate point (t, α) corresponds to the measured angle α and time t. The gap indicates the time when the obstacle is in the line of sight at the time to be measured, for example. Small dots that do not form a regular pattern represent pseudo reflections. The invention further describes the analysis of the measured angular material, so that the coordinates of all reflector tissue are determined. To obtain this, the following steps are performed: Automatic association of readings with anonymous objects: First, the angles measured for the same anonymous reflector tissue are identified. This is solved by extrapolating the previous angle measurements and determining which of the subsequent angle measurements matches this extrapolation well. This also allows correct identification even if the reflector is temporarily hidden from the laser beam. As a result, some of the angle measurements are sorted as a subset representing the same, and other incorrect measurements are sorted out. B. Calculating reflector position and position uncertainty: Starting with a rough estimate of the reflector position and the associated great uncertainty, the vehicle moves and the readings for the reflector are obtained from a larger area of the floor. As it becomes possible, the continuation including complex matrix calculation using Newton-Raphson method etc. URFACES IN COMPUTATIONAL VISION, May 30, 1996, ISBN 91-628-2022-2, ISSN 0347-8475, ISRN LUTFD2 / TFMA-96 / 1006-SE, ISRN LUTFD2 / TFMA-96 / 5002-SE Description), the position evaluation value is refined and the position uncertainty is correspondingly reduced. The above references are incorporated by reference in the present application. These essentially two steps can then be applied in turn in the outer and inner loop according to FIG. The flowchart of FIG. 3 further illustrates how these above-described steps are applied. In the inner loop, the bearing and time values are sorted and associated with the reflector. A precision filter is used to account for the motion continuously imposed on the vehicle. The outer loop occurs when enough measurements and / or enough additional reflectors have been added. First, the known reflector positions are refined, after which these new values form the basis for calculating the position and uncertainty of the additional reflector. When the position of all reflectors has been calculated and the position uncertainty has dropped to the required level, the reflector map is complete and the measurement is finished. In the embodiment in question, the reflector tissue 6-16 has a limited reflection area, in which the detection values can be obtained. The detected value determines the direction of the reflector tissue 9 and may thereby be used to determine whether a received reflection has been received from some reflector tissue. The measurement device includes a computer that collects measurement data related to the received reflection and its orientation. While the above-described embodiments of the present invention have been described in detail with reference to the accompanying drawings, the present invention is not limited to any particular embodiments, but is defined by the appended claims. It should be understood that different changes or modifications can be made by those skilled in the art without departing from the invention. For example, the reference object can be a natural object of any environment. Further, for each time value, more than one orientation may be registered, for example, by detecting the orientation of multiple objects simultaneously with the aid of a matrix detector (eg, a camera / flash system). Appendix A: Calculation of Relative Momentum Using Continuous Time Multiple Linear Constraints It is possible to calculate the relative momentum of a vehicle without odometry or a priori knowledge of its motion. Relative momentum is calculated only from bearing measurements. Assuming that the azimuth measurements are grouped into groups corresponding to the same reflector, interpolating the bearing and the first two derivatives of that azimuth with respect to time, It is possible to find this. Equation (3.23) (see below) relates to these measured quantities with unknown relative momentum of the vehicle. In this equation, u (0) is a unit vector indicating the direction of the azimuth, and u (1) and u (2) represent the first and second derivatives of this direction (azimuth) with respect to time. Using algorithm 3.4.1 (see below), it is possible to calculate the velocity vector (v1, v2) and the vehicle acceleration vector (a1, a2), as well as the angular velocity of the vehicle (r1). To calculate these unknown parameters, orientations for at least five different reflectors are needed. Note that these motion parameters are derived solely from image measurements. Neither path measurement nor reflector position is required. In fact, using this method, the path measurement data is obtained only from the azimuth measurement values. Utilizing the conventional dead-reckoning, the momentum of the vehicle is calculated using the angular velocity and the position velocity of the vehicle. After the relative momentum of the vehicle is known, the coordinates of the reflector are calculated using triangulation. Using the measured orientation to the reflector from two different locations, find the coordinates of the reflector. Calibrated continuous trilinear form Consider time-dependent calibrated camera coordinates p (t) = (R (t) c (t)). An object coordinate system in which P (0) = (I 0) is selected. The Taylor expansion of rotational coordinates R (t) and vector c (t) And Taylor expansion u (t) = u (0 ) + tu (1) + u (2) R (2) + o unless all of the image points u (t) the following successive calibration trilinear constraints are satisfied for (t 3) No. Since R is a rotating coordinate, the form of its first derivative is And the form of the second part of the Tatar expansion is It is. By subtracting r 2 in the fourth column for the second part, it can be seen that the constraint does not include R (2) . Next, the constraints are examined in more detail. Introduce a variable like The form of the determinant is It is. Introduce w = (v 1 v 2 a 1 a 2 ) and x = (1 r 1 ) T. We tried two tentative algorithms to find these. Algorithm 3.4.1. 1. It may be possible to approximate the rotation speed r 1 . This is usually quite low. 2. The corresponding T matrix is calculated for all image directions u i (t). Here is referred to as T i. The vector w should be orthogonal to each vector T iz . Given r 1, it is possible to find a w as the left null space of coordinates. A vector w is found by singular value decomposition of the coordinates. 3. Similarly, after w is roughly known, z is Can be found as a right-hand null space. 4. Repeat steps 2 and 3 and hope that the process converges. The above ideas have been tested only experimentally, but have been successful so far. Further research is needed. Algorithm 3.4.2. Another approach is As the right-hand null space of Impose. Then, the motion parameters (r 1 , v 1 , v 2 , a 1 , a 2 ) can be found by singular value decomposition.

───────────────────────────────────────────────────── フロントページの続き (81)指定国 ＥＰ(ＡＴ，ＢＥ，ＣＨ，ＤＥ， ＤＫ，ＥＳ，ＦＩ，ＦＲ，ＧＢ，ＧＲ，ＩＥ，ＩＴ，Ｌ Ｕ，ＭＣ，ＮＬ，ＰＴ，ＳＥ)，ＯＡ(ＢＦ，ＢＪ，ＣＦ ，ＣＧ，ＣＩ，ＣＭ，ＧＡ，ＧＮ，ＭＬ，ＭＲ，ＮＥ， ＳＮ，ＴＤ，ＴＧ)，ＡＰ(ＧＨ，ＫＥ，ＬＳ，ＭＷ，Ｓ Ｄ，ＳＺ，ＵＧ)，ＥＡ(ＡＭ，ＡＺ，ＢＹ，ＫＧ，ＫＺ ，ＭＤ，ＲＵ，ＴＪ，ＴＭ)，ＡＬ，ＡＭ，ＡＴ，ＡＵ ，ＡＺ，ＢＡ，ＢＢ，ＢＧ，ＢＲ，ＢＹ，ＣＡ，ＣＨ， ＣＮ，ＣＵ，ＣＺ，ＤＥ，ＤＫ，ＥＥ，ＥＳ，ＦＩ，Ｇ Ｂ，ＧＥ，ＨＵ，ＩＬ，ＩＳ，ＪＰ，ＫＥ，ＫＧ，ＫＰ ，ＫＲ，ＫＺ，ＬＣ，ＬＫ，ＬＲ，ＬＳ，ＬＴ，ＬＵ， ＬＶ，ＭＤ，ＭＧ，ＭＫ，ＭＮ，ＭＷ，ＭＸ，ＮＯ，Ｎ Ｚ，ＰＬ，ＰＴ，ＲＯ，ＲＵ，ＳＤ，ＳＥ，ＳＧ，ＳＩ ，ＳＫ，ＴＪ，ＴＭ，ＴＲ，ＴＴ，ＵＡ，ＵＧ，ＵＳ， ＵＺ，ＶＮ────────────────────────────────────────────────── ─── Continuation of front page    (81) Designated countries EP (AT, BE, CH, DE, DK, ES, FI, FR, GB, GR, IE, IT, L U, MC, NL, PT, SE), OA (BF, BJ, CF) , CG, CI, CM, GA, GN, ML, MR, NE, SN, TD, TG), AP (GH, KE, LS, MW, S D, SZ, UG), EA (AM, AZ, BY, KG, KZ , MD, RU, TJ, TM), AL, AM, AT, AU , AZ, BA, BB, BG, BR, BY, CA, CH, CN, CU, CZ, DE, DK, EE, ES, FI, G B, GE, HU, IL, IS, JP, KE, KG, KP , KR, KZ, LC, LK, LR, LS, LT, LU, LV, MD, MG, MK, MN, MW, MX, NO, N Z, PL, PT, RO, RU, SD, SE, SG, SI , SK, TJ, TM, TR, TT, UA, UG, US, UZ, VN

Claims (1)

【特許請求の範囲】 １．移動水陸路輸送ユニットについての無名の固定参照物体の位置を決定し、該 物体に関してナビゲートし、該輸送水陸路の上を移動する方法であって、 移動装置に固定された方向を基準にして、該装置の測定点から１つ以上の該参 照物体までの方位を検出するステップと、 該方位を、方位が有効な時間とともに格納し、該参照物体の位置を計算し、各 参照物体の計算された位置の不確実性を計算するステップとを包含し、該位置お よび該不確実性は連続的に計算され、該移動装置が該輸送水陸路の上を移動する ときの該不確実性を低減するステップを包含することを特徴とする、方法。 ２．前記方位が、時間的に連続して測定されることを特徴とする、請求項１に記 載の方法。 ３．各時間値について、１つよりも多い方位が検出されることを特徴とする、請 求項１に記載の方法。 ４．前記方位の検出が、電磁信号、例えば光信号の放出、反射および検出を含む ことを特徴とする、請求項１に記載の方法。 ５．前記信号が、前記輸送水陸路に実質的に平行に延びる回転レーザビームであ ることを特徴とする、請求項６に記載の方法。 ６．移動水陸路輸送ユニットについての無名の固定参照物体の位置を決定し、該 物体に関してナビゲートし、該輸送水陸路の上を移動するための装置であって、 移動装置に固定された方向を基準にして、該装置の測定点から１つ以上の該参 照物体までの方位を検出するための装置と、 該方位を、方位が有効な時間とともに格納するための手段と、 該移動装置が該輸送水陸路の上を移動するときに、各参照物体を追跡するため の計算手段と、 該参照物体の位置を計算し、各参照物体の計算された位置の不確実性を計算す るための手段と、該位置および該不確実性を連続的に計算し、該移動装置が該輸 送水陸路の上を移動するときの該不確実性を低減するための手段とを含むことを 特徴とする、装置。 ７．前記方位を検出するための装置が、レーザ走査手段と、該方位を時間的に連 続して検出するための角度検出器手段とを含むことを特徴とする、請求項６に記 載の装置。 ８．前記方位を検出するための手段が、フラッシュ手段と、各時間値について１ よりも多い方位を検出するためのカメラ手段とを含むことを特徴とする、請求項 ６に記載の装置。 ９．前記各参照物体を追跡するための計算手段が、予測フィルタを含むことを特 徴とする、請求項８に記載の装置。 １０．前記参照物体が、複数の反射器手段からなることを特徴とする、請求項８ に記載の装置。[Claims] 1. Determining the location of the unnamed fixed reference object for the mobile overland transport unit; Navigating about an object and navigating over the transport waterway,   One or more reference points from a measurement point of the device with respect to a direction fixed to the mobile device. Detecting a direction to the illuminated object;   The azimuth is stored with the time when the azimuth is valid, and the position of the reference object is calculated. Calculating the uncertainty of the calculated position of the reference object. And the uncertainty is calculated continuously and the moving device moves over the transport waterway Reducing the uncertainty of the time. 2. The method according to claim 1, wherein the direction is measured continuously in time. The method described. 3. The contractor characterized in that more than one bearing is detected for each time value. The method of claim 1. 4. Said azimuth detection includes emission, reflection and detection of electromagnetic signals, for example optical signals The method of claim 1, wherein: 5. The signal is a rotating laser beam extending substantially parallel to the transport waterway. 7. The method according to claim 6, wherein: 6. Determining the location of the unnamed fixed reference object for the mobile overland transport unit; An apparatus for navigating with respect to an object and moving over the transport waterway,   One or more reference points from a measurement point of the device with respect to a direction fixed to the mobile device. A device for detecting the direction to the illuminated object,   Means for storing the orientation along with the time at which the orientation is valid;   To track each reference object as the mobile device moves over the transport waterway Calculation means,   Calculating the position of the reference object and calculating the uncertainty of the calculated position of each reference object; Means for continuously calculating the location and the uncertainty so that the mobile device Means for reducing said uncertainty when traveling over waterways. A device characterized by: 7. An apparatus for detecting the azimuth includes a laser scanning unit, and the azimuth is temporally linked. 7. Detecting means according to claim 6, further comprising an angle detecting means for detecting. On-board equipment. 8. The means for detecting the azimuth comprises a flash means and one for each time value. Camera means for detecting more orientations. 7. The apparatus according to 6. 9. The calculation means for tracking each reference object includes a prediction filter. 9. The device of claim 8, wherein the device is characterized. 10. 9. The method of claim 8, wherein the reference object comprises a plurality of reflector means. An apparatus according to claim 1.
JP53702897A 1996-04-15 1997-04-15 Method and apparatus for determining the location of a plurality of unnamed fixed reference objects for mobile hydro-land transport Expired - Lifetime JP4067567B2 (en)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
SE9601440-2 1996-04-15
SE9601440A SE9601440D0 (en) 1996-04-15 1996-04-15 Method for determining a plurality of fixed objects
PCT/SE1997/000634 WO1997039394A1 (en) 1996-04-15 1997-04-15 A method for determining the positions of a plurality of anonymous fixed reference objects for mobile surface transportation and a device for determining said positions

Publications (2)

Publication Number Publication Date
JP2000508766A true JP2000508766A (en) 2000-07-11
JP4067567B2 JP4067567B2 (en) 2008-03-26

Family

ID=20402213

Family Applications (1)

Application Number Title Priority Date Filing Date
JP53702897A Expired - Lifetime JP4067567B2 (en) 1996-04-15 1997-04-15 Method and apparatus for determining the location of a plurality of unnamed fixed reference objects for mobile hydro-land transport

Country Status (8)

Country Link
US (1) US6012003A (en)
EP (1) EP0900416B1 (en)
JP (1) JP4067567B2 (en)
AT (1) ATE446537T1 (en)
AU (1) AU2656097A (en)
DE (1) DE69739628D1 (en)
SE (1) SE9601440D0 (en)
WO (1) WO1997039394A1 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPWO2013076829A1 (en) * 2011-11-22 2015-04-27 株式会社日立製作所 Autonomous mobile system
JP2021156882A (en) * 2020-03-27 2021-10-07 ジック アーゲー Acquisition of distance measurement data

Families Citing this family (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3316841B2 (en) * 1998-08-06 2002-08-19 村田機械株式会社 Automatic guided vehicle system
US6504605B1 (en) 2000-10-24 2003-01-07 The Regents Of The University Of California Method and apparatus for determining the coordinates of an object
US6369879B1 (en) 2000-10-24 2002-04-09 The Regents Of The University Of California Method and apparatus for determining the coordinates of an object
KR100624387B1 (en) * 2005-04-25 2006-09-20 엘지전자 주식회사 Robot system which can designate a movement area
US8508590B2 (en) * 2010-03-02 2013-08-13 Crown Equipment Limited Method and apparatus for simulating a physical environment to facilitate vehicle operation and task completion
US8538577B2 (en) * 2010-03-05 2013-09-17 Crown Equipment Limited Method and apparatus for sensing object load engagement, transportation and disengagement by automated vehicles
EP2385435A1 (en) 2010-04-22 2011-11-09 Danaher Motion Särö AB A method and a system for gathering data
EP2508956B1 (en) 2011-04-06 2013-10-30 Kollmorgen Särö AB A collision avoiding method and system
WO2012141601A2 (en) 2011-04-11 2012-10-18 Crown Equipment Limited Method and apparatus for efficient scheduling for multiple automated non-holonomic vehicles using a coordinated path planner
US8655588B2 (en) 2011-05-26 2014-02-18 Crown Equipment Limited Method and apparatus for providing accurate localization for an industrial vehicle
US8548671B2 (en) 2011-06-06 2013-10-01 Crown Equipment Limited Method and apparatus for automatically calibrating vehicle parameters
US8589012B2 (en) 2011-06-14 2013-11-19 Crown Equipment Limited Method and apparatus for facilitating map data processing for industrial vehicle navigation
US8594923B2 (en) 2011-06-14 2013-11-26 Crown Equipment Limited Method and apparatus for sharing map data associated with automated industrial vehicles
US20140058634A1 (en) 2012-08-24 2014-02-27 Crown Equipment Limited Method and apparatus for using unique landmarks to locate industrial vehicles at start-up
US9056754B2 (en) 2011-09-07 2015-06-16 Crown Equipment Limited Method and apparatus for using pre-positioned objects to localize an industrial vehicle
US20130060461A1 (en) * 2011-09-07 2013-03-07 INRO Technologies Limited Method and apparatus for using pre-positioned objects to localize an industrial vehicle
US11977391B1 (en) * 2023-04-14 2024-05-07 Jack George Lawrence, Jr. Robot navigation with obstacle detection using a distance measuring sensor

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB8313339D0 (en) * 1983-05-14 1983-06-22 Gen Electric Co Plc Vehicle guidance
SE451770B (en) 1985-09-17 1987-10-26 Hyypae Ilkka Kalevi KIT FOR NAVIGATION OF A LARGE VESSEL IN ONE PLAN, EXTRA A TRUCK, AND TRUCK FOR EXTENDING THE KIT
US4788441A (en) * 1985-12-16 1988-11-29 Acme-Cleveland Corporation Range finder wherein distance between target and source is determined by measuring scan time across a retroreflective target
US4790402A (en) * 1987-09-28 1988-12-13 Tennant Company Automated guided vehicle
EP0366350A3 (en) * 1988-10-25 1991-05-22 Tennant Company Guiding an unmanned vehicle by reference to overhead features
US4969036A (en) * 1989-03-31 1990-11-06 Bir Bhanu System for computing the self-motion of moving images devices
US4967064A (en) * 1989-06-30 1990-10-30 Tennant Company Method and apparatus for a target determining apparatus having increased range
EP0488828B1 (en) * 1990-11-30 1996-08-14 Honda Giken Kogyo Kabushiki Kaisha Control device of an autonomously moving body and evaluation method for data thereof
DE4324531C1 (en) * 1993-07-21 1994-12-01 Siemens Ag Method for constructing an environmental map and for determining an individual position in the environment by a self-propelled unit
US5367458A (en) * 1993-08-10 1994-11-22 Caterpillar Industrial Inc. Apparatus and method for identifying scanned reflective anonymous targets

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPWO2013076829A1 (en) * 2011-11-22 2015-04-27 株式会社日立製作所 Autonomous mobile system
JP2021156882A (en) * 2020-03-27 2021-10-07 ジック アーゲー Acquisition of distance measurement data
JP7114207B2 (en) 2020-03-27 2022-08-08 ジック アーゲー Acquisition of distance measurement data

Also Published As

Publication number Publication date
AU2656097A (en) 1997-11-07
JP4067567B2 (en) 2008-03-26
SE9601440D0 (en) 1996-04-15
EP0900416B1 (en) 2009-10-21
EP0900416A1 (en) 1999-03-10
US6012003A (en) 2000-01-04
WO1997039394A1 (en) 1997-10-23
DE69739628D1 (en) 2009-12-03
ATE446537T1 (en) 2009-11-15

Similar Documents

Publication Publication Date Title
JP2000508766A (en) Method and apparatus for locating a plurality of unnamed fixed reference objects for mobile overland transportation
AU755485B2 (en) Method for determining the position of an automated guided vehicle
EP0238615B1 (en) Method of navigating an automated guided vehicle
CA2328227C (en) Method of tracking and sensing position of objects
JP7059888B2 (en) Assistance control system
CN110082753A (en) The method for determining vehicle location
CN110082747A (en) Increase the method for the reliability of determining vehicle location based on multiple test points
WO2018221454A1 (en) Map generation device, control method, program, and storage medium
CN108303989A (en) A kind of method and apparatus moved along wall for mobile robot
CN112744217B (en) Collision detection method, travel path recommendation device, and storage medium
US11420632B2 (en) Output device, control method, program and storage medium
CN112711027A (en) Tunnel internal transverse positioning method based on laser radar point cloud data
Maki et al. Positioning method for an AUV using a profiling sonar and passive acoustic landmarks for close-range observation of seafloors
CN108873014A (en) Mirror surface detection method and device based on laser radar
CN112731337A (en) Map construction method, device and equipment
JPWO2018180247A1 (en) Output device, control method, program, and storage medium
JP3247143B2 (en) Positioning / posture surveying device for moving objects
Kälin et al. Highly Accurate Pose Estimation as a Reference for Autonomous Vehicles in Near-Range Scenarios. Remote Sens. 2022, 14, 90
WO2024141367A1 (en) Information processing apparatus
CN114660619A (en) SLAM positioning method and positioning system based on multiple sensors
WO2018221456A1 (en) Route searching device, control method, program, and storage medium
Lenda et al. Comparison of Accuracy of Kinematic Methods for Localization of Mobile Targets
JP2024509299A (en) Method and apparatus for calibrating an environmental depth sensor
Podsędkowski et al. Institute of Machine Tools and Production Engineering Technical University of Łódź, ul. Stefanowskiego 1/15 90-924 Łódź, Poland {1podsedk| idzik}@ p. lodz. pl 20.1 Introduction to Robot Localisation Methods
Podsędkowski et al. Robot localisation methods using the laser scanners

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040408

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20060307

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20060601

A602 Written permission of extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A602

Effective date: 20060714

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20060907

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20070731

A711 Notification of change in applicant

Free format text: JAPANESE INTERMEDIATE CODE: A711

Effective date: 20070726

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20071030

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20071218

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20080109

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110118

Year of fee payment: 3

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110118

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120118

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130118

Year of fee payment: 5

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

EXPY Cancellation because of completion of term