Determination of the position and orientation of at least one object in space

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.

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.

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.

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.

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.

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.