Methods and systems for improvement of measurement efficiency in surveying
First Claim
1. A method of estimating the position of a target point within a coordinate system using a structural member having pivot point placed at the target point and a moveable end having at least one degree of freedom, a satellite navigation system having an antenna mounted to the moveable end, and a tilt sensor, the coordinate system having three bases for defining the coordinates of the system and a plumb-position axis oriented within the coordinate system which is collinear with the direction of gravitational pull at the target point, the structural member having an orientation axis passing through the pivot point and a point on the antenna, the tilt sensor measuring an inclination angle (θ
- ) between the orientation axis and the plumb-position axis and providing measured inclination data representative thereof, the antenna having a phase center, the satellite navigation system measuring the position of the antenna'"'"'s phase center and providing measured coordinates therefor within the coordinate system, said method comprising;
(a) moving the moveable end of the structural member while keeping the pivot point of the structural member at the target point;
(b) determining a distance between the phase center of the antenna and the pivot point;
(c) obtaining, during the performance of step (a), one or more measured inclination values from the tilt sensor and one or more corresponding sets of measured antenna coordinates from the navigation system; and
(d) generating an estimate for at least one of the coordinates of the pivot point from the measured antenna coordinates, the measured inclination data, and the distance between the phase center of the antenna and the pivot point, the estimate for said at least one of the coordinates of the pivot point being an estimate for at least one of the coordinates of the target point.
1 Assignment
0 Petitions
Accused Products
Abstract
Methods and systems for measuring coordinates of a target, particularly under strong multipath conditions, are described. A satellite navigation system antenna and a tilt sensor are mounted on a range pole, with the sensor at the pole'"'"'s bottom tip. Signals from the antenna and tilt sensor are provided to a receiver, which computes the antenna'"'"'s coordinates from the antenna signals, and the pole tips position from the computed coordinates and the tilt data. The operator places the pole tip on the target and swings the pole by hand over an angle sector of 15 degrees while keeping the tip on the target. Height of the target can be computed with a single measurement set, and X-Y coordinates with just three measurement sets. The use of additional measurements reduces errors in the target'"'"'s coordinates since multipath errors are uncorrelated during movement of the antenna. Vertical alignment of the pole is unnecessary.
-
Citations
60 Claims
-
1. A method of estimating the position of a target point within a coordinate system using a structural member having pivot point placed at the target point and a moveable end having at least one degree of freedom, a satellite navigation system having an antenna mounted to the moveable end, and a tilt sensor, the coordinate system having three bases for defining the coordinates of the system and a plumb-position axis oriented within the coordinate system which is collinear with the direction of gravitational pull at the target point, the structural member having an orientation axis passing through the pivot point and a point on the antenna, the tilt sensor measuring an inclination angle (θ
- ) between the orientation axis and the plumb-position axis and providing measured inclination data representative thereof, the antenna having a phase center, the satellite navigation system measuring the position of the antenna'"'"'s phase center and providing measured coordinates therefor within the coordinate system, said method comprising;
(a) moving the moveable end of the structural member while keeping the pivot point of the structural member at the target point;
(b) determining a distance between the phase center of the antenna and the pivot point;
(c) obtaining, during the performance of step (a), one or more measured inclination values from the tilt sensor and one or more corresponding sets of measured antenna coordinates from the navigation system; and
(d) generating an estimate for at least one of the coordinates of the pivot point from the measured antenna coordinates, the measured inclination data, and the distance between the phase center of the antenna and the pivot point, the estimate for said at least one of the coordinates of the pivot point being an estimate for at least one of the coordinates of the target point. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15)
wherein step (c) obtains two or more measured inclination values from the tilt sensor and two or more corresponding sets of measured antenna coordinates;
wherein the third basis comprising a Z-axis which is parallel to the plumb-position axis; and
wherein step (d) comprises;
generating an estimate of the Z-axis coordinate of the pivot point from one or more measured inclination values and the one or more corresponding sets of measured antenna coordinates; and
generating estimates of the coordinates of the pivot point in the first and second bases from two or more measured inclination values and the two or more corresponding sets of measured antenna coordinates.
- ) between the orientation axis and the plumb-position axis and providing measured inclination data representative thereof, the antenna having a phase center, the satellite navigation system measuring the position of the antenna'"'"'s phase center and providing measured coordinates therefor within the coordinate system, said method comprising;
-
5. A method according to claim 1 further comprising measuring the temperature of the tilt sensor, and wherein the measure inclination data is corrected to account for temperature effects on the sensor.
-
6. A method according to claim 1 wherein the tilt sensor is mounted on the structural member at a location which is closer to the pivot point than the moveable end.
-
7. A method according to claim 6 wherein the tilt sensor is mounted at the bottom end of the range pole.
-
8. A method according to claim 1 wherein the moveable end of the structural member is moved such that the orientation axis of the structural member moves within a sector angle relative to the plumb position axis of at least 5 degrees.
-
9. A method according to claim 1 wherein the structural member is rotated about the orientation axis during the performance of step (a).
-
10. A method according to claim 1 wherein said measured antenna coordinates and measured inclination data are obtained at a frequency of at least 1 Hz.
-
11. A method according to claim 1 wherein said step (d) is performed with two or more iterative processing steps while new measured antenna coordinates and new measure inclination data are obtained in a real-time environment, and wherein one or more of the iterative processing steps operate on the new measured antenna coordinates new measured inclination values as they are obtained.
-
12. A method according to claim 1 wherein steps (a) and (c) are performed during a first duration of time with the obtained measured antenna coordinates and measured inclination data being stored in a computer readable medium, and wherein step (d) is performed during a subsequent time duration using the measured antenna coordinates and measured pole-inclination data stored in said computer readable medium.
-
13. A method according to claim 1 wherein step (c) obtains the measured antenna coordinates from a coordinates processor which determines the measured antenna coordinates relative to a base station with a baseline vector formed between the base station and the antenna'"'"'s phase center, and wherein the coordinates processor resolves the phase ambiguities of the satellites signals relative to the baseline vector.
-
14. A method according to claim 1 wherein the antenna receives a multipath satellite signal which causes a first error in the measured antenna coordinates and a second error in the estimate;
-
wherein step (c) obtains two or more measured inclination values from the tilt sensor and two or more corresponding sets of measured antenna coordinates from the navigation system; and
wherein step (d) generates the estimate from the measured antenna coordinates and measured inclination values such that the second error is less that the first error when the first error is obtained with the antenna positioned directly over the target point.
-
-
15. A method according to claim 1 wherein the antenna receives a multipath satellite signal which causes a first error in the measured antenna coordinates and a second error in the estimate;
-
wherein step (c) obtains three or more measured inclination values from the tilt sensor and three or more corresponding sets of measured antenna coordinates from the navigation system; and
wherein step (d) generates the estimate from the measured antenna coordinates and measured inclination data of the plurality of three or more different antenna positions such that the second error is less that the first error when the first error is obtained with the antenna positioned directly over the target point.
-
-
16. A method of estimating the position of a target point within a coordinate system using a structural member having pivot point placed at the target point and a moveable end having at least one degree of freedom, and using a satellite navigation system having an antenna mounted to the moveable end, the coordinate system having three bases for defining the coordinates of the system and a plumb-position axis oriented within the coordinate system which is collinear with the direction of gravitational pull at the target point, the structural member having an orientation vector with an origin at the pivot point, an end-point located at a point on the antenna, a length r, an inclination angle θ
- relative to the plumb-position axis, and an azimuth angle φ
about the plumb-position axis and in a plane which is perpendicular to the plumb-position axis and which intersects the pivot point, the radius r and angles θ and
φ
being parameters of the orientation vector and at least one of the parameters being adjusted by the structural member, the antenna having a phase center, the satellite navigation system measuring the position of the antenna'"'"'s phase center and providing measured coordinates therefor within the coordinate system as its output data, said method comprising the steps of;(a) moving the moveable end of the structural member while keeping the pivot point of the structural member at the target point;
(b) measuring, during the performance of step (a), two or more sets of parameters of the orientation vector and obtaining two or more corresponding sets of measured antenna coordinates from the navigation system, each measured set of parameters of the orientation vector having at least two of the parameters r, θ
, and φ
; and
(c) generating an estimate for at least one of the coordinates of the pivot point from the measured parameters of the orientation vector and the measured antenna coordinates, the estimate for said at least one of the coordinates of the pivot point being an estimate for at least one of the coordinates of the target point. - View Dependent Claims (17, 18, 19)
wherein the third basis comprising a Z-axis which is parallel to the plumb-position axis; and
wherein step (c) comprises;
generating an estimate of the Z-axis coordinate of the pivot point from one or more sets of measured parameters and the one or more corresponding sets of measured antenna coordinates; and
generating estimates of the coordinates of the pivot point in the first and second bases from two or more sets of measured parameters and the two or more corresponding sets of measured antenna coordinates.
- relative to the plumb-position axis, and an azimuth angle φ
-
18. A method according to claim 16 wherein the antenna receives a multipath satellite signal which causes a first error in the measured antenna coordinates and a second error in the estimate;
-
wherein step (b) measures two or more sets of parameters of the orientation vector and obtains two or more corresponding sets of measured antenna coordinates; and
wherein step (d) generates the estimate from the sets of measured parameters and antenna coordinates such that the second error is less that the first error when the first error is obtained with the antenna positioned directly over the target point.
-
-
19. A method according to claim 16 wherein the antenna receives a multipath satellite signal which causes a first error in the measured antenna coordinates and a second error in the estimate;
-
wherein step (b) measures three or more sets of parameters of the orientation vector and obtains three or more corresponding sets of measured antenna coordinates; and
wherein step (d) generates the estimate from the sets of measured parameters and antenna coordinates such that the second error is less that the first error when the first error is obtained with the antenna positioned directly over the target point.
-
-
20. A survey apparatus for use with a global positioning satellite system to measure the coordinates of a target point within a coordinate system, the coordinate system having three bases for defining the coordinates of the system and a plumb-position axis oriented within the coordinate system which is collinear with the direction of gravitational pull at the target point, the survey apparatus comprising:
-
a satellite navigation system receiver having an antenna and an output providing measured antenna coordinates representative of the position of a phase center of the antenna;
a structural member having a pivot point for placement at the target point, a moveable end for holding the antenna and having at least one degree of freedom, an orientation axis passing through the pivot point and a point on the antenna, and a distance between the pivot point and said point on the antenna as measured along the orientation axis;
a tilt sensor mounted to structural member and having an output that provides measured inclination data which is representative of the angle between the orientation axis and the plumb-position axis;
a data processor which receives the measured inclination data output by said tilt sensor and the measured antenna coordinates output by said satellite navigation system; and
a first program of instructions stored on a computer-readable medium which directs the data processor to generate an estimate for at least one of the coordinates of the pivot point from the distance, the measured antenna coordinates, and the measured inclination data. - View Dependent Claims (21, 22, 23, 24, 25, 26, 27, 28)
-
-
29. A survey apparatus for use with a global positioning satellite system to measure the coordinates of a target point within a coordinate system, the coordinate system having three bases for defining the coordinates of the system and a plumb-position axis oriented within the coordinate system which is collinear with the direction of gravitational pull at the target point, the survey apparatus comprising:
-
a satellite navigation system receiver having an antenna and providing a plurality of measured satellite pseudorange data and satellite carrier phase data;
a structural member having a pivot point for placement at the target point, a moveable end for holding the antenna and having at least one degree of freedom, and an orientation axis between the pivot point and a point on the antenna;
a tilt sensor mounted to structural member and having an output that provides measured inclination data which is representative of the angle between the orientation axis and the plumb-position axis;
a first data processor which receives the measured inclination data output by said tilt sensor and the measured pseudorange and carrier phase data from the satellite navigation system at a plurality of time moments; and
a first program of instructions stored on a first computer-readable medium which directs the first data processor to store the measured inclination data and the measured pseudorange and carrier phase data for a plurality of time moments in a second computer readable medium. - View Dependent Claims (30)
a second data processor which receives the generated set of antenna coordinates and the measured inclination data stored in said second computer readable medium; and
a second program of instructions stored on a computer readable medium which directs the second data processor to generate an estimate for at least one of the coordinates of the pivot point from the distance between the pivot point and the antenna, the measured antenna coordinates and the measured inclination data of a plurality of time moments.
-
-
31. A survey apparatus for use with a global positioning satellite system to measure the coordinates of a target point within a coordinate system, the coordinate system having three bases for defining the coordinates of the system and a plumb-position axis oriented within the coordinate system which is collinear with the direction of gravitational pull at the target point, the survey apparatus comprising:
-
a satellite navigation system receiver having an antenna, the antenna having a phase center, the satellite navigation system measuring the position of the antenna'"'"'s phase center and providing measured coordinates therefor within the coordinate system as its output data;
a structural member having a pivot point for placement at the target point, a moveable end configured to hold the antenna and having at least one degree of freedom, and an orientation vector with an origin at the pivot point, an end-point located at a point on the antenna, a length r, an inclination angle θ
relative to the plumb-position axis, and an azimuth angle φ
about the plumb-position axis and in a plane which is perpendicular to the plumb-position axis and which intersects the pivot point, the radius r and angles θ and
φ
being parameters of the orientation vector and at least one of the parameters being adjusted by the structural member;
a first sensor configured to measure one of the parameters of the orientation vector and provide measured values thereof, and an second sensor configured to measure another one of the parameters of the orientation vector and provide measured values thereof;
a first data processor which receives the measured parameters and the measured antenna coordinates; and
a first program of instructions stored on a computer-readable medium which directs the first data processor to generate an estimate for at least one of the coordinates of the pivot point from the measured parameters of the orientation vector and the measured antenna coordinates. - View Dependent Claims (32)
wherein the third basis comprising a Z-axis which is parallel to the plumb-position axis; and
wherein the first program of instructions directs the first data processor to generate an estimate of the Z-axis coordinate of the pivot point from one or more sets of measured parameters and the one or more corresponding sets of measured antenna coordinates, and directs the first data processor to generate estimates of the coordinates of the pivot point in the first and second bases from two or more sets of measured parameters and the two or more corresponding sets of measured antenna coordinates.
-
-
33. A survey apparatus for use with a global positioning satellite system to measure the coordinates of a target point within a coordinate system, the coordinate system having three bases for defining the coordinates of the system and a plumb-position axis oriented within the coordinate system which is collinear with the direction of gravitational pull at the target point, the survey apparatus comprising:
-
a satellite navigation system receiver having an antenna, the antenna having a phase center, the receiver providing a plurality of measured satellite pseudorange data and satellite carrier phase data;
a structural member having a pivot point for placement at the target point, a moveable end configured to hold the antenna and having at least one degree of freedom, and an orientation vector with an origin at the pivot point, an end-point located at a point on the antenna, a length r, an inclination angle θ
relative to the plumb-position axis, and an azimuth angle φ
about the plumb-position axis and in a plane which is perpendicular to the plumb-position axis and which intersects the pivot point, the radius r and angles θ and
φ
being parameters of the orientation vector and at least one of the parameters being adjusted by the structural member;
a first sensor configured to measure one of the parameters of the orientation vector and provide measured values thereof, and an second sensor configured to measure another one of the parameters of the orientation vector and provide measured values thereof;
a first data processor which receives the measured parameters and the measured pseudorange and carrier phase data from the satellite navigation system at a plurality of time moments; and
a first program of instructions stored on a computer-readable medium which directs the first data processor to store the measured parameters and the measured pseudorange and carrier phase data for a plurality of time moments in a second computer readable medium. - View Dependent Claims (34)
a second data processor which receives the generated set of antenna coordinates and the measured inclination data stored in said second computer readable medium; and
a second program of instructions stored on a computer readable medium which directs the second data processor to generate an estimate for at least one of the coordinates of the pivot point from parameters of the orientation vector and the measured antenna coordinates of a plurality of time moments.
-
-
35. A method of estimating the position of a target point within a coordinate system using a structural member having pivot point for contacting the target point and a moveable end having at least one degree of freedom, a satellite navigation system having an antenna mounted to the moveable end, and a tilt sensor, a plumb-position axis being present within the coordinate system which is collinear with the direction of gravitational pull at the target point, the coordinate system having three bases for defining the coordinates of the system with one of the bases comprising a Z-axis parallel to the plumb-position axis, the pivot point having a respective set of coordinates which describe its location within the coordinate system, the structural member having an orientation axis passing through the pivot point and a point on the antenna, the tilt sensor measuring an inclination angle (θ
- ) between the orientation axis and the plumb-position axis and providing measured inclination value representative thereof, the antenna having a phase center and the satellite navigation system measuring the position of the antenna'"'"'s phase center and providing measured coordinates therefor within the coordinate system, said method comprising the steps of;
(a) obtaining a length r representative of a distance from the pivot point to the phase center of the antenna;
(b) obtaining a number N of one or more measurement sets, each measurement set comprising a measured Z-axis coordinate zai which represents the measured position of the antenna'"'"'s phase center along the Z-axis of the coordinate system and a corresponding measured inclination value which is substantially representative of the inclination angle between the orientation axis and the plumb-position, wherein the index “
i”
represents the identity of the measurement set;
(c) generating an estimated Z-axis coordinate zt which is representative of the estimated position of the pivot point along the Z-axis, said estimated Z-axis coordinate zt being generated according to a form which is equivalent to;
- View Dependent Claims (36, 37, 38)
- ) between the orientation axis and the plumb-position axis and providing measured inclination value representative thereof, the antenna having a phase center and the satellite navigation system measuring the position of the antenna'"'"'s phase center and providing measured coordinates therefor within the coordinate system, said method comprising the steps of;
-
39. A method of estimating the position of a target point within a coordinate system using a range pole having a first end for contacting the target point, a second end for holding a satellite navigation system antenna which has a phase center, and an axis between the pole'"'"'s first and second ends, a plumb-position axis oriented within the coordinate system which is collinear with the direction of gravitational pull at the target point, the coordinate system having three bases for defining the coordinates of the system with the first and second bases spanning a plane which is perpendicular to the plumb-position axis and the third basis comprising a Z-axis which is parallel to the plumb-position axis, the first pole end having a respective set of first, second, and third coordinates which describe its location along the first, second, and third bases, respectively, of the coordinate system, the pole having an inclination angle (θ
- ) between its axis and the plumb-position axis, said method comprising the steps of;
(a) obtaining a length r representative of the distance from the first end of the pole to the phase center of the antenna as measure along the pole'"'"'s axis;
(b) obtaining a number N of two or more measurement sets, each measurement set comprising a first coordinate representative of the measured position of the antenna'"'"'s phase center along the first basis of the coordinate system, a second coordinate representative of the measured position of the antenna'"'"'s phase center along the second basis of the coordinate system, and a corresponding pole inclination value representative of the pole'"'"'s inclination angle;
(c) selecting two measurement sets and forming two corresponding relationships therefor, each relationship using the measured antenna coordinates and measured pole inclination value of its corresponding measurement set, each relationship describing a locus of estimated first and second coordinates for the pole'"'"'s first end, the locus being such that a line which starts from a first point located at the first two measured antenna coordinates of the measurement set and any third antenna coordinate and which is drawn to any second point on said locus which is a distance r from the first point has an inclination angle which is equal to the angle indicated by the measured pole inclination value of the measurement set;
(d) generating two possible sets of estimates for the first and second coordinates of the pole'"'"'s first end from the relationships;
(e) receiving an additional position of antenna'"'"'s phase center measured at an inclination angle of the pole'"'"'s axis which is less than the inclination angles of the selected measurement sets; and
(f) detecting the one of the two possible sets of estimates whose first and second coordinates are closest to the first and second coordinates of the additional position of the antenna'"'"'s phase center and providing said set as an estimate of the first and second coordinates of the target point. - View Dependent Claims (40, 41)
wherein said method generates an estimated X-axis coordinate xt which represents the estimated position of the pole'"'"'s first end along the X-axis of the coordinate system, and an estimated Y-axis coordinate yt which represents the estimated position of the pole'"'"'s first end along the Y-axis of the coordinate system;
wherein the first measured antenna coordinate of each i-th measurement set comprises an X-axis coordinate xai which represents the measured position of the antenna'"'"'s phase center along the X-axis of the coordinate system, and wherein the second measured antenna coordinate of each i-th measurement set comprises a Y-axis coordinate yai which represents the measured position of the antenna'"'"'s phase center along the Y-axis of the coordinate system, where the index “
i”
represents the identity of the measurement set and the corresponding relationship;
wherein each relationship of step (c) comprises a first equation which is equivalent to the form;
(xai−
xt)2+(yai−
yt)2=(r sin θ
i)2, where θ
i is the pole'"'"'s inclination angle indicated by the measurement set'"'"'s measured pole inclination value.
- ) between its axis and the plumb-position axis, said method comprising the steps of;
-
41. The method of claim 39 further comprising receiving a temperature value representative of the temperature during which the measurement sets were made, and correcting the measured inclination values of the measurement sets based on the measured temperature value.
-
42. A method of estimating the position of a target point within a coordinate system using a structural member having pivot point for contacting the target point and a moveable end having at least one degree of freedom, a satellite navigation system having an antenna mounted to the moveable end, and a tilt sensor, a plumb-position axis being present within the coordinate system which is collinear with the direction of gravitational pull at the target point, the coordinate system having three bases for defining the coordinates of the system with the first and second bases spanning a plane which is perpendicular to the plumb-position axis and the third basis comprising a Z-axis which is parallel to the plumb-position axis, the pivot point having a respective set of coordinates which describe its location within the coordinate system, the structural member having an orientation axis passing through the pivot point and a point on the antenna, the tilt sensor measuring an inclination angle (θ
- ) between the orientation axis and the plumb-position axis and providing measured inclination value representative thereof, the antenna having a phase center and the satellite navigation system measuring the position of the antenna'"'"'s phase center and providing measured coordinates therefor within the coordinate system, said method comprising the steps of;
(a) obtaining a length r representative of a distance from the pivot point to the phase center of the antenna;
(b) obtaining a number N of three or more measurement sets, each measurement set comprising a first coordinate representative of the measured position of the antenna'"'"'s phase center along the first basis of the coordinate system, a second coordinate representative of the measured position of the antenna'"'"'s phase center along the second basis of the coordinate system, and a corresponding measured inclination value which is substantially representative of the measured inclination angle between the orientation axis and the plumb-position;
(c) forming a number N of relationships with each relationship corresponding to a respective measurement set and using the measured antenna coordinates and measured inclination value of its corresponding measurement set, each relationship describing a locus of estimated first and second coordinates for the pivot point, said locus being such that a line which starts from a first point located at the first two measured antenna coordinates of the measurement set and any third antenna coordinate and which is drawn to any second point on said locus which is a distance r from the first point has an inclination angle which is equal to the angle indicated by the measured pole inclination value of the measurement set; and
(d) generating a set of estimates for the first and second coordinates of the pivot point from the relationships and providing said estimates as estimates for the first and second coordinates of the target point. - View Dependent Claims (43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58)
wherein said method generates an estimated X-axis coordinate xt which represents the estimated position of the pivot point along the X-axis of the coordinate system, and an estimated Y-axis coordinate yt which represents the estimated position of the pivot point along the Y-axis of the coordinate system;
wherein the first measured antenna coordinate of each i-th measurement set comprises an X-axis coordinate xai which represents the measured position of the antenna'"'"'s phase center along the X-axis of the coordinate system, and wherein the second measured antenna coordinate of each i-th measurement set comprises a Y-axis coordinate yai which represents the measured position of the antenna'"'"'s phase center along the Y-axis of the coordinate system, where the index “
i”
represents the identity of the measurement set and the corresponding relationship;
wherein each relationship of step (c) comprises a first equation which is equivalent to the form;
{(xai−
xt)2+(yai−
yt)2}1/2 =r sin θ
i, where θ
i is the inclination angle indicated by the measurement set'"'"'s measured inclination value.
- ) between the orientation axis and the plumb-position axis and providing measured inclination value representative thereof, the antenna having a phase center and the satellite navigation system measuring the position of the antenna'"'"'s phase center and providing measured coordinates therefor within the coordinate system, said method comprising the steps of;
-
44. The method of claim 43 wherein step (d) comprises the step of generating the estimated coordinates xt and yt of the pivot point from a non-linear least-squares fitting of the estimated coordinates xt and yt to the first equations of the relationships.
-
45. The method of claim 44 wherein the non-linear least-squares fitting comprises one or more iterations of generating values for the estimated coordinates xt and yt, each iteration being represented by an index k, and further comprises steps of:
-
(e) selecting a set of initial iteration values xt,k and yt,k for the estimated coordinates xt and yt for the first iteration (k=1);
wherein each iteration comprises the steps of; (f) forming a plurality of difference quantities mk[i](i=1, 2, . . . , N) corresponding to the number N of relationships, each difference quantity being proportional to the difference between the left and right sides of the first equation of the corresponding relationship with the iteration values xt,k and yt,k being used in the first equations in place of the estimated coordinates xt and yt, a vector Mk represents the plurality of difference quantities mk[i](i=1, 2, . . . , N);
(g) forming a first derivative matrix Hk which comprises the first derivatives of the difference quantities mk[i](i=1, 2, . . . , N) with respect to the estimated coordinate values xt and yt, matrix Hk having a transpose matrix matrix H′
k;
(h) forming a plurality N of second derivative matrices Gk,i(i=1, 2, . . . , N) of the difference quantities mk[i](i=1, 2, . . . , N), the elements of each i-th matrix Gk,i(i=1, 2, . . . , N) comprising the second derivatives of mk[i] with respect to the estimated coordinate values xt and yt; and
(i) with a vector Xk representing the iteration values xt,k and yt,k, generating a set of updated iteration values xt,k+1 and yt,k+1 according to a form which is equivalent to;
where vector Xk+1 represents the updated iteration values xt,k+1 and yt,k+1, and where the operator ( )−
1 denotes matrix inversion.
-
-
46. The method of claim 45 further comprising the steps of:
-
repeating steps (f)-(i) one or more times to provide one or more corresponding iterations, at least one component of vector Xk being set equal to its corresponding component of Xk+1 prior to the start of each such iteration; and
thereafter providing the components of Xk+1 as estimates for the first and second coordinates of the target point.
-
-
47. The method of claim 45 further comprising:
-
receiving M additional measurement sets with M being equal to one or more;
forming M additional relationships corresponding to the M additional measurement sets;
repeating steps (f)-(i) one or more times to provide one or more corresponding iterations, at least one component of vector Xk being set equal to its corresponding component of Xk+1 prior to the start of each such iteration, wherein Mk, Hk, and the series of second derivative matrices Gk,i(i=1, . . . [N+M]) are expand to be representative of the additional relationships for at least one repeated iteration; and
thereafter providing the components of Xk+1 as estimates for the first and second coordinates of the target point.
-
-
48. The method of claim 45 wherein the first derivatives of matrix Hk are computed with xt=xt,k and yt=yt,k, and wherein the second derivative elements of matrices Gk,i(i=1, 2, . . . , N) are computed with xt=xt,k and yt=yt,k.
-
49. The method of claim 42 wherein said method further computes an estimated Z-axis coordinate zt which is representative of the estimated position of the pivot point along the Z-axis of the coordinate system;
-
wherein at least one measurement set has a Z-axis coordinate which is representative of the measured position of the antenna'"'"'s phase center along the Z-axis of the coordinate system; and
wherein said method further comprises the step of generating, from a selected measurement set which has a Z-axis coordinate zaS, the estimated Z-axis coordinate zt according to a form which is equivalent to zt=zaS−
r cos θ
S, where θ
S is the inclination angle indicated by the measured inclination value of the selected measurement set, and the step of providing the estimated Z-axis coordinate zt as estimates for the first and second coordinates of the target point.
-
-
50. The method of claim 42 wherein said method further computes an estimated Z-axis coordinate zt which is representative of the estimated position of the pivot point along the Z-axis of the coordinate system;
-
wherein each i-th measurement set has a Z-axis coordinate zai which is representative of the measured position of the antenna'"'"'s phase center along the Z-axis of the coordinate system;
wherein said method further comprises the step of generating the estimated Z-axis coordinate zt according to a form which is equivalent to;
-
-
51. The method of claim 44 wherein the non-linear least-squares fitting comprises one or more iterations of generating values for the estimated coordinates xt and yt, each iteration being represented by an index k, and further comprises the steps of:
-
(e) selecting a set of initial iteration values xt,k, and yt,k, for the estimated coordinates xt and yt for the first iteration (k=1);
wherein each iteration comprises the steps of; (f) forming a plurality of difference quantities mk[i](i=1, 2, . . . , N) corresponding to the number N of relationships, each difference quantity being proportional to the difference between the left and right sides of the first equation of the corresponding relationship with the iteration values xt,k and yt,k being used in the first equations in place of the estimated coordinates xt and yt, a vector Mk represents the plurality of difference quantities mk[i](i=1, 2, . . . , N);
(g) forming a first derivative matrix Hk which comprises the first derivatives of the difference quantities mk[i](i=1, 2, . . . , N) with respect to the estimated coordinate values xt and yt, matrix Hk having a transpose matrix matrix H′
k;
(h) with a vector Xk representing the iteration values xt,k and yt,k, computing a set of updated iteration values xt,k+1 and yt,k+1 according to a form which is equivalent to;
-
-
52. The method of claim 51 further comprising the steps of:
-
repeating steps (f)-(i) one or more times to provide one or more corresponding iterations, at least one component of vector Xk being set equal to its corresponding component of Xk+1 prior to the start of each such iteration; and
thereafter providing the components of Xk+1 as estimates for the first and second coordinates of the target point.
-
-
53. The method of claim 51 further comprising:
-
receiving M additional measurement sets with M being equal to one or more;
forming M additional relationships corresponding to the M additional measurement sets;
repeating steps (f)-(i) one or more times to provide one or more corresponding iterations, at least one component of vector Xk being set equal to its corresponding component of Xk+1 prior to the start of each such iteration, wherein Mk and Hk are expand to be representative of the additional relationships for at least one repeated iteration; and
thereafter providing the components of Xk+1 as estimates for the first and second coordinates of the target point.
-
-
54. The method of claim 51 wherein the first derivatives of matrix Hk are computed with xt=xt,k and yt=yt,k.
-
55. The method of claim 42 wherein said method further computes an estimated Z-axis coordinate zt which is representative of the estimated position of the pivot point along the Z-axis of the coordinate system;
-
wherein at least one measurement set has a Z-axis coordinate which is representative of the measured position of the antenna'"'"'s phase center along the Z-axis of the coordinate system; and
wherein said method further comprises the step of generating, from a selected measurement set which has a Z-axis coordinate zaS, the estimated Z-axis coordinate zt according to a form which is equivalent to zt=zaS−
r cos θ
S, where θ
S is the inclination angle indicated by the measured inclination value of the selected measurement set, and the step of providing the estimated Z-axis coordinate zt as estimates for the first and second coordinates of the target point.
-
-
56. The method of claim 52 wherein said method further computes an estimated Z-axis coordinate zt which is representative of the estimated position of the pivot point along the Z-axis of the coordinate system;
-
wherein each i-th measurement set has a Z-axis coordinate zai which is representative of the measured position of the antenna'"'"'s phase center along the Z-axis of the coordinate system;
wherein said method further comprises the step of generating the estimated Z-axis coordinate zt according to a form which is equivalent to;
-
-
57. The method of claim 42 wherein the structural member comprises a range pole having a first end as the pivot point, a second end as the moveable end, and a pole axis as the orientation axis, and wherein step (a) comprises the step of swinging the range pole.
-
58. The method of claim 42 wherein step (a) comprises receiving length r from an external source, and wherein step (b) comprises receiving the measurement sets from an external source.
-
59. A computer program product for directing a computer processor to estimate the position of a target point within a coordinate system using data derived from a structural member having pivot point for contacting the target point and a moveable end having at least one degree of freedom, a satellite navigation system having an antenna mounted to the moveable end, and a tilt sensor, the coordinate system having three bases for defining the coordinates of the system, a plumb-position axis oriented within the coordinate system which is collinear with the direction of gravitational pull at the target point, the pivot point having a respective set of coordinates which describe its location within the coordinate system, the structural member having an orientation axis passing through the pivot point and a point on the antenna, the tilt sensor measuring an inclination angle (θ
- ) between the orientation axis and the plumb-position axis and providing measured inclination value representative thereof, the antenna having a phase center and the satellite navigation system measuring the position of the antenna'"'"'s phase center and providing measured coordinates therefor within the coordinate system, the computer program product comprising;
a computer-readable medium;
a first set of instructions embodied on the computer-readable medium which directs the data processor to obtain a length r which is representative of a distance from the pivot point to a point on the antenna;
a second set of instructions embodied on the computer-readable medium which directs the data processor to obtain a number N of one or more measurement sets, each measurement set comprising a set of one or more measured antenna coordinates which are representative of the measured position of the antenna'"'"'s phase center within the coordinate system, and further comprising a corresponding measured inclination value representative of the inclination angle provided by the tilt sensor;
a third set of instructions embodied on the computer-readable medium which directs the data processor to generate an estimate for at least one of the coordinates of the pivot point from the plurality of measurement sets; and
a fourth set of instructions embodied on the computer-readable medium which directs the data processing system to provide the estimate for the at least one of the coordinates of the pivot point as an estimate for at least one of the coordinates of the target point. - View Dependent Claims (60)
wherein the second set of instructions includes a first group of instructions which directs the data processor to determine when a set of measured antenna coordinates are provided on the second port and a second group of instructions which directs the data processor to read the antenna coordinates from the second port and the inclination value from the first port at substantially the same time.
- ) between the orientation axis and the plumb-position axis and providing measured inclination value representative thereof, the antenna having a phase center and the satellite navigation system measuring the position of the antenna'"'"'s phase center and providing measured coordinates therefor within the coordinate system, the computer program product comprising;
Specification