Method of tracking and sensing position of objects
First Claim
1. A method for determining the position of a moveable object, including the steps of:
- a) initiating the method when said object is at an initial known location in three-dimensions;
b) obtaining data indicative of the three-dimensional location relative to said object of one or more fixed reference features by way of one or more sensors associated with said object to determine the displacement of said object from said reference feature(s);
c) moving said object to a new object location;
d) at the new object location, obtaining new data indicative of the new location of said fixed reference feature or features relative to said object via said sensor(s);
e) determining from said new data, the displacement of said object relative to said fixed feature or features;
f) determining from said displacement of said objection and knowledge of said initial known location, the new three-dimensional location of said object;
g) if the object is moving out of view of said fixed reference feature(s), and/or when a new fixed reference feature or features come into view, obtaining data via said sensor(s) indicative of the three-dimensional location of said new fixed feature or features which may be used as new reference locations relative to said object; and
h) repeating steps (c) to (g) as required until predetermined conditions are fulfilled.
2 Assignments
0 Petitions
Accused Products
Abstract
A spatial position and orientation sensor based on a three-dimensional imaging system provides information describing the actual three-dimensional spatial position relative to the sensor of objects in the field of view of the sensor. The sensor thus directly determines its location relative to its surroundings. Movement of the sensor, and thus movement of an object carrying the sensor, relative to the surroundings is detected by comparing repeated determinations of the location in three dimensions of fixed features in the surroundings relative to the sensor. An algorithm is used to calculate changes in the position of features in the field of view of the sensor relative to the sensor. Knowledge of changes in position relative to fixed features is used to determine movement in three dimensions of the sensor or an object carrying the sensor relative to the fixed features in the surroundings. The features in the surroundings may be natural or artificial. The true extent of the movement of the sensor in three dimensions is directly determined from the change in position and orientation of the sensor relative to the fixed features in the surroundings. The extent of the movement is used to determine the new position and orientation of the sensor relative to a previous position. When starting from a predetermined location the actual position and orientation of the sensor may be reliably tracked over a period of time by accumulating the measured movements over that time.
-
Citations
6 Claims
-
1. A method for determining the position of a moveable object, including the steps of:
-
a) initiating the method when said object is at an initial known location in three-dimensions;
b) obtaining data indicative of the three-dimensional location relative to said object of one or more fixed reference features by way of one or more sensors associated with said object to determine the displacement of said object from said reference feature(s);
c) moving said object to a new object location;
d) at the new object location, obtaining new data indicative of the new location of said fixed reference feature or features relative to said object via said sensor(s);
e) determining from said new data, the displacement of said object relative to said fixed feature or features;
f) determining from said displacement of said objection and knowledge of said initial known location, the new three-dimensional location of said object;
g) if the object is moving out of view of said fixed reference feature(s), and/or when a new fixed reference feature or features come into view, obtaining data via said sensor(s) indicative of the three-dimensional location of said new fixed feature or features which may be used as new reference locations relative to said object; and
h) repeating steps (c) to (g) as required until predetermined conditions are fulfilled. - View Dependent Claims (2, 3, 4)
-
-
1-1. A method for determining the position of a moveable object, including the steps of:
-
a) initiating the method when said object is at an initial known location in three-dimensions;
b) obtaining data indicative of the three-dimensional location relative to said object of one or more fixed reference features by way of one or more sensors associated with said object to determine the displacement of said object from said reference feature(s);
c) moving said object to a new object location;
d) at the new object location, obtaining new data indicative of the new location of said fixed reference feature or features relative to said object via said sensor(s);
e) determining from said new data, the displacement of said object relative to said fixed feature or features;
f) determining from said displacement of said object and knowledge of said initial known location, the new three-dimensional location of said object;
g) if the object is moving out of view of said fixed reference feature(s), and/or when a new fixed reference feature or features come into view, obtaining data via said sensor(s) indicative of the three-dimensional location of said new fixed feature or features which may be used as new reference locations relative to said object; and
h) repeating steps (c) to (g) as required until predetermined conditions are fulfilled.
-
-
2-2. A method according to claim 1 including, between the steps of (f) and (g), obtaining additional data indicative of the three-dimensional location of the fixed feature(s), or of extensions of said fixed feature(s) if the new data obtained in step (d) is no longer suitable for use as reference data.
-
3-3. A method according to any one of claims 1 or 2 wherein said data indicative of three-dimensional location of said one or more reference features includes optical reflectance data.
-
4-4. A method according to claim 3 wherein said fixed feature or features form part of a natural feature and/or an artificial feature defining a three-dimensional object.
-
5. A vehicle including;
-
drive means for propelling the vehicle along a path;
one or more sensors mounted at a known orientation and position on said vehicle, said one or more sensors providing three-dimensional data representative of at least a selected volume about said vehicle;
processing means for receiving said data from said sensor and processing said data to determine at least one of;
the location of one or more fixed reference points;
the position of said vehicle relative to said one or more fixed reference points; and
the location of said vehicle having knowledge of a previously known or determined location in three-dimensions. - View Dependent Claims (6)
-
-
5-5. A vehicle including;
-
drive means for propelling the vehicle along a path;
one or more sensors mounted at a known orientation and position on said vehicle, said one or more sensors providing three-dimensional data representative of at least a selected volume about said vehicle;
processing means for processing data received from said one or more sensors to determine;
the location of one or more stationary points which are used as local temporary reference points, said determination of location not requiring any a priori knowledge relating to the location of the said one or more stationary points;
the displacement of said vehicle relative to said one or more stationary points;
the location of said vehicle, having knowledge of a previously known or determined vehicle location in three-dimensions and the determined displacement of said vehicle, where said previously determined vehicle location is calculated from a knowledge of a location previous to that, and from a determination of the displacement of said vehicle relative to a previous one or more stationary point.
-
-
6-6. A vehicle according to claim 5 wherein said processing means also generates control signals for said drive means.
Specification