WO2015183050A1 - 옵티컬 트래킹 시스템 및 옵티컬 트래킹 시스템의 마커부 자세 및 위치 산출방법 - Google Patents
옵티컬 트래킹 시스템 및 옵티컬 트래킹 시스템의 마커부 자세 및 위치 산출방법 Download PDFInfo
- Publication number
- WO2015183050A1 WO2015183050A1 PCT/KR2015/005444 KR2015005444W WO2015183050A1 WO 2015183050 A1 WO2015183050 A1 WO 2015183050A1 KR 2015005444 W KR2015005444 W KR 2015005444W WO 2015183050 A1 WO2015183050 A1 WO 2015183050A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- coordinate
- matrix
- pattern
- coordinates
- transformation
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/20—Analysis of motion
- G06T7/246—Analysis of motion using feature-based methods, e.g. the tracking of corners or segments
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/20—Analysis of motion
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
- G06T7/73—Determining position or orientation of objects or cameras using feature-based methods
-
- 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/10056—Microscopic image
-
- 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/30204—Marker
Definitions
- the present invention relates to an optical tracking system and a method of calculating the position of the marker unit of the optical tracking system, and more particularly, to an optical tracking system and the method of calculating the position of the marker unit of the optical tracking system using the pattern information.
- an optical tracking system is used to track the position of a given object.
- the optical tracking system can be utilized to track an object in real time in equipment such as surgical robots.
- the optical tracking system typically includes a plurality of markers attached to a target object and imaging units for imaging light emitted by the markers, and mathematically calculating information obtained from the imaging units to obtain position information and the like. do.
- the conventional optical tracking system has a disadvantage in that the size of the equipment is increased by including a plurality of markers, and thus may be inappropriate in the case of tracking requiring small precision.
- an object of the present invention is to provide an optical tracking system that can accurately and easily track markers.
- Another object of the present invention is to provide a method for calculating the position and position of the marker of the optical tracking system applicable to the optical tracking system.
- An optical tracking system is a marker portion including a pattern having a specific information and a first lens having a first focal length and spaced apart from the pattern, the second A first imaging unit including a second lens having a focal length and a first imaging unit spaced apart from the second lens, and configured to form a first image of the pattern by the first lens and the second lens; A second imaging unit including a third lens having a third focal length and a second imaging unit spaced apart from the third lens, and configured to form a second image of the pattern by the first lens and the third lens; And a first coordinate transformation between the coordinates on the patterned surface of the pattern and the first pixel coordinates on the first image of the pattern, and the rotation edge between the first pixel coordinates and the second pixel coordinates on the second image of the pattern.
- To from a second coordinate conversion equation between the second second-pixel coordinates on the image of the coordinates and the pattern on the pattern surface of the pattern determines the position marker portion, and a tracking processing unit for parts of the
- the processing unit a first transformation matrix for converting a first coordinate corresponding to the coordinates on the pattern surface of the pattern to a second coordinate corresponding to the three-dimensional coordinates of the first lens of the marker unit, A second transformation for converting a third coordinate corresponding to a three-dimensional coordinate of the second lens of the second coordinate to a fourth coordinate corresponding to a first pixel coordinate on a first image of the pattern of the first imaging unit A third transformation matrix equal to the first transformation matrix for converting a fifth coordinate corresponding to a coordinate on a pattern surface of the pattern into a sixth coordinate corresponding to three-dimensional coordinates of the first lens of the marker unit, And a fourth coordinate for converting a seventh coordinate corresponding to the three-dimensional coordinate of the third lens of the sixth coordinate into an eighth coordinate corresponding to a second pixel coordinate on the second image of the pattern of the second imaging unit.
- the first coordinate transformation equation is defined to convert the first coordinate into the fourth coordinate including the first transformation matrix and the second transformation matrix
- the second coordinate transformation equation is the third transformation matrix and the fourth transformation matrix.
- a first posture defining a posture of the marker unit with respect to the first imaging unit from the first and second coordinate transformation equations, wherein the processing unit is defined to convert the fifth coordinate to the eighth coordinate including a transformation matrix;
- a positive matrix can be obtained.
- the first coordinate transformation equation may be defined by the following equation,
- the second coordinate transformation equation may be defined by the following equation.
- the first transform matrix and the third transform matrix may be defined by the following equation,
- the second and fourth transformation matrices may be defined by the following equation.
- the processor may obtain the first transform matrix and the third transform matrix by obtaining calibration values u c , v c, and f b from at least three captured images.
- the second transform matrix and the fourth transform matrix can be obtained by obtaining calibration values of f c , pw and ph using data.
- the processor may acquire a plurality of data for the first coordinate and the fourth coordinate and a plurality of data for the fifth and eighth coordinates, and the obtained plurality of data.
- the first posture definition matrix can be obtained by the following equation.
- the data of four coordinates are the pixel coordinates on the first image of the pattern corresponding to the center of the pattern, ((ru 1 , rv 1 ),..., (ru n , rv n ) Is data of the fifth coordinate, (ru ' 1 , rv' 1 ), ..., (ru ' n , rv' n ) is data of the eighth coordinate, and (ru ' c , rv' c ) is the Pixel coordinates on the second image of the pattern corresponding to the center)
- the processing unit may determine a position of the marker unit from a third coordinate transformation equation relating to the second coordinate and the fourth coordinate and a fourth coordinate transformation equation relating to the sixth coordinate and the eighth coordinate,
- the marker unit may be tracked using the position of the marker unit.
- the third coordinate transformation equation may be defined by the following equation,
- the fourth coordinate transformation equation may be defined by the following equation.
- the processing unit may acquire a first center coordinate and a second center coordinate which are centers of a viewing range of the pattern photographed by the first and second imaging units, respectively, and obtain the obtained center coordinates.
- the position conversion matrix between the first imaging unit and the second image forming unit may be calibrated, and the position of the marker unit may be obtained using the calibrated position transformation matrix.
- the processing unit may obtain a conversion coefficient by measuring the marker unit at at least two positions, and using the obtained conversion coefficient together with the obtained central coordinates, the first imaging unit and The position transformation matrix between the second image forming unit may be calibrated.
- the method of calculating the position and position of the marker part of the optical tracking system includes a pattern having a specific information with specific information, a pattern spaced apart from the pattern, and having a first focal length.
- a marker unit including a first lens, a second lens having a second focal length, and a second lens are spaced apart from the second lens, and the first image of the pattern is formed by the first lens and the second lens.
- a first image forming unit including a first image forming unit, a third lens having a third focal length, and a third lens spaced apart from the third lens, and the second image of the pattern is formed by the first lens and the third lens Including an image forming second imaging unit, it is provided to calculate the posture of the marker portion to track the marker portion.
- the method of calculating the position and position of the marker part of the optical tracking system may include converting a first coordinate corresponding to a coordinate on a pattern surface of the pattern into second coordinate corresponding to three-dimensional coordinates of the first lens of the marker part.
- Convert to coordinate Obtaining a fourth transform matrix; and a first coordinate transform equation and a third transform matrix including the first transform matrix and the second transform matrix, and converting the first coordinate into the fourth coordinate.
- obtaining a posture definition matrix defining a posture of the marker unit from a second coordinate transformation equation including a fourth transformation matrix and converting the fifth coordinate to the eighth coordinate.
- the method of calculating the position and position of the marker unit of the optical tracking system further includes: obtaining a conversion factor by measuring the marker unit at at least two positions before calibrating the position transformation matrix.
- the position transformation matrix between the first imaging unit and the second imaging unit may be calibrated using the obtained conversion factor together with the acquired data.
- the marker portion in an optical tracking system for tracking a marker portion, can be miniaturized by including a pattern of specific information so as to enable tracking, and the optical system of the marker portion and the image forming portion can be modeled by coordinate transformation.
- the optical system of the marker portion and the image forming portion can be modeled by coordinate transformation.
- the location of the marker part can be more accurately determined by modeling a miniaturized marker part including a pattern of specific information by using a stereo method, it is possible to accurately track the marker part in a simpler and easier way.
- FIG. 1 is a conceptual diagram illustrating an optical tracking system according to an embodiment of the present invention.
- FIG. 2 is a flowchart schematically illustrating a problem solving process required for a processing unit of the optical tracking system of FIG. 1 to determine a posture of a marker unit.
- FIG. 3 is a flowchart illustrating a process of modeling a system in the problem solving process of FIG. 2.
- FIG. 4 is a conceptual diagram illustrating a process of modeling the system of FIG. 3.
- FIG. 5 is a flowchart illustrating a process of calibrating a second transform matrix during the problem solving process of FIG. 2.
- FIG. 6 is a flowchart illustrating a process of calibrating a first transform matrix in the problem solving process of FIG. 2.
- FIG. 7 is a flowchart illustrating an example of a process of obtaining a posture definition matrix in the problem solving process of FIG. 2.
- FIG. 8 is a flowchart illustrating another example of a process of obtaining a posture definition matrix in the problem solving process of FIG. 2.
- FIG. 9 is a flowchart illustrating a method of calculating a marker posture of an optical tracking system according to an exemplary embodiment of the present invention.
- FIG. 10 is a conceptual diagram illustrating an optical tracking system according to another embodiment of the present invention.
- FIG. 11 is a flowchart schematically illustrating a problem solving process required for a processing unit of the optical tracking system of FIG. 10 to determine a posture of a marker unit.
- FIG. 12 is a flowchart illustrating a process of calibrating a transformation matrix during the problem solving process of FIG. 11.
- FIG. 13 is a flowchart illustrating an example of a process of obtaining a posture definition matrix in the problem solving process of FIG. 11.
- FIG. 14 is a flowchart illustrating a method of calculating a marker part attitude of an optical tracking system according to another exemplary embodiment of the present invention.
- FIG. 15 is a flowchart schematically illustrating a problem solving process required for a processing unit of the optical tracking system of FIG. 10 to determine a position of a marker unit.
- FIG. 16 is a conceptual diagram illustrating a process of performing system modeling in the problem solving process of FIG. 15.
- FIG. 17 is a flowchart illustrating a process of calibrating a position transformation matrix during the problem solving process of FIG. 15.
- FIG. 18 is a flowchart illustrating an example of a process of acquiring a position of a marker unit in the problem solving process of FIG. 15.
- FIG. 19 is a flowchart illustrating another example of a process of acquiring a position of a marker part in the problem solving process of FIG. 15.
- 20 is a flowchart illustrating a marker position calculation method of the optical tracking system according to an embodiment of the present invention.
- first and second may be used to describe various components, but the components should not be limited by the terms. The terms are used only for the purpose of distinguishing one component from another.
- the first component may be referred to as the second component, and similarly, the second component may also be referred to as the first component.
- FIG. 1 is a conceptual diagram illustrating an optical tracking system according to an embodiment of the present invention.
- the optical tracking system 100 includes a marker unit 110, an image forming unit 120, and a processing unit 130.
- the marker unit 110 includes a pattern 112 and a first lens 114.
- the pattern 112 has specific information.
- the specific information is information that can be recognized for tracking in the imaging unit 120, which will be described later.
- the one-dimensional pattern similar to a bar code and two similar to a QR code Dimensional patterns and the like.
- the first lens 114 is spaced apart from the pattern 112 and has a first focal length.
- the separation distance between the first lens 114 and the pattern 112 may allow the imaging unit 120, which will be described later, to image and track the pattern 112 even at a distance. It may be equal to the first focal length of (114).
- bundles of rays with respect to the pattern 112 passing through the first lens 114 may be parallel to each other.
- the first lens 114 may perform a function similar to that of an objective lens of a microscope.
- the marker unit 110 may not include a light source. In this case, the marker unit 110 may be used as a passive marker using an illumination located outside. Alternatively, the marker unit 110 may include a light source. In this case, the marker unit 110 may be used as an active marker using self illumination.
- the imaging unit 120 includes a second lens 122 and an imaging unit 124.
- the second lens 122 has a second focal length.
- the second lens 114 may perform a function similar to that of the eyepiece of the microscope, for example.
- the imaging unit 124 is spaced apart from the second lens 122 and the image of the pattern 112 is formed by the first lens 114 and the second lens 122.
- the separation distance between the imaging unit 124 and the second lens 122 may form an optical bundle for the pattern 112 parallel to each other through the first lens 114.
- the second focal length may be the same as the second focal length of the second lens 122.
- the imaging unit 124 may include an image sensor such as a charge coupled device (CCD), a complementary metal-oxide semiconductor (CMOS), or the like.
- the processor 130 determines the posture of the marker unit 110 from a coordinate conversion equation between coordinates on the pattern surface of the pattern 112 and pixel coordinates on the image of the pattern 112.
- the processor 130 tracks the marker unit 110 using the determined posture of the marker unit 110.
- the processing unit 130 may include, for example, a computer or more specifically a central processing unit (CPU).
- FIG. 2 is a flowchart schematically illustrating a problem solving process required for a processing unit of the optical tracking system of FIG. 1 to determine a posture of a marker unit.
- system modeling is performed on the optical tracking system 100 having the above-described configuration (S100).
- the coordinate transformation between the coordinates on the pattern surface of the pattern 112 and the pixel coordinates on the image of the pattern 112 is based on the optical system of the optical tracking system 100. Since it is made by, by modeling the coordinate transformation according to the optical system of the optical tracking system 100 can set the coordinate transformation equation. In this case, the coordinate transformation according to the optical system of the optical tracking system 100 may be modeled by the optical system of each of the marker unit 110 and the image forming unit 120 and the relationship between them.
- the coordinates on the pattern surface of the pattern 112 shown in FIG. 1 are the first coordinates
- the three-dimensional local coordinates of the first lens 114 of the first coordinates are the second coordinates
- the first transformation is performed.
- the matrix is a matrix for converting the first coordinates to the second coordinates
- the second transform matrix is a matrix for converting the third coordinates to the fourth coordinates.
- the coordinate transformation equation obtained as a result of the system modeling is determined by equations for various parameters of the optical system of the marker unit 110 and the imaging unit 120 shown in FIG. 1, but the parameters cannot be accurately obtained. Since the value may change due to mechanical arrangement, etc., more accurate system modeling may be possible by calibrating the first and second transformation matrices.
- the posture refers to the direction in which the marker unit 110 is directed
- the posture definition matrix is a matrix that provides information on the posture of the marker unit 110, and the marker unit 110 from the posture definition matrix. Roll, pitch, yaw, and the like.
- FIG. 3 is a flowchart illustrating a system modeling process of the problem solving process of FIG. 2, and FIG. 4 is a conceptual diagram illustrating a process of modeling the system of FIG. 3.
- the center point of the first lens 114 is referred to as the first center point A
- the center point of the second lens 122 is called the second center point O
- any point on the pattern 112 is referred to as B.
- the light passing through the first center point A of the first lens 114 goes straight and the light passing through the first center point A meets the second lens 122.
- the point D is refracted by the second lens 122 at the point D and formed at the imaging unit 124 is E.
- the light passing through the first center point A of the first lens 114 and passing through the second center point O of the second lens 122 goes straight, and the point where the light meets the extension line of the line segment DE is referred to as C. .
- the equation of a straight line for the line segment AO (or line AC)
- the coordinate of the first center point A is set to (X, Y, Z), and the coordinate of the second center point O is set to (0,0,0), which is the origin. Since the coordinate of the second center point O of the second lens 122 is set as the origin, the three-dimensional local coordinate system for the second lens 122 is the same as the world coordinate system.
- the coordinates of the pixels (corresponding to the point E) of the image of the pattern 112 formed in the phase are set to (u ', v').
- the coordinates (u, v) and (u c , v c ) may be set based on, for example, the upper left side of the pattern 112, and the coordinates (u ′, v ′) are, for example, the pattern ( 112 may be set based on the upper left side of the image.
- the imaging unit 124 when the imaging unit 124 is positioned at the focal length f c of the second lens 122, the z-axis coordinate of the imaging unit 124 becomes -f c .
- the equation of straight line L1 is found from line segment AO, where the position of point C is obtained.
- the equation of straight line L2 is found from line segment AB, where the position of point D is obtained.
- the equation for straight line L3 is found from line segment DC.
- the attitude definition matrix defining the attitude of the marker unit 110 is defined as a 3 * 3 matrix [R], and each component of the matrix [R] is r 11 , r 12 , r 13 , r 21 , r 22 ,
- the world coordinate of point B is the pattern coordinate (u, v) of point B, and the focal length f b of the matrix [R] and the first lens 114.
- the pixel coordinates (u ', v') of the point E can be represented by the pattern coordinates (u, v) of the point B, the pattern 112 corresponding to the point B and the pattern corresponding to the point E You can define the relationship between images.
- the relational expression may be represented by a matrix equation as shown in Equation 1 below, and the matrix equation regarding the coordinate transformation may be set as the coordinate transformation formula.
- (u, v) is the first coordinate
- (u ', v') is the fourth coordinate
- [C] is the first transformation matrix
- [A] is the second transformation matrix
- [R] Means the posture definition matrix.
- (u c , v c ) is the coordinate on the pattern surface of the center of the pattern
- f b is the first focal length
- f c is the second focal length
- pw is the width of the pixel of the image of the pattern
- ph Is the height of the pixels of the image of the pattern.
- i is a predetermined i-th pattern.
- the coordinate transformation equation consists of the product of the first and second transformation matrices and the attitude definition matrix described in FIG. 1.
- the coordinates on the pattern surface of the pattern 112 may be defined as a first coordinate ((u, v)) and the first lens of the first coordinate ( 114 is a 3D local coordinate for the second coordinate, the 3D local coordinates (same as the world coordinate) for the second lens 122 of the second coordinate, and the image forming unit 120
- the coordinate transformation equation is a first transformation for converting the first coordinates to the second coordinates.
- a posture definition matrix [R] for converting the second coordinates to the third coordinates
- a second transformation matrix [A] for converting the third coordinates to the fourth coordinates ] [C].
- the calibration is first performed on the second transform matrix, and then performed on the first transform matrix.
- FIG. 5 is a flowchart illustrating a process of calibrating a second transform matrix during the problem solving process of FIG. 2.
- a matrix [B] and a matrix [H] are defined to facilitate mathematical analysis for calibration (S210).
- Equation 2 when the matrix [B] is defined using the second transform matrix [A], it is represented by Equation 2, and the first transform matrix [C] and the second transform matrix [A] are defined. And a matrix [H] using the posture definition matrix [R], as shown in Equation 3 below.
- Equation 4 is obtained by multiplying A ⁇ 1 by both sides of Equation 3.
- the matrix [B] can be defined as in Equation 5.
- ⁇ -f c / pw
- ⁇ -f c / ph
- f c is the focal length of the second lens 122 of the imaging unit 120
- pw and ph are the width and height of the pixel, respectively it means.
- the column vectors b and v ij are defined using Equation 6 using nonzero components of the matrix [B].
- Equation 7 Using the orthogonality of the matrix [R] in Equation 6, Equation 7 can be obtained.
- the column vector b may be obtained by using a method such as singular value decomposition (SVD). Finding the column vector b gives us all the components of the matrix [B].
- SVD singular value decomposition
- the matrix through a formula (8) to know all of the components of the [B] v 'c, ⁇ , ⁇ , u' can be obtained c (representing the ⁇ , ⁇ as a parameter).
- the first transform matrix [C] is calibrated using the second transform matrix [A] previously calibrated.
- FIG. 6 is a flowchart illustrating a process of calibrating a first transform matrix in the problem solving process of FIG. 2.
- the calibrated matrix [A] is substituted into the matrix [H] to obtain a matrix [R] (S250).
- Equation 10 is obtained by substituting the second transform matrix [A] of Equation 9 into Equation 3 and arranging [R] [C] of Equation 1.
- the product of the matrix [A] and the matrix [R] is defined as the matrix [HK], substituted into the coordinate transformation equation of Equation 1, and arranged to be composed of the components of the matrix [HK] and the matrix [C].
- the matrix [HK] can be obtained by using the matrix [A] obtained from Equation 9 and the matrix [R] obtained from Equation 11, and when applied to the coordinate conversion equation of Equation 1, the matrix [HK] and the matrix [ Equation 12 consisting of the components of C] is obtained.
- the matrix [AA], the matrix [BB], and the matrix [CC] can be defined using Equation 13 using the matrix [HK].
- FIG. 7 is a flowchart illustrating an example of a process of obtaining a posture definition matrix in the problem solving process of FIG. 2.
- Equation 14 can be obtained by setting this as an equation.
- the matrix [H] is obtained using, for example, a method such as singular value decomposition (SVD) (S320a).
- SVD singular value decomposition
- Equation 15 is obtained.
- Equation 15 2n equations of Equation 15 are obtained using a method such as singular value decomposition (SVD) as an example.
- SVD singular value decomposition
- the posture definition matrix may be obtained in other ways.
- FIG. 8 is a flowchart illustrating another example of a process of obtaining a posture definition matrix in the problem solving process of FIG. 2.
- Equation 16 is obtained.
- the matrix [R] is obtained using, for example, a method such as singular value decomposition (SVD) (S330b).
- SVD singular value decomposition
- Equation 16 2n equations of Equation 16 are obtained using a method such as singular value decomposition (SVD).
- SVD singular value decomposition
- the posture of the marker unit 110 may be calculated by applying the system modeling process and the method of obtaining the posture definition matrix [R] to the optical tracking system 100 shown in FIG. 1.
- FIG. 9 is a flowchart illustrating a method of calculating a marker posture of an optical tracking system according to an exemplary embodiment of the present invention.
- the processor 130 first calibrates first and second transform matrices from at least three images (S510).
- the calibration is substantially the same as the process of step S200 described in FIG. 2 and the steps S210 to S280 described in detail in FIGS. 5 and 6, and the processing unit 130 includes steps S230 and S280 of the process.
- the first and second transformation matrices may be calibrated using only the final equation for calibration.
- an attitude definition matrix is obtained from a coordinate transformation equation including the first and second transformation matrices (S520).
- the attitude definition matrix is substantially the same as the process of step S300 described in FIG. 2, steps S310 to S330a, and steps S310 to S330b described in detail with reference to FIGS. 7 and 8, and the processing unit 130.
- the attitude definition matrix may be obtained using only the final equation for acquiring the attitude definition matrix as in steps S320a and S320a, or step S320b.
- the processor 130 preliminarily obtains a first transformation matrix for converting the first coordinates to the second coordinates and a second transformation matrix for converting the third coordinates to the fourth coordinates in advance. From the coordinate transformation equation, an attitude definition matrix defining the attitude of the marker unit 110 may be obtained.
- the posture of the marker unit 110 may be obtained by obtaining the posture definition matrix.
- the roll, pitch, yaw, and the like of the marker unit 110 may be grasped from the posture defining matrix.
- the marker part can be miniaturized by including a pattern of specific information so as to enable tracking, and the attitude of the marker part can be determined by modeling the optical system of the marker part and the image forming part by coordinate transformation. Therefore, accurate tracking of the marker portion may be possible in a simpler and easier way.
- FIG. 10 is a conceptual diagram illustrating an optical tracking system according to another embodiment of the present invention.
- the optical tracking system 1000 includes a marker unit 1110, a first imaging unit 1120a, a second imaging unit 1120b, and a processing unit 1130. .
- the optical tracking system 1000 shown in FIG. 10 has the optical system shown in FIG. 1 except that the stereo method including two imaging units is applied and the processing unit 1140 determines the posture using the two imaging units. Since it is substantially the same as the tracking system 100, overlapping detailed description is omitted.
- the marker part 1110 includes a pattern 1112 and a first lens 1114 and is substantially the same as the marker part 110 shown in FIG. 1.
- the first imaging unit 1120a may be disposed to be spaced apart from the second lens having the second focal length and the second lens, and the first image of the pattern may be formed by the first lens and the second lens. It includes an imaging unit.
- the second imaging unit 1120b is disposed to be spaced apart from the third lens and the third lens having a third focal length, and the second image of the pattern is formed by the first lens and the third lens. It includes an imaging unit.
- Each of the first imaging unit 1120a and the second imaging unit 1120b is substantially the same as the imaging unit 120 illustrated in FIG. 1.
- the processor 1130 may perform a first coordinate transformation between the coordinates on the pattern surface of the pattern 1112 and the first pixel coordinates on the first image of the pattern 1112 and the coordinates on the pattern surface of the pattern 1112 and the An attitude of the marker unit 1110 is determined from a second coordinate transformation equation between second pixel coordinates on the second image of the pattern 1112.
- the second coordinate transformation equation includes a rotation transformation between the first pixel coordinate and the second pixel coordinate on the second image.
- the processing unit 1130 tracks the marker unit 1110 using the determined posture of the marker unit 1110.
- FIG. 11 is a flowchart schematically illustrating a problem solving process required for a processing unit of the optical tracking system of FIG. 10 to determine a posture of a marker unit.
- system modeling is performed on the optical tracking system 1000 having the above-described configuration (S1100).
- the coordinate transformation between the coordinates on the pattern surface of the pattern 1112 and the pixel coordinates on the image of the pattern 1112 is an optical system of the optical tracking system 1100. Since it is made by, by modeling the coordinate transformation according to the optical system of the optical tracking system 1000 can set the coordinate transformation equation. In this case, the coordinate transformation according to the optical system of the optical tracking system 100 may be modeled by the optical system of each of the marker unit 1110 and the first and second image forming units 1120a and 1120b and a relationship therebetween. .
- the coordinate on the pattern surface of the pattern 1112 shown in FIG. 10 is the first coordinate
- the three-dimensional local coordinates of the first lens 1114 of the first coordinate is the second coordinate
- the pixel coordinates on the first image of the pattern 1112 of the first image forming unit 1120a are defined as fourth coordinates, respectively.
- the first transform matrix is a matrix for converting the first coordinates to the second coordinates
- the second transform matrix is a matrix for converting the third coordinates to the fourth coordinates.
- coordinates on the pattern surface of the pattern 1112 illustrated in FIG. 10 are fifth coordinates
- the three-dimensional local coordinates of the first lens 1114 of the fifth coordinates are sixth coordinates and the sixth coordinates.
- the three-dimensional local coordinates of the third lens 1122b may be defined as seventh coordinates
- the pixel coordinates of the second image of the pattern 1112 of the second image forming unit 1120b may be defined as eighth coordinates, respectively.
- the third transformation matrix is a matrix for converting the fifth coordinate to the sixth coordinate
- the fourth transformation matrix is a matrix for converting the seventh coordinate to the eighth coordinate.
- the coordinate transformation equation obtained as a result of the system modeling is determined by equations for various parameters of the optical system of the marker unit 1110 and the imaging unit 1120 shown in FIG. 10, but the parameters cannot be obtained correctly. Since the value may change due to mechanical arrangement, etc., more accurate system modeling may be possible by calibrating the first and second transformation matrices.
- the posture definition matrix is a matrix that provides information about the posture of the marker unit 1110.
- the roll, pitch, yaw, and the like of the marker unit 1110 may be obtained from the posture definition matrix. I can figure it out.
- Equation 1 may be independently applied to the first imaging unit 1120a and the second imaging unit 1120b. Accordingly, the following equation 17 can be obtained as a system modeling result.
- L and 1 are applied to the variable for the first imaging unit 1120a
- R and r are applied to the variable for the second imaging unit 1120b.
- [R LR ] means a matrix for converting the three-dimensional local coordinates of the first imaging unit 1120a into the three-dimensional local coordinates of the second imaging unit 1120b, and the second determination It can be seen as a matrix defining the attitude of the first imaging unit 1120a with respect to the upper portion 1120b.
- FIG. 12 is a flowchart illustrating a process of calibrating a transformation matrix during the problem solving process of FIG. 11.
- the process of calibrating the transform matrix is basically the same as the process described with reference to FIGS. 5 and 6.
- steps S210 to S240 are applied to the first image forming unit 1120a to calibrate [A l ] (S1210a).
- step S250 is applied to the first imaging unit 1120a to obtain [R L ] (S1220a).
- steps S210 to S240 are applied to the second image forming unit 1120b to calibrate [A r ] (S1210b).
- step S250 is applied to the second image forming unit 1120b to obtain [R R ] (S1220b).
- [C] corresponding to the calibrated first and third transform matrices is obtained.
- FIG. 13 is a flowchart illustrating an example of a process of obtaining a posture definition matrix in the problem solving process of FIG. 11.
- the process of acquiring the posture definition matrix is basically the same as the process described with reference to FIG. 8, but there is a difference in using more data as a stereo system.
- steps S310 and S320b are applied to [R L ] in the first coordinate transformation equation to arrange the first equations for components r11 to r33 (S1310).
- This process corresponds to the processes of steps S310 and S320b described in FIG. 8, and the first equation is shown in Equation 21 below.
- equation (22) is obtained.
- the matrix [R L ] is obtained using a method such as singular value decomposition (SVD) as an example (S1340).
- Equation 22 since the matrixes [LW i ] and [RW i ] in Equation 22 each include two equations, a total of 4n equations are obtained for r 11 to r 33 , and the same method as singular value decomposition (SVD) is performed. Obtained using
- Equation 22 includes more equations than the method described with reference to FIGS. 1 to 9 including 4n expressions, so that a more accurate result for the matrix [R L ] can be obtained, and thus the marker part 1110 More accurate posture measurement may be possible.
- FIG. 14 is a flowchart illustrating a method of calculating a marker part attitude of an optical tracking system according to another exemplary embodiment of the present invention.
- the processor 1130 first calibrates first, second, third and fourth transformation matrices from at least three images (S1510).
- the calibration is substantially the same as the steps S1200 described with reference to FIG. 11 and the processes of steps S1210a and S1210b to S1280 described in detail with reference to FIG.
- the first and second transform matrices may be calibrated using only the final equation for calibration such as S1220b and S1280.
- the attitude definition matrix is obtained from the first and second coordinate transformation equations including the first, second, third and fourth transformation matrices (S1520).
- the attitude definition matrix is substantially the same as that of steps S1300 described in FIG. 11 and steps S1310 to S1340 described in detail in FIG. 13, and the processing unit 1130 performs steps S1330 and S1340 during the process.
- the attitude definition matrix may be obtained using only the final equation for obtaining the attitude definition matrix.
- the processor 1130 may convert the first coordinate into the second coordinate, a second transform matrix to convert the third coordinate into the fourth coordinate, and the fifth coordinate into the sixth transform.
- the marker unit 1110 is obtained from the first and second coordinate transformation equations. We can obtain a posture definition matrix that defines the posture.
- the posture of the marker unit 1110 may be known.
- the roll, pitch, yaw, and the like of the marker part 1110 may be grasped from the posture defining matrix.
- the marker portion including the pattern of the specific information can be miniaturized so that the tracking is possible, and the optical system of the marker portion and the image forming unit coordinate conversion type By modeling, but by applying a stereo method can determine the position of the marker more accurately, it may be possible to accurately track the marker in a simpler and easier way.
- the optical tracking system 1000 as described above may determine the position of the marker unit 1110 in addition to the posture of the marker unit 1110.
- FIG. 15 is a flowchart schematically illustrating a problem solving process required for a processing unit of the optical tracking system of FIG. 10 to determine a position of a marker unit.
- system modeling is performed on the optical tracking system 1000 having the above-described configuration (S2100).
- the system modeling may be performed by using the center of the center of the first lens 1114 (see FIG. 10) of the marker unit 1110, unlike the above-described coordinate conversion equation.
- the second coordinate (same as the sixth coordinate) corresponding to the coordinate is performed to be included.
- the position conversion matrix [T] indicates the position of the first imaging unit 1120a according to the separation between the first imaging unit 1120a (see FIG. 10) and the second imaging unit 1120b (see FIG. 10).
- the matrix converts to the position of the second imaging unit 1120b.
- FIG. 16 is a conceptual diagram illustrating a process of performing system modeling in the problem solving process of FIG. 15.
- the second coordinate P2 corresponding to the coordinate of the center of the first lens 1114 of the marker unit 1110 and the first pattern of the pattern 1112 of the first image forming unit 1120a may be used.
- a third coordinate transformation equation is set with respect to the fourth coordinates P4 corresponding to the first pixel coordinates on the first image.
- the third coordinate transformation equation may be expressed as a matrix equation as shown in Equation 23 below.
- the sixth coordinate P6 (same as the second coordinate P2) and the second image forming unit 1120b corresponding to the coordinates of the center of the first lens 1114 of the marker unit 1110.
- a fourth coordinate transformation equation is set with respect to the eighth coordinates P8 corresponding to the second pixel coordinates on the second image of the pattern 1112.
- the position conversion matrix [T] between the first imaging unit 1120a and the second imaging unit 1120b is set to be included. Accordingly, the fourth coordinate transformation equation may be expressed as a matrix equation as shown in Equation 24 below.
- (u ' 2 , v' 2 ) is the eighth coordinate (P8)
- (X, Y, Z) is the sixth coordinate (P6) (same as the second coordinate (P2))
- a R is The fourth transform matrix, [R LR ], has a 3x3 form and defines a posture of the first image forming unit 1120a with respect to the second image forming unit 1120b described in FIG. 11 and the like
- [T] is 3x1.
- the position conversion matrix converts the position of the first imaging unit 1120a into the position of the second imaging unit 1120b. As shown in FIG.
- the rotation conversion of the eighth coordinate P8 of the second imaging unit 1120b is based on the reference point.
- the part is represented by the matrix [R LR ] and the position conversion part is represented by [T], so that it can be expressed as [R LR
- the factors shown in the system modeling are all the factors obtained in FIGS. 11 to 14 except for the position conversion matrix [T]. Accordingly, when the position transformation matrix [T] is obtained, the second coordinate P2 (same as the sixth coordinate P6), that is, the position of the marker unit 1110 may be obtained.
- FIG. 17 is a flowchart illustrating a process of calibrating a position transformation matrix during the problem solving process of FIG. 15.
- first, first and second center coordinates respectively photographed by the first and second imaging units 1124a and 1124b are obtained (S2210).
- first and second center coordinates refer to the center of the filed of view that appears when the pattern 1112 is photographed by the first and second imaging units 1124a and 1124b, respectively. Central coordinates can be obtained.
- the elementary matrix may be expressed by Equation 25.
- Equation 25 the subscript j represents the sequence number of several data obtained when several central coordinates are obtained.
- Equation 26 By arranging Equation 25 as a component of the elementary matrix [F], Equation 26 can be obtained. Equation 26 is applied to at least eight points, for example, using a method such as singular value decomposition (SVD). The base matrix [F] can be obtained.
- SVD singular value decomposition
- Equation 27 The basic matrix [E] is expressed by Equation 27.
- Equation 28 Since the basic matrix [E] calculated from Equation 27 is expressed as a product of position transformation and rotation transformation, the matrix [t] X corresponding to the position transformation component can be obtained by arranging as in Equation 28.
- the matrix [t] X may be the same as the position transformation matrix, but if necessary, the position transformation matrix may be calculated by multiplying a scale factor.
- the conversion factor can be obtained by measuring the marker at at least two positions. For example, it can be calculated by moving the markers to at least two marker stages having known separation distances and measuring them.
- the position conversion matrix [T] is a matrix of a 3x1 type (t x , t y , t z ) T having t x , t y , t z as components of the matrix [t] X obtained. It can be calculated by multiplying the conversion factor.
- FIG. 18 is a flowchart illustrating an example of a process of acquiring a position of a marker unit in the problem solving process of FIG. 15.
- a first equation is obtained from a first position conversion equation for the first imaging unit 1120a (S2310).
- Equation 23 which is the first position conversion equation, is defined as in Equation 29.
- Equation (30) corresponding to the first equation can be obtained by leaving the self on both sides of Equation 29 to be 0 and arranging it.
- Equation 24 which is the second position conversion equation is defined as Equation 31.
- the second equation may be obtained by applying Equation 31 to the same process as the process of obtaining the first equation (S2310).
- Equation 30 corresponding to the first equation includes two equations, and since the second equation also includes two equations in the same manner, four equations may be obtained in correspondence to the two imaging units.
- the position of the marker unit 1110 is obtained from the first and second equations and the position transformation matrix [T] (S2330).
- three-dimensional coordinates of the center of the first lens 1114 of the marker unit 1110 may be obtained by applying the calibrated position transformation matrix [T] to the first and second equations.
- FIG. 19 is a flowchart illustrating another example of a process of acquiring a position of a marker part in the problem solving process of FIG. 15.
- a third equation is obtained from the first pattern coordinate transformation equation for the first imaging unit 1120a (S2350).
- Equation 32 a first pattern coordinate transformation equation modified from the first position transformation equation is set and arranged.
- Equation 33 By arranging Equation 32 into an equation, Equation 33 can be obtained.
- This step is substantially the same as the step (S2350) of obtaining the third equation except that the object is not the first imaging unit 1120a but the second imaging unit 1120b.
- Equation 33 corresponding to the third equation includes two equations, and since the fourth equation also includes two equations in the same manner, four equations may be obtained in correspondence to the two imaging units.
- the position of the marker part 1110 is obtained from the third and fourth equations and the position transformation matrix [T] (S2370).
- three-dimensional coordinates of the center of the first lens 1114 of the marker unit 1110 may be obtained by applying the calibrated position transformation matrix [T] to the first and second equations.
- 20 is a flowchart illustrating a marker position calculation method of the optical tracking system according to an embodiment of the present invention.
- a plurality of coordinate values are obtained by photographing the first and second imaging units 1124a and 1124b (S2510).
- Acquisition of the coordinate values is substantially the same as the process of acquiring the first central coordinate and the second central coordinate described in FIG. 17 (S2210). For example, at least eight coordinate values are acquired.
- the position conversion matrix is calibrated using the obtained coordinate values and the conversion factor (S2530).
- the calibration is substantially the same as the process of step S2200 described with reference to FIG. 15 and step S2250 described with reference to FIG. Can be.
- the position of the marker unit 1110 is obtained using the calibrated position transformation matrix (S2540).
- Acquisition of the position of the marker part 1110 may include steps S2300 described in FIG. 15, steps S2310 through S2330 described in detail in FIG. 18, and steps S2350 through S2370 described in detail in FIG. 19. Substantially the same, the processor 1130 may use only the final equation for the position acquisition, such as step S2330 or step S2370 during the process.
- the miniaturized marker portion including the pattern of specific information is modeled by applying a stereo method, the position of the marker portion can be determined more accurately, so that the accurate tracking of the marker portion can be performed in a simpler and easier way. It may be possible.
Landscapes
- Engineering & Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Multimedia (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Studio Devices (AREA)
- Image Analysis (AREA)
Abstract
Description
Claims (13)
- 특정정보를 갖는 패턴(pattern) 및 상기 패턴으로부터 이격되어 배치되며 제1 초점거리를 갖는 제1 렌즈를 포함하는 마커(marker)부;제2 초점거리를 갖는 제2 렌즈 및 상기 제2 렌즈로부터 이격되어 배치되며 상기 제1 렌즈와 상기 제2 렌즈에 의하여 상기 패턴의 제1 이미지가 결상되는 제1 결상유닛을 포함하는 제1 결상부;제3 초점거리를 갖는 제3 렌즈 및 상기 제3 렌즈로부터 이격되어 배치되며 상기 제1 렌즈와 상기 제3 렌즈에 의하여 상기 패턴의 제2 이미지가 결상되는 제2 결상유닛을 포함하는 제2 결상부; 및상기 패턴의 패턴면 상의 좌표와 상기 패턴의 제1 이미지 상의 제1 픽셀좌표 사이의 제1 좌표변환식 및 상기 제1 픽셀좌표와 상기 패턴의 제2 이미지 상의 제2 픽셀좌표 사이의 회전변환을 포함하는 상기 패턴의 패턴면 상의 좌표와 상기 패턴의 제2 이미지 상의 제2 픽셀좌표 사이의 제2 좌표변환식으로부터 상기 마커부의 자세를 결정하여, 상기 마커부를 트래킹하는 처리부를 포함하는 옵티컬 트래킹 시스템.
- 제1항에 있어서,상기 처리부는, 상기 패턴의 패턴면 상의 좌표에 해당하는 제1 좌표를 상기 마커부의 상기 제1 렌즈에 대한 3차원적 좌표에 해당하는 제2 좌표로 변환하는 제1 변환행렬, 상기 제2 좌표의 상기 제2 렌즈에 대한 3차원적 좌표에 해당하는 제3 좌표를 상기 제1 결상부의 상기 패턴의 제1 이미지 상의 제1 픽셀좌표에 해당하는 제4 좌표로 변환하는 제2 변환행렬, 상기 패턴의 패턴면 상의 좌표에 해당하는 제5 좌표를 상기 마커부의 상기 제1 렌즈에 대한 3차원적 좌표에 해당하는 제6 좌표로 변환하는 상기 제1 변환행렬과 동일한 제3 변환행렬, 및 상기 제6 좌표의 상기 제3 렌즈에 대한 3차원적 좌표에 해당하는 제7 좌표를 상기 제2 결상부의 상기 패턴의 제2 이미지 상의 제2 픽셀좌표에 해당하는 제8 좌표로 변환하는 제4 변환행렬을 획득하고,상기 제1 좌표변환식은 상기 제1 변환행렬 및 상기 제2 변환행렬을 포함하여 상기 제1 좌표를 상기 제4 좌표로 변환하도록 정의되고, 상기 제2 좌표변환식은 상기 제3 변환행렬 및 상기 제4 변환행렬을 포함하여 상기 제5 좌표를 상기 제8 좌표로 변환하도록 정의되며,상기 처리부는 상기 제1 및 제2 좌표변환식들로부터 상기 제1 결상부에 대한 상기 마커부의 자세를 정의하는 제1 자세정의행렬을 획득하는 것을 특징으로 하는 옵티컬 트래킹 시스템.
- 제2항에 있어서,상기 제1 좌표변환식은 하기 수학식에 의하여 정의되고,((lu,lv)는 상기 제1 좌표, (lu',lv')는 상기 제4 좌표, [C]는 상기 제1 변환행렬, [Al]은 상기 제2 변환행렬, [RL]은 상기 제1 자세정의행렬, s는 비례상수)상기 제2 좌표변환식은 하기 수학식에 의하여 정의되는 것을 특징으로 하는 옵티컬 트래킹 시스템.((ru,rv)는 상기 제5 좌표, (ru',rv')는 상기 제8 좌표, [C]는 상기 제1 변환행렬과 동일한 상기 제3 변환행렬, [Ar]은 상기 제4 변환행렬, [RR]은 상기 제2 결상부에 대한 상기 마커부의 자세를 정의하는 제2 자세정의행렬, [RLR]은 상기 제2 결상부에 대한 상기 제1 결상부의 자세를 정의하는 제3 자세정의행렬, s는 비례상수)
- 제3항에 있어서, 상기 제1 변환행렬 및 상기 제3 변환행렬은 하기 수학식에 의하여 정의되고,((uc,vc)는 상기 패턴의 중심의 좌표, fb는 상기 제1 초점거리)상기 제2 및 제4 변환행렬은 하기 수학식에 의하여 정의되는 것을 특징으로 하는 옵티컬 트래킹 시스템.((u'c,v'c)는 상기 패턴의 중심에 대응하는 상기 패턴의 이미지 상의 픽셀좌표, fc는 상기 제2 변환행렬의 경우 상기 제2 초점거리이고 상기 제4 변환행렬의 경우 상기 제3 초점거리, pw는 상기 제2 변환행렬의 경우 상기 패턴의 제1 이미지의 픽셀의 폭이고 상기 제4 변환행렬의 경우 상기 패턴의 제2 이미지의 픽셀의 폭, ph는 상기 제2 변환행렬의 경우 상기 패턴의 제1 이미지의 픽셀의 높이이고 상기 제4 변환행렬의 경우 상기 패턴의 제2 이미지의 픽셀의 높이)
- 제4항에 있어서, 상기 처리부는,적어도 3개 이상의 촬영 이미지로부터 uc, vc 및 fb의 캘리브레이션 값을 획득함으로써 상기 제1 변환행렬 및 상기 제3 변환행렬을 획득하고,상기 획득된 데이터를 이용하여 fc, pw, ph의 캘리브레이션 값을 획득함으로써 상기 제2 변환행렬 및 상기 제4 변환행렬을 획득하는 것을 특징으로 하는 옵티컬 트래킹 시스템.
- 제3항에 있어서, 상기 처리부는,상기 제1 좌표와 상기 제4 좌표에 대한 복수의 데이터 및 상기 제5 좌표와 상기 제8 좌표에 대한 복수의 데이터를 획득하고, 상기 획득된 복수의 데이터가 적용된 하기 수학식에 의하여 상기 제1 자세정의행렬을 획득하는 것을 특징으로 하는 옵티컬 트래킹 시스템.((lu1,lv1), …, (lun,lvn)은 상기 제1 좌표의 데이터, (lu'1,lv'1), …, (lu',lv')은 상기 제4 좌표의 데이터, (lu'c,lv'c)는 상기 패턴의 중심에 대응하는 상기 패턴의 제1 이미지 상의 픽셀좌표, ((ru1,rv1), …, (run,rvn)은 상기 제5 좌표의 데이터, (ru'1,rv'1), …, (ru'n,rv'n)은 상기 제8 좌표의 데이터, (ru'c,rv'c)는 상기 패턴의 중심에 대응하는 상기 패턴의 제2 이미지 상의 픽셀좌표)
- 제3항에 있어서, 상기 처리부는,상기 제2 좌표와 상기 제4 좌표에 관한 제3 좌표변환식 및 상기 제6 좌표와 상기 제8 좌표에 관한 제4 좌표변환식으로부터 상기 마커부의 위치를 결정하고, 결정된 상기 마커부의 위치를 이용하여 상기 마커부를 트래킹하는 것을 특징으로 하는 옵티컬 트래킹 시스템.
- 제7항에 있어서,상기 제3 좌표변환식은 하기 수학식에 의하여 정의되고,((u'1,v'1)은 상기 제4 좌표, (X,Y,Z)는 상기 제2 좌표, [AL]은 상기 제2 변환행렬, [I]는 3x3형태의 항등행렬(identity matrix), [0]은 3x1 형태의 영행렬, s는 비례상수)상기 제4 좌표변환식은 하기 수학식에 의하여 정의되는 것을 특징으로 하는 옵티컬 트래킹 시스템.((u'2,v'2)은 상기 제8 좌표, (X,Y,Z)는 상기 제6 좌표, [AR]은 상기 제4 변환행렬, [RLR]은 3x3형태의 상기 제3 자세정의행렬, [T]는 3x1 형태의 위치변환행렬, s는 비례상수)
- 제8항에 있어서, 상기 처리부는,상기 제1 및 제2 결상유닛에서 각각 촬영된 상기 패턴의 시야범위의 중심인 제1 중심좌표 및 제2 중심좌표를 획득하고,상기 획득된 중심좌표들을 이용하여 상기 제1 결상부 및 상기 제2 결상부 사이의 위치변환행렬을 캘리브레이션하며,상기 캘리브레이션된 위치변환행렬을 이용하여 상기 마커부의 위치를 획득하는 것을 특징으로 하는 옵티컬 트래킹 시스템.
- 제9항에 있어서, 상기 처리부는,상기 마커부를 적어도 2개 이상의 위치에서 측정하여 환산계수를 획득하고,상기 획득된 환산계수를 상기 획득된 중심좌표들과 함께 이용하여 상기 제1 결상부 및 상기 제2 결상부 사이의 상기 위치변환행렬을 캘리브레이션하는 것을 특징으로 하는 옵티컬 트래킹 시스템.
- 특정정보를 갖는 패턴(pattern) 및 상기 패턴으로부터 이격되어 배치되며 제1 초점거리를 갖는 제1 렌즈를 포함하는 마커(marker)부, 제2 초점거리를 갖는 제2 렌즈 및 상기 제2 렌즈로부터 이격되어 배치되며 상기 제1 렌즈와 상기 제2 렌즈에 의하여 상기 패턴의 제1 이미지가 결상되는 제1 결상유닛을 포함하는 제1 결상부, 및 제3 초점거리를 갖는 제3 렌즈 및 상기 제3 렌즈로부터 이격되어 배치되며 상기 제1 렌즈와 상기 제3 렌즈에 의하여 상기 패턴의 제2 이미지가 결상되는 제2 결상유닛을 포함하여, 상기 마커부를 트래킹하도록 상기 마커부의 자세를 산출하기 위한 옵티컬 트래킹 시스템의 마커부 자세 및 위치 산출방법에 있어서,상기 패턴의 패턴면 상의 좌표에 해당하는 제1 좌표를 상기 마커부의 상기 제1 렌즈에 대한 3차원적 좌표에 해당하는 제2 좌표로 변환하는 제1 변환행렬, 상기 제2 좌표의 상기 제2 렌즈에 대한 3차원적 좌표에 해당하는 제3 좌표를 상기 제1 결상부의 상기 패턴의 제1 이미지 상의 제1 픽셀좌표에 해당하는 제4 좌표로 변환하는 제2 변환행렬, 상기 패턴의 상기 패턴면 상의 좌표에 해당하는 제5 좌표를 상기 마커부의 상기 제1 렌즈에 대한 3차원적 좌표에 해당하는 제6 좌표로 변환하는 상기 제1 변환행렬과 동일한 제3 변환행렬, 및 상기 제6 좌표의 상기 제3 렌즈에 대한 3차원적 좌표에 해당하는 제7 좌표를 상기 제2 결상부의 상기 패턴의 제2 이미지 상의 제2 픽셀좌표에 해당하는 제8 좌표로 변환하는 제4 변환행렬을 획득하는 단계; 및상기 제1 변환행렬 및 상기 제2 변환행렬을 포함하며, 상기 제1 좌표를 상기 제4 좌표로 변환하는 제1 좌표변환식 및 상기 제3 변환행렬 및 상기 제4 변환행렬을 포함하며, 상기 제5 좌표를 상기 제8 좌표로 변환하는 제2 좌표변환식으로부터 상기 마커부의 자세를 정의하는 자세정의행렬을 획득하는 단계를 포함하는 옵티컬 트래킹 시스템의 마커부 자세 및 위치 산출방법.
- 제11항에 있어서,상기 제1 및 제2 결상유닛에서 각각 촬영된 상기 패턴의 시야범위의 중심인 제1 중심좌표 및 제2 중심좌표를 획득하는 단계;상기 획득된 중심좌표들을 이용하여 상기 제1 결상부 및 상기 제2 결상부 사이의 위치변환행렬을 캘리브레이션하는 단계; 및상기 캘리브레이션된 위치변환행렬을 이용하여 상기 마커부의 위치를 획득하는 단계를 더 포함하는 것을 특징으로 하는 옵티컬 트래킹 시스템의 마커부 자세 및 위치 산출방법.
- 제12항에 있어서,상기 위치변환행렬을 캘리브레이션하는 단계 이전에,상기 마커부를 적어도 2개 이상의 위치에서 측정하여 환산계수를 획득하는 단계를 더 포함하고,위치변환행렬을 캘리브레이션하는 단계에서, 상기 획득된 환산계수를 상기 획득된 중심좌표들과 함께 이용하여 상기 제1 결상부 및 상기 제2 결상부 사이의 상기 위치변환행렬을 캘리브레이션하는 것을 특징으로 하는 옵티컬 트래킹 시스템의 마커부 자세 및 위치 산출방법.
Priority Applications (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US15/314,672 US10109066B2 (en) | 2014-05-29 | 2015-05-29 | Optical tracking system, and method for calculating posture and location of marker part in optical tracking system |
JP2016569681A JP6357251B2 (ja) | 2014-05-29 | 2015-05-29 | オプティカルトラッキングシステム及びオプティカルトラッキングシステムのマーカー部の姿勢並びに位置算出方法 |
CN201580027892.7A CN106415663B (zh) | 2014-05-29 | 2015-05-29 | 光学跟踪系统及光学跟踪系统的标记部姿势及位置算出方法 |
EP19182768.2A EP3576051B1 (en) | 2014-05-29 | 2015-05-29 | Optical tracking system, and method for calculating posture and location of marker part in optical tracking system |
CN202011125744.8A CN113240732B (zh) | 2014-05-29 | 2015-05-29 | 光学跟踪系统及光学跟踪系统的标记部姿势及位置算出方法 |
EP15800560.3A EP3151196B1 (en) | 2014-05-29 | 2015-05-29 | Optical tracking system, and method for calculating posture and location of marker part in optical tracking system |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR10-2014-0065178 | 2014-05-29 | ||
KR1020140065178A KR101613418B1 (ko) | 2014-05-29 | 2014-05-29 | 옵티컬 트래킹 시스템 및 옵티컬 트래킹 시스템의 마커부 자세 및 위치 산출방법 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2015183050A1 true WO2015183050A1 (ko) | 2015-12-03 |
Family
ID=54699308
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/KR2015/005444 WO2015183050A1 (ko) | 2014-05-29 | 2015-05-29 | 옵티컬 트래킹 시스템 및 옵티컬 트래킹 시스템의 마커부 자세 및 위치 산출방법 |
Country Status (6)
Country | Link |
---|---|
US (1) | US10109066B2 (ko) |
EP (2) | EP3576051B1 (ko) |
JP (1) | JP6357251B2 (ko) |
KR (1) | KR101613418B1 (ko) |
CN (2) | CN106415663B (ko) |
WO (1) | WO2015183050A1 (ko) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2018025531A (ja) * | 2016-08-09 | 2018-02-15 | コー・ヤング・テクノロジー・インコーポレーテッド | オプティカルトラッキング用のマーカー、オプティカルトラッキングシステム及びオプティカルトラッキング方法 |
US11033337B2 (en) * | 2017-12-20 | 2021-06-15 | Koh Young Technology Inc. | Optical tracking system and optical tracking method |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107194968B (zh) * | 2017-05-18 | 2024-01-16 | 腾讯科技(上海)有限公司 | 图像的识别跟踪方法、装置、智能终端和可读存储介质 |
KR102166372B1 (ko) * | 2017-12-20 | 2020-10-15 | 주식회사 고영테크놀러지 | 옵티컬 트래킹 시스템 및 옵티컬 트래킹 방법 |
US11366233B2 (en) | 2020-04-14 | 2022-06-21 | Plusai, Inc. | System and method for GPS based automatic initiation of sensor calibration |
US11635313B2 (en) * | 2020-04-14 | 2023-04-25 | Plusai, Inc. | System and method for simultaneously multiple sensor calibration and transformation matrix computation |
US11673567B2 (en) | 2020-04-14 | 2023-06-13 | Plusai, Inc. | Integrated fiducial marker for simultaneously calibrating sensors of different types |
CN114486292B (zh) * | 2022-04-18 | 2022-07-12 | 中国汽车技术研究中心有限公司 | 碰撞测试中假人运动响应的测量方法、设备和存储介质 |
CN115631362B (zh) * | 2022-09-26 | 2024-07-05 | 北京霍里思特科技有限公司 | 一种铁器的识别方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20070122271A (ko) * | 2006-06-26 | 2007-12-31 | 한국산업기술대학교산학협력단 | 로봇 자세 제어 시스템 및 로봇 자세 제어 방법 |
US20080125896A1 (en) * | 2006-07-24 | 2008-05-29 | The Boeing Company | Closed-Loop Feedback Control Using Motion Capture Systems |
US20110017826A1 (en) * | 2009-07-23 | 2011-01-27 | Massachusetts Institute Of Technology | Methods and apparatus for bokeh codes |
JP2012069126A (ja) * | 2011-10-13 | 2012-04-05 | Nintendo Co Ltd | 画像処理プログラム、画像処理装置、画像処理システム、および、画像処理方法 |
KR101262181B1 (ko) * | 2010-05-03 | 2013-05-14 | 한국과학기술원 | 수족관 내의 로봇 물고기 위치 탐지 방법 및 장치 |
Family Cites Families (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3144400B2 (ja) | 1998-11-13 | 2001-03-12 | 日本電気株式会社 | ジェスチャ認識装置及び方法 |
KR100374346B1 (ko) * | 2000-12-06 | 2003-03-04 | 한국과학기술원 | 영상을 이용한 머리의 위치 및 방향을 추적하는 방법 |
EP1349114A3 (en) * | 2002-03-19 | 2011-06-15 | Canon Kabushiki Kaisha | Sensor calibration apparatus, sensor calibration method, program, storage medium, information processing method, and information processing apparatus |
US7632004B2 (en) * | 2004-07-06 | 2009-12-15 | Tseng-Lu Chien | LED night light with more than 1 optics means |
CN101308012B (zh) * | 2008-05-29 | 2010-06-23 | 上海交通大学 | 双单目白光三维测量系统标定方法 |
US7671318B1 (en) * | 2008-11-14 | 2010-03-02 | Lockheed Martin Corporation | Sensor apparatus and method for low-frequency scene suppression and fixed pattern noise suppression |
CN101766476B (zh) * | 2009-07-08 | 2011-05-11 | 中国科学院自动化研究所 | 自发荧光分子影像系统 |
DE102009049849B4 (de) * | 2009-10-19 | 2020-09-24 | Apple Inc. | Verfahren zur Bestimmung der Pose einer Kamera, Verfahren zur Erkennung eines Objekts einer realen Umgebung und Verfahren zur Erstellung eines Datenmodells |
US8848977B2 (en) * | 2010-01-04 | 2014-09-30 | The Board Of Trustees Of The Leland Stanford Junior University | Method for optical pose detection |
US9832441B2 (en) * | 2010-07-13 | 2017-11-28 | Sony Interactive Entertainment Inc. | Supplemental content on a mobile device |
JP4869430B1 (ja) | 2010-09-24 | 2012-02-08 | 任天堂株式会社 | 画像処理プログラム、画像処理装置、画像処理システム、および、画像処理方法 |
US8441626B2 (en) * | 2010-12-17 | 2013-05-14 | Teledyne Scientific & Imaging, Llc | Optical angle-of-arrival measurement system and method for multiple light sources |
WO2012083982A1 (en) * | 2010-12-21 | 2012-06-28 | Metaio Gmbh | Method for determining a parameter set designed for determining the pose of a camera and/or for determining a three-dimensional structure of the at least one real object |
WO2012092058A2 (en) * | 2010-12-29 | 2012-07-05 | Orthodyne Electroncis Corporation | Methods and systems for aligning tooling elements of ultrasonic bonding systems |
US9235894B2 (en) * | 2011-01-27 | 2016-01-12 | Metaio Gmbh | Method for determining correspondences between a first and a second image, and method for determining the pose of a camera |
CN102890785A (zh) * | 2011-07-19 | 2013-01-23 | 上海上大海润信息系统有限公司 | 一种服务机器人目标识别与定位的方法 |
US20130063558A1 (en) * | 2011-09-14 | 2013-03-14 | Motion Analysis Corporation | Systems and Methods for Incorporating Two Dimensional Images Captured by a Moving Studio Camera with Actively Controlled Optics into a Virtual Three Dimensional Coordinate System |
CN103236054B (zh) * | 2013-04-10 | 2015-07-15 | 博奥生物集团有限公司 | 一种拍照装置的定位方法及定位系统 |
CN103315739B (zh) * | 2013-05-22 | 2015-08-19 | 华东师范大学 | 基于动态跟踪技术免除运动伪影的磁共振影像方法和系统 |
US9478030B1 (en) * | 2014-03-19 | 2016-10-25 | Amazon Technologies, Inc. | Automatic visual fact extraction |
-
2014
- 2014-05-29 KR KR1020140065178A patent/KR101613418B1/ko active IP Right Grant
-
2015
- 2015-05-29 EP EP19182768.2A patent/EP3576051B1/en active Active
- 2015-05-29 US US15/314,672 patent/US10109066B2/en active Active
- 2015-05-29 CN CN201580027892.7A patent/CN106415663B/zh active Active
- 2015-05-29 WO PCT/KR2015/005444 patent/WO2015183050A1/ko active Application Filing
- 2015-05-29 EP EP15800560.3A patent/EP3151196B1/en active Active
- 2015-05-29 CN CN202011125744.8A patent/CN113240732B/zh active Active
- 2015-05-29 JP JP2016569681A patent/JP6357251B2/ja active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20070122271A (ko) * | 2006-06-26 | 2007-12-31 | 한국산업기술대학교산학협력단 | 로봇 자세 제어 시스템 및 로봇 자세 제어 방법 |
US20080125896A1 (en) * | 2006-07-24 | 2008-05-29 | The Boeing Company | Closed-Loop Feedback Control Using Motion Capture Systems |
US20110017826A1 (en) * | 2009-07-23 | 2011-01-27 | Massachusetts Institute Of Technology | Methods and apparatus for bokeh codes |
KR101262181B1 (ko) * | 2010-05-03 | 2013-05-14 | 한국과학기술원 | 수족관 내의 로봇 물고기 위치 탐지 방법 및 장치 |
JP2012069126A (ja) * | 2011-10-13 | 2012-04-05 | Nintendo Co Ltd | 画像処理プログラム、画像処理装置、画像処理システム、および、画像処理方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2018025531A (ja) * | 2016-08-09 | 2018-02-15 | コー・ヤング・テクノロジー・インコーポレーテッド | オプティカルトラッキング用のマーカー、オプティカルトラッキングシステム及びオプティカルトラッキング方法 |
US10108833B2 (en) | 2016-08-09 | 2018-10-23 | Koh Young Technology Inc. | Marker for optical tracking, optical tracking system, and optical tracking method |
US11033337B2 (en) * | 2017-12-20 | 2021-06-15 | Koh Young Technology Inc. | Optical tracking system and optical tracking method |
Also Published As
Publication number | Publication date |
---|---|
CN106415663B (zh) | 2020-11-10 |
EP3151196B1 (en) | 2019-08-14 |
EP3151196A1 (en) | 2017-04-05 |
US10109066B2 (en) | 2018-10-23 |
US20170200278A1 (en) | 2017-07-13 |
KR101613418B1 (ko) | 2016-04-21 |
JP2017525937A (ja) | 2017-09-07 |
EP3576051B1 (en) | 2021-03-24 |
EP3576051A1 (en) | 2019-12-04 |
EP3151196A4 (en) | 2017-11-22 |
JP6357251B2 (ja) | 2018-07-11 |
CN106415663A (zh) | 2017-02-15 |
CN113240732A (zh) | 2021-08-10 |
KR20150138501A (ko) | 2015-12-10 |
CN113240732B (zh) | 2024-04-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2015183050A1 (ko) | 옵티컬 트래킹 시스템 및 옵티컬 트래킹 시스템의 마커부 자세 및 위치 산출방법 | |
WO2017191927A1 (en) | Dual camera module and method for controlling the same | |
WO2020145718A1 (ko) | 디스플레이용 기판 | |
EP3427471A1 (en) | Apparatus and method for controlling auto focus of camera module | |
WO2020060235A1 (ko) | 카메라 장치 | |
WO2020213862A1 (ko) | 카메라 모듈 및 광학 기기 | |
WO2014178610A1 (ko) | 옵티컬 트랙킹 시스템 및 이를 이용한 트랙킹 방법 | |
WO2020050532A1 (ko) | 광 스캐닝 홀로그래피 시스템 | |
WO2019112396A1 (ko) | 휴대폰 케이스 | |
WO2023018076A1 (ko) | 렌즈 구동장치 및 이를 포함하는 카메라 장치 | |
WO2018182310A1 (ko) | 비디오 부호화 방법 및 장치, 비디오 복호화 방법 및 장치 | |
WO2022035192A1 (ko) | 카메라 엑추에이터 및 이를 포함하는 카메라 장치 | |
WO2023239159A1 (ko) | 광학계 및 이를 포함하는 카메라 모듈 | |
WO2020059977A1 (ko) | 연속적으로 스티어링 가능한 2차 디퍼런셜 마이크로폰 어레이 및 그것을 구성하는 방법 | |
WO2023132413A1 (ko) | 제조 시의 위치 정밀도와 부착 시 편의성이 향상된 3d 보호필름의 제조 시스템 및 보호필름 부착방법 | |
WO2022235109A1 (ko) | 카메라 엑추에이터 및 이를 포함하는 카메라 장치 | |
WO2018143653A1 (ko) | 터치 입력 및 지문 입력을 인식하는 장치 및 방법 | |
WO2023214748A1 (ko) | 이미지에서의 측색 방법, 장치, 및 컴퓨터-판독가능 매체 | |
WO2022173223A1 (ko) | 광학계 및 이를 포함하는 카메라 모듈 | |
WO2018164538A1 (ko) | 스캐너 | |
WO2021020603A1 (ko) | 복합 패턴을 이용한 초고속 편향 측정법을 이용한 자유곡면의 3차원 형상측정시스템 및 측정방법 | |
WO2022255780A1 (ko) | 광학계 | |
WO2023101276A1 (ko) | 영상 처리 장치 및 그 동작 방법 | |
WO2023113446A1 (ko) | 광학계 및 이를 포함하는 카메라 모듈 | |
WO2022108338A1 (ko) | 이미지 복원 신호의 위상 보정 방법 및 시스템 |
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: 15800560 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2016569681 Country of ref document: JP Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
WWE | Wipo information: entry into national phase |
Ref document number: 15314672 Country of ref document: US |
|
REEP | Request for entry into the european phase |
Ref document number: 2015800560 Country of ref document: EP |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2015800560 Country of ref document: EP |