WO2016152619A1 - 移動体の位置検出方法 - Google Patents

移動体の位置検出方法 Download PDF

Info

Publication number
WO2016152619A1
WO2016152619A1 PCT/JP2016/057950 JP2016057950W WO2016152619A1 WO 2016152619 A1 WO2016152619 A1 WO 2016152619A1 JP 2016057950 W JP2016057950 W JP 2016057950W WO 2016152619 A1 WO2016152619 A1 WO 2016152619A1
Authority
WO
WIPO (PCT)
Prior art keywords
moving body
axis direction
error
plane
data
Prior art date
Application number
PCT/JP2016/057950
Other languages
English (en)
French (fr)
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 株式会社村田製作所
Priority to CN201680018123.5A priority Critical patent/CN107407719B/zh
Priority to JP2017508241A priority patent/JP6515998B2/ja
Publication of WO2016152619A1 publication Critical patent/WO2016152619A1/ja
Priority to US15/713,788 priority patent/US10539653B2/en

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
    • G01S5/30—Determining absolute distances from a plurality of spaced points of known location
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S1/00—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith
    • G01S1/72—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith using ultrasonic, sonic or infrasonic waves
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S1/00—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith
    • G01S1/72—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith using ultrasonic, sonic or infrasonic waves
    • G01S1/76—Systems for determining direction or position line
    • G01S1/80—Systems for determining direction or position line using a comparison of transit time of synchronised signals transmitted from non-directional transducers or transducer systems spaced apart, i.e. path-difference systems
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves

Definitions

  • the present invention relates to a position detection method for a moving body, and more particularly to a position detection method for a moving body for detecting the position of the moving body on a plane.
  • an apparatus provided with a position detection sensor for detecting the position of the moving body in cooperation with the sensor provided in the moving body while arranging the sensor on the moving body.
  • a method of detecting the position of a moving body using
  • FIG. 12 a receiver 114 that receives ultrasonic waves is used as a sensor included in the moving body 113, and ultrasonic waves are transmitted as a position detection sensor 2.
  • Two transmitters 112a and 112b are used.
  • the transmitters 112a and 112b are installed at a known interval d1.
  • the apparatus obtains the distances d2 and d3 between the two transmitters 112a and 112b and the receiver 114 based on the propagation time of the ultrasonic signals from the two transmitters 112a and 112b to the receiver 114, respectively.
  • the position of the moving body 113 is determined based on the theorem.
  • Patent Document 1 has a problem that the position detection error of the moving body 113 tends to be large, and it is difficult to detect the position of the moving body 113 with high accuracy.
  • This invention solves the said subject, and aims at providing the position detection method of a moving body for detecting the position of the moving body which moves on a plane accurately.
  • a position detection method for a moving body of the present invention includes: A position detection method of a moving body for detecting a position of the moving body on the plane by a position detection sensor for detecting a position of the moving body in cooperation with a sensor provided on the moving body moving on the plane.
  • XY coordinate data for calibration is obtained by detecting the position of the moving body or the dummy moving body at each of the plurality of positions by the position detection sensor
  • Correction data for the plurality of positions is obtained from a difference between the acquired calibration XY coordinate data and true position data for the plurality of positions where the moving body or the dummy moving body is positioned
  • the position of the moving body that moves on the plane is detected by the position detection sensor, and the detected XY coordinate data obtained is corrected by an interpolation method using the correction data. It is characterized by obtaining position data that approximates the position.
  • the position detection method of the moving body of the present invention includes A position detection method of a moving body for detecting a position of the moving body on the plane by a position detection sensor for detecting a position of the moving body in cooperation with a sensor provided on the moving body moving on the plane.
  • the movable body provided with the sensor at a predetermined position or the dummy movable body equipped with the sensor at the same position as the movable body is located on a plurality of intersections where the reference line in the X-axis direction and the reference line in the Y-axis direction intersect.
  • XY coordinate data for calibration is obtained by detecting the position of the moving body or the dummy moving body at each of the plurality of intersections with the position detection sensor, From the difference between the acquired calibration XY coordinate data and the true position data of the plurality of intersections where the movable body or the dummy movable body is positioned, the X-axis direction and the Y-axis direction at the plurality of intersection points While obtaining the amount of displacement as an X-axis direction error and a Y-axis direction error, Based on the X-axis direction error and the Y-axis direction error, a plurality of X-axis direction reference lines and an X-axis direction error approximation expression that is a calculation formula for errors at each position on the Y-axis direction reference line and the Y-axis direction Find the error approximation formula, In detecting the position of the moving body that actually moves on the plane, The position of the moving body moving on the plane is detected by the position detection sensor, and the obtained
  • the moving body includes a plurality of sensors at a predetermined position, and the positional relationship between the plurality of sensors detected by the position detection sensor, In the case of being configured to be able to detect the rotational direction position with the axis perpendicular to the plane as the rotational axis,
  • the movable body having the sensor at a predetermined position or the dummy movable body having the sensor at the same position as the movable body is positioned on the plurality of intersections
  • the movable body or the dummy movable body Position the rotation direction position in a predetermined direction, and detect the rotation direction position of the moving body or the dummy moving body at each of the plurality of intersections by the position detection sensor, thereby correcting the rotation direction position.
  • the error in the position data in the rotational direction detected for the moving body is corrected, and in addition to the position on the plane of the moving body (the position in the X-axis direction and the Y-axis direction), the moving body It is possible to accurately detect the position in the rotation direction.
  • the position of the moving body moving on the plane is detected by the position detection sensor, and the obtained detected XY coordinate data is used as the correction data. Since the position data approximated to the true position of the moving body is obtained by correcting by the interpolation method, the position error of the detected XY coordinates with respect to the moving body is corrected and moved on the plane. The position of the moving body can be detected with high accuracy.
  • the position of the moving body (or dummy moving body) at each of a plurality of intersections is detected by a position detection sensor to obtain calibration XY coordinate data. From the difference between the acquired calibration XY coordinate data and the true position data of the plurality of intersection points where the moving body (or dummy moving body) is positioned, the X-axis direction and the Y-axis direction at the plurality of intersection points The amount of positional deviation is obtained as an X-axis direction error and a Y-axis direction error, and based on the X-axis direction error and the Y-axis direction error, the error of each position on the plurality of X-axis direction reference lines and Y-axis direction reference lines is calculated.
  • the position of the moving body moving on the plane is The detected XY coordinate data detected by the position detection sensor was corrected by linear interpolation using the X-axis direction error approximate expression and the Y-axis direction error approximate expression, and approximated to the true position of the moving object. Since the position data is obtained, the position data that approximates the true position of the moving object can be obtained easily and accurately.
  • FIG. It is a figure which shows the error approximation formula at the time of expressing the error of each position on a reference line with an approximate curve
  • (a) is an X-axis direction error approximation formula
  • (b) is a Y-axis direction error approximation formula
  • (c) is a figure.
  • the robot body is configured to roll with the robot body on the sphere, move with the sphere on the plane, or rotate the robot body on the sphere.
  • a method for detecting the position of the moving body when the ball riding robot is a moving body will be described.
  • two position detection sensors (ultrasonic transmitters) 12a and 12b held by the sensor holding jigs 11a and 11b are used, and the sensor provided in the dummy moving body 23
  • a method for detecting the position of the moving body 13 using the sensors 24 (14a, 14b) provided in the moving body 13 (FIG. 7) and 24 (24a, 24b) will be described as an example.
  • the apparatus used for carrying out the position detection method of the moving body includes a sensor 14 (14a, 14a, 14) included in the moving body 13 to move the plane P, which is the upper surface of the stage 15. 14b), two position detection sensors (ultrasonic transmitters) 12a and 12b for detecting the position of the moving body 13 are provided.
  • the two position detection sensors (ultrasonic transmitters) 12 a and 12 b are separately held by two sensor holding jigs 11 a and 11 b, and a height position H 1 from the plane P that is the upper surface of the stage 15 is
  • the horizontal distance d1 between the position detection sensors 12 can be set to a predetermined value.
  • the method for detecting the position of the moving body obtains correction data for correcting the position data detected by the position detection sensors 12a and 12b before actually detecting the position of the moving body 13.
  • the stage (preparation stage) A and the correction data obtained in this preparation stage A the position of the mobile body 13 when the mobile body 13 is actually moved (close to the true position corrected using the correction data).
  • a stage (actual detection stage) B for detecting the position in real time is provided (see FIG. 1).
  • the moving body 13 of this embodiment is a ball riding robot, it does not become independent unless appropriate control is performed by operating an attitude detection sensor or a control device.
  • the position of the sensor 14 (14a, 14b) on the plane P when it is placed on the stage 15 is the moving body (ball riding robot).
  • a dummy moving body 23 (see FIG. 2) which is the same as 13 is used.
  • the dummy moving body 23 provided with the sensor 24 (24a, 24b) which has the same characteristic as the sensor 14 (14a, 14b) of the moving body (ball riding robot) 13.
  • XY coordinates are set on the plane P (the upper surface of the stage 25), and a plurality of X-axis direction reference lines X1, X2, parallel to the X-axis direction of the XY coordinates are set.
  • X3, X4, X5, X6, X7 and a plurality of Y axis direction reference lines Y1, Y2, Y3, Y4, Y5, Y6, Y7 parallel to the Y axis direction are set (FIG. 1: S1).
  • These X-axis direction reference lines X1 to X7 and Y-axis direction reference lines Y1 to Y7 are formed on the plane P of the stage 25 so as to be equally spaced.
  • the dummy moving bodies 23 are sequentially positioned on the intersections In where the X-axis direction reference lines X1 to X7 and the Y-axis direction reference lines Y1 to Y7 intersect (FIG. 1: S2).
  • the dummy moving body 23 In positioning the dummy moving body 23 on each intersection In where the X-axis direction reference lines X1 to X7 and the Y-axis direction reference lines Y1 to Y7 intersect, in this embodiment, the dummy moving body 23 is manually set to each intersection point. Position on In.
  • the dummy mark is formed on the dummy moving body 23 so as to be aligned with the X-axis direction reference line X5 and the Y-axis direction reference line Y7.
  • the dummy moving body 23 is used so that the planar position of the sensor 24a included in the 23 is exactly coincident with the intersection In.
  • the central axis of the dummy moving body 23 and the planar position of one of the two sensors 24a and 24b included in the dummy moving body 23 are not necessarily required to coincide with each other. If the positional relationship between the dummy moving body 23 and the sensors 24a and 24b is maintained at a predetermined correct positional relationship, the true position of the dummy moving body 23 (actually the dummy moving body 23 is moved by the method of the present invention). The error between the detected position and the position on the intersection point In) can be accurately obtained.
  • two sensors 24 In order to position the dummy moving body 23 on each intersection In where the X-axis direction reference lines X1 to X7 and the Y-axis direction reference lines Y1 to Y7 intersect, two sensors 24 ( The line L connecting the lines 24a and 24b) and the X axis or the Y axis are positioned so as to reliably hold a predetermined angle (for example, parallel or orthogonal). That is, the dummy moving body 23 is positioned so that the line L connecting the two sensors 24 (24a, 24b) and the X axis or the Y axis reliably hold a predetermined angle.
  • a predetermined angle for example, parallel or orthogonal
  • the positions of the dummy moving bodies 23 on a plurality of intersections In are detected using the two position detection sensors 12a and 12b.
  • the position (XY coordinate position) of the dummy moving body is obtained from the propagation time of the ultrasonic signal from the two position detection sensors 12a and 12b to the sensor 24 provided in the dummy moving body 23.
  • distances d2 and d3 between the two position detection sensors 12a and 12b and the sensor 24 (24a) are obtained, respectively, and the dummy moving body 23 Find the position.
  • the position of the dummy moving body 23 at each of the plurality of intersections In is acquired as XY coordinate data for calibration (hereinafter referred to as calibration XY coordinate data) (FIG. 1: S3).
  • calibration XY coordinate data XY coordinate data for calibration
  • the two sensors 24 (24a, 24b) provided in the dummy moving body 23 calibration data of the rotational direction position of the dummy moving body 23 at each of the plurality of intersections In (hereinafter referred to as rotational direction position calibration data).
  • the ultrasonic waves transmitted at the same time from the position detection sensors 12a and 12b provided in at least one of the sensor holding jigs 11a and 11b are the two sensors 24a and 24b of the dummy moving body 23. Find the time difference to reach Then, for each detected value of the XY coordinates of the dummy moving body 23, the rotational direction position can be obtained based on this time difference and the adjacent distance between the two sensors 24a and 24b.
  • FIG. 5 is an example showing an X-axis direction error Ex, a Y-axis direction error Ey, and a rotational direction position error E ⁇ at each intersection In.
  • the error approximate expression Xy1 in the X-axis direction When the error approximate expression Xy1 in the X-axis direction is obtained, the X-axis direction error Ex when viewed along the Y-axis direction reference line Y1 (6.1, 5, 4, 3, 2, in order from the left in FIG. 5). As shown in FIG. 6A, an X-axis direction error Ex is plotted corresponding to each X coordinate, and an approximate expression for fitting to the plotted point is obtained.
  • the error approximate expression Xy1 is expressed by an nth-order approximate expression according to the required accuracy (n is an integer of 0 or more smaller than the number of intersections in the X-axis direction).
  • the error approximate expression Xy1 in FIG. 6A is a first-order approximate expression.
  • the Y-axis direction error Ey when viewed along the X-axis direction reference line X1 (in FIG. 5, 6, 5.1, 4, 3, 2, Focusing on (1,0), as shown in FIG. 6B, the Y-axis direction error Ey is plotted corresponding to each Y coordinate, and an approximate expression for fitting to the plotted point is obtained.
  • the error approximate expression Yx1 is also expressed by an nth-order approximate expression (n is an integer of 0 or more smaller than the number of intersections in the Y-axis direction).
  • the rotational direction position error E ⁇ when viewed along the Y-axis direction reference line Y1 (in FIG. 5, 6, 4.9, 4, 3, 2, in order from the left). Focusing on (1,0), as shown in FIG. 6 (c), the rotational direction position error E ⁇ is plotted corresponding to each X coordinate, and an approximate expression for fitting to the plotted point is obtained.
  • the error approximate expression ⁇ y1 is also expressed by an nth-order approximate expression (n is an integer of 0 or more smaller than the number of intersections in the X-axis direction).
  • the robot body rolls on the sphere while the robot body is on the sphere. Is used as a moving body 13, and the moving body 13 is actually moved on the stage 15 by using a ball riding robot configured such that the robot can move with the sphere or the robot body can rotate on the sphere. Then, the process proceeds to a stage (actual detection stage) B for detecting the position.
  • the moving body 13 in cooperation with a sensor (ultrasonic wave receiver) 14 (14a, 14b) included in the moving body 13, two position detections for detecting the position of the moving body 13 are performed.
  • the position of the moving body 13 on the plane P is detected by the sensors (ultrasound transmitters) 12a and 12b (FIG. 1: S6).
  • the two position detection sensors 12a and 12b are fixed to the same sensor holding jigs 11a and 11b as in the preparation stage A.
  • the sensor 14 (14a, 14b) provided in the moving body 13 has the same positional relationship as the sensor 24 (24a, 24b) provided in the dummy moving body 23 used in the preparation stage A.
  • the moving body 13 is remotely operated on a stage 15 by a control device such as a computer (not shown) so that it can be moved in a predetermined direction.
  • the movable body 13 is provided with two sensors 14 (14a, 14b) at a height H2 from the plane P of the stage 15.
  • the distances d2 and d3 between the two position detection sensors 12a and 12b and the sensor 14 are obtained from the propagation times of signals from the two position detection sensors 12a and 12b to the sensor 14 included in the moving body 13, respectively.
  • the height position H1 of the two position detection sensors 12a and 12b and the distance d1 are set to be the same values as in the preparation stage A, and the length of the triangle is three sides. From the relationship, the position of the moving body 13 on the plane P is detected.
  • XY coordinate data (hereinafter, detected XY coordinate data) detected by the position detection sensors 12a and 12b is corrected by an interpolation method such as linear interpolation, thereby approximating the true position of the moving body 13. Is obtained.
  • the true rotational direction of the moving body 13 is corrected by correcting the detected rotational direction position data (hereinafter, detected rotational direction position data) of the moving body 13 detected by the position detection sensors 12a and 12b by an interpolation method. Rotational direction position data approximate to the position is obtained.
  • linear interpolation is performed using a linear function composed of straight lines p1-p2.
  • the linear interpolation method is not limited to linear interpolation, and interpolation may be performed using a dimensional function corresponding to the number of data. Is possible.
  • correction is performed according to the case of correcting the detected X coordinate data Dx described above.
  • the horizontal axis is the Y-coordinate and the vertical axis is the Y-axis direction error
  • two Y-axis direction errors are obtained from the two error approximation equations Yx3 and Yx4.
  • the correction is performed in accordance with the case of correcting the detected X coordinate data Dx described above.
  • the horizontal axis is the X coordinate
  • the vertical axis is the rotation direction position error
  • the detected X coordinate data Dx is outside the outermost X-axis direction reference lines X1 and X7
  • an error approximation expression outside the X coordinates X1 and X7 The position of the moving body 13 can be obtained using the same value as the error in the X-axis direction when the inclination is 0 and the X-coordinates X1 and X7 (see FIG. 10A). It is also possible to extend the error approximate expression outside the X coordinates X1 and X7 and obtain the position of the moving body 13 by the extended error approximate expression (see FIG. 10B).
  • the position detection method of the moving body having the above-described configuration obtains correction data for correcting the position data detected by the position detection sensors 12a and 12b in the preparation stage A, it is the same as the preparation stage A.
  • the height position H1 of the two position detection sensors 12a and 12b and the interval d1 are set as conditions, the mobile body 13 is detected when the position of the mobile body 13 is detected in another environment (for example, different venues). It is possible to accurately detect the position of.
  • an ultrasonic receiver is used as the sensors 14 and 24 provided in the moving body 13 and the dummy moving body 23, and an ultrasonic transmitter is used as a position detection sensor. It is also possible to obtain the distances d2 and d3 by replacing the sound wave transmitter.
  • the position detection sensors 12a and 12b it is possible to use ultrasonic sensors having both transmission and reception functions.
  • the two position detection sensors (ultrasonic transmitters) 12a and 12b are held by the sensor holding jigs 11a and 11b.
  • the moving body 13 or the dummy moving body 23 is used. It is also possible to configure so as to include a position detecting sensor.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

　平面上を移動する移動体の位置を精度よく検出するための、移動体の位置検出方法を提供する。　平面上にＸ軸方向基準線とＹ軸方向基準線を設定し（Ｓ１）、これらの基準線の交点上にダミー移動体を位置させ（Ｓ２）、ダミー移動体の位置を位置検出用センサにより検出して（Ｓ３）、真の位置データとの差から、交点における位置ずれ量を、Ｘ軸方向誤差およびＹ軸方向誤差として求め（Ｓ４）、これらの誤差を基に、基準線上の各位置の誤差の算出式であるＸ軸方向誤差近似式およびＹ軸方向誤差近似式を求め（Ｓ５）、実際に平面上を移動する移動体の位置を検出するにあたっては、移動体の位置を位置検出用センサにより検出し（Ｓ６）、得られた検出ＸＹ座標データを、Ｘ軸方向誤差近似式およびＹ軸方向誤差近似式を用いて線形補間法により補正することで（Ｓ７）、移動体の真の位置に近似した位置データを得るようにする（Ｓ８）。

Description

移動体の位置検出方法
　本発明は、移動体の位置検出方法に関し、詳しくは、移動体の平面上における位置を検出するための移動体の位置検出方法に関する。
　平面上を移動する移動体の動きを制御するには、移動体の現在位置を精度よく把握することが必要である。そして、移動体の位置を検出する方法として、例えば、移動体にセンサを配設するとともに、移動体が備えるセンサと協働して、移動体の位置を検出する位置検出用センサを備えた装置を用いて、移動体の位置を検出する方法がある。
　そして、そのような方法で移動体の位置を検出するための装置および方法が特許文献１に開示されている。
　この特許文献１に開示されている装置では、図１２に示すように、移動体１１３が備えるセンサとして、超音波を受信する受信機１１４が用いられ、位置検出用センサとして超音波を発信する２つの発信機１１２ａ，１１２ｂが用いられている。発信機１１２ａ，１１２ｂは、既知の間隔ｄ１で設置されている。
　そして、この装置は、２つの発信機１１２ａ，１１２ｂから受信機１１４への超音波信号の伝播時間により、２つの発信機１１２ａ，１１２ｂと受信機１１４の距離ｄ２，ｄ３をそれぞれ求め、三平方の定理に基づき移動体１１３の位置を求めるように構成されている。
特開平７－１４０２４１号公報
　しかし、特許文献１に開示された位置検出方法では、移動体１１３の位置検出誤差が大きくなりやすく、移動体１１３の位置を精度よく検出することが困難であるという問題点がある。
　本発明は、上記課題を解決するものであり、平面上を移動する移動体の位置を精度よく検出するための、移動体の位置検出方法を提供することを目的とする。
　上記課題を解決するため、本発明の移動体の位置検出方法は、
　平面上を移動する移動体が備えるセンサと協働して、前記移動体の位置を検出する位置検出用センサにより、前記移動体の前記平面上における位置を検出するための移動体の位置検出方法であって、
　前記平面上にＸＹ座標を想定し、
　前記平面上の前記ＸＹ座標で特定される複数の位置であって、Ｘ方向およびＹ方向において異なる複数の位置に、前記センサを所定の位置に備えた前記移動体もしくは前記移動体と同じ位置に前記センサを備えたダミー移動体を位置させ、
　前記複数の位置のそれぞれにおける、前記移動体もしくは前記ダミー移動体の位置を前記位置検出用センサにより検出して校正用ＸＹ座標データを取得し、
　取得した前記校正用ＸＹ座標データと、前記移動体もしくは前記ダミー移動体を位置させた前記複数の位置についての真の位置データとの差から、前記複数の位置についての補正データを求めておき、
　実際に前記平面上を移動する前記移動体の位置を検出するにあたっては、
　前記平面上を移動する前記移動体の位置を、前記位置検出用センサにより検出し、得られた検出ＸＹ座標データを前記補正データを用いた補間法により補正することで、前記移動体の真の位置に近似した位置データを得るようにしたこと
　を特徴としている。
　また、上記課題を解決するため、本発明の移動体の位置検出方法は、
　平面上を移動する移動体が備えるセンサと協働して、前記移動体の位置を検出する位置検出用センサにより、前記移動体の前記平面上における位置を検出するための移動体の位置検出方法であって、
　前記平面上にＸＹ座標と、Ｘ軸方向に平行な複数のＸ軸方向基準線と、Ｙ軸方向に平行な複数のＹ軸方向基準線とを想定し、
　前記Ｘ軸方向基準線とＹ軸方向基準線が交わる複数の交点上に、前記センサを所定の位置に備えた前記移動体もしくは前記移動体と同じ位置に前記センサを備えたダミー移動体を位置させ、
　前記複数の交点のそれぞれにおける、前記移動体もしくは前記ダミー移動体の位置を前記位置検出用センサにより検出して校正用ＸＹ座標データを取得し、
　取得した前記校正用ＸＹ座標データと、前記移動体もしくは前記ダミー移動体を位置させた前記複数の交点についての真の位置データとの差から、前記複数の交点におけるＸ軸方向およびＹ軸方向の位置ずれ量を、Ｘ軸方向誤差およびＹ軸方向誤差として求めるとともに、
　前記Ｘ軸方向誤差および前記Ｙ軸方向誤差を基に、複数の前記Ｘ軸方向基準線および前記Ｙ軸方向基準線上の各位置の誤差の算出式であるＸ軸方向誤差近似式およびＹ軸方向誤差近似式を求めておき、
　実際に前記平面上を移動する前記移動体の位置を検出するにあたっては、
　前記平面上を移動する前記移動体の位置を、前記位置検出用センサにより検出し、得られた検出ＸＹ座標データを、前記Ｘ軸方向誤差近似式および前記Ｙ軸方向誤差近似式を用いて線形補間法により補正することで、前記移動体の真の位置に近似した位置データを得るようにしたこと
　を特徴としている。
　なお、本発明において、平面上に、ＸＹ座標、Ｘ軸およびＹ軸方向に平行な複数の基準線（Ｘ軸方向基準線およびＹ軸方向基準線）を想定するとは、実際にＸＹ座標、Ｘ軸方向基準線、Ｙ軸方向基準線などを平面上に引いたり、実際には線は引かずに、光学的方法で示したりする場合などを含む概念である。
　また、上述した移動体の位置検出方法が、前記移動体が複数のセンサを所定の位置に備え、前記位置検出用センサにより検出される前記複数のセンサの位置関係から、前記移動体の、前記平面に対して垂直な軸を回転軸とする回転方向位置を検出することができるように構成されている場合において、
　前記複数の交点上に、前記センサを所定の位置に備えた前記移動体もしくは前記移動体と同じ位置に前記センサを備えたダミー移動体を位置させる際に、前記移動体もしくは前記ダミー移動体の回転方向位置が所定の方向に向くように位置させ、前記複数の交点のそれぞれにおける、前記移動体もしくは前記ダミー移動体の前記回転方向位置を、前記位置検出用センサにより検出して回転方向位置校正用データを取得し、
　取得した前記回転方向位置校正用データと、前記複数の交点についての真の回転方向位置データとの差から、前記複数の交点における回転方向位置誤差を求めるとともに、
　前記回転方向位置誤差に基づいて、各位置の誤差の算出式である回転方向誤差近似式を求めておき、
　実際に前記平面上を移動する前記移動体の回転方向位置を検出するにあたっては、
　前記平面上を移動する前記移動体の回転方向位置を、前記位置検出用センサにより検出し、得られた検出回転方向位置データを、前記回転方向誤差近似式を用いて線形補間法により補正することで、前記移動体の真の回転方向位置に近似した回転方向位置データを得るようにすることが好ましい。
　上記構成を備えることで、移動体に対して検出した回転方向の位置データの誤差を修正して、移動体の平面上の位置（Ｘ軸方向およびＹ軸方向の位置）に加えて、移動体の回転方向の位置を精度よく検出することができる。
　本発明の移動体の位置検出方法においては、上述のように、平面上を移動する移動体の位置を、位置検出用センサにより検出し、得られた検出ＸＹ座標データを、補正データを用いた補間法により補正することで、移動体の真の位置に近似した位置データを得るようにしているので、移動体に対して検出したＸＹ座標の位置の誤差を修正して、平面上を移動する移動体の位置を精度よく検出することができる。
　また、本発明の他の移動体の位置検出方法においては、複数の交点のそれぞれにおける、移動体（もしくはダミー移動体）の位置を位置検出用センサにより検出して校正用ＸＹ座標データを取得し、取得した校正用ＸＹ座標データと、移動体（もしくはダミー移動体）を位置させた上述の複数の交点についての真の位置データとの差から、複数の交点におけるＸ軸方向およびＹ軸方向の位置ずれ量を、Ｘ軸方向誤差およびＹ軸方向誤差として求めるとともに、Ｘ軸方向誤差およびＹ軸方向誤差を基に、複数のＸ軸方向基準線およびＹ軸方向基準線上の各位置の誤差の算出式であるＸ軸方向誤差近似式およびＹ軸方向誤差近似式を求め、平面上を移動する前記移動体の位置を実際に検出するにあたっては、平面上を移動する移動体の位置を、位置検出用センサにより検出し、得られた検出ＸＹ座標データを、Ｘ軸方向誤差近似式およびＹ軸方向誤差近似式を用いて線形補間法により補正して、移動体の真の位置に近似した位置データを得るようにしているので、移動体の真の位置に近似した位置データを容易に、精度よく求めることが可能になる。
本発明の実施形態にかかる移動体の位置検出方法のフローを示す図である。図１における（Ａ）は準備段階のフロー、（Ｂ）は移動体を実際に動かして移動体の位置を検出する実検出段階のフローである。 図１に示した準備段階Ａで用いられる、ダミー移動体の位置を検出するための装置の斜視図である。 図２に示した装置の平面上のＸＹ座標、Ｘ軸方向基準線およびＹ軸方向基準線を示す図である。 図３に示したＸ軸方向基準線およびＹ軸方向基準線の交点に配設するダミー移動体を示す図である。 ダミー移動体を使って検出したＸＹ座標データおよび回転方向位置データと、真のＸＹ位置データおよび回転方向位置データとのずれ量（Ｘ軸方向誤差、Ｙ軸方向誤差、回転方向位置誤差）の一例を示す図である。 基準線上の各位置の誤差を近似曲線で表した場合の誤差近似式を示す図であり、（ａ）はＸ軸方向誤差近似式、（ｂ）はＹ軸方向誤差近似式、（ｃ）は回転方向位置誤差近似式を示す図である。 図１に示した実検出段階Ｂで用いられる、移動体の位置を検出するための装置の斜視図である。 実検出段階Ｂにおいて、位置検出用センサにより検出した移動体の座標データおよび回転方向位置データを示す図である。 実検出段階Ｂで検出したＸ座標データに対する補正の行い方を説明するための図であり、（ａ）は、図６（ａ）に示した誤差近似式を用いてＸ軸方向誤差を求める方法を示す図であり、（ｂ）は、（ａ）で求めたＸ軸方向誤差を用いて線形補間を行い、検出したＸ座標データに対する補正量を求める方法を示す図である。 移動体が最外のＸ軸方向基準線の外側にある場合において、移動体の位置を求める方法を説明するための図である。 移動体が最外のＹ軸方向基準線の外側にある場合において、移動体の位置を求める方法を説明するための図である。 従来における移動体の位置を検出する方法を示す図である。
　次に、本発明の実施形態を示して本発明をさらに詳しく説明する。
　なお、この実施形態では、ロボット本体が球体上に乗った状態で球体を転動させ、平面上を球体とともに移動したり、ロボット本体が球体上で回転したりすることができるように構成された球乗りロボットが移動体である場合における、移動体の位置検出方法について説明する。
　また、この実施形態では、図２に示すように、センサ保持治具１１ａ，１１ｂに保持させた２つの位置検出用センサ（超音波発信機）１２ａ，１２ｂを用い、ダミー移動体２３が備えるセンサ２４（２４ａ，２４ｂ）、および、移動体１３（図７）が備えるセンサ１４（１４ａ，１４ｂ）を利用して、移動体１３の位置を検出する方法を例にとって説明する。
　まず、本発明の移動体の位置検出方法を実施するために用いる装置について説明する。
　この実施形態において、移動体の位置検出方法を実施するために用いられる装置は、図７に示すように、ステージ１５の上面である平面Ｐを移動させるべき移動体１３が備えるセンサ１４（１４ａ，１４ｂ）と協働して、移動体１３の位置を検出する２つの位置検出用センサ（超音波発信機）１２ａ，１２ｂを備えている。
　２つの位置検出用センサ（超音波発信機）１２ａ，１２ｂはそれぞれ別々に、２つのセンサ保持治具１１ａ，１１ｂに保持されており、ステージ１５の上面である平面Ｐからの高さ位置Ｈ１と、位置検出用センサ１２間の水平方向距離ｄ１は所定の値に設定することができるように構成されている。
　次に、この実施形態における移動体の位置検出方法について説明する。
　なお、本発明の移動体の位置検出方法は、実際に移動体１３の位置を検出する前の段階で、位置検出用センサ１２ａ，１２ｂにより検出される位置データを補正するための補正データを求める段階（準備段階）Ａと、この準備段階Ａで求めた補正データを用いて、実際に移動体１３を移動させる場合の移動体１３の位置（上記補正データを用いて補正した真の位置に近い位置を）をリアルタイムで検出する段階（実検出段階）Ｂを備えている（図１参照）。
　この実施形態の移動体１３は、球乗りロボットであるため、姿勢検知センサや制御機器などを作動させてしかるべき制御を行わないと自立しない。作業性を高めるために、準備段階Ａの校正用データを採取する段階では、ステージ１５に配置した際の、平面Ｐ上のセンサ１４（１４ａ，１４ｂ）の位置が、移動体（球乗りロボット）１３と同じになっているダミー移動体２３（図２参照）を用いる。なお、移動体（球乗りロボット）１３のセンサ１４（１４ａ，１４ｂ）と、同じ特性を有するセンサ２４（２４ａ，２４ｂ）を備えたダミー移動体２３を用いることが好ましい。
　ただし、転倒防止用の治具を利用することにより、実際にその位置を検出すべき移動体（球乗りロボット）１３を用いて、校正用データを採取するようにすることも可能である。
　また、この実施形態では、校正用データを採取し、補正データを求める準備段階Ａで、ダミー移動体２３を移動させるステージとして、準備段階用のステージ２５（図２参照）を別途用意して用いる。なお、この実施形態における平面Ｐ（ステージ２５の上面）は、４ｍ四方の正方形である。
　ただし、上述の校正用データを採取する際のステージとして、実際に移動体（球乗りロボット）１３を動作させる場合に用いるステージ１５（図７）と同じものを用いることも可能である。
　準備段階Ａでは、まず、図３に示すように、平面Ｐ（ステージ２５の上面）上にＸＹ座標を設定し、ＸＹ座標のＸ軸方向に平行な複数のＸ軸方向基準線Ｘ１，Ｘ２，Ｘ３，Ｘ４，Ｘ５，Ｘ６，Ｘ７と、Ｙ軸方向に平行な複数のＹ軸方向基準線Ｙ１、Ｙ２，Ｙ３，Ｙ４，Ｙ５，Ｙ６，Ｙ７を設定する（図１：Ｓ１）。
　これらＸ軸方向基準線Ｘ１～Ｘ７とＹ軸方向基準線Ｙ１～Ｙ７は、それぞれ等間隔となるようにステージ２５の平面Ｐに形成されている。
　次に、図２に示すように、Ｘ軸方向基準線Ｘ１～Ｘ７とＹ軸方向基準線Ｙ１～Ｙ７が交わる交点Ｉｎ上に、順次、ダミー移動体２３を位置させる（図１：Ｓ２）。
　ダミー移動体２３を、上述のＸ軸方向基準線Ｘ１～Ｘ７とＹ軸方向基準線Ｙ１～Ｙ７が交わる各交点Ｉｎ上に位置させるにあたって、この実施形態では、ダミー移動体２３を手動により各交点Ｉｎ上に位置させるようにする。
　この実施形態では、図４に示すように、ダミー移動体２３に形成された三角状マークを、Ｘ軸方向基準線Ｘ５とＹ軸方向基準線Ｙ７に合うように位置させることで、ダミー移動体２３が備えるセンサ２４ａの平面位置が、交点Ｉｎに正確に一致するようなダミー移動体２３を用いる。
　ただし、必ずしも、ダミー移動体２３の形態上の中心軸と、ダミー移動体２３が備える２つのセンサ２４ａ，２４ｂのいずれか一方の平面位置とを一致させる必要はない。ダミー移動体２３と、センサ２４ａ，２４ｂの位置関係が、所定の正しい位置関係に保たれていれば、本発明の方法により、ダミー移動体２３の真の位置（実際にダミー移動体２３をおいた交点Ｉｎ上の位置）と、検出値との間の誤差を正確に求めることができる。
　また、ダミー移動体２３を、上述のＸ軸方向基準線Ｘ１～Ｘ７とＹ軸方向基準線Ｙ１～Ｙ７が交わる各交点Ｉｎ上に位置させるにあたっては、ダミー移動体２３が備える２つのセンサ２４（２４ａ，２４ｂ）を結ぶ線Ｌと、Ｘ軸あるいはＹ軸とが、所定の角度を確実に保持するように（例えば、平行になるように、あるいは直交するように）位置させる。すなわち、２つのセンサ２４（２４ａ，２４ｂ）を結ぶ線Ｌと、Ｘ軸あるいはＹ軸とが、所定の角度を確実に保持するようにダミー移動体２３を位置させることにより、２つのセンサ２４（２４ａ，２４ｂ）を結ぶ線Ｌと、Ｘ軸あるいはＹ軸との角度の関係から、ダミー移動体２３の回転方向位置（平面Ｐに対して垂直な軸を回転軸とする回転方向の位置）を得ることが可能になる。
　次に、複数の交点Ｉｎ上（この実施形態では４９個）におけるダミー移動体２３の位置を、２つの位置検出用センサ１２ａ，１２ｂを用いて検出する。ダミー移動体の位置（ＸＹ座標位置）は、２つの位置検出用センサ１２ａ，１２ｂからダミー移動体２３が備えるセンサ２４への超音波信号の伝播時間から求める。具体的には、超音波信号の伝播時間を基に、２つの位置検出用センサ１２ａ，１２ｂとセンサ２４（２４ａ）の距離ｄ２、ｄ３をそれぞれ求め、三平方の定理に基づきダミー移動体２３の位置を求める。これにより、複数の交点Ｉｎのそれぞれにおける、ダミー移動体２３の位置を校正用のＸＹ座標データ（以下、校正用ＸＹ座標データ）として取得する（図１：Ｓ３）。
　また、ダミー移動体２３に備えた２つのセンサ２４（２４ａ，２４ｂ）により、複数の交点Ｉｎのそれぞれにおける、ダミー移動体２３の回転方向位置の校正用データ（以下、回転方向位置校正用データ）も取得する。具体的には、少なくともいずれか一方のセンサ保持治具１１ａ，１１ｂに備えられた位置検出用センサ１２ａ，１２ｂから同一の時点に発信した超音波が、ダミー移動体２３の２つのセンサ２４ａ，２４ｂへ到達する時間差を求める。そして、ダミー移動体２３のＸＹ座標の検出値それぞれに対して、この時間差と、２つのセンサ２４ａ，２４ｂの隣接距離を基に、回転方向位置を求めることができる。
　次に、取得した校正用ＸＹ座標データと、ダミー移動体２３を位置させた複数の交点Ｉｎについての真の位置データとの差から、複数の交点ＩｎにおけるＸ軸方向およびＹ軸方向の位置ずれ量を、Ｘ軸方向誤差ＥｘおよびＹ軸方向誤差Ｅｙとしてそれぞれ求める（図１：Ｓ４）。
　同様に、取得した回転方向位置校正用データと、複数の交点Ｉｎについての真の回転方向位置データとの差から、複数の交点Ｉｎにおける回転方向位置のずれ量を、回転方向位置誤差Ｅθとして求める。
　図５は、それぞれの交点ＩｎにおけるＸ軸方向誤差Ｅｘ、Ｙ軸方向誤差Ｅｙおよび回転方向位置誤差Ｅθを示した一例である。
　例えば、図５において、Ｘ軸方向基準線Ｘ１とＹ軸方向基準線Ｙ１の交点ＩｎにおけるＸ軸方向誤差Ｅｘ、Ｙ軸方向誤差Ｅｙおよび回転方向位置誤差Ｅθは、（Ｅｘ，Ｅｙ，Ｅθ）＝（６．１ｃｍ，６ｃｍ，６°）であることを示している。
　次に、図６（ａ）～（ｃ）に示すように、それぞれの上記誤差Ｅｘ，Ｅｙ，Ｅθを基に、Ｘ軸方向基準線Ｘ１～Ｘ７上の各位置の誤差の算出式である誤差近似式Ｘｙ１，Ｘｙ２，Ｘｙ３，Ｘｙ４，Ｘｙ５，Ｘｙ６，Ｘｙ７、および、Ｙ軸方向基準線Ｙ１～Ｙ７上の各位置の誤差の算出式である誤差近似式Ｙｘ１，Ｙｘ２，Ｙｘ３，Ｙｘ４，Ｙｘ５，Ｙｘ６，Ｙｘ７を求める（図１：Ｓ５）。
　また、Ｙ軸方向基準線Ｙ１～Ｙ７に沿ってみた場合のそれぞれの回転方向位置の誤差近似式θｙ１，θｙ２，θｙ３，θｙ４，θｙ５，θｙ６，θｙ７を求める。
　Ｘ軸方向の誤差近似式Ｘｙ１を求める場合は、Ｙ軸方向基準線Ｙ１に沿ってみた場合のＸ軸方向誤差Ｅｘ（図５では、左から順に６．１，５，４，３，２，１，０）に着目し、図６（ａ）に示すように、各Ｘ座標に対応させてＸ軸方向誤差Ｅｘをプロットし、プロットした点にフィッティングする近似式を求める。なお、誤差近似式Ｘｙ１は、必要とされる精度に応じて、ｎ次の近似式で表現される（ｎは、Ｘ軸方向の交点の数よりも小さい０以上の整数）。例えば、図６（ａ）の誤差近似式Ｘｙ１は、１次の近似式である。
　同様に、それぞれのＹ軸方向基準線Ｙ２～Ｙ７に沿ってみた場合のそれぞれのＸ軸方向誤差Ｅｘに着目し、図６（ａ）に示すＸ軸方向の誤差近似式Ｘｙ２～Ｘｙ７を求める。
　Ｙ軸方向の誤差近似式Ｙｘ１を求める場合は、Ｘ軸方向基準線Ｘ１に沿ってみた場合のＹ軸方向誤差Ｅｙ（図５では、上から順に６，５．１，４，３，２，１，０）に着目し、図６（ｂ）に示すように、各Ｙ座標に対応させてＹ軸方向誤差Ｅｙをプロットし、プロットした点にフィッティングする近似式を求める。なお、誤差近似式Ｙｘ１も、ｎ次の近似式で表現される（ｎは、Ｙ軸方向の交点の数よりも小さい０以上の整数）。
　同様に、それぞれのＸ軸方向基準線Ｘ２～Ｘ７に沿ってみた場合のそれぞれのＹ軸方向誤差Ｅｙに着目し、図６（ｂ）に示すＹ軸方向の誤差近似式Ｙｘ２～Ｙｘ７を求める。
　回転方向位置の誤差近似式θｙ１を求める場合は、Ｙ軸方向基準線Ｙ１に沿ってみた場合の回転方向位置誤差Ｅθ（図５では、左から順に６，４．９，４，３，２，１，０）に着目し、図６（ｃ）に示すように、各Ｘ座標に対応させて回転方向位置誤差Ｅθをプロットし、プロットした点にフィッティングする近似式を求める。なお、誤差近似式θｙ１も、ｎ次の近似式で表現される（ｎは、Ｘ軸方向の交点の数よりも小さい０以上の整数）。
　同様に、それぞれのＹ軸方向基準線Ｙ２～Ｙ７に沿ってみた場合のそれぞれの回転方向位置誤差Ｅθに着目し、図６（ｃ）に示す回転方向位置の誤差近似式θｙ２～θｙ７を求める。
　なお、上記実施形態では、Ｙ軸方向基準線Ｙ１～Ｙ７に沿ってみた場合の回転方向位置誤差Ｅθに着目したが、Ｘ軸方向基準線Ｘ１～Ｘ７に沿ってみた場合の回転方向位置誤差Ｅθに着目して、回転方向位置の誤差近似式θｘ１～θｘ７を導出することも可能である。
　上記に示す準備段階Ａで必要な校正用のデータを採取し、補正データを求めた後、ダミー移動体２３に代えて、ロボット本体が球体上に乗った状態で球体を転動させ、平面上を球体とともに移動したり、ロボット本体が球体上で回転したりすることができるように構成された球乗りロボットを移動体１３として用い、この移動体１３を、ステージ１５上で実際に移動させて、その位置を検出する段階（実検出段階）Ｂに移行する。
　実検出段階Ｂでは、図７に示すように、移動体１３が備えるセンサ（超音波受信機）１４（１４ａ，１４ｂ）と協働して、移動体１３の位置を検出する２つの位置検出用センサ（超音波発信機）１２ａ，１２ｂにより、移動体１３の平面Ｐ上における位置を検出する（図１：Ｓ６）。なお、２つの位置検出用センサ１２ａ，１２ｂは、準備段階Ａと同じセンサ保持治具１１ａ，１１ｂに固定されている。また、移動体１３が備えるセンサ１４（１４ａ，１４ｂ）は、準備段階Ａで用いたダミー移動体２３が備えるセンサ２４（２４ａ，２４ｂ）と同じ位置関係にある。
　移動体１３は、図示しないコンピュータなどの制御装置により、ステージ１５上において、所定の方向に移動させることができるように遠隔操作されている。移動体１３には、ステージ１５の平面Ｐから高さＨ２の位置に２つのセンサ１４（１４ａ，１４ｂ）が設けられている。
　そして、２つの位置検出用センサ１２ａ，１２ｂから移動体１３が備えるセンサ１４への信号の伝播時間により、２つの位置検出用センサ１２ａ，１２ｂとセンサ１４の距離ｄ２，ｄ３がそれぞれ求められる。実検出段階Ｂでは、２つの位置検出用センサ１２ａ，１２ｂの高さ位置Ｈ１と、間隔ｄ１が準備段階Ａと同様の値となるように設定されており、３角形の３辺の長さの関係から、移動体１３の平面Ｐ上の位置が検出される。
　このとき、位置検出用センサ１２ａ，１２ｂにより検出したＸＹ座標データ（以下、検出ＸＹ座標データ）を、線形補間などの補間法により補正することで、移動体１３の真の位置に近似した位置データが得られる。
　また、位置検出用センサ１２ａ，１２ｂにより検出した移動体１３の、検出した回転方向位置データ（以下、検出回転方向位置データ）を、補間法により補正することで、移動体１３の真の回転方向位置に近似した回転方向位置データが得られる。
　具体的には、図８に示すように、位置検出用センサ１２ａ，１２ｂにより検出した移動体１３の検出Ｘ座標データＤｘ、検出Ｙ座標データＤｙおよび検出回転方向位置データＤθが、（Ｄｘ，Ｄｙ，Ｄθ）＝（ａ、ｂ、ｃ）であった場合に、以下に示す方法を用いて、移動体１３の真の位置に近似した位置データを得るようにしている。
　検出Ｘ座標データＤｘを補正する場合は、まず、図６（ａ）に示した誤差近似式Ｘｙ１～Ｘｙ７のうち、検出Ｙ座標データＤｙ＝ｂを挟んで近傍に位置する基準線Ｙ５，Ｙ６に沿ってみた場合の誤差近似式Ｘｙ５，Ｘｙ６を選択する。そして、図９（ａ）に示すように、横軸をＸ座標、縦軸をＸ軸方向誤差とした座標系において、Ｘ座標がＤｘ＝ａであるときの誤差近似式Ｘｙ５，Ｘｙ６に対応するＸ軸方向誤差α，βをそれぞれ求める。
　次に、図９（ｂ）に示すように、横軸をＹ座標、縦軸をＸ軸方向誤差とした座標系において、Ｘ軸方向誤差がαであってＹ座標がＹ５である点ｐ１と、Ｘ軸方向誤差がβであってＹ座標がＹ６である点ｐ２とを直線でつなぐ。そして、直線ｐ１－ｐ２上において、検出Ｙ座標データＤｙ＝ｂのときのＸ軸方向誤差γを求めることで線形補間を行う（図１：Ｓ７）。
　求めたＸ軸方向誤差γが、真の値からのずれ量（補正すべき位置ずれ量）に相当し、検出Ｘ座標データＤｘ＝ａに対して、Ｘ軸方向誤差γを補正することで、移動体１３の真の位置に近似したＸ軸方向の位置データが得られる（図１：Ｓ８）。
　なお、上記では直線ｐ１－ｐ２からなる一次関数を用いて線形補間を行ったが、線形補間の方法としては一次線形補間に限られず、データ数に応じた次元関数を用いて補間を行うことが可能である。
　検出Ｙ座標データＤｙを補正する場合は、上述した検出Ｘ座標データＤｘを補正する場合に準じて補正を行う。
　例えば、図６（ｂ）に示した誤差近似式Ｙｘ１～Ｙｘ７のうち、検出Ｘ座標データＤｘ＝ａを挟んで近傍に位置する基準線Ｘ３，Ｘ４に沿ってみた場合の誤差近似式Ｙｘ３，Ｙｘ４を選択し、横軸をＹ座標、縦軸をＹ軸方向誤差とした座標系において、２つの誤差近似式Ｙｘ３，Ｙｘ４から２つのＹ軸方向誤差を求める。そして、横軸をＸ座標、縦軸をＹ軸方向誤差とした座標系において、検出Ｘ座標データＤｘ＝ａのときのＹ軸方向誤差を求める。
　このＹ軸方向誤差が、真の値からのずれ量（補正すべき位置ずれ量）に相当し、検出Ｙ座標データＤｙ＝ｂに対して、Ｙ軸方向誤差を補正することで、移動体１３の真の位置に近似したＹ軸方向の位置データを得る。
　検出回転方向位置データＤθを補正する場合も、上述した検出Ｘ座標データＤｘを補正する場合に準じて補正を行う。
　例えば、図６（ｃ）に示した誤差近似式θｙ１～θｙ７のうち、検出Ｙ座標データＤｙ＝ｂを挟んで近傍に位置する基準線Ｙ５，Ｙ６に沿ってみた場合の誤差近似式θｙ５，θｙ６を選択し、横軸をＸ座標、縦軸を回転方向位置誤差とした座標系において、２つの誤差近似式θｙ５，θｙ６から２つの回転方向位置誤差を求める。そして、横軸をＹ座標、縦軸を回転方向位置誤差とした座標系において、検出Ｙ座標データＤｙ＝ｂのときの回転方向位置誤差を求める。
　この回転方向位置誤差が、真の値からのずれ量（補正すべき回転方向位置ずれ量）に相当し、検出回転方向位置データＤθ＝ｃに対して、回転方向位置誤差を補正することで、移動体１３の真の位置に近似した回転方向位置データを得る。
　そして、図１に示すように、移動体１３の位置データ（ＸＹ座標データ，回転方向位置データ）の補正が終了すれば、再び、Ｓ６に示す移動体１３の位置の検出に戻り、Ｓ６～Ｓ８に示すステップを繰り返し実行する。なお、ＸＹ座標データ、回転方向位置データに関する演算は、コンピュータ（図示せず）にて並行処理されている。
　なお、上記実施形態では、移動体１３が最外の基準線の内側に位置する場合の位置検出方法を示したが、移動体１３が最外の基準線の外側に位置する場合は、上述した誤差近似式を援用するか、または、新たな誤差近似式を導出して、移動体１３の位置を求めることが可能である。
　例えば、検出したＸ座標データＤｘが最外のＸ軸方向基準線Ｘ１およびＸ７の外側にある場合において、移動体１３の位置を求める場合には、Ｘ座標Ｘ１およびＸ７の外側における誤差近似式の傾きを０とみなし、Ｘ座標Ｘ１およびＸ７のときのＸ軸方向誤差と同じ値を用いて移動体１３の位置を求めるようにすることができる（図１０（ａ）参照）。
　また、Ｘ座標Ｘ１およびＸ７の外側に誤差近似式を延長し、延長した誤差近似式により、移動体１３の位置を求めるようにすることもできる（図１０（ｂ）参照）。
　また、検出したＹ座標データＤｙがＹ軸方向基準線Ｙ１およびＹ７の外側にある場合において、移動体１３の位置を求める場合には、その内側の最も近い位置にある基準線に沿ってみた場合の誤差近似式Ｘｙ１およびＸｙ７を用いて、移動体１３の位置を求めるようにすることができる（図１１（ａ）および図６（ａ）参照）。
　また、誤差近似式Ｘｙ１～Ｘｙ７の変化する傾向に基づいて新たな誤差近似式Ｘｙ１’およびＸｙ７’を導出し、その新たな誤差近似式をもとに移動体１３の位置を求めるようにすることもできる（図１１（ｂ）参照）。
　なお、Ｙ軸方向誤差や回転方向位置誤差についても同様にして対応することが可能である。
　上記構成を備える移動体の位置検出方法は、準備段階Ａにて、位置検出用センサ１２ａ，１２ｂにより検出される位置データを補正するため補正データを求めているので、この準備段階Ａと同一の条件に、２つの位置検出用センサ１２ａ，１２ｂの高さ位置Ｈ１と、間隔ｄ１等を設定すれば、別の環境（例えば異なる会場）で移動体１３の位置を検出する場合に、移動体１３の位置を正確に検出することが可能になる。
　また、上記実施形態では、移動体１３およびダミー移動体２３に備えられるセンサ１４，２４として超音波受信機を用い、位置検出用センサとして超音波発信機を用いたが、超音波受信機と超音波発信機を入れ替えた態様とし、距離ｄ２，ｄ３を求めることも可能である。また、位置検出用センサ１２ａ，１２ｂとして、発信および受信の両方の機能を備えた超音波センサを用いることも可能である。
　また、上記実施形態では、２つの位置検出用センサ（超音波発信機）１２ａ，１２ｂを、センサ保持治具１１ａ，１１ｂに保持させるように構成したが、移動体１３、あるいは、ダミー移動体２３が位置検出用センサを備えるように構成することも可能である。
　本発明はさらにその他の点においても上記の実施形態に限定されるものではなく、発明の範囲内において種々の応用、変形を加えることが可能である。
　１１ａ，１１ｂ　センサ保持治具
　１２ａ，１２ｂ　位置検出用センサ
　１３　　　　　　移動体（球乗りロボット）
　１４（１４ａ，１４ｂ）　移動体が備えるセンサ
　１５，２５　　　ステージ
　２３　　　　　　ダミー移動体
　２４（２４ａ，２４ｂ）　ダミー移動体が備えるセンサ
　Ｄｘ　　　　　　検出した移動体のＸ座標データ（検出Ｘ座標データ）
　Ｄｙ　　　　　　検出した移動体のＹ座標データ（検出Ｙ座標データ）
　Ｄθ　　　　　　検出した移動体の回転方向位置データ（検出回転方向位置データ）
　Ｅｘ　　　　　　Ｘ軸方向誤差
　Ｅｙ　　　　　　Ｙ軸方向誤差
　Ｅθ　　　　　　回転方向位置誤差
　Ｉｎ　　　　　　Ｘ軸方向基準線とＹ軸方向基準線の交点
　Ｐ　　　　　　　平面
　Ｘ１，Ｘ２，Ｘ３，Ｘ４，Ｘ５，Ｘ６，Ｘ７　Ｘ軸方向基準線
　Ｘｙ１，Ｘｙ２，Ｘｙ３，Ｘｙ４，Ｘｙ５，Ｘｙ６，Ｘｙ７　Ｘ軸方向誤差近似式
　Ｙ１，Ｙ２，Ｙ３，Ｙ４，Ｙ５，Ｙ６，Ｙ７　Ｙ軸方向基準線
　Ｙｘ１，Ｙｘ２，Ｙｘ３，Ｙｘ４，Ｙｘ５，Ｙｘ６，Ｙｘ７　Ｙ軸方向誤差近似式
　θｙ１，θｙ２，θｙ３，θｙ４，θｙ５，θｙ６，θｙ７　回転方向位置誤差近似式
　α　　　　　　　誤差近似式Ｘｙ５上におけるＸ軸方向誤差
　β　　　　　　　誤差近似式Ｘｙ６上におけるＸ軸方向誤差
　γ　　　　　　　検出Ｘ座標データＤｘ＝ａにおけるＸ軸方向誤差（補正すべき位置ずれ量）

Claims (3)

  1. 　平面上を移動する移動体が備えるセンサと協働して、前記移動体の位置を検出する位置検出用センサにより、前記移動体の前記平面上における位置を検出するための移動体の位置検出方法であって、
    　前記平面上にＸＹ座標を想定し、
    　前記平面上の前記ＸＹ座標で特定される複数の位置であって、Ｘ方向およびＹ方向において異なる複数の位置に、前記センサを所定の位置に備えた前記移動体もしくは前記移動体と同じ位置に前記センサを備えたダミー移動体を位置させ、
    　前記複数の位置のそれぞれにおける、前記移動体もしくは前記ダミー移動体の位置を前記位置検出用センサにより検出して校正用ＸＹ座標データを取得し、
    　取得した前記校正用ＸＹ座標データと、前記移動体もしくは前記ダミー移動体を位置させた前記複数の位置についての真の位置データとの差から、前記複数の位置についての補正データを求めておき、
    　実際に前記平面上を移動する前記移動体の位置を検出するにあたっては、
    　前記平面上を移動する前記移動体の位置を、前記位置検出用センサにより検出し、得られた検出ＸＹ座標データを前記補正データを用いた補間法により補正することで、前記移動体の真の位置に近似した位置データを得るようにしたこと
    　を特徴とする移動体の位置検出方法。
  2. 　平面上を移動する移動体が備えるセンサと協働して、前記移動体の位置を検出する位置検出用センサにより、前記移動体の前記平面上における位置を検出するための移動体の位置検出方法であって、
    　前記平面上にＸＹ座標と、Ｘ軸方向に平行な複数のＸ軸方向基準線と、Ｙ軸方向に平行な複数のＹ軸方向基準線とを想定し、
    　前記Ｘ軸方向基準線とＹ軸方向基準線が交わる複数の交点上に、前記センサを所定の位置に備えた前記移動体もしくは前記移動体と同じ位置に前記センサを備えたダミー移動体を位置させ、
    　前記複数の交点のそれぞれにおける、前記移動体もしくは前記ダミー移動体の位置を前記位置検出用センサにより検出して校正用ＸＹ座標データを取得し、
    　取得した前記校正用ＸＹ座標データと、前記移動体もしくは前記ダミー移動体を位置させた前記複数の交点についての真の位置データとの差から、前記複数の交点におけるＸ軸方向およびＹ軸方向の位置ずれ量を、Ｘ軸方向誤差およびＹ軸方向誤差として求めるとともに、
    　前記Ｘ軸方向誤差および前記Ｙ軸方向誤差を基に、複数の前記Ｘ軸方向基準線および前記Ｙ軸方向基準線上の各位置の誤差の算出式であるＸ軸方向誤差近似式およびＹ軸方向誤差近似式を求めておき、
    　実際に前記平面上を移動する前記移動体の位置を検出するにあたっては、
    　前記平面上を移動する前記移動体の位置を、前記位置検出用センサにより検出し、得られた検出ＸＹ座標データを、前記Ｘ軸方向誤差近似式および前記Ｙ軸方向誤差近似式を用いて線形補間法により補正することで、前記移動体の真の位置に近似した位置データを得るようにしたこと
    　を特徴とする移動体の位置検出方法。
  3. 　前記移動体が複数のセンサを所定の位置に備え、前記位置検出用センサにより検出される前記複数のセンサの位置関係から、前記移動体の、前記平面に対して垂直な軸を回転軸とする回転方向位置を検出することができるように構成されている場合において、
    　前記複数の交点上に、前記センサを所定の位置に備えた前記移動体もしくは前記移動体と同じ位置に前記センサを備えたダミー移動体を位置させる際に、前記移動体もしくは前記ダミー移動体の回転方向位置が所定の方向に向くように位置させ、前記複数の交点のそれぞれにおける、前記移動体もしくは前記ダミー移動体の前記回転方向位置を、前記位置検出用センサにより検出して回転方向位置校正用データを取得し、
    　取得した前記回転方向位置校正用データと、前記複数の交点についての真の回転方向位置データとの差から、前記複数の交点における回転方向位置誤差を求めるとともに、
    　前記回転方向位置誤差に基づいて、各位置の誤差の算出式である回転方向誤差近似式を求めておき、
    　実際に前記平面上を移動する前記移動体の回転方向位置を検出するにあたっては、
    　前記平面上を移動する前記移動体の回転方向位置を、前記位置検出用センサにより検出し、得られた検出回転方向位置データを、前記回転方向誤差近似式を用いて線形補間法により補正することで、前記移動体の真の回転方向位置に近似した回転方向位置データを得るようにしたこと
    　を特徴とする請求項２記載の移動体の位置検出方法。
PCT/JP2016/057950 2015-03-26 2016-03-14 移動体の位置検出方法 WO2016152619A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201680018123.5A CN107407719B (zh) 2015-03-26 2016-03-14 移动体的位置检测方法
JP2017508241A JP6515998B2 (ja) 2015-03-26 2016-03-14 移動体の位置検出方法
US15/713,788 US10539653B2 (en) 2015-03-26 2017-09-25 Method for detecting position of mobile body

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2015064678 2015-03-26
JP2015-064678 2015-03-26

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US15/713,788 Continuation US10539653B2 (en) 2015-03-26 2017-09-25 Method for detecting position of mobile body

Publications (1)

Publication Number Publication Date
WO2016152619A1 true WO2016152619A1 (ja) 2016-09-29

Family

ID=56978090

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2016/057950 WO2016152619A1 (ja) 2015-03-26 2016-03-14 移動体の位置検出方法

Country Status (4)

Country Link
US (1) US10539653B2 (ja)
JP (1) JP6515998B2 (ja)
CN (1) CN107407719B (ja)
WO (1) WO2016152619A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10539653B2 (en) * 2015-03-26 2020-01-21 Murata Manufacturing Co., Ltd. Method for detecting position of mobile body

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10173691B2 (en) * 2016-11-18 2019-01-08 Ford Global Technologies, Llc Vehicle sensor calibration using wireless network-connected sensors
CN109801341B (zh) * 2019-01-30 2020-11-03 北京经纬恒润科技有限公司 一种标定靶的位置校验方法及装置
JP2021124310A (ja) * 2020-02-03 2021-08-30 株式会社Ｓｃｒｅｅｎホールディングス 測位装置、測位プログラム、および、測位方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06324139A (ja) * 1993-05-17 1994-11-25 Oki Electric Ind Co Ltd 音源位置推定装置
JPH0854926A (ja) * 1994-08-08 1996-02-27 Toshiba Corp 自律移動ロボットの誘導装置
JP2005274363A (ja) * 2004-03-25 2005-10-06 Hitachi Ltd 無線位置検出システム

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07140241A (ja) 1993-11-19 1995-06-02 Yokogawa Denshi Kiki Kk 移動体の位置検出装置
CN1216342C (zh) * 2002-09-18 2005-08-24 中国人民解放军国防科学技术大学 将普通扫描仪用于精密测量的扫描仪精确标定与修正方法
KR100565227B1 (ko) * 2003-12-22 2006-03-30 엘지전자 주식회사 이동로봇의 위치인식장치 및 방법
DE102007008598A1 (de) * 2007-02-19 2008-08-21 Fraunhofer-Gesellschaft zur Förderung der angewandten Forschung e.V. Automatische Programmierung von Robotern zum Abschweißen gehefteter Profile auf Mikropaneelen mit Hilfe digitaler Bilderfassung
US8880105B2 (en) * 2011-12-29 2014-11-04 Khalifa University Of Science, Technology And Research Method and system for localization
CN104020444B (zh) * 2014-06-23 2016-03-23 西北工业大学 一种双轮差动式机器人室内组合定位方法
WO2016152619A1 (ja) * 2015-03-26 2016-09-29 株式会社村田製作所 移動体の位置検出方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06324139A (ja) * 1993-05-17 1994-11-25 Oki Electric Ind Co Ltd 音源位置推定装置
JPH0854926A (ja) * 1994-08-08 1996-02-27 Toshiba Corp 自律移動ロボットの誘導装置
JP2005274363A (ja) * 2004-03-25 2005-10-06 Hitachi Ltd 無線位置検出システム

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10539653B2 (en) * 2015-03-26 2020-01-21 Murata Manufacturing Co., Ltd. Method for detecting position of mobile body

Also Published As

Publication number Publication date
CN107407719B (zh) 2020-12-25
US20180011168A1 (en) 2018-01-11
JPWO2016152619A1 (ja) 2017-12-21
JP6515998B2 (ja) 2019-05-22
US10539653B2 (en) 2020-01-21
CN107407719A (zh) 2017-11-28

Similar Documents

Publication Publication Date Title
WO2016152619A1 (ja) 移動体の位置検出方法
CN107995885B (zh) 一种坐标系标定方法 、系统及装置
US9199379B2 (en) Robot system display device
CN101282823B (zh) 确定虚拟工具中心点的方法及用于该方法的装置
CN109910000B (zh) 基于视觉的操纵系统的校准以及操作
JP6025386B2 (ja) 画像計測装置、画像計測方法及び画像計測プログラム
CN106462140B (zh) 用于标定工业机器人系统的工具中心点的方法
CN102566577B (zh) 一种工业机器人简易标定方法
Balanji et al. A novel vision-based calibration framework for industrial robotic manipulators
CN105509671B (zh) 一种利用平面标定板的机器人工具中心点标定方法
JP6421722B2 (ja) 画像処理装置、校正方法および校正プログラム
JP2006289524A (ja) 加工物設置誤差測定装置
JP4967858B2 (ja) カメラとロボット間のキャリブレーション方法及びその装置
US11273554B2 (en) Method and device for evaluating calibration precision
JP5300929B2 (ja) 測定方法、測定装置及びプログラム
KR101809473B1 (ko) 이송계의 기하학적 오차 측정방법 및 그 방법을 수행하는 프로그램이 기록된 컴퓨터로 판독 가능한 기록매체
JP2009222568A (ja) ３次元形状データの生成方法および装置ならびにコンピュータプログラム
CN112476435B (zh) 重力加速度方向的标定方法、标定装置及存储介质
US20170197309A1 (en) Robot control system and method
TW202005765A (zh) 機械手臂校正系統以及校正方法
US11620846B2 (en) Data processing method for multi-sensor fusion, positioning apparatus and virtual reality device
WO2020208974A1 (ja) 基準位置設定方法及び操作検出装置
JP7318295B2 (ja) 表示方法
JP5563505B2 (ja) 群ロボット制御システム、群ロボット制御装置、及び群ロボット制御方法
CN113384347A (zh) 一种机器人标定方法、装置、设备及存储介质

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 16768522

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2017508241

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 16768522

Country of ref document: EP

Kind code of ref document: A1