Determination of the position and orientation of at least one object in space
First Claim
1. A system for determining the position and orientation of at least two objects, at least one of which is moveable, in a three dimensional space defined by a coordinate system, which system comprises:
- a plurality of sensors disposed in spaced apart, non-linear, relationship with respect to each other and in known relation to said coordinate system;
a first plurality of illuminatable points disposed in known spaced apart relationship with respect to each other and in known relationship to one of said at least two objects disposed within said coordinate system, wherein at least three of said illuminatable points are non-linear with respect to each other;
a second plurality of illuminatable points disposed in known spaced apart relationship with respect to each other and in known relationship to another of said at least two objects disposed within said coordinate system;
means to illuminate said first and second pluralities of illuminatable points, such that said illuminated points are distinguishable from each other, wherein the first and second pluralities of illuminatable points are sufficient to define the position and orientation of the said at least two objects, wherein radiation between said first and second pluralities of illuminatable points and at least one of said sensors defines a plurality of straight lines;
means to detect a plurality of angles intercepted between said straight lines and at least one reference line; and
means to convert at least some of said detected angles into determined locations of said first and second pluralities of illuminatable points, wherein said detected angles and the determined locations of said first and second pluralities of illuminatable points are sufficient to define a position and orientation of said objects at the time that said angles were formed.
1 Assignment
0 Petitions
Accused Products
Abstract
System for sensing at least two points on an object for determining the position and orientation of the object relative to another object. Two light emitters mounted in spaced relation to each other on an external portion of an invasive probe remaining outside an object into which an invasive tip is inserted are sequentially strobed to emit light. Three light sensors or detectors, the positions of which are known with respect to a predetermined coordinate system, detect the positions of the two light emitters positioned on the probe. A computer connected to the probe and to the light sensors receives data from the sensors and determines the position and orientation of the probe relative to the predetermined coordinate system. The computer then determines the position and orientation of the invasive portion of the probe inside the object by correlating the position of the invasive portion of the probe relative to the predetermined coordinate system with the position of a model of the object defined in relation to the predetermined coordinate system. A display device connected to the computer indicates the location of the invasive portion of the probe in the object by displaying a representation of the location of the invasive portion of the probe with respect to the model of the object.
-
Citations
21 Claims
-
1. A system for determining the position and orientation of at least two objects, at least one of which is moveable, in a three dimensional space defined by a coordinate system, which system comprises:
-
a plurality of sensors disposed in spaced apart, non-linear, relationship with respect to each other and in known relation to said coordinate system;
a first plurality of illuminatable points disposed in known spaced apart relationship with respect to each other and in known relationship to one of said at least two objects disposed within said coordinate system, wherein at least three of said illuminatable points are non-linear with respect to each other;
a second plurality of illuminatable points disposed in known spaced apart relationship with respect to each other and in known relationship to another of said at least two objects disposed within said coordinate system;
means to illuminate said first and second pluralities of illuminatable points, such that said illuminated points are distinguishable from each other, wherein the first and second pluralities of illuminatable points are sufficient to define the position and orientation of the said at least two objects, wherein radiation between said first and second pluralities of illuminatable points and at least one of said sensors defines a plurality of straight lines;
means to detect a plurality of angles intercepted between said straight lines and at least one reference line; and
means to convert at least some of said detected angles into determined locations of said first and second pluralities of illuminatable points, wherein said detected angles and the determined locations of said first and second pluralities of illuminatable points are sufficient to define a position and orientation of said objects at the time that said angles were formed.
-
-
2. A method of determining the position and orientation of at least two objects in a three dimensional space defined by a coordinate system, which method comprises:
-
disposing a first object in a three dimensional volume defined by a three dimensional coordinate system;
disposing a second object in said three dimensional volume defined by said three dimensional coordinate system;
disposing a plurality of sensors in known relationship to said three dimensional coordinate system;
disposing a plurality of first and second illuminatable points in known relationship to each of said objects, respectively;
illuminating a plurality of said points related to at least two of said objects, respectively, whereby forming a plurality of substantially straight lines of radiation between a plurality of first illuminated points and at least one of said sensors and forming a plurality of substantially straight lines of radiation between a plurality of second illuminated points and at least one of said sensors;
measuring a sufficient number of a plurality of angles between at least some of said lines and at least one reference line, wherein the number of angles is sufficient to uniquely characterize the position and orientation of each of said first and second objects, respectively; and
converting said sufficient number of measured angles into a unique characteristic position and orientation of each of said two objects. - View Dependent Claims (3)
-
-
4. A system for determining the position and orientation of at least two movable objects in a three dimensional space defined by a coordinate system, which system comprises:
-
at least two sensors disposed in spaced apart relationship with respect to each other and in know relation to said coordinate system;
a first plurality of illuminatable points disposed in known spaced apart relationship with respect to each other and in known spatial relationship to a first of said moveable objects;
a second plurality of illuminatable points disposed in known spaced apart relationship with respect to each other and in known spatial relationship to a second of said moveable objects;
means to illuminate said first and second pluralities of illuminatable points, such that said first and second pluralities of illuminatable points are distinguishable from each other, wherein the first and second pluralities of illuminatable points are sufficient to define the position and orientation of said at least two moveable objects;
wherein radiation between said first and second pluralities of illuminatable points and said sensors in line of sight with respect to each other form substantially straight lines;
means to detect and measure angles intercepted between at least two of said substantially straight lines, involving each of said first and second pluralities of illuminatable points, and a corresponding reference line;
means to convert said detected angles into determined locations of said first and second pluralities of illuminatable points, wherein said detected angles and said determined locations of said first and second pluralities of illuminatable points are sufficient to define a position and orientation of said objects at the time that said angles were formed; and
means to convert the determined locations into the positions and orientations of said first and second objects at a time when said first and second pluralities of illuminatable lights are illuminated. - View Dependent Claims (5, 6)
-
-
7. A method of determining the position and orientation of at least two objects in a three dimensional space defined by a coordinate system, which method comprises:
-
disposing a first object in a three dimensional volume defined by a three dimensional coordinate system;
disposing a second object in said three dimensional volume defined by said three dimensional coordinate system;
disposing at least two sensors in known relationship to said three dimensional coordinate system;
disposing a plurality of first and second illuminatable points in known relationship to each of said two objects, respectively, wherein said plurality of illuminatable points are sufficient in number and location to be visible to at least two of said sensors regardless of the orientation of their respective objects;
illuminating a plurality of said points related to said objects, respectively, wherein radiation between said illuminatable points and said sensors respectively form a plurality of substantially straight lines of radiation;
whereby forming a plurality of angles between at least some of said lines and at least one reference line, wherein the number of angles is sufficient to uniquely characterize the position and orientation of each of said first and second objects, respectively;
measuring said sufficient number of angles;
converting said sufficient number of measured angles into a unique location of each of said illuminated points that are visible to said sensors; and
converting said locations of said illuminatable points into characteristic positions and orientations of each of said two objects at the time of illumination. - View Dependent Claims (8)
-
-
9. Apparatus for determining the position and orientation of a first object in relation to the position and orientation of a second object, where both of said objects are disposed within a three dimensional space defined by a coordinate system, comprising:
-
at least two sensors disposed in known spatial relationship to said coordinate system;
at least two objects disposed in said coordinate system;
a first plurality of illuminatable points disposed on said first object in known spatial relationship to each other and to said first object, wherein said first plurality of illuminatable points will be sufficient to define a position and an orientation of at least a portion of said first object;
a second plurality of illuminatable points disposed on said second object in known spatial relationship to each other and to said second object, wherein said second plurality of illuminatable points will be sufficient to define a position and an orientation of at least a portion of said second object;
means to illuminate said first and second pluralities of illuminatable points to define the position and orientation of at least a portion of said first and second objects, wherein illumination created by the first and second pluralities of illuminatable lights comprises electromagnetic radiation, whereby said illumination forms substantially straight lines of radiation between said first and second pluralities of illuminatable points and said sensors;
means to measure a plurality of angles between said substantially straight lines of radiation and said first and second pluralities of illuminatable points and said sensors and at least one reference line; and
means to convert said angles into locations of said first and second pluralities of illuminatable points disposed at locations, to define a position and orientation of at least a portion of each of said respective objects. - View Dependent Claims (10, 11, 12, 13, 14)
-
-
15. Apparatus comprising:
-
a frame, adapted to be attached to a moveable object so as to move in concert with said object such that the position and orientation of said frame is directly related to the position and orientation of said object wherein said object is disposed within a three dimensional space defined by a particular coordinate system;
at least three non-colinear reference points in known spatial relationship to said frame and in known spatial relationship to each other, wherein said reference points are sufficient to identify a position and an orientation of said frame, and the position and orientation of said frame is sufficient to identify a position and orientation of said object;
at least three emitters of electromagnetic energy that are disposed in known spatial relation to said reference points;
a plurality of receivers of electromagnetic energy wherein at least one of the receivers receives the electromagnetic energy emitted from said emitters, wherein said plurality of receivers are disposed in known spatial relationship to said coordinate system, wherein said emitted energy forms a substantially straight line with at least one of the receivers, and wherein said straight line forms an angle with a reference line;
means for measuring the angle to identify the locations of determined reference point locations; and
means for converting the locations of a sufficient number of said determined reference point locations into a position and orientation of said frame in said coordinate system, and means for converting said position and orientation of said frame to a position and orientation of said object. - View Dependent Claims (16, 17, 18)
wherein said at least one image is referenced to a further three dimensional coordinate system different from said particular three dimensional coordinate system; - and
means to transform at least one of said particular and further three dimensional coordinate systems to correspond to the other of said three dimensional coordinate systems thereby causing said position and orientation of said object to be defined in the same three dimensional coordinate system as said image.
-
-
17. Apparatus as claimed in claim 16 wherein said electromagnetic energy comprises light of an infra red wavelength.
-
18. Apparatus as claimed in claim 15 wherein at least one of said emitters comprises a reflector of electromagnetic radiation.
-
19. A method of determining the position and orientation of an object in a three dimensional volume defined by a three dimensional coordinate system comprising:
-
disposing a sufficient number of object related emitters or receivers of electromagnetic radiation on said object to define a position and orientation of said object, wherein said sufficient number of object related emitters or receivers, respectively, comprise at least three non-colinear elements;
disposing a sufficient number of volume related electromagnetic sensors or emitters, respectively, in respective line of sight with said object related emitters or sensors, and in known location(s) in relation to said three dimensional coordinate system, to obtain data sufficient to calculate a three dimensional location of each of said sufficient number of object related emitters or sensors, respectively;
causing electromagnetic radiation to be radiated from said emitters to one or more of said sensors, in a manner as to distinguish the radiation from each emitter from the radiation from all other emitters, wherein said radiation exists in substantially straight lines extending between said emitters, respectively, and one or more of said sensors;
determining an angle of at least some of said lines of radiation with respect to at least one reference line;
from a plurality of said angles relative to each object related emitter or sensor, determining the locations of said sufficient number of said object related emitters or one or more of said sensors; and
from said sufficient number of object related locations determining a position and orientation of said object at the time of said radiation. - View Dependent Claims (20, 21)
-
Specification