CA2166273A1 - Apparatus and method for determining terrestrial position - Google Patents
Apparatus and method for determining terrestrial positionInfo
- Publication number
- CA2166273A1 CA2166273A1 CA 2166273 CA2166273A CA2166273A1 CA 2166273 A1 CA2166273 A1 CA 2166273A1 CA 2166273 CA2166273 CA 2166273 CA 2166273 A CA2166273 A CA 2166273A CA 2166273 A1 CA2166273 A1 CA 2166273A1
- Authority
- CA
- Canada
- Prior art keywords
- reference point
- terrestrial
- set forth
- dynamic reference
- position signal
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Abandoned
Links
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
- E02F3/80—Component parts
- E02F3/84—Drives or control devices therefor, e.g. hydraulic drive systems
- E02F3/844—Drives or control devices therefor, e.g. hydraulic drive systems for positioning the blade, e.g. hydraulically
- E02F3/847—Drives or control devices therefor, e.g. hydraulic drive systems for positioning the blade, e.g. hydraulically using electromagnetic, optical or acoustic beams to determine the blade position, e.g. laser beams
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C15/00—Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Electromagnetism (AREA)
- Mechanical Engineering (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- Acoustics & Sound (AREA)
- Optics & Photonics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Operation Control Of Excavators (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Radar Systems Or Details Thereof (AREA)
- Train Traffic Observation, Control, And Security (AREA)
Abstract
An apparatus (302) for determining the terrestrial position of a dynamic reference point located on the ground surface is provided. The apparatus determined the terrestrial position of a terrestrial reference point located on the apparatus (302) and the location of the dynamic reference point relative to a local reference point located on the apparatus (302). The terrestrial position of the dynamic reference point is determined as a function of the terrestrial position of the terrestrial reference point and the relative location of the dynamic reference point. Knowledge of the terrestrial position of the dynamic reference point may be indicative of a tool position or the topography of the work site.
Description
wo 95~04917 2 ~ 7 ~ PCT~S94107442 Description Apparatus and Method for Determining Terrestrial Position Technical Field This invention relates generally to an apparatus and method for determining position and more particularly to an apparatus and method for determining the terrestrial position of a dynamic reference point.
Backqround of the Invention Today's construction site is designed by an architect. The architect's designs are copied to blueprints and are transmitted to the contractor. The contractor will stake the area, i.e., survey the undeveloped area and place stakes at predetermined positions. The contractor, by comparing the architect's plans and the results of the survey, will determine the amount of dirt that needs to be removed or placed at each marker to meet the design plans.
After this process, earthmoving vehicles, e.g., bulldozers, scrapers, or excavators, are used to remove or fill the areas around the stakes. An unprocessed island is left remaining around the stake.
After all the areas have been processed, the site is surveyed once again to confirm that the processed site meets the design specifications.
The above process requires large amounts of manual labor. The site has to be surveyed, staked, processed and surveyed once again. Furthermore, only a highly trained operator can efficiently operate the vehicle to obtain the desired degree of accuracy.
Laser systems have been used in order to provide a reference to the operator in performing this process. Typically, the laser system emits a laser WO95/04917 PCT~S94/07442 ~6~ 2-beam which is swept over the site in a plane. The vehicle must be equipped with a suitable receiver.
The system is able to give the operator an indication of the height of the vehicle and/or work implement with reference to the laser beam.
However, the laser systems are limited by the range of the laser, the sensitivity of the laser detector and environmental limitations, e.g., rain.
Furthermore, the laser system gives an indication of the relative height of the detector.
The height or position of the work implement is determined through the geometry of the work implement.
The geometry of the work implement changes based on the type of work implement and the relative positions of the work implement's linkages. Also, the blade of the work implement will wear over its life, changing its geometry. All of these factors decrease the accuracy of the operation of the vehicle.
In addition, the site must be manually surveyed again after the site has been processed. In order to accomplish this using the laser system, the vehicle must be stopped at each point which must be surveyed, the work implement must be set on the ground surface, and a reading taken. All this has to be done while the laser is in range. This is highly inefficient.
The present invention is directed to overcoming one or more of the problems, as set forth above.
Disclosure of the Invention In one aspect of the present invention, an apparatus for determining the position of a dynamic reference point located on the ground surface is provided. The apparatus determines the terrestrial wo 95~04917 ~ 2 7 ~ PCT~S94/07442 position of a terrestrial reference point located on the apparatus and the location of the dynamic reference point relative to a local reference point located on the apparatus. The terrestrial position of the dynamic reference point is determined as a function of the terrestrial position of the terrestrial reference point and the relative location of the dynamic reference point.
In another aspect of the present invention, a method for determining the terrestrial position of a dynamic reference point on a site plan utilizing an apparatus is provided. The method includes the steps of determining the terrestrial position (Xt~yt~ Zt) of a terrestrial reference point located on the apparatus and determining the location (xm~ Yml Zm) Of the dynamic reference point relative to a local reference point located on the apparatus. The terrestrial position (Xt,Yt,Zt) of the dynamic reference point is determined as a function of the position of the terrestrial reference point and the relative location of the local reference point.
Brief DescriPtion of the Drawings Fig. 1 is a diagrammatical illustration of a work vehicle having a work implement with a blade, shown as a track type tractor (TTT);
Fig. 2 is a diagrammatical illustration of a front view of the TTT of Fig. 1;
Fig. 3 is a diagrammatical illustration of an apparatus according to an embodiment of the present invention;
Fig. 4 is a diagrammatical illustration of the TTT of Fig. 1 including the apparatus of Fig. 3, according to an embodiment of the present invention;
WO 95tO4gl7 PCT/US94/07442 Fig. 5 is a line illustration of the apparatus of Fig. 3 shown illustrating a terrestrial reference point, a local reference point and a dynamic reference point;
Fig. 6 is an illustration of a two-dimensional orientation sensor; and Fig. 7 is a block diagram of the apparatus of Fig. 3.
Best Mode for Carryin~ Out the Invention With reference to Figs. 1-7, the present invention is directed towards determining the terrestrial position of a dynamic reference point.
In one embodiment, the present invention includes an apparatus 302 for determining the terrestrial position of a dynamic reference point on the ground surface. The apparatus 302 may be connected to a vehicle 102 or may be adapted to be hand carried. The apparatus 302 is adapted to be positioned over the dynamic reference point and to determine its terrestrial position. By determining the position of a series of dynamic reference points over a site, real-time surveillance of a site plan may be accomplished. Terrestrial position refers to position relative to the Earth, i.e. a coordinate system having an origin at the center of the Earth.
As used herein, terrestrial may also refer to a local site coordinate system. Thus, the local site reference coordinate system is fixed and transformations between the Earth coordinate system and the local site reference coordinate system is easily accomplished.
- Typically, positions will be referred to in Cartesian coordinates (X,Y,Z), however other reference systems may be used.
WO9S/04gl7 ~ 2 7~ PCT~S94/07442 With reference to Fig. 1, an exemplary work vehicle 102 is shown as a track type tractor (TTT).
However, the present invention may be adapted to other types of earthmoving vehicles, e.g., scrapers, motor graders, hydraulic excavators. In order to perform real-time surveillance, the present invention may be used with an earthmoving vehicle, as described below, or a non-earthmoving vehicle, e.g., a pick-up truck.
The TTT 102 includes an undercarriage 104 which provides movement, an operator station 106, and an engine 108. The TTT's work implement 110 includes a push arm 112 on each side of the vehicle 102 (only one is shown). A bulldozer blade 114 is rotatably connected to the ends of the push arms 112. A pair of tilt cylinders 116 provide movement of the blade 114 relative to the push arms 112. At least one lift cylinder 118 provides movement of the blade 114 relative to the vehicle 102.
The blade's movement relative to the vehicle are termed as pitch and tilt. Pitch refers to the blade's front and back movement as shown in Fig. 1 and labeled as G. As shown in Fig. 2 and labeled as F, tilt refers to the blade's rotational movement. For exemplary purposes only, the TTT 102 may have a maximum tilt angle of 25- and a maximum pitch angle of 7.3-.
The TTT dimensions as labeled are:
A: length with blade straight B: width C: blade height D: maximum digging depth E: ground clearance at full lift F: maximum tilt, and G: maximum pitch.
WO 95/04gl7 PCT/US94/07442 ~6~6~
In another embodiment, the apparatus 302 is connected to a work vehicle 102 and is adapted to determine the position of the work vehicle~s 102 work implement 110 as it performs a fill or cut operation or rests on the ground surface. With reference to Fig. 4, the apparatus 302 is connected to the vehicle 102 on or near the work implement 110. The apparatus 302 is adapted to determine the terrestrial position of a dynamic reference point behind the work implement. The terrestrial position of the dynamic reference point is used as an indication of the work implement's position and/or topography of the site.
Referring to Figs. 3 and 5, the apparatus 302 includes a support member 304.
A means 306 determines the terrestrial position of a terrestrial reference point 502 and responsively produces a terrestrial position signal.
The terrestrial reference point position determining means 306 is connected to the support member 304. In the preferred embodiment, the terrestrial position determining means 306 consists of a Global Positioning System (GPS). A GPS 306 receives signals from a constellation of man-made satellites orbiting the earth and determines position relative to the Earth by means of triangulation. Typically, a constellation consists of 3-4 satellites. Preferably, the U.S.
Government's NAVSTAR GPS satellites are used. One suitable GPS system is disclosed in U.S. Application Serial Number 07/628,560 filed December 3, 1990 and titled "Vehicle Position Determination System and Method."
Returning to Fig. 3, the terrestrial position determining means 306 includes a GPS antenna 308 and a GPS receiver 310. A suitable GPS antenna 308 is available from Magnavox Corp. of Torrance Ca as WO95/04917 PCT~S94/07442 2 ~ q 3 model number 723010. In the preferred embodiment, the antenna and pre-amp are mounted on the apparatus 302.
The GPS receiver is mounted elsewhere~on the vehicle.
The GPS receiver 310 is adapted to determine the terrestrial position of the terrestrial reference point which is typically located on the apparatus 302 or at the receiver 310.
A means 312 determines the location of the dynamic reference point 506 relative to a local reference point 504 located on the apparatus 302 and responsively produces a local position signal. The means 312 is connected to the support member 304.
In the preferred embodiment, the dynamic reference point location determining means 312 includes an ultrasonic sensor 314. The ultrasonic sensor 314 emits an ultrasonic wave aimed at the dynamic reference point 506, receives a reflection of the emitted wave and responsively determines the distance between the ultrasonic sensor and the dynamic reference point 506. The local reference point 504 is located on the ultrasonic sensor 314 and is the point from which the sensor measures the distance. One suitable ultrasonic sensor 314 is available from Agtek of Livermore, CA as model no. 9140.
In the preferred embodiment, the ultrasonic sensor 314 includes a reference wire 316 to compensate for temperature effects on the sensor's 314 accuracy.
The ultrasonic sensor 314 is adapted to determine the distance to the ground and to calibrate its measurements based on the measured and known distances to the reference wire 316.
In the preferred embodiment, the dynamic reference point location determining means 312 includes means 318 for determining the orientation of the apparatus 302 with respect to the ground surface.
WO95/04gl7 PCT~S94/07442 2 ~6~ 3 -8-In the preferred embodiment, the orientation of the apparatus 302 is characterized in terms of pitch (~) and tilt (~). If the apparatus 302 is connected to the blade 114, as in Fig. 4, the pitch and tilt of the apparatus 302 coincides with the pitch and tilt of the blade 114 (see Figs. 1,2,4, and 5). The pitch and tile of the apparatus 302 is used to determine the location of an adjusted dynamic reference point 506'.
The terrestrial position of the dynamic reference point is determined as a function of the measured tilt and pitch (see below).
In the preferred embodiment, the orientation determining means 318 includes a two dimensional bubble sensor 320. With reference to Fig. 6, the two-dimensional sensor 320 includes a casing 602 filled with an electrically conductive fluid. A bubble or pocket of gas 606, e.g., air, is trapped within the casing 602. As the orientation of the apparatus 302 changes, the location of the bubble 606 moves within the casing. The electrical impedance across thesensor 320 varies with the location of the bubble 606 and is proportional to the respective angles. The sensor 320 measures the electrical impedance across the casing on two perpendicular axes, as shown and responsively determines the pitch and tilt angles. A
suitable 2-axis bubble sensor is available from Spetron Glass and Electronics Inc of Hauppauge, NY as model no. SP5000. In alternate embodiment, two single axis sensors, model no. L-212t may be used.
Additionally, the present invention may alternately use a pendulum type sensor.
With reference to Fig. 7, the apparatus 302 includes a controlling means 700. Preferably, the controlling means 700 includes a microprocessor. In wo 95/04917 ~ 2 7 3 PCT~S94/07442 the preferred embodiment, a notebook computer is used.
The controlling means 700 includes a means - 702 for receiving the terrestrial position signal and the local position signal, responsively determining the terrestrial position of the dynam1c reference point 506 and producing a dynamic reference point terrestrial position signal.
In the preferred embodiment, the terrestrial position of the dynamic reference point is determined by the equations:
Xt = xt _ (hg + hS) sin Yt = Yt -+ (hg + h5) sin ~
Zt = Zt ~ (hg + hS) (1 - sin2 ~ - sin2 15 ~) 1/2 where Xt, Yt, Zt define the terrestrial position of the dynamic reference point in Cartesian coordinates xt, Yt, Zt define the terrestrial position of the terrestrial reference point in Cartesian coordinates;
h5 is the measured distance between the local reference point and the dynamic reference point;
hg is the known distance between the terrestrial reference point and the local reference point;
and is the measured pitch angle; and is the measured tilt angle.
A means 704 produces a desired reference point position signal. In the preferred embodiment, the desired reference point position signal producing means 704 includes storage memory, e.g., random access memory (RAM), erasable programmable read only memory (EPROM), a fixed disk drive, a hard disk drive or other suitable type of storage device. The storage WO95/04917 PCT~S94/07442 device retains the site plan including a series of points on the site plane and their respective desired terrestrial heights or positions. The desired reference point position signal corresponds to the desired height or position of the current dynamic reference point according to the site plan.
A means 706 receives the desired reference point position signal and the dynamic reference point terrestrial position signal, compares the received signals, and responsively producing a difference signal. The difference signal corresponds to the amount of material that has to be removed or filled in order to meet the site plan specifications.
A storing means 708 receives signals and stores the signals in a storage medium. The storing means 708 may include any of the types of memory listed above. The storing means 708 may be adapted to download stored data to an external computer either directly or through other means, e.g., a satellite network. In one embodiment, the storing means 708 receives and stores the difference signal. In another embodiment, the storing means 708 receives and stores the dynamic reference point terrestrial position signal.
A means 710 receives signal and displays the information to the operator. In one embodiment, the display means 710 receives the dynamic reference point terrestrial position signal and responsively displays dynamic reference point terrestrial position signal.
In another embodiment, the display means 710 receives the difference signal and responsively displays the difference signal. The display means 710 may display the-received information in a number~of different formats, e.g., a number, a graphic illustration showing the information relative to~the site plane, wo gs/04gl7 2 ~ ~ ~ 2 7 ~ PCT~S94/07442 and/or a graphic showing the difference. Other types - of displays and/or formats are possible and the present invention is not limited to any such type of - display.
In an alternate embodiment, the information may be relayed over a radio link to a remote location for display and/or storage.
Industrial APPlicability With reference to the drawings and in operation the present invention or apparatus 302 is adapted to determine the terrestrial position of a dynamic reference point. As discussed above, the dynamic reference point is preferably a point on the ground surface and may be used to accomplish real-time surveying of a site or may be used to determine the position of a work vehicle's implement. The terrestrial position of the dynamic reference point 506 is determined utilizing the apparatus 302 discussed above and the method described below.
First, the terrestrial position (Xt~yt~ Zt) of a terrestrial reference point 502 is produced.
Preferably this is accomplished utilizing a global position system (GPS). The GPS system includes a GPS
receiver 310 which receives electromagnetic signals from orbiting satellites and determines the position of a point on the receiver 310 (terrestrial reference point 502) with respect to the Earth. "Terrestrial"
refers to a reference coordinate system. In one embodiment, the terrestrial reference coordinate system is centered at the Earth. The GPS receiver 310 determines positions relative to this coordinate system. In another embodiment, the reference coordinate system is fixed at the particular site. A
~6~7 3 -12-simple transformation converts between the two coordinate systems.
Second, the location (Xml Yml Zm) of the dynamic reference point (506) relative to a local reference point (504) located on the apparatus (302) is determined and a local position signal is responsively produced. In the preferred embodiment, this step entails using an ultrasonic sensor 314 for determining the distance (hS) between a local reference point 504 located on the apparatus 302 and the dynamic reference point and an orientation sensor 320 for determining the tilt and pitch of the apparatus 302.
The local position signal is preferably indicative of the determined distance, hS.
The terrestrial position (Xt~yt~ Zt) Of the dynamic reference point is determined as a function of the terrestrial position of the terrestrial reference point, the distance between the local reference point and the dynamic reference point and the orientation of the apparatus 302 (see discussion above).
The terrestrial position of the dynamic reference point maybe used as an indicator of tool position or may be used as an indicator of the topography of the work site.
In one embodiment, the apparatus 302 is mounted on a vehicle, e.g., a pickup or a bulldozer.
The topography of the work site may be obtained by driving over the work site. If done with the bulldozer, this is accomplished with the blade in a raised position.
Other aspects, objects, and features of the present invention can be obtained from a study of the drawings, the disclosure, and the appended claims.
Backqround of the Invention Today's construction site is designed by an architect. The architect's designs are copied to blueprints and are transmitted to the contractor. The contractor will stake the area, i.e., survey the undeveloped area and place stakes at predetermined positions. The contractor, by comparing the architect's plans and the results of the survey, will determine the amount of dirt that needs to be removed or placed at each marker to meet the design plans.
After this process, earthmoving vehicles, e.g., bulldozers, scrapers, or excavators, are used to remove or fill the areas around the stakes. An unprocessed island is left remaining around the stake.
After all the areas have been processed, the site is surveyed once again to confirm that the processed site meets the design specifications.
The above process requires large amounts of manual labor. The site has to be surveyed, staked, processed and surveyed once again. Furthermore, only a highly trained operator can efficiently operate the vehicle to obtain the desired degree of accuracy.
Laser systems have been used in order to provide a reference to the operator in performing this process. Typically, the laser system emits a laser WO95/04917 PCT~S94/07442 ~6~ 2-beam which is swept over the site in a plane. The vehicle must be equipped with a suitable receiver.
The system is able to give the operator an indication of the height of the vehicle and/or work implement with reference to the laser beam.
However, the laser systems are limited by the range of the laser, the sensitivity of the laser detector and environmental limitations, e.g., rain.
Furthermore, the laser system gives an indication of the relative height of the detector.
The height or position of the work implement is determined through the geometry of the work implement.
The geometry of the work implement changes based on the type of work implement and the relative positions of the work implement's linkages. Also, the blade of the work implement will wear over its life, changing its geometry. All of these factors decrease the accuracy of the operation of the vehicle.
In addition, the site must be manually surveyed again after the site has been processed. In order to accomplish this using the laser system, the vehicle must be stopped at each point which must be surveyed, the work implement must be set on the ground surface, and a reading taken. All this has to be done while the laser is in range. This is highly inefficient.
The present invention is directed to overcoming one or more of the problems, as set forth above.
Disclosure of the Invention In one aspect of the present invention, an apparatus for determining the position of a dynamic reference point located on the ground surface is provided. The apparatus determines the terrestrial wo 95~04917 ~ 2 7 ~ PCT~S94/07442 position of a terrestrial reference point located on the apparatus and the location of the dynamic reference point relative to a local reference point located on the apparatus. The terrestrial position of the dynamic reference point is determined as a function of the terrestrial position of the terrestrial reference point and the relative location of the dynamic reference point.
In another aspect of the present invention, a method for determining the terrestrial position of a dynamic reference point on a site plan utilizing an apparatus is provided. The method includes the steps of determining the terrestrial position (Xt~yt~ Zt) of a terrestrial reference point located on the apparatus and determining the location (xm~ Yml Zm) Of the dynamic reference point relative to a local reference point located on the apparatus. The terrestrial position (Xt,Yt,Zt) of the dynamic reference point is determined as a function of the position of the terrestrial reference point and the relative location of the local reference point.
Brief DescriPtion of the Drawings Fig. 1 is a diagrammatical illustration of a work vehicle having a work implement with a blade, shown as a track type tractor (TTT);
Fig. 2 is a diagrammatical illustration of a front view of the TTT of Fig. 1;
Fig. 3 is a diagrammatical illustration of an apparatus according to an embodiment of the present invention;
Fig. 4 is a diagrammatical illustration of the TTT of Fig. 1 including the apparatus of Fig. 3, according to an embodiment of the present invention;
WO 95tO4gl7 PCT/US94/07442 Fig. 5 is a line illustration of the apparatus of Fig. 3 shown illustrating a terrestrial reference point, a local reference point and a dynamic reference point;
Fig. 6 is an illustration of a two-dimensional orientation sensor; and Fig. 7 is a block diagram of the apparatus of Fig. 3.
Best Mode for Carryin~ Out the Invention With reference to Figs. 1-7, the present invention is directed towards determining the terrestrial position of a dynamic reference point.
In one embodiment, the present invention includes an apparatus 302 for determining the terrestrial position of a dynamic reference point on the ground surface. The apparatus 302 may be connected to a vehicle 102 or may be adapted to be hand carried. The apparatus 302 is adapted to be positioned over the dynamic reference point and to determine its terrestrial position. By determining the position of a series of dynamic reference points over a site, real-time surveillance of a site plan may be accomplished. Terrestrial position refers to position relative to the Earth, i.e. a coordinate system having an origin at the center of the Earth.
As used herein, terrestrial may also refer to a local site coordinate system. Thus, the local site reference coordinate system is fixed and transformations between the Earth coordinate system and the local site reference coordinate system is easily accomplished.
- Typically, positions will be referred to in Cartesian coordinates (X,Y,Z), however other reference systems may be used.
WO9S/04gl7 ~ 2 7~ PCT~S94/07442 With reference to Fig. 1, an exemplary work vehicle 102 is shown as a track type tractor (TTT).
However, the present invention may be adapted to other types of earthmoving vehicles, e.g., scrapers, motor graders, hydraulic excavators. In order to perform real-time surveillance, the present invention may be used with an earthmoving vehicle, as described below, or a non-earthmoving vehicle, e.g., a pick-up truck.
The TTT 102 includes an undercarriage 104 which provides movement, an operator station 106, and an engine 108. The TTT's work implement 110 includes a push arm 112 on each side of the vehicle 102 (only one is shown). A bulldozer blade 114 is rotatably connected to the ends of the push arms 112. A pair of tilt cylinders 116 provide movement of the blade 114 relative to the push arms 112. At least one lift cylinder 118 provides movement of the blade 114 relative to the vehicle 102.
The blade's movement relative to the vehicle are termed as pitch and tilt. Pitch refers to the blade's front and back movement as shown in Fig. 1 and labeled as G. As shown in Fig. 2 and labeled as F, tilt refers to the blade's rotational movement. For exemplary purposes only, the TTT 102 may have a maximum tilt angle of 25- and a maximum pitch angle of 7.3-.
The TTT dimensions as labeled are:
A: length with blade straight B: width C: blade height D: maximum digging depth E: ground clearance at full lift F: maximum tilt, and G: maximum pitch.
WO 95/04gl7 PCT/US94/07442 ~6~6~
In another embodiment, the apparatus 302 is connected to a work vehicle 102 and is adapted to determine the position of the work vehicle~s 102 work implement 110 as it performs a fill or cut operation or rests on the ground surface. With reference to Fig. 4, the apparatus 302 is connected to the vehicle 102 on or near the work implement 110. The apparatus 302 is adapted to determine the terrestrial position of a dynamic reference point behind the work implement. The terrestrial position of the dynamic reference point is used as an indication of the work implement's position and/or topography of the site.
Referring to Figs. 3 and 5, the apparatus 302 includes a support member 304.
A means 306 determines the terrestrial position of a terrestrial reference point 502 and responsively produces a terrestrial position signal.
The terrestrial reference point position determining means 306 is connected to the support member 304. In the preferred embodiment, the terrestrial position determining means 306 consists of a Global Positioning System (GPS). A GPS 306 receives signals from a constellation of man-made satellites orbiting the earth and determines position relative to the Earth by means of triangulation. Typically, a constellation consists of 3-4 satellites. Preferably, the U.S.
Government's NAVSTAR GPS satellites are used. One suitable GPS system is disclosed in U.S. Application Serial Number 07/628,560 filed December 3, 1990 and titled "Vehicle Position Determination System and Method."
Returning to Fig. 3, the terrestrial position determining means 306 includes a GPS antenna 308 and a GPS receiver 310. A suitable GPS antenna 308 is available from Magnavox Corp. of Torrance Ca as WO95/04917 PCT~S94/07442 2 ~ q 3 model number 723010. In the preferred embodiment, the antenna and pre-amp are mounted on the apparatus 302.
The GPS receiver is mounted elsewhere~on the vehicle.
The GPS receiver 310 is adapted to determine the terrestrial position of the terrestrial reference point which is typically located on the apparatus 302 or at the receiver 310.
A means 312 determines the location of the dynamic reference point 506 relative to a local reference point 504 located on the apparatus 302 and responsively produces a local position signal. The means 312 is connected to the support member 304.
In the preferred embodiment, the dynamic reference point location determining means 312 includes an ultrasonic sensor 314. The ultrasonic sensor 314 emits an ultrasonic wave aimed at the dynamic reference point 506, receives a reflection of the emitted wave and responsively determines the distance between the ultrasonic sensor and the dynamic reference point 506. The local reference point 504 is located on the ultrasonic sensor 314 and is the point from which the sensor measures the distance. One suitable ultrasonic sensor 314 is available from Agtek of Livermore, CA as model no. 9140.
In the preferred embodiment, the ultrasonic sensor 314 includes a reference wire 316 to compensate for temperature effects on the sensor's 314 accuracy.
The ultrasonic sensor 314 is adapted to determine the distance to the ground and to calibrate its measurements based on the measured and known distances to the reference wire 316.
In the preferred embodiment, the dynamic reference point location determining means 312 includes means 318 for determining the orientation of the apparatus 302 with respect to the ground surface.
WO95/04gl7 PCT~S94/07442 2 ~6~ 3 -8-In the preferred embodiment, the orientation of the apparatus 302 is characterized in terms of pitch (~) and tilt (~). If the apparatus 302 is connected to the blade 114, as in Fig. 4, the pitch and tilt of the apparatus 302 coincides with the pitch and tilt of the blade 114 (see Figs. 1,2,4, and 5). The pitch and tile of the apparatus 302 is used to determine the location of an adjusted dynamic reference point 506'.
The terrestrial position of the dynamic reference point is determined as a function of the measured tilt and pitch (see below).
In the preferred embodiment, the orientation determining means 318 includes a two dimensional bubble sensor 320. With reference to Fig. 6, the two-dimensional sensor 320 includes a casing 602 filled with an electrically conductive fluid. A bubble or pocket of gas 606, e.g., air, is trapped within the casing 602. As the orientation of the apparatus 302 changes, the location of the bubble 606 moves within the casing. The electrical impedance across thesensor 320 varies with the location of the bubble 606 and is proportional to the respective angles. The sensor 320 measures the electrical impedance across the casing on two perpendicular axes, as shown and responsively determines the pitch and tilt angles. A
suitable 2-axis bubble sensor is available from Spetron Glass and Electronics Inc of Hauppauge, NY as model no. SP5000. In alternate embodiment, two single axis sensors, model no. L-212t may be used.
Additionally, the present invention may alternately use a pendulum type sensor.
With reference to Fig. 7, the apparatus 302 includes a controlling means 700. Preferably, the controlling means 700 includes a microprocessor. In wo 95/04917 ~ 2 7 3 PCT~S94/07442 the preferred embodiment, a notebook computer is used.
The controlling means 700 includes a means - 702 for receiving the terrestrial position signal and the local position signal, responsively determining the terrestrial position of the dynam1c reference point 506 and producing a dynamic reference point terrestrial position signal.
In the preferred embodiment, the terrestrial position of the dynamic reference point is determined by the equations:
Xt = xt _ (hg + hS) sin Yt = Yt -+ (hg + h5) sin ~
Zt = Zt ~ (hg + hS) (1 - sin2 ~ - sin2 15 ~) 1/2 where Xt, Yt, Zt define the terrestrial position of the dynamic reference point in Cartesian coordinates xt, Yt, Zt define the terrestrial position of the terrestrial reference point in Cartesian coordinates;
h5 is the measured distance between the local reference point and the dynamic reference point;
hg is the known distance between the terrestrial reference point and the local reference point;
and is the measured pitch angle; and is the measured tilt angle.
A means 704 produces a desired reference point position signal. In the preferred embodiment, the desired reference point position signal producing means 704 includes storage memory, e.g., random access memory (RAM), erasable programmable read only memory (EPROM), a fixed disk drive, a hard disk drive or other suitable type of storage device. The storage WO95/04917 PCT~S94/07442 device retains the site plan including a series of points on the site plane and their respective desired terrestrial heights or positions. The desired reference point position signal corresponds to the desired height or position of the current dynamic reference point according to the site plan.
A means 706 receives the desired reference point position signal and the dynamic reference point terrestrial position signal, compares the received signals, and responsively producing a difference signal. The difference signal corresponds to the amount of material that has to be removed or filled in order to meet the site plan specifications.
A storing means 708 receives signals and stores the signals in a storage medium. The storing means 708 may include any of the types of memory listed above. The storing means 708 may be adapted to download stored data to an external computer either directly or through other means, e.g., a satellite network. In one embodiment, the storing means 708 receives and stores the difference signal. In another embodiment, the storing means 708 receives and stores the dynamic reference point terrestrial position signal.
A means 710 receives signal and displays the information to the operator. In one embodiment, the display means 710 receives the dynamic reference point terrestrial position signal and responsively displays dynamic reference point terrestrial position signal.
In another embodiment, the display means 710 receives the difference signal and responsively displays the difference signal. The display means 710 may display the-received information in a number~of different formats, e.g., a number, a graphic illustration showing the information relative to~the site plane, wo gs/04gl7 2 ~ ~ ~ 2 7 ~ PCT~S94/07442 and/or a graphic showing the difference. Other types - of displays and/or formats are possible and the present invention is not limited to any such type of - display.
In an alternate embodiment, the information may be relayed over a radio link to a remote location for display and/or storage.
Industrial APPlicability With reference to the drawings and in operation the present invention or apparatus 302 is adapted to determine the terrestrial position of a dynamic reference point. As discussed above, the dynamic reference point is preferably a point on the ground surface and may be used to accomplish real-time surveying of a site or may be used to determine the position of a work vehicle's implement. The terrestrial position of the dynamic reference point 506 is determined utilizing the apparatus 302 discussed above and the method described below.
First, the terrestrial position (Xt~yt~ Zt) of a terrestrial reference point 502 is produced.
Preferably this is accomplished utilizing a global position system (GPS). The GPS system includes a GPS
receiver 310 which receives electromagnetic signals from orbiting satellites and determines the position of a point on the receiver 310 (terrestrial reference point 502) with respect to the Earth. "Terrestrial"
refers to a reference coordinate system. In one embodiment, the terrestrial reference coordinate system is centered at the Earth. The GPS receiver 310 determines positions relative to this coordinate system. In another embodiment, the reference coordinate system is fixed at the particular site. A
~6~7 3 -12-simple transformation converts between the two coordinate systems.
Second, the location (Xml Yml Zm) of the dynamic reference point (506) relative to a local reference point (504) located on the apparatus (302) is determined and a local position signal is responsively produced. In the preferred embodiment, this step entails using an ultrasonic sensor 314 for determining the distance (hS) between a local reference point 504 located on the apparatus 302 and the dynamic reference point and an orientation sensor 320 for determining the tilt and pitch of the apparatus 302.
The local position signal is preferably indicative of the determined distance, hS.
The terrestrial position (Xt~yt~ Zt) Of the dynamic reference point is determined as a function of the terrestrial position of the terrestrial reference point, the distance between the local reference point and the dynamic reference point and the orientation of the apparatus 302 (see discussion above).
The terrestrial position of the dynamic reference point maybe used as an indicator of tool position or may be used as an indicator of the topography of the work site.
In one embodiment, the apparatus 302 is mounted on a vehicle, e.g., a pickup or a bulldozer.
The topography of the work site may be obtained by driving over the work site. If done with the bulldozer, this is accomplished with the blade in a raised position.
Other aspects, objects, and features of the present invention can be obtained from a study of the drawings, the disclosure, and the appended claims.
Claims (33)
1. An apparatus (302) for determining the position of a dynamic reference point (506) located on the ground surface, comprising:
a support member (304);
means (306) connected to said support member (304) for determining the terrestrial position of a terrestrial reference point (502) and responsively producing a terrestrial position signal;
means (312) connected to said support member (304) for determining the location of the dynamic reference point (506) relative to a local reference point (504) located on the apparatus (302) and responsively producing a local position signal; and means (702) for receiving said terrestrial position signal and said local position signal, responsively determining the terrestrial position of the dynamic reference point (506) and producing a dynamic reference point terrestrial position signal.
a support member (304);
means (306) connected to said support member (304) for determining the terrestrial position of a terrestrial reference point (502) and responsively producing a terrestrial position signal;
means (312) connected to said support member (304) for determining the location of the dynamic reference point (506) relative to a local reference point (504) located on the apparatus (302) and responsively producing a local position signal; and means (702) for receiving said terrestrial position signal and said local position signal, responsively determining the terrestrial position of the dynamic reference point (506) and producing a dynamic reference point terrestrial position signal.
2. An apparatus (302), as set forth in claim 1, including means (318) for measuring the orientation of the apparatus 302 with respect to the ground surface and wherein the terrestrial position of the dynamic reference point (506) is determined as a function thereof.
3. An apparatus (302), as set forth in claim 1, wherein said apparatus (302) is connected to a vehicle (102) and is adapted to determine the terrestrial position of a plurality of dynamic reference points (506) as the vehicle traverses the ground topography.
4. An apparatus (302), as set forth in claim 1, wherein said apparatus (302) is connected to a work vehicle (102), said work vehicle (102) having a work implement (110), the apparatus (302) being adapted to determine a position of said work implement (110) with respect to the ground surface.
5. An apparatus (302), as set forth in claim 1, wherein said apparatus (302) is connected to a work vehicle (102), said work vehicle (102) including a work implement (110) having a blade (114), the apparatus (302) being adapted to determine a position of a cutting edge of said blade (114) with respect to the ground surface.
6. An apparatus (302), as set forth in claim 1, including means (708) for receiving said dynamic reference point terrestrial position signal and storing said dynamic reference point terrestrial position signal.
7. An apparatus (302), as set forth in claim 1, including means (710) for receiving said dynamic reference point terrestrial position signal and displaying said dynamic reference point terrestrial position signal.
8. An apparatus (302), as set forth in claim 1, including:
means (704) for producing a desired reference point position signal; and means (706) for receiving said desired reference point position signal and said dynamic reference point terrestrial position signal, comparing said received signals, and responsively producing a difference signal.
means (704) for producing a desired reference point position signal; and means (706) for receiving said desired reference point position signal and said dynamic reference point terrestrial position signal, comparing said received signals, and responsively producing a difference signal.
9. An apparatus (302), as set forth in claim 8, including means (708) for receiving said difference signal and storing said difference signal.
10. An apparatus (302), as set forth in claim 8, including means (710) for receiving said difference signal and displaying said difference signal.
11. An apparatus (302), as set forth in claim 1, wherein said terrestrial position determining means (306) being adapted to receive signals from a plurality of orbiting satellites and said terrestrial position being a function thereof.
12. An apparatus (302), as set forth in claim 1, wherein said terrestrial position determining means (306) being adapted to receive signals from a constellation of NAVSTAR Global Positioning System (GPS) satellites.
13. An apparatus (302), as set forth in claim 1, wherein said terrestrial position determining means (306) includes a GPS antenna (308) and a GPS
receiver (310).
receiver (310).
14. An apparatus (302) adapted to determine the terrestrial profile of the ground topography of a predefined work area as the terrestrial positions of a series of dynamic reference points (506), comprising:
a vehicle (102);
a support member (304) connected to said vehicle (102);
means (306) connected to said support member (304) for determining the terrestrial position of a terrestrial reference point (502) and responsively producing a terrestrial position signal;
means (312) connected to said support member (304) for determining the location of one of the dynamic reference points (506) relative to a local reference point (504) located on the apparatus (302) and responsively producing a local position signal;
and means (702) for receiving said terrestrial position signal and said local position signal, responsively determining the terrestrial position of the one dynamic reference point (506) and producing a dynamic reference point terrestrial position signal.
a vehicle (102);
a support member (304) connected to said vehicle (102);
means (306) connected to said support member (304) for determining the terrestrial position of a terrestrial reference point (502) and responsively producing a terrestrial position signal;
means (312) connected to said support member (304) for determining the location of one of the dynamic reference points (506) relative to a local reference point (504) located on the apparatus (302) and responsively producing a local position signal;
and means (702) for receiving said terrestrial position signal and said local position signal, responsively determining the terrestrial position of the one dynamic reference point (506) and producing a dynamic reference point terrestrial position signal.
15. An apparatus (302), as set forth in claim 14, including means (318) for measuring the orientation of the apparatus (302) with respect to the ground topography and wherein the terrestrial position of the dynamic reference point is determined as a function thereof.
16. An apparatus (302), as set forth in claim 15, wherein said orientation measuring means (318) includes a two-dimensional bubble sensor (320).
17. An apparatus (302), as set forth in claim 16, wherein said two-dimensional bubble sensor (320) is adapted to measure the pitch and tilt angle of the apparatus (302).
18. An apparatus (302), as set forth in claim 14, including means (708) for receiving said dynamic reference point terrestrial position signal and storing said dynamic reference point terrestrial position signal.
19. An apparatus ( 302), as set forth in claim 14, including means (710) for receiving said dynamic reference point terrestrial position signal and displaying said dynamic reference point terrestrial position signal.
20. An apparatus (302), as set forth in claim 14, including:
means (704) for producing a desired reference point position signal; and means (706) for receiving said desired reference point position signal and said dynamic reference point terrestrial position signal, comparing said received signals, and responsively producing a difference signal.
means (704) for producing a desired reference point position signal; and means (706) for receiving said desired reference point position signal and said dynamic reference point terrestrial position signal, comparing said received signals, and responsively producing a difference signal.
21. An apparatus (302), as set forth in claim 20, including means (708) for receiving said difference signal and storing said difference signal.
22. An apparatus (302), as set forth in claim 20, including means (710) for receiving said difference signal and displaying said difference signal.
23. An apparatus (302) adapted to determine the terrestrial position of a cutting edge of a work implement (110) of a vehicle (102), comprising:
a support member (304) connected to the vehicle (102);
means (306) connected to said support member (304) for determining the terrestrial position of a terrestrial reference point (502) and responsively producing a terrestrial position signal;
means (312) connected to said support member (304) for determining the location of a dynamic reference point (506) relative to a local reference point (504) and responsively producing a local position signal; and means (702) for receiving said terrestrial position signal and said local position signal, responsively determining the terrestrial position of the cutting edge of the work implement (110).
a support member (304) connected to the vehicle (102);
means (306) connected to said support member (304) for determining the terrestrial position of a terrestrial reference point (502) and responsively producing a terrestrial position signal;
means (312) connected to said support member (304) for determining the location of a dynamic reference point (506) relative to a local reference point (504) and responsively producing a local position signal; and means (702) for receiving said terrestrial position signal and said local position signal, responsively determining the terrestrial position of the cutting edge of the work implement (110).
24. An apparatus (302), as set forth in claim 23, including means (318) for measuring the orientation of the apparatus 302 with respect to the ground topography and wherein the terrestrial position of the cutting edge is determined as a function thereof.
25. An apparatus (302), as set forth in claim 23, including means (708) for receiving said dynamic reference point terrestrial position signal and storing said dynamic reference point terrestrial position signal.
26. An apparatus (302), as set forth in claim 23, including means (710) for receiving said dynamic reference point terrestrial position signal and displaying said dynamic reference point terrestrial position signal.
27. An apparatus (302), as set forth in claim 23, including:
means (704) for producing a desired reference point position signal; and means (706) for receiving said desired reference point position signal and said dynamic reference point terrestrial position signal, comparing said received signals, and responsively producing a difference signal.
means (704) for producing a desired reference point position signal; and means (706) for receiving said desired reference point position signal and said dynamic reference point terrestrial position signal, comparing said received signals, and responsively producing a difference signal.
28. An apparatus (302), as set forth in claim 27, including means (708) for receiving said difference signal and storing said difference signal.
29. An apparatus (302), as set forth in claim 27, including means (710) for receiving said difference signal and displaying said difference signal.
30. A method for determining the terrestrial position of a dynamic reference point (506) on a site plan utilizing an apparatus (302), comprising:
determining the terrestrial position (Xt,yt, Zt) of a terrestrial reference point (502) located on the apparatus (302) and responsively producing a terrestrial position signal;
determining the location (Xm,Ym, Zm) of the dynamic reference point (506) relative to a local reference point (504) located on the apparatus (302) and responsively producing a local position signal;
receiving said terrestrial position and local position signals and responsively determining the terrestrial position (Xt,Yt, Zt) of the dynamic reference point (506).
determining the terrestrial position (Xt,yt, Zt) of a terrestrial reference point (502) located on the apparatus (302) and responsively producing a terrestrial position signal;
determining the location (Xm,Ym, Zm) of the dynamic reference point (506) relative to a local reference point (504) located on the apparatus (302) and responsively producing a local position signal;
receiving said terrestrial position and local position signals and responsively determining the terrestrial position (Xt,Yt, Zt) of the dynamic reference point (506).
31. A method, as set forth in claim 30, wherein said step of determining the location (Xm,Ym, Zm) of the dynamic reference point (506) includes the steps of:
determining the distance (hs) between the local reference point and the dynamic reference point and responsively producing a distance signal;
determining the orientation of the apparatus (302) and responsively producing an orientation signal; and receiving said distance and orientation signals and wherein said terrestrial position (Xt, Yt, Zt) of the dynamic reference point (506).
determining the distance (hs) between the local reference point and the dynamic reference point and responsively producing a distance signal;
determining the orientation of the apparatus (302) and responsively producing an orientation signal; and receiving said distance and orientation signals and wherein said terrestrial position (Xt, Yt, Zt) of the dynamic reference point (506).
32. A method, as set forth in claim 31, wherein the step of determining the orientation of the apparatus (302) includes the step of determining the pitch (.beta.) and the tilt (.alpha.) angles of the apparatus.
33. A method, as set forth in claim 32, wherein the terrestrial position (Xt,Yt,Zt) of the dynamic reference point is determined by the equations:
Xt = xt (hg + hs) sin .alpha.
Yt = Yt (hg + hs) sin .beta.
Zt = Zt - (hg + hs) (1 - sin2 .alpha. - sin2 .beta.) 1/2, where hg is the distance between the terrestrial reference point and the local reference point.
Xt = xt (hg + hs) sin .alpha.
Yt = Yt (hg + hs) sin .beta.
Zt = Zt - (hg + hs) (1 - sin2 .alpha. - sin2 .beta.) 1/2, where hg is the distance between the terrestrial reference point and the local reference point.
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| US10364293A | 1993-08-09 | 1993-08-09 | |
| US103,642 | 1993-08-09 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CA2166273A1 true CA2166273A1 (en) | 1995-02-16 |
Family
ID=22296252
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CA 2166273 Abandoned CA2166273A1 (en) | 1993-08-09 | 1994-07-06 | Apparatus and method for determining terrestrial position |
Country Status (5)
| Country | Link |
|---|---|
| EP (1) | EP0713573A1 (en) |
| JP (1) | JPH09501497A (en) |
| AU (1) | AU684299B2 (en) |
| CA (1) | CA2166273A1 (en) |
| WO (1) | WO1995004917A1 (en) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6228362B1 (en) | 1992-08-21 | 2001-05-08 | Immunomedics, Inc. | Boron neutron capture therapy using pre-targeting methods |
| US9222237B1 (en) * | 2014-08-19 | 2015-12-29 | Caterpillar Trimble Control Technologies Llc | Earthmoving machine comprising weighted state estimator |
| US9428885B2 (en) * | 2014-09-15 | 2016-08-30 | Trimble Navigation Limited | Guidance system for earthmoving machinery |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE3340317A1 (en) * | 1983-11-08 | 1984-08-16 | Walter 4790 Paderborn Hesse | Test set for the simultaneous orientation and height determination of points in cavities where access is difficult |
| AU642638B2 (en) * | 1989-12-11 | 1993-10-28 | Caterpillar Inc. | Integrated vehicle positioning and navigation system, apparatus and method |
| DE4133392C1 (en) * | 1991-10-09 | 1992-12-24 | Rheinbraun Ag, 5000 Koeln, De | Determining progress of mining material spreader - receiving signals from at least four satellites at end of tipping arm and at vehicle base and calculating actual geodetic positions and height of material tip |
| JPH05164833A (en) * | 1991-12-16 | 1993-06-29 | Taisei Corp | Vehicle management device and method |
-
1994
- 1994-07-06 AU AU73574/94A patent/AU684299B2/en not_active Ceased
- 1994-07-06 CA CA 2166273 patent/CA2166273A1/en not_active Abandoned
- 1994-07-06 JP JP7506405A patent/JPH09501497A/en active Pending
- 1994-07-06 EP EP94922479A patent/EP0713573A1/en not_active Ceased
- 1994-07-06 WO PCT/US1994/007442 patent/WO1995004917A1/en not_active Application Discontinuation
Also Published As
| Publication number | Publication date |
|---|---|
| WO1995004917A1 (en) | 1995-02-16 |
| JPH09501497A (en) | 1997-02-10 |
| AU7357494A (en) | 1995-02-28 |
| AU684299B2 (en) | 1997-12-11 |
| EP0713573A1 (en) | 1996-05-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP0776485B1 (en) | Apparatus and method for determining the position of a work implement | |
| AU719511B2 (en) | Apparatus and method for determining the position of a work implement | |
| US5935183A (en) | Method and system for determining the relationship between a laser plane and an external coordinate system | |
| US9650763B2 (en) | Methodss for performing non-contact based determination of the position of an implement | |
| US6191732B1 (en) | Real-time surveying/earth moving system | |
| JP3585242B2 (en) | Cutting gradient control device | |
| US6047227A (en) | Method and apparatus for operating geography altering machinery relative to a work site | |
| RU2134329C1 (en) | Device for determining location of digging attachment and method for determining positioning of operating machine on work site | |
| US5964298A (en) | Integrated civil engineering and earthmoving system | |
| US5704142A (en) | Excavator data acquisition and control system and process | |
| US5375663A (en) | Earthmoving apparatus and method for grading land providing continuous resurveying | |
| US6711838B2 (en) | Method and apparatus for determining machine location | |
| AU684299B2 (en) | Apparatus and method for determining terrestrial position | |
| JPH0427484B2 (en) |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| FZDE | Dead |