US10795006B2 - 3D time-of-flight camera system and position/orientation calibration method therefor - Google Patents
3D time-of-flight camera system and position/orientation calibration method therefor Download PDFInfo
- Publication number
- US10795006B2 US10795006B2 US13/058,962 US200913058962A US10795006B2 US 10795006 B2 US10795006 B2 US 10795006B2 US 200913058962 A US200913058962 A US 200913058962A US 10795006 B2 US10795006 B2 US 10795006B2
- Authority
- US
- United States
- Prior art keywords
- camera
- reference plane
- time
- scene
- planes
- 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.)
- Active, expires
Links
- 238000000034 method Methods 0.000 title claims description 46
- 238000012545 processing Methods 0.000 claims abstract description 4
- 239000011159 matrix material Substances 0.000 claims description 34
- 230000009466 transformation Effects 0.000 claims description 21
- 238000001514 detection method Methods 0.000 claims description 16
- 230000003993 interaction Effects 0.000 claims description 7
- 230000007480 spreading Effects 0.000 claims description 3
- 239000013598 vector Substances 0.000 description 15
- 238000004422 calculation algorithm Methods 0.000 description 12
- 238000009434 installation Methods 0.000 description 8
- 230000003287 optical effect Effects 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 238000013519 translation Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000011218 segmentation Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000003190 augmentative effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000012512 characterization method Methods 0.000 description 1
- 239000003086 colorant Substances 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 238000010191 image analysis Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000012634 optical imaging Methods 0.000 description 1
- 230000001131 transforming effect Effects 0.000 description 1
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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/497—Means for monitoring or calibrating
- G01S7/4972—Alignment of sensor
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
- G01S17/894—3D imaging with simultaneous measurement of time-of-flight at a 2D array of receiver pixels, e.g. time-of-flight cameras or flash lidar
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/80—Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10028—Range image; Depth image; 3D point clouds
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/30—Subject of image; Context of image processing
- G06T2207/30196—Human being; Person
Definitions
- the present invention generally relates to the technical field of 3D computer vision, in particular to a position/orientation calibration method for a 3D time-of-flight camera system.
- a 3D time-of-flight camera designates a camera that acquires images (herein called “range images”) containing distance information pertaining to a scene by using the time-of-flight measurement principle.
- Such camera generally comprises a light source emitting modulated or pulsed light into the scene to be imaged in 3D and a pixel array on which the scene is imaged by an optical system. The camera then correlates the light detected in the pixels with the light emitted and determines, for each pixel, the phase difference between emitted and received light, or the difference between emission and reception times. These quantities are proportional to the radial distance between the camera and the part of the scene that is imaged onto the pixel concerned.
- Some 3D TOF cameras are known that acquire range images in real time.
- 3D TOF cameras have been proposed to employ such 3D TOF cameras in the automotive field, e.g. for passenger detection and classification in a vehicle, for monitoring the surroundings of a car. 3D TOF cameras have also been suggested for controlling access to restricted areas (e.g. in airports, banks or public buildings), in particular for detecting, tracking and counting of persons and objects.
- restricted areas e.g. in airports, banks or public buildings
- An important advantage of 3D TOF camera systems is that the depth (or range) information is readily available and does not require cost-intensive computation as, for instance, in stereoscopic systems.
- the second step they propose to use a smaller number of targets positioned at distances greater than 1.5 m with the help of an accurate electronic distance-measuring device.
- reference points in the scene are used in order to perform the calibration process.
- the paper “High Resolution Segmentation with a Time-of-Flight 3D-Camera using the Example of a Lecture” Scene by Santrac et al. (Freie Vietnamese Berlin, 2006) deals with the combination of range images from a 3D TOF camera and images from a 2D camera. To map the images to the two cameras, a calibration step is performed prior to using the camera combination for segmentation.
- a calibration pattern with at least 5 ⁇ 5 characteristic points is put in front of the two cameras in such a way that the points are distributed as evenly as possible on the screen of both cameras.
- ISPRS Commission V Symposium ‘Image Engineering and Vision Metrology’, XXVI, Part 5, Dresden 25-27 September 2006 Kahlmann et al. present a characterization of the Swissranger SR-2 camera and the sensor calibration method that allowed them to increase the accuracy of the camera.
- the calibration process was based on photogrammetric calibration using a 5 ⁇ 5 matrix of reference points represented by NIR LEDs.
- Real-time or near real-time calculation of scene coordinates from image data acquired with a 3D (time-of-flight) camera requires the knowledge of the transformation matrix from the camera to the world coordinate system comprising the camera's orientation and position parameters.
- camera positioning and orientation may differ from installation to installation which currently implies that for each individual installation an external camera calibration has to be performed.
- state-of-the art methods require some boards with known reference coordinates to be precisely installed. The installation of such calibrations tools can time-consuming and—depending on the available space—intricate, if not impossible.
- the invention facilitates installation, in particular position and orientation calibration, of a 3D TOF camera.
- a position and orientation calibration method for a camera system including a 3D TOF camera comprises
- the proposed method which is expected to be typically carried out as one of the last steps of installation of a 3D TOF camera, does not require using any predefined calibration pattern or calibration tool that mark predefined reference points in the scene.
- a region in the camera field of view corresponds to a plane that has a known orientation with respect to the world coordinate system.
- this reference plane would be the floor in scene.
- the proposed method takes profit from the fact that a 3D camera provides 3D data points of the scene in camera perspective (i.e. in the camera coordinate system).
- roll angle designates an angle measuring rotation about the camera-x-axis
- pitch angle designates an angle measuring rotation about the camera-y-axis.
- the internal camera calibration should have been carried out beforehand, e.g. in the camera factory.
- internal calibration designates calibration of camera parameters, which are independent of the location where the camera is installed, e.g. optical system parameters such as focal length, principal point location and lens distortion.
- a method of internal camera calibration is disclosed, e.g. in EP 1 662 440 A1.
- the present method addresses “external calibration”, i.e. calibration of parameters, which do depend on the location where the camera is installed.
- the range images provided are preferably evaluated automatically.
- the range images have to be processed by appropriate means, such as e.g. object or pattern recognition software.
- object or pattern recognition software One of the benefits of the present invention is that the same software can be used on range images provided by 3D TOF cameras mounted in different locations, since method proposed allows compensating for position and/or orientation differences between the cameras.
- a further aspect of the invention concerns a camera system configured and arranged for carrying out the position and orientation calibration method.
- Such system comprises a 3D TOF camera for acquiring a camera-perspective range image of a scene and an image processor for processing the range image.
- the image processor contains a position and orientation calibration routine implemented therein in hardware and/or software, which position and orientation calibration routine, when executed by the image processor, detects one or more planes within a range image acquired by the 3D TOF camera, selects a reference plane among the at least one or more planes detected and computes position and orientation parameters of the 3D TOF camera with respect to the reference plane, such as, e.g., elevation above the reference plane and/or camera roll angle and/or camera pitch angle.
- RANSAC Random SAmple Consensus
- RANSAC Random SAmple Consensus
- the detection of one or more planes may advantageously comprise compensating for range errors induced by light spreading in the 3D TOF camera and/or discarding image pixels containing range information deemed unreliable (e.g. pixels having too little brightness or outliers).
- a preferred method for compensating the effects of light spreading is described in European patent application 07 024 505.5.
- the selection of a reference plane out of the planes detected comprises identifying a floor plane and fixing the floor plane as the reference plane. It is expected that in most applications the floor will lie in the field of view of the camera, since surveillance cameras are commonly mounted in an elevate position above and directed downward to the area to be monitored. Most preferably, the selection of the reference plane is effected autonomously by the calibration routine based upon and following input of user-defined limits of camera roll angle and/or camera pitch angle with respect to the floor plane. It may happen that the scene imaged by the camera contains more than one planar surface (floor and walls for instance).
- the person who installs the camera may input rough orientation indications (like: “roll angle between ⁇ 45° and +45°”, “pitch angle between ⁇ 90° and 0°”, etc.) in order to allow the camera to determine the floor plane autonomously.
- rough orientation indications like: “roll angle between ⁇ 45° and +45°”, “pitch angle between ⁇ 90° and 0°”, etc.
- the selection of the reference plane may also comprise the presentation of the one or more detected planes using a user interface and fixing of the reference plane based upon user interaction.
- the camera system preferably comprising a user interface for presenting output data to and/or receiving input data from a user.
- user interface may, for instance, comprise a display screen, a keyboard or a keypad, a touchscreen, etc.
- the camera system could comprise a hardware interface allowing a user to temporarily connect a user interface (e.g. a laptop) for setting up the system.
- a user interface comprises a display screen enabling the person installing the camera to visualize the scene in the camera perspective. If the person also has to select a plane, the one or more planes detected could be indicated on the display screen (e.g. in different colours).
- the calibration routine comprises computing coordinate transformation parameters of the coordinate transformation between the camera coordinate system and the world coordinate system.
- coordinate transformation transforms when applied to a camera-perspective range image of the scene, such range image into a Cartesian representation of the scene, in which coordinates are defined with respect to the reference plane.
- the camera system preferably comprises a memory, in which the coordinate transformation parameters may be stored.
- the camera system as presented herein is suitable, in particular for pedestrian detection at crosswalks, since the scene imaged in such application typically comprises an extended floor plane that may serve as the reference plane.
- FIG. 1 is a schematic diagram illustrating the relationship between world and the camera coordinate systems
- FIG. 2 is a schematic illustration of a 3D TOF camera system
- FIG. 3 is a perspective view of a crosswalk surveillance system including a 3D TOF camera
- FIG. 4 is a flow diagram of a preferred method of installing a 3D TOF camera.
- FIG. 2 shows a schematic illustration of a 3D TOF camera system 10 , comprising a 3D TOF camera 12 and an image processor 14 (shown as an element separate from the camera 12 , but which may also be incorporated with it in the same housing).
- the camera comprises an optical imaging system, illustrated by lens 16 , and an illumination unit, illustrated by LED array 18 , for illuminating the scene to be imaged with modulated or pulsed light.
- the camera system also comprises a hardware interface, e.g. a USB port, a firewire port, etc. (not shown in the drawing) allowing the connection of a user interface (in this case a laptop computer 20 )
- Range images acquired with a 3D TOF camera correspond to matrices of distance values d, which indicate the distances from the camera to the imaged surface elements.
- the 3D coordinates c [X,Y,Z] T of the visible surface elements within the scene can be determined with reference to the camera coordinate system. Coordinates expressed with reference to the camera coordinate system are preceded with a superscript “c” for distinction with coordinates expressed in the world coordinate system (i.e. with respect to the reference plane), which are preceded by a superscript “w”.
- this is achieved by computing the product between the acquired distance value at each pixel and a unit vector c [e x ,e y ,e z ] T defined according to the internal camera parameters for each pixel. This computation is explained in EP 1 662 440 A1, incorporated herein by reference in its entirety.
- w ⁇ tilde over (M) ⁇ [ Rt ] ⁇ c ⁇ tilde over (M) ⁇ (1)
- This rotation matrix R is presented using Euler angles ⁇ , ⁇ and ⁇ that define a sequence of three elementary rotations around z, y and x-axis respectively.
- One normally uses the convention that the rotations are performed clockwise, first around the z-axis, then around the y-axis already once rotated, and finally around the x-axis that is already twice rotated during the previous stages: [ R ] [ R z ] ⁇ R y ⁇ [ R x ] (2) where the elementary rotation matrices [R z ], ⁇ R y ⁇ and [R x ] are given by:
- [ R z ] [ cos ⁇ ⁇ ⁇ - sin ⁇ ⁇ ⁇ 0 sin ⁇ ⁇ ⁇ cos ⁇ ⁇ ⁇ 0 0 0 1 ] ( 3 )
- [ R y ] [ cos ⁇ ⁇ ⁇ 0 sin ⁇ ⁇ ⁇ 0 1 0 - sin ⁇ ⁇ ⁇ 0 cos ⁇ ⁇ ⁇ ] ( 4 )
- [ R x ] [ 1 0 0 0 cos ⁇ ⁇ ⁇ - sin ⁇ ⁇ ⁇ 0 sin ⁇ ⁇ ⁇ cos ⁇ ⁇ ⁇ ] ( 5 )
- the scale factor ⁇ can be determined arranging the equations in (12) in the previous constraint (14) as follows:
- a direct Least Square computation involving the constraint of equation (14) can be computed, e.g. as is presented in “Direct Least Square Fitting of Ellipses”, Tern Analysis and Machine Intelligence, Vol. 21, No. 5, May 1999, by Fitzgibbon et al.
- a 4 ⁇ 4 matrix is obtained.
- This matrix can be combined with the constraining matrix of (14), yielding a generalised eigensystem that has to be solved.
- the lower computational cost of the direct Least Squares method in comparison to the SVD makes it suitable for implementation on real microprocessors.
- Equation (16) can be solved for obtaining the rotation angles ⁇ and ⁇ as follows:
- angles ⁇ and ⁇ which correspond to pitch and roll rotations, respectively, have been estimated.
- the remaining angle to complete the rotation matrix is the yaw angle ⁇ , which can be fixed to an arbitrary value, e.g. 0° for convenience.
- the translation vector t can be fixed to [0,0,t z ] T which means that the origin of the world coordinate system lies vertically underneath the origin of the camera coordinate system.
- the transformation matrix presented in (1) may be fully determined using the floor as the reference plane.
- the method as presented so far in this detailed description corresponds to that part of the external camera calibration, which follows the selection of the reference plane.
- objects e.g. furniture or people
- more than one plane roof or walls
- robust fitting routines have to be used to detect the plane or planes within the scene.
- a RANSAC based plane detection is preferably used.
- the RANSAC algorithm is an iterative algorithm for robust fitting of models. It is robust in the sense of good tolerance to outliers in the experimental data.
- the algorithm randomly selects three points of the range image and computes the number of inliers belonging to the plane (with some error tolerance) spanned by the three points.
- the algorithm then goes on by selecting three new points and making the same operations until no more data can be fitted on a plane or until a predefined number of iterations is reached.
- Those three points that define the best plane(s) (with the highest number of inliers) will be returned by the algorithm.
- the planes defined by the different point triplets are not necessarily the best fit to the planes actually present in the scene. Accordingly, a better estimation of the plane parameters may be computed using e.g. a Least Squares method.
- points belonging to objects or persons in the scene will normally be discarded since they do not belong to a plane.
- the floor can be discriminated from other planes in the scene (e.g. the ceiling or walls) as follows: the camera is installed above the floor, the estimated z-coordinate t z of the camera in the world coordinate system is positive (where it is assumed that the world coordinate system is so oriented that points above the floor level have a positive z-coordinate). Any ceiling above the camera can easily be discarded from the set of candidates of the floor plane by imposing the condition t z >0 to the detected planes for being further considered.
- ⁇ square root over (2) ⁇ /2 can be imposed on detected planes for being further considered.
- the estimated rotation matrix coefficient a 31 is the projection of the camera x-axis onto the normal vector of the calibration plane, the above condition allows to discard side-walls, i.e. walls that are parallel to the world z-axis. Mounting situations in which the camera shall be rotated around the y-axis by more than ⁇ /4 can also be handled.
- the user would have to indicate on the user interface, in which of the four possible quadrants the roll angle lies, such that the range image can be rotated accordingly by 0, ⁇ /2, ⁇ , 3 ⁇ /2 prior to applying the calibration method.
- Indicating the quadrant of the roll angle basically corresponds to indicating to the camera, which of its sides is the upper side.
- any plane detected in the range image can be used as the reference plane if the relative orientation of the detected plane with respect to the world coordinate system is indicated (directly or indirectly, e.g. via indicating the camera's upper side or bottom side).
- the calibration routine preferably is configured to guide the user through the installation and could, for instance, ask the user to indicate an approximative orientation of the camera, e.g. whether the camera looks down or up and in which quadrant of the circle the roll angle lies.
- the calibration routine could also be configured to display (e.g. by means of colour, highlighting, or the like) the different planes detected within the range image and the user could be asked to indicate the reference plane to be selected.
- the user indicates the approximate camera orientation before plane detection is carried out.
- the calibration routine is to be configured to select as the reference plane a plane, which has a predefined orientation with respect to the approximate camera orientation (e.g. the floor plane)
- some hypothetical planes spanned by randomly chosen point triplets in the RANSAC algorithm can immediately be discarded because their orientation is incompatible with the approximate camera orientation provided.
- the RANSAC algorithm is preferably optimised in such a way as to evaluate the cost function (normally the number of inliers) only for such point triplets that define hypothetical planes in agreement with the approximate camera orientation.
- the calibration routine is preferably configured to discard regions in the range image in which the amplitude of the modulation of the light reflected from the scene is below a certain predefined threshold (so that parts of the scene that are far from the non-ambiguity distance of the camera are eliminated) before it carries out plane detection, in order to reduce the pool of image points which have to be considered in the plane detection algorithm and thereby improve computation time.
- a preferred method of installing a 3D TOF camera system will now be described with reference to FIG. 4 .
- the person hereinafter: the user in charge of installing the camera system mounts a 3D TOF camera 12 in the desired location, e.g. in an elevated position above a crosswalk 22 , as illustrated in FIG. 3 .
- the user Once the camera is correctly positioned and oriented (which should be verified by connecting a display screen to the camera or using a built-in display screen if one is available), the user starts a camera setup program, which comprises a camera calibration routine.
- the calibration routine asks the user to indicate the approximate orientation of the camera. It could do this, for instance, by proposing a set of pictograms or pictures illustrating different predefined camera positions and/or orientations and requesting the user to select the pictogram or picture that corresponds best to actual camera orientation. After that, camera orientation should not be changed any more; if such change should nevertheless be necessary, the setup program should be started anew. A range image of the scene to be monitored is then acquired in step 43 . Provided that the camera orientation has not been changed in the meanwhile, a range image acquired beforehand (when the camera was mounted) could also be used for the calibration and step 43 be omitted.
- the calibration routine then calculates the coordinates of the points of the range image in the camera coordinate system (in step 44 ), e.g. using the method proposed in EP 1 662 440 A1, whereby the optical parameters of the camera (known beforehand and stored in a memory of the camera) are taken into account.
- the optical camera parameters are stored in form of a set of vectors, each vector belonging to a specific pixel of the range image.
- the coordinate calculation method of this step comprises, for each pixel, multiplying the range value determined for the pixel with that stored vector that corresponds to the specific pixel:
- the next steps are plane detection (at reference numeral 45 ), which as described above, is preferably carried out using a RANSAC algorithm and selection of the reference plane among the planes detected (step 46 ).
- floor plane identification may be done autonomously (i.e. without user interaction at this stage), using e.g. the previously defined approximate orientation of the camera, or based upon user interaction (e.g. requesting the user to indicate the floor plane).
- the calibration routine has sufficient information to compute camera position (in terms of vertical distance from the reference plane) and orientation (roll and pitch angles with respect to the reference plane), which is thus carried out in step 47 .
- camera position and orientation translates into a coordinate transformation from the camera coordinate system into the world reference system.
- step 48 the calibration routine computes this coordinate transformation (e.g. in form of a matrix) and combines it with the above coordinate calculation method, whereby a set of vectors [ w e x i , w e y i , w e z i ] T is obtained in step 49 , by means of which the distance values measured for each pixel may be directly converted into a point expressed by its coordinates in the world reference system:
- the data necessary for transforming the range images acquired by the camera into a Cartesian representation of the scene in the world coordinate system are the vectors [ w e x i , w e y i , w e z i ] T and [t x , t y , t z ] T .
- the camera preferably keeps the vectors [ c e x i , c e y i , c e z i ] T in memory in case the calibration has to be repeated (e.g. after servicing the camera).
- the present invention is suited for most applications of 3D TOF cameras and greatly facilitates installation of such cameras in a real-world environment.
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Theoretical Computer Science (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Automatic Focus Adjustment (AREA)
Abstract
Description
-
- acquiring a camera-perspective range image of the scene to be imaged using the 3D TOF camera,
- detecting one or more planes (i.e. planar surfaces) within the range image and selecting a reference plane among the one or more planes detected,
- computing position and orientation parameters of the 3D TOF camera with respect to the reference plane. Such position and orientation parameters preferably include at least one, preferably two and most preferably all, of elevation above the reference plane (i.e. distance between the camera and the reference plane), camera roll angle and camera pitch angle.
w {tilde over (M)}=[Rt]·c {tilde over (M)} (1)
where {tilde over (M)} represents a coordinate vector augmented by 1 as the last element {tilde over (M)}=[X,Y,Z,1]T to allow the homography representation between the camera and the world coordinate systems.
[R]=[R z]·└R y┘·[R x] (2)
where the elementary rotation matrices [Rz], └Ry┘ and [Rx] are given by:
where n≥14. The more points coming from the floor, the more accurate will be the value of each unknown variable.
a 31 =λ·v 1
a 32 =λ·v 2
a 33 =λ·v 3
t z =λ·v 4 (12)
R T ·R=I (13)
where I represents the unity matrix, the following constraint can be defined:
a 31 2 +a 32 2 +a 33 2=1 (14)
where di is the distance measured in the i-th pixel, [cex i, cey i, cez i]T is the vector stored for the i-th pixel, and the left-hand side is the coordinate vector of the image point in the camera reference system. The result of this step is a Cartesian representation of the scene in the camera coordinate system.
where R is given by equation (2). It should be noted that in a practical embodiment of the routine, the
Claims (21)
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP08162222 | 2008-08-12 | ||
EP08162222.7 | 2008-08-12 | ||
EP08162222A EP2154650A1 (en) | 2008-08-12 | 2008-08-12 | 3D time-of-flight camera system and position/orientation calibration method therefor |
PCT/EP2009/055054 WO2010018009A1 (en) | 2008-08-12 | 2009-04-27 | 3d time-of-flight camera system and position/orientation calibration method therefor |
Publications (2)
Publication Number | Publication Date |
---|---|
US20110205340A1 US20110205340A1 (en) | 2011-08-25 |
US10795006B2 true US10795006B2 (en) | 2020-10-06 |
Family
ID=40193539
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US13/058,962 Active 2031-11-19 US10795006B2 (en) | 2008-08-12 | 2009-04-27 | 3D time-of-flight camera system and position/orientation calibration method therefor |
Country Status (5)
Country | Link |
---|---|
US (1) | US10795006B2 (en) |
EP (1) | EP2154650A1 (en) |
JP (1) | JP2011530706A (en) |
DE (1) | DE112009001833B4 (en) |
WO (1) | WO2010018009A1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20220239513A1 (en) * | 2021-01-28 | 2022-07-28 | Dell Products, Lp | System and method for operating an intelligent face framing management system for videoconferencing applications |
Families Citing this family (56)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8515257B2 (en) | 2007-10-17 | 2013-08-20 | International Business Machines Corporation | Automatic announcer voice attenuation in a presentation of a televised sporting event |
US10831093B1 (en) | 2008-05-19 | 2020-11-10 | Spatial Cam Llc | Focus control for a plurality of cameras in a smartphone |
KR101619076B1 (en) * | 2009-08-25 | 2016-05-10 | 삼성전자 주식회사 | Method of detecting and tracking moving object for mobile platform |
US8964028B2 (en) * | 2009-12-21 | 2015-02-24 | Mesa Imaging Ag | Stray light compensation method and system for time of flight camera systems |
EP2378310B1 (en) * | 2010-04-15 | 2016-08-10 | Rockwell Automation Safety AG | Time of flight camera unit and optical surveillance system |
JP5471853B2 (en) * | 2010-06-03 | 2014-04-16 | 株式会社Ihi | Three-dimensional shape measuring device, three-dimensional shape measuring additional device, and three-dimensional shape measuring method |
TWI466065B (en) * | 2010-07-23 | 2014-12-21 | Hon Hai Prec Ind Co Ltd | Detection device and detection method |
US9013550B2 (en) * | 2010-09-09 | 2015-04-21 | Qualcomm Incorporated | Online reference generation and tracking for multi-user augmented reality |
CN102034234B (en) * | 2010-10-20 | 2012-12-12 | 浙江工业大学 | Self-calibration method of multi-view structured light system |
US8866889B2 (en) | 2010-11-03 | 2014-10-21 | Microsoft Corporation | In-home depth camera calibration |
EP2453254B1 (en) * | 2010-11-15 | 2013-01-16 | Cedes AG | Device for monitoring a door with a 3D sensor |
CN102162738B (en) * | 2010-12-08 | 2012-11-21 | 中国科学院自动化研究所 | Calibration method of camera and inertial sensor integrated positioning and attitude determining system |
DE102011100628B4 (en) * | 2011-05-05 | 2013-04-25 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Method and device for determining at least one camera parameter |
TWI478107B (en) * | 2011-11-29 | 2015-03-21 | Hon Hai Prec Ind Co Ltd | Apparatus and method for controlling gates |
EP2615580B1 (en) | 2012-01-13 | 2016-08-17 | Softkinetic Software | Automatic scene calibration |
KR101909544B1 (en) * | 2012-01-19 | 2018-10-18 | 삼성전자주식회사 | Apparatus and method for plane detection |
WO2013111229A1 (en) * | 2012-01-23 | 2013-08-01 | 日本電気株式会社 | Camera calibration device, camera calibration method, and camera calibration program |
JP2015517134A (en) * | 2012-03-05 | 2015-06-18 | マイクロソフト コーポレーション | Depth image generation based on optical falloff |
CN102693539A (en) * | 2012-03-13 | 2012-09-26 | 夏东 | Rapid three-dimensional calibration method for wide baselines for intelligent monitoring systems |
US9870704B2 (en) * | 2012-06-20 | 2018-01-16 | Conduent Business Services, Llc | Camera calibration application |
US10324033B2 (en) | 2012-07-20 | 2019-06-18 | Samsung Electronics Co., Ltd. | Image processing apparatus and method for correcting an error in depth |
CN102835974A (en) * | 2012-08-23 | 2012-12-26 | 华南理工大学 | Method for medical ultrasound three-dimensional imaging based on parallel computer |
US11002854B2 (en) | 2013-03-13 | 2021-05-11 | Cognex Corporation | Lens assembly with integrated feedback loop and time-of-flight sensor |
US10712529B2 (en) | 2013-03-13 | 2020-07-14 | Cognex Corporation | Lens assembly with integrated feedback loop for focus adjustment |
US9658717B2 (en) | 2013-05-14 | 2017-05-23 | Otter Products, Llc | Virtual writing surface |
US9229583B2 (en) | 2013-05-29 | 2016-01-05 | Otter Products, Llc | Object location determination including writing pressure information of a stylus |
US20140363073A1 (en) * | 2013-06-11 | 2014-12-11 | Microsoft Corporation | High-performance plane detection with depth camera data |
US9170685B2 (en) | 2013-06-20 | 2015-10-27 | Otter Products, Llc | Object location determination |
US9335866B2 (en) | 2013-11-20 | 2016-05-10 | Otter Products, Llc | Retractable touchscreen adapter |
US9846969B2 (en) * | 2014-12-01 | 2017-12-19 | Thinkware Corporation | Electronic apparatus, control method thereof, computer program, and computer-readable recording medium |
US9729806B2 (en) * | 2015-01-06 | 2017-08-08 | Semiconductor Components Industries, Llc | Imaging systems with phase detection pixels |
CN105519102B (en) * | 2015-03-26 | 2018-12-28 | 北京旷视科技有限公司 | video monitoring method and video monitoring system |
CN105444681A (en) * | 2015-11-16 | 2016-03-30 | 安徽省道一电子科技有限公司 | High-precision rail crawling measurement method based on single camera calibration and coding points |
CA3005894A1 (en) | 2015-11-20 | 2017-05-26 | Magic Leap, Inc. | Methods and systems for large-scale determination of rgbd camera poses |
KR102535617B1 (en) * | 2016-01-04 | 2023-05-24 | 한국전자통신연구원 | System and method for detecting object in depth image |
US10346949B1 (en) | 2016-05-27 | 2019-07-09 | Augmented Pixels, Inc. | Image registration |
CN107808398B (en) * | 2016-09-08 | 2023-04-07 | 松下知识产权经营株式会社 | Camera parameter calculation device, calculation method, program, and recording medium |
KR101949046B1 (en) * | 2016-12-28 | 2019-05-20 | 이승희 | Handwriting input device |
JP6957820B2 (en) * | 2017-03-24 | 2021-11-02 | 住友電工システムソリューション株式会社 | Radio sensor, adjustment method and adjustment program |
US10304254B2 (en) | 2017-08-08 | 2019-05-28 | Smart Picture Technologies, Inc. | Method for measuring and modeling spaces using markerless augmented reality |
CN109901137B (en) * | 2017-12-08 | 2021-06-04 | 浙江舜宇智能光学技术有限公司 | Calibration method and calibration equipment of wide-angle TOF module |
CN109920003B (en) * | 2017-12-12 | 2023-09-15 | 广东虚拟现实科技有限公司 | Camera calibration detection method, device and equipment |
CA3083350A1 (en) | 2017-12-21 | 2019-06-27 | Magic Leap, Inc. | Method for calibrating an augmented reality device |
CN109143252B (en) * | 2018-08-08 | 2022-08-30 | 合肥泰禾智能科技集团股份有限公司 | Method and device for distance calibration of TOF depth camera |
CN109300159B (en) * | 2018-09-07 | 2021-07-20 | 百度在线网络技术(北京)有限公司 | Position detection method, device, equipment, storage medium and vehicle |
CN109903241B (en) * | 2019-01-31 | 2021-06-15 | 武汉市聚芯微电子有限责任公司 | Depth image calibration method and system of TOF camera system |
CN110232714B (en) * | 2019-04-30 | 2021-07-20 | 北京云迹科技有限公司 | Calibration method and system of depth camera |
AU2020274025B2 (en) | 2019-05-10 | 2022-10-20 | Smart Picture Technologies, Inc. | Methods and systems for measuring and modeling spaces using markerless photo-based augmented reality process |
CN110852180B (en) * | 2019-10-17 | 2022-08-02 | 上海快仓智能科技有限公司 | TOF camera calibration method for automatic guided vehicle and automatic guided vehicle |
MX2022013294A (en) * | 2020-04-24 | 2022-11-30 | Crown Equip Corp | Calibration of a distance and range measurement device. |
KR20230034390A (en) * | 2020-07-08 | 2023-03-09 | 크라운 이큅먼트 코포레이션 | Calibration of industrial vehicle distance and ranging devices |
CN112361962B (en) * | 2020-11-25 | 2022-05-03 | 天目爱视(北京)科技有限公司 | Intelligent visual 3D information acquisition equipment of many every single move angles |
CN113418467A (en) * | 2021-06-16 | 2021-09-21 | 厦门硅谷动能信息技术有限公司 | Method for detecting general and black luggage size based on ToF point cloud data |
CN113284197B (en) * | 2021-07-22 | 2021-11-23 | 浙江华睿科技股份有限公司 | TOF camera external reference calibration method and device for AGV, and electronic equipment |
CN113689391B (en) * | 2021-08-16 | 2024-07-19 | 炬佑智能科技(苏州)有限公司 | ToF equipment installation parameter acquisition method and system and ToF equipment |
CN115097427B (en) * | 2022-08-24 | 2023-02-10 | 北原科技(深圳)有限公司 | Automatic calibration method based on time-of-flight method |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5259037A (en) * | 1991-02-07 | 1993-11-02 | Hughes Training, Inc. | Automated video imagery database generation using photogrammetry |
US5699444A (en) * | 1995-03-31 | 1997-12-16 | Synthonics Incorporated | Methods and apparatus for using image data to determine camera location and orientation |
US20080064952A1 (en) * | 2006-08-18 | 2008-03-13 | Dun Alex Li | Systems and methods for on-line marker-less camera calibration using a position tracking system |
US20090086014A1 (en) * | 2007-09-28 | 2009-04-02 | The Boeing Company | Local positioning system and method |
US7741961B1 (en) * | 2006-09-29 | 2010-06-22 | Canesta, Inc. | Enhanced obstacle detection and tracking for three-dimensional imaging systems used in motor vehicles |
US9578310B2 (en) * | 2012-01-13 | 2017-02-21 | Softkinetic Software | Automatic scene calibration |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10132935A (en) * | 1996-11-01 | 1998-05-22 | Nec Corp | Missile position measuring equipment |
AU2834899A (en) * | 1998-02-18 | 1999-09-06 | Gmd-Forschungszentrum Informationstechnik Gmbh | Camera tracking system for a virtual television or video studio |
JP3994950B2 (en) * | 2003-09-19 | 2007-10-24 | ソニー株式会社 | Environment recognition apparatus and method, path planning apparatus and method, and robot apparatus |
EP1662440A1 (en) | 2004-11-30 | 2006-05-31 | IEE INTERNATIONAL ELECTRONICS & ENGINEERING S.A. | Method for determining the position of an object from a digital image |
WO2007029686A1 (en) * | 2005-09-07 | 2007-03-15 | Sharp Kabushiki Kaisha | 3d image recording/reproducing system |
JP2007300191A (en) * | 2006-04-27 | 2007-11-15 | Fujitsu Ltd | Infrared image processor and infrared image processing method |
-
2008
- 2008-08-12 EP EP08162222A patent/EP2154650A1/en not_active Withdrawn
-
2009
- 2009-04-27 JP JP2011522445A patent/JP2011530706A/en active Pending
- 2009-04-27 DE DE112009001833.5T patent/DE112009001833B4/en active Active
- 2009-04-27 WO PCT/EP2009/055054 patent/WO2010018009A1/en active Application Filing
- 2009-04-27 US US13/058,962 patent/US10795006B2/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5259037A (en) * | 1991-02-07 | 1993-11-02 | Hughes Training, Inc. | Automated video imagery database generation using photogrammetry |
US5699444A (en) * | 1995-03-31 | 1997-12-16 | Synthonics Incorporated | Methods and apparatus for using image data to determine camera location and orientation |
US20080064952A1 (en) * | 2006-08-18 | 2008-03-13 | Dun Alex Li | Systems and methods for on-line marker-less camera calibration using a position tracking system |
US7741961B1 (en) * | 2006-09-29 | 2010-06-22 | Canesta, Inc. | Enhanced obstacle detection and tracking for three-dimensional imaging systems used in motor vehicles |
US20090086014A1 (en) * | 2007-09-28 | 2009-04-02 | The Boeing Company | Local positioning system and method |
US9578310B2 (en) * | 2012-01-13 | 2017-02-21 | Softkinetic Software | Automatic scene calibration |
Non-Patent Citations (13)
Title |
---|
"Vision and Inertial Sensor Cooperation Using Gravity as a Vertical Reference". Lobo et al., IEEE Transactions on Pattern Analysis and Machine Intelligence, vol. 25, No. 12, pp. 1597-1608, Dec. 2003. * |
Alessandro Bevilacqua, et al.; "People tracking using a Time-of-Flight depth sensor"; IEEE International Conference On Video and Signal Based Surveillance, 2006. AVSS, Nov. 1, 2006; XP002509695. |
ALLESSANDRO BEVILACQUA, LUIGI DI STEFANO, PIETRO AZZARI: "People Tracking Using a Time-of-Flight Depth Sensor", IEEE INTERNATIONAL CONFERENCE ON VIDEO AND SIGNAL BASED SURVEILLANCE, 2006. AVSS '06., IEEE, IEEE, 1 November 2006 (2006-11-01), IEEE, pages 1 - 5, XP002509695, ISBN: 978-0-7695-2688-1 |
Andrew Fitzgibbon, et al.; "Direct Least Square Fitting of Ellipses"; Tern Analysis and Machine Intelligence, vol. 21, No. 5, May 1999; pp. 476-480. |
Christopher Jaynes, "Multi-view calibration from planar motion trajectories" Image and Vision Computing Guildford, GB, vol. 22, No. 7, Jul. 1, 2004, pp. 535-550, XP002464738. |
CHRISTOPHER JAYNES: "Multi-view calibration from planar motion trajectories", IMAGE AND VISION COMPUTING, ELSEVIER, GUILDFORD, GB, vol. 22, no. 7, 1 July 2004 (2004-07-01), GUILDFORD, GB, pages 535 - 550, XP002464738, ISSN: 0262-8856, DOI: 10.1016/j.imavis.2003.09.008 |
Frederic Garcia Becerro; "External-Self-Calibration of a 3D time-of-flight camera in real environments" [Online] Jun. 18, 2008, pp. 1-96, XP002509694. |
H. Cantzler; Random Sample Consensus (RANSAC); Institute for Perception, Action and Behaviour, Division of Informatics, University of Edinburgh, Edinburgh, EH1 2QL, UK; pp. 1-4. |
International Search Report; PCT/EP2009/055054; dated Jun. 15, 2009. |
J.-A. Beraldin, S. F., et al.; "Practical Range Camera Calibration"; Institute for Information Technology; National Research Council of Canada; Ottawa, Canada K1A 0R6; pp. 1-11. |
Martin A. Fischler, et al.; "Random Sample Consensus: A Paradigm for Model Fitting with Applications to Image Analysis and Automated Cartography"; Graphics and Image Processing; Jun. 1981; vol. 24, No. 6, pp. 381-395. |
Neven Santrac, et al.; "High Resolution Segmentation with a Time-of-Flight 3D-Camera using the Example of a Lecture Scene"; Freie Universit{umlaut over ( )}at Berlin; Department of Mathematics and Computer Science; Takustr. 9, 14195 Berlin, Germany; {santrac, fland, rojas}@inf.fu-berlin.de; B-06-09; Sep. 2006. |
T. Kahlmann, et al.; "Calibration for Increased Accuracy of the Range Imaging Camera Swissranger"; ISPRS Commission V Symposium ‘Image Engineering and Vision Metrology’, IAPRS vol. XXXVI, Part 5, Dresden Sep. 25-27, 2006; pp. 136-141. |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20220239513A1 (en) * | 2021-01-28 | 2022-07-28 | Dell Products, Lp | System and method for operating an intelligent face framing management system for videoconferencing applications |
US11463270B2 (en) * | 2021-01-28 | 2022-10-04 | Dell Products, Lp | System and method for operating an intelligent face framing management system for videoconferencing applications |
Also Published As
Publication number | Publication date |
---|---|
WO2010018009A1 (en) | 2010-02-18 |
DE112009001833B4 (en) | 2022-11-03 |
US20110205340A1 (en) | 2011-08-25 |
DE112009001833T5 (en) | 2011-07-28 |
JP2011530706A (en) | 2011-12-22 |
EP2154650A1 (en) | 2010-02-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10795006B2 (en) | 3D time-of-flight camera system and position/orientation calibration method therefor | |
EP3236286B1 (en) | Auto commissioning system and method | |
CN109212510B (en) | Method and device for measuring the angular resolution of a multiline lidar | |
Pandey et al. | Extrinsic calibration of a 3d laser scanner and an omnidirectional camera | |
EP2111530B1 (en) | Automatic stereo measurement of a point of interest in a scene | |
US20190120934A1 (en) | Three-dimensional alignment of radar and camera sensors | |
WO2021037086A1 (en) | Positioning method and apparatus | |
EP2312330A1 (en) | Graphics-aided remote position measurement with handheld geodesic device | |
US20120105825A1 (en) | Measuring device for noncontact measurement of distances to a target object | |
US20140022281A1 (en) | Projecting airplane location specific maintenance history using optical reference points | |
CN109690622A (en) | Camera registration in multicamera system | |
CN111383279A (en) | External parameter calibration method and device and electronic equipment | |
CN107966155B (en) | Object positioning method, object positioning system and electronic equipment | |
CN111815716A (en) | Parameter calibration method and related device | |
CN103649674A (en) | Measurement device and information processing device | |
US20220327737A1 (en) | Determining position using computer vision, lidar, and trilateration | |
WO2022217988A1 (en) | Sensor configuration scheme determination method and apparatus, computer device, storage medium, and program | |
KR20190076815A (en) | Method for estimating pose of moving object of electronic apparatus | |
US11692812B2 (en) | System and method for measuring three-dimensional coordinates | |
CN114724104B (en) | Method, device, electronic equipment, system and medium for detecting visual recognition distance | |
JP7363545B2 (en) | Calibration judgment result presentation device, calibration judgment result presentation method and program | |
CN113256734A (en) | Vehicle-mounted sensing sensor calibration method and system and electronic equipment | |
CN112149441A (en) | Two-dimensional code positioning control method based on reflector | |
US20230400330A1 (en) | On-site compensation of measurement devices | |
US20240114119A1 (en) | Image processing device, image processing method, and program |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AS | Assignment |
Owner name: IEE INTERNATIONAL ELECTRONICS & ENGINEERING S.A., LUXEMBOURG Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:GARCIA, FREDERIC;GRANDIDIER, FREDERIC;MIRBACH, BRUNO;AND OTHERS;REEL/FRAME:026237/0645 Effective date: 20110505 Owner name: IEE INTERNATIONAL ELECTRONICS & ENGINEERING S.A., Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:GARCIA, FREDERIC;GRANDIDIER, FREDERIC;MIRBACH, BRUNO;AND OTHERS;REEL/FRAME:026237/0645 Effective date: 20110505 |
|
AS | Assignment |
Owner name: IEE INTERNATIONAL ELECTRONICS & ENGINEERING S.A., LUXEMBOURG Free format text: CHANGE OF APPLICANT ADDRESS;ASSIGNOR:IEE INTERNATIONAL ELECTRONICS & ENGINEERING S.A.;REEL/FRAME:046364/0247 Effective date: 20180606 Owner name: IEE INTERNATIONAL ELECTRONICS & ENGINEERING S.A., Free format text: CHANGE OF APPLICANT ADDRESS;ASSIGNOR:IEE INTERNATIONAL ELECTRONICS & ENGINEERING S.A.;REEL/FRAME:046364/0247 Effective date: 20180606 |
|
STCV | Information on status: appeal procedure |
Free format text: APPEAL BRIEF (OR SUPPLEMENTAL BRIEF) ENTERED AND FORWARDED TO EXAMINER |
|
STCV | Information on status: appeal procedure |
Free format text: EXAMINER'S ANSWER TO APPEAL BRIEF MAILED |
|
STCV | Information on status: appeal procedure |
Free format text: ON APPEAL -- AWAITING DECISION BY THE BOARD OF APPEALS |
|
STCF | Information on status: patent grant |
Free format text: PATENTED CASE |
|
MAFP | Maintenance fee payment |
Free format text: PAYMENT OF MAINTENANCE FEE, 4TH YEAR, LARGE ENTITY (ORIGINAL EVENT CODE: M1551); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY Year of fee payment: 4 |