The present invention relates to surveying instruments, such as total stations. More particularly, the present invention relates to a method for determining coordinates of a target in relation to a surveying instrument having at least two cameras for capturing a field of view and at least one identified target point within the field of view.
In surveying, the use of a camera in a geodetic instrument may provide for improved user convenience and new functions. Particularly, a view such as an image or a video feed provided by the camera and shown on a display of the instrument may be used for assisting target selection and for providing the user with an overview of potential points of interest.
One apparent difference between a traditional eyepiece and a video image shown on a display, is that the display image may have an active overlay of information. Various information may be given together with the captured image to facilitate instrument usage.
For a general background of a geodetic instrument comprising a camera for capturing an image or a video feed of the view towards which the geodetic instrument is aimed, reference is made to WO 2005/059473.
Surveying instruments of this kind, i.e. which includes a camera, are sometimes referred to as video-theodolites.
In a conventional geodetic instrument, electronic distance measuring (EDM) may alternatively or additionally be used, where a modulated light beam is emitted towards a target, and light reflected against the target is subsequently detected at the geodetic instrument.
Processing of the detected signal enables determination of distance to the target by means of e.g. time of flight (TOF) measurements or phase modulation techniques. Using a TOF technique, the time of flight of a laser pulse from the geodetic instrument to a target and back again is measured and distance can thus be calculated. Using a phase modulation technique, light of different frequencies is emitted from the geodetic instrument to the target, whereby reflected light pulses are detected and the distance is calculated based on the phase difference between emitted and received pulses.
In the field of video-theodolites, or more generally for geodetic instruments provided with a camera, problems arise when the camera center and the instrument rotation center do not coincide. Directions to targets from the camera center determined based on the camera image will normally not apply directly as directions to the target from the instrument rotation center.
Further, at a close range distance of approximately 0-25 m from the target, EDM-type geodetic instruments have limitations due to target spot size, low signal strenght owing to imperfect optic configuration, optical cross talk, measurement errors, etc.
The present invention provides a method for determining, in relation to a surveying instrument, target coordinates of points of interest, or target, identified in two images captured by two different cameras in the surveying instrument.
Throughout this application, the terms “geodetic instrument”, “surveying instrument” and “total station” will be used interchangeably.
When the camera center or perspective center and the rotation center of a surveying instrument are non-coincident (eccentric), it is generally not possible to directly determine a correct direction from the rotation center towards an arbitrary point identified or indicated in an image captured by the camera. In other words, if a direction from a camera to a target is determined from an image captured by the camera, the direction towards the target from the rotation center that is not coinciding with the camera center, will typically not be adequately determined by approximation using the direction from the camera. Only if the distance to the point of interest is known would it be possible to derive the correct direction from the rotation center to the target from the image. It is thus desirable to determine coordinates of the target with respect to the rotational center of the surveying instrument.
The present invention provides a method for determining coordinates of a target in relation to a surveying instrument wherein a first image is captured using a first camera in a first camera position and orientation, a target is selected by identifying at least one object point in the first image, and, first image coordinates of the at least one object point in the first image are measured. A second image is captured, preferably simultaneous with the first image, using a second camera in a second position and orientation, the at least one object point identified in the first image is identified also in the second image, and second image coordinates of the at least one object point in the second image are measured. Finally, coordinates of the target in relation to the rotation center of the surveying instrument are determined based on the first camera position and orientation, the first image coordinates, the second camera position and orientation, the second image coordinates, and camera calibration data.
The present invention makes use of an understanding that the coordinates of the point of interest from the surveying instrument can be determined by using the eccentricity of cameras in the surveying instrument for capturing a respective image from the cameras, the cameras being in known camera positions and orientations, the positions and orientations being different for the respective camera. Identification of an object point and the coordinates thereof in the two images together with camera calibration data it thus enabled. When target coordinates with respect to the rotational center of the instrument have been determined, distance from the rotation center to the target can be determined. However, target coordinates may be used for other purposes than determining distance. For instance, it may be useful to measure coordinates of the total station relative to a ground reference point very accurately for surveying instrument stationing. Advantageously, target coordinates are determined in relation to the rotational center of the surveying instrument. Of course, it would alternatively be possible to use the total station as “origin” and express coordinates of the ground reference point relative to the total station.
The present invention also provides a total station which comprises various means for carrying out the above-described method.
Further, the dual camera solution provided by the present invention is highly advantageous since it may be combined in a surveying instrument with conventional EDM. Thus, dual camera targeting may be used at close range (e.g. in the range of about 0-25 m), while EDM may be used at far range (>25 m).
In addition, the present invention can be implemented in a computer program that, when executed, performs the inventive method in a surveying instrument. The computer program may, for example, be downloaded into a surveying instrument as an upgrade. As will be understood, the inventive method can be implemented for a surveying instrument using software, hardware or firmware, or a combination thereof, as desired in view of the particular circumstances.
In the following detailed description, reference is made to the accompanying drawings, on which:
For determining the direction from the surveying instrument towards a selected target P, there are a number of functions implemented in the instrument. For example, if the direction to a target from the camera is expressed as horizontal and vertical angles (θx,θy) from the camera axis, a function is provided in the instrument (or in an associated control unit) that determines the direction to a target from the camera by calculating the horizontal and the vertical angles (θx,θy) based on pixel coordinates in the image or video feed captured by the camera. Hence, the function f that calculates the horizontal and vertical angles (θx,θy) based on image pixels can be described as
(θx,θy)=f(x,y,C)
where x, y are the number of pixels (or more generally, pixel coordinates) of the desired target in the coordinate system of the camera, and C are calibration factors to be determined for each system. The calibration factors C include details about the camera, such as but not limited to, its eccentricity eq and el and its focal length tcam (
In order to find the direction to a target captured with an eccentric camera from an instrument using one image, e.g. for aiming the instrument towards the desired target P, it is necessary to know the distance to the target. To this end, it may be useful to study the schematic diagram shown in
However, if two images are captured from a pair of cameras in a surveying instrument, where a first image is captured using a first camera in a first camera position and orientation, said first camera position being eccentric to the rotation center of the surveying instrument, and a second image is captured preferably simultaneously using a second camera in a second camera position and orientation, said second position typically but not necessarily being eccentric to the rotation center of the surveying instrument, at least one object point corresponding to a target is identified in the first image and in the second image, and image coordinates for the object point in the first image and second image are measured, coordinates of the target with respect to the rotation center of the surveying instrument can be determined using camera calibration data.
Even though the main object of surveying typically is to obtain the coordinates of the target with respect to the rotation center of the surveying instrument, determining the direction towards the target from the rotation center of the surveying instrument may also be useful e.g. for aiming the surveying instrument towards the target for subsequent distance measuring. Further, determining the target distance from the rotation center of the surveying instrument may also be useful e.g. for determining a sample interval for a distance measuring instrument using time of flight measurements, focusing capability of EDM, and auto focus for a further camera or for a user.
General steps of the method according to the present invention are outlined in
Once the target has been selected by identification of the object point in the first image in the step S402, first image coordinates of the object point in the first image are measured in a step S403.
The object point identified in the first image is identified in a step S404 in the second image. For example, the object point may be identified by selection by an operator clicking on a screen showing the image captured by the second camera, or preferably by means of digital image processing.
Once the object point has been identified in the second image in step S404, second image coordinates of the object point in the second image are measured in a step S405.
The first camera position and orientation is determined by taking into account the horizontal and vertical direction of the first camera center to the instrument rotation center, e.g. first camera calibration data in the form of eccentricity parameters eq and el, such that first camera coordinates are related to surveying instrument coordinates. Further, as will be discussed in the following, other calibration data can be considered, for example camera position independent parameters such as the so-called camera constant representing distance between the camera center and image plane and/or parameter of distortion, which depends on the image position. Similarly, the second camera position and orientation is determined by taking into account the horizontal and vertical direction of the second camera center to the instrument rotation center, e.g. second camera calibration data in the form of eccentricity parameters eq and el, such that second camera coordinates are related to surveying instrument coordinates.
Finally, coordinates of the target in relation to the rotation center of the surveying instrument are thus determined in a step S406 based on the first camera position and orientation, the first image coordinates, the second camera position and orientation, the second image coordinates, and respective camera calibration data.
Assuming that a scan of a target is desired, i.e. the three dimensional appearance of a target is of interest, a similar procedure as the one shown in
The surveying instrument 500 comprises a first camera comprising a first camera sensor 501 and a first optical system 502. The first camera has a first camera center, or first projection center, that has a first camera position O′ eccentric to the location O of the rotation center of the instrument 500 and having a first camera orientation. The surveying instrument 500 further comprises a second camera comprising a second camera sensor 503 and a second optical system 504. The second camera has a second camera center, or second projection center, that has a second camera position O″ eccentric to the location O of the rotation center of the instrument 600 and having a second orientation. Each camera has a line of sight that is approximately parallel with the line of sight of the instrument. The cameras may have an arbitrary eccentric location with respect to the instrument rotation center.
A first image is captured by the first camera sensor 501 with the first camera center located in a first camera position O′ eccentric to the location O of the rotation center of the surveying instrument 500 and having a first camera orientation. A target in position P is selected by identifying at least one object point in a position P′ in the first image. Once the target has been selected by identification of the object point in the first image, first image coordinates of the object point in the first image are measured.
A second image is captured, preferably but not necessarily simultaneous as the first image, by the second camera sensor 502 in a second camera position O″ eccentric to the location O of the rotation center of the surveying instrument 500 and having a second camera orientation. The at least one object point identified in the first image is identified also in the second image in a position P″. Once the object point has been identified in the second image, second image coordinates of the object point in position P″ in the second image are measured.
Finally, coordinates of the target P in relation to the rotation center O of the surveying instrument are determined based on the first camera position and orientation, the first image coordinates, the second camera position and orientation, the second image coordinates, and first and second camera calibration data. Thus, a first image and a second image are captured by the first camera and the second camera, respectively. Image coordinates for the object point are measured in the images and target coordinates of the target in relation to the instrument rotation center can be determined using respective camera calibration data.
After the object point has been identified, it is determined in a step S603 if the object point can be identified using image processing and recognition software. If it cannot it is determined if a pattern in the vicinity of the point is detectable. If this is not the case the uncertainty is displayed in a step S605 and suitable alternative method is used in a step S606.
If a pattern can be detected or if the point can be identified by software in the first image in step S603, the so called epipolar line can be calculated in a step S607 using the first camera position and orientation, the second camera position and orientation, the first image coordinates, first and second camera calibration data and a minimum distance Dmin (see
Once the object point has been identified in the second image, second coordinates of the object point in the second image are measured in a step S611. Coordinates of the target in relation to the rotation center of the surveying instrument are determined based on the first camera position and orientation, the first image coordinates, the second camera position and orientation, the second image coordinates, and first and second camera calibration data. A target direction from the rotation center of the surveying instrument is determined based on the determined target coordinates in relation to the rotation center of the surveying instrument. That is, the coordinates of the target are expressed in relation to the coordinate system of the surveying instrument. Hence, the target coordinates are typically related to a coordinate system having its origin at the rotation center of the surveying instrument.
In an optional step S612, if distance to target is a desired parameter, the distance from the instrument rotation center to the target may be determined based on the target coordinates in relation to the rotation center of the surveying instrument.
The surveying instrument of
A first image is captured by the first camera, when the first camera center is located in a first position O′ eccentric to the location O of the rotation center of the surveying instrument and the first camera having a first camera orientation. A target in position P is selected by identifying an object point in a position P′(x′, y′) in the first image.
The distance between the first camera and the second camera is denoted dc. A second image is captured by the second camera, the second camera center being located in the second position O″ eccentric to the location O of the rotation center of the surveying instrument and the second camera having the second camera orientation. The object point identified in the first image is identified in the second image in a position P″(x″, y″).
The so called collinearity equations are used to estimate the coordinates of P. For a background of the deriving of the collinearity equations and of calibration of a camera reference is made to WO 2005/059473.
The measured coordinates P′ in the first image can be defined by the equations:
The measured coordinates P″ in the second image can be defined by the equations:
The following parameters are known from calibration:
All parameters are measured or known from camera calibration except from X, Y, Z which are the coordinates of P. Hence, there are three unknowns and four equations. X, Y, Z can be determined with a least square method. It should be noted that there is no limitation to two images to estimate the location of point P, but at least two images are necessary. Hence, two or more images may be used.
It should be noted that once the target has been selected by identification of the object point in the first image, a first direction r′ to the target from the position O′ of the first camera center can determined. It should further be noted that the camera constant and parameter of distortion are individual parameters for each camera, i.e. the calculations for the first image use first camera calibration data while the calculations for the second image use second camera calibration data.
Using this first direction r′ together with a maximum distance Dmax (which may be selected as infinity), and a minimum distance Dmin (which may be selected as a single base distance dc) along the direction r′, a section of r′ can then be transformed into a section of a so called epipolar line EPL in the second image on which the object point should be located in the second image. Hence, if a pattern has been recognized in the first image around the position P′ of the object point in the first image, this pattern may be recognized in the second image, e.g. by means of automatic image processing, by searching along the section of the epipolar line in the second image or in an area around that section. If in alternative, an operator is to identify the target in the second image, the identification can be simplified by graphical indication of the section of the epipolar line in the second image.
In a special case, the object point P may be so close to the instrument (but not closer than Dmin) that it is not visible in the second image. The result is that the epipolar line extends the image for this close object point. A rotation of the instrument and revised second image capturing is needed. The rotation angle is determined by the first camera position and orientation, the first image coordinates P′(x′, y′), the second camera position and orientation, the first and second camera calibration data and Dmin. A revised second image is captured with the second camera. It is thus possible to search along the epipolar line for the object point in the revised second image.
In
For rotation of the alidade about the vertically oriented rotation axis to aim the instrument in any desired horizontal direction, there is provided drive means 1005. The rotational position of the alidade 1001 is tracked by means of a graduated disc 1006 and a corresponding angle encoder or sensor 1007. For rotation of the center unit 1004 about the horizontally oriented rotation axis, there are provided similar drive means 1008, graduated disc 1009 and sensor 1010. Moreover, the instrument has an optical plummet 1012, which gives a downwards view along the vertically oriented rotation axis. The optical plummet is used by the operator to center or position the instrument above any desired point on the ground.
As mentioned above, the instrument line of sight is centered at the intersection between the vertical and the horizontal rotation axes, and this can be seen in the figure where these axes cross in the center of a telescope 1013 in the center unit 1004.
In the telescope, there is provided a light source 1014, such as a laser pointer. Preferably, the light source is coaxial with the telescope, even though it could be placed elsewhere such that it instead is eccentric with the telescope. It should be understood that light sources having other wavelengths, e.g. light being invisible to the human eye, may be used depending on the responsivity of the cameras. The light source can be used for performing EDM, but can also, as will be discussed in the following, be used for indicating an object to be targeted. In the center unit, two cameras 1017, 1018 are further arranged for capturing an image or a video feed generally in the direction of the instrument line of sight. However, as shown, the cameras 1017, 1018 are eccentric from the center of the telescope 1013; but could be located in many different positions than what is shown in
The instrument can also be manually operated for aiming towards a desired target using vertical and horizontal motion servo knobs 1015 and 1016.
The cameras of the instrument are operable to capture images from different positions and orientations eccentric to a rotation center of the surveying instrument.
Advantageously, the light source 1014, being e.g. a laser pointer, can be used to facilitate identification of a target object point. In analogy with the method described in the above, a first image is captured using a first camera in a first camera position and orientation, the first camera position being eccentric to the rotation center of the surveying instrument. Simultaneously, a second image is captured using a second camera in a second camera position and orientation, which second camera position also is eccentric to the rotation center of the surveying instrument. In this particular embodiment, while the first two images are captured, the laser pointer is turned on to illuminate the target, thus creating a distinct target object point. Note that the light of the laser pointer may be concentrated into a small point, but can alternatively be arranged to produce a light pattern or structure. Then, another two images are captured with the laser pointer being turned off. The first image of the first camera is subtracted from the second image of the first camera (or vice versa), and a similar procedure is undertaken for the second camera, in order to produce a difference image for the first camera and a difference image for the second camera. Using the first camera difference image, an object point relating to the target is identified and image coordinates of the object point in the first difference image are measured. Then, the object point identified in the first difference image is identified in the second difference image, and image coordinates of the object point in the second difference image are measured. Finally, coordinates of the target in relation to the rotation center of the surveying instrument are determined based on the first camera position and orientation, the image coordinates of the first difference image, the second camera position and orientation, the image coordinates of the second difference image, and respective camera calibration data.
According to the present invention, the instrument further comprises means for identifying an object point corresponding to a selected target in the displayed image; means for determining, based on the position of the object point in the displayed images, directions toward the target from the cameras in different positions; means for measuring image coordinates of the object point in the displayed images, and means for determining target coordinates of the target in relation to the rotation center of the surveying instrument, based on the first camera position and orientation, the first image coordinates, the second camera position and orientation, the second image coordinates, and first and second camera calibration data.
The means for identifying the object point in the captured image may take the form of a cursor that can be moved across the display. Alternatively, the display may be a touch display, where the object point is identified by simply clicking or tapping on the display. This is preferred for the identification of the object point in the first image.
The means for identifying the object point may include further functionality implemented in the form of image processing software. In such case, the further functionality would be that object points may be identified based on certain features in the captured image, for example markers or patterns located at the desired target. For example, an object point identified in a first image may be automatically identified in a second image based on patterns identified in the first image. In case the object point is automatically identified by the instrument, the user may be given the option to give a confirmation that the identified object point is correct before or during the aiming and measuring procedures. This is preferred for the identification of the object point in the second image.
The means for measuring image coordinates of the object point in the displayed images, and the means for determining target coordinates of the target in relation to the rotation center of the surveying instrument are preferably implemented in the form of computer program code that is executed in a processor. However, implementation may also be made in dedicated hardware, such as in a special purpose microprocessor or a digital signal processor (DSP), firmware or similar.
The means for rotating the instrument is preferably implemented in association with the servo control system for the instrument for controlled activation of the drive motors 1005 and 1008 (see
While specific embodiments have been described, the skilled person will understand that various modifications and alterations are conceivable within the scope as defined in the appended claims.
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/EP2008/052531 | 2/29/2008 | WO | 00 | 11/2/2010 |