The present disclosure relates to a work vehicle, such as a motor grader, for grading a surface, and in particular to a vehicle grade control system for controlling an implement position based on a forward looking sensor to achieve a desired grade of the surface.
Work vehicles, such as a motor grader, can be used in construction and maintenance for creating a flat surface at various angles, slopes, and elevations. When paving a road for instance, a motor grader can be used to prepare a base foundation to create a wide flat surface to support a layer of asphalt. A motor grader can include two or more axles, with an engine and cab disposed above the axles at the rear end of the vehicle and another axle disposed at the front end of the vehicle. An implement, such as a blade, is attached to the vehicle between the front axle and rear axle.
Motor graders include a drawbar assembly attached toward the front of the grader, which is pulled by the grader as it moves forward. The drawbar assembly rotatably supports a circle drive member at a free end of the drawbar assembly and the circle drive member supports a work implement such as the blade, also known as a mold board. The angle of the work implement beneath the drawbar assembly can be adjusted by the rotation of the circle drive member relative to the drawbar assembly.
In addition, to the blade being rotated about a rotational fixed axis, the blade is also adjustable to a selected angle with respect to the circle drive member. This angle is known as blade slope. The elevation of the blade is also adjustable.
To properly grade a surface, the motor grader includes a one or more sensors which measure the orientation of the vehicle with respect to gravity and the location of the blade with respect to the vehicle. A rotation sensor located at the circle drive member provides a rotational angle of the blade with respect to a longitudinal axis defined by a length of the vehicle. A blade slope sensor provides a slope angle of the blade with respect to a lateral axis which is generally aligned with a vehicle lateral axis, such as defined by the vehicle axles. A mainfall sensor provides an angle of travel of the vehicle with respect to gravity.
Machine control systems, which include 2 dimensional (2D) and 3 dimensional (3D) machine control systems, are located at the surface being graded to provide grade information to the motor grader. A vehicle grade control system receives signals from the machine control system to enable the motor grader to grade the surface. The motor grader includes a grade control system operatively coupled to each of the sensors, so that the surface being graded can be graded to the desired slope, angle, and elevation. The desired grade of the surface is planned ahead of or during a grading operation.
Machine control systems can provide slope, angle, and elevation signals to the vehicle grade control system to enable the motor grader or an operator to adjust the slope, angle, and elevation of the blade. The vehicle grade control system can be configured to automatically control the slope, angle, and elevation of the blade to grade the surface based on desired slopes, angles, and elevations as is known by those skilled in the art. In these automatic systems, adjustments to the position of the blade with respect to the vehicle are made constantly to the blade in order to achieve the slope, angle and/or elevation targets. Many vehicle grade control systems offer an included or optional display that indicates to the operator how well the vehicle grade control system is keeping up to the target slope, angle, and/or elevation.
In some conditions, the surface being graded includes gullies, ravines, ditches, or other depressions that are recessed below a grade surface and ridges, mounds, banks, or other elevated areas that extend above a grade surface. Each of the depressions or elevated areas are irregularly shaped and can extend across a surface at varying angles with respect to the moving direction of the vehicle. As the vehicle moves over these irregularities, the blade of a motor grader deviates from the desired grade surface which prevents the vehicle from operating efficiently and effectively when reshaping the grade of the surface.
Therefore, a need exists for adjusting the position of the blade in response to the occurrence of the irregularities to grade a surface to a grade target.
In one embodiment of the present disclosure, there is provided a method of controlling an implement position of a vehicle moving along a path of a surface. The vehicle includes a frame supported by wheels and an implement adjustably coupled to the frame. The method includes: receiving a grade target to grade the surface to a desired grade with the implement; locating surface irregularities of the surface in a path of the motor grader; identifying an angle of the frame based on the located surface irregularities, determining a difference between the identified angle of the frame and the grade target; identifying a position of the implement with respect to the frame based on the determined difference; and grading the surface with the identified position of the implement.
In another embodiment of the present disclosure, there is provided a vehicle grade control system for a vehicle having wheels, a frame, and an implement configured to move through a range of positions with respect to the frame to grade a surface having a current grade to a grade target. The control system includes an antenna operatively connected to the frame and configured to receive a location of the vehicle with respect to the surface. One or more image sensors is configured to image surface irregularities of the surface in a path of the vehicle and to transmit one or more images of the surface irregularities. Control circuitry is operatively connected to the antenna and to the one or more image sensors. The control circuitry includes a processer and a memory, wherein the memory is configured to store program instructions and the processor is configured to execute the stored program instructions to: locate surface irregularities from the one or more imaged surface irregularities; identify an anticipated angle of the frame based on the located surface irregularities; determine a difference between the identified anticipated angle of the frame and the grade target; identify a position of the implement with respect to the frame based on the determined difference; and adjust the position of the implement with based on the identified position to grade the surface to arrive at the grade target.
In still another embodiment of the present disclosure, there is provided a method of controlling an implement position of a plurality of motor graders configured to move along a path of a surface, wherein each of the motor graders includes a frame supported by wheels and an implement adjustably coupled to the frame. The method includes: receiving, at a first motor grader of one of the plurality of motor graders, a grade target to grade the surface to a desired grade with the implement; locating surface irregularities of the surface in a path of the first motor grader; identifying an anticipated angle of the frame of the first motor grader based on the located surface irregularities; determining a difference between the identified angle of the frame of the first motor grader and the grade target; identifying positions of the implement of the first motor grader with respect to the frame based on the determined difference during the first path; grading the surface of the path with the identified position of the implement of the first motor grader; and identifying the path graded by the first motor grader.
The above-mentioned aspects of the present disclosure and the manner of obtaining them will become more apparent and the disclosure itself will be better understood by reference to the following description of the embodiments of the disclosure, taken in conjunction with the accompanying drawings, wherein:
Corresponding reference numerals are used to indicate corresponding parts throughout the several views.
The embodiments of the present disclosure described below are not intended to be exhaustive or to limit the disclosure to the precise forms in the following detailed description. Rather, the embodiments are chosen and described so that others skilled in the art may appreciate and understand the principles and practices of the present disclosure.
Referring to
As shown in
An operator cab 110 is mounted on an upwardly and inclined rear region 112 of the front frame 102 and contains various controls for the motor grader 100 disposed so as to be within the reach of a seated or standing operator. In one aspect, these controls may include a steering wheel 114 and a lever assembly 116. A user interface 117 is supported by a console located in the cab and includes one or more different types of operator controls including manual and electronic buttons of switches. In different embodiments, the user interface 117 includes a visual display providing operator selectable menus for controlling various features of the vehicle 100. In one or more embodiments, a video display is provided to show images provided by the image sensor 148 or cameras located on the vehicle.
An engine 118 is mounted on the rear frame 104 and supplies power for all driven components of the motor grader 100. The engine 118, for example, is configured to drive a transmission (not shown), which is coupled to drive the rear wheels 108 at various selected speeds and either in forward or reverse modes. A hydrostatic front wheel assist transmission (not shown), in different embodiments, is selectively engaged to power the front wheels 106, in a manner known in the art.
Mounted to a front location of the front frame 102 is a drawbar or draft frame 120, having a forward end universally connected to the front frame 102 by a ball and socket arrangement 122 and having opposite right and left rear regions suspended from an elevated central section 124 of the front frame 102. Right and left lift linkage arrangements including right and left extensible and retractable hydraulic actuators 126 and 128, respectively, support the left and right regions of the drawbar 120. The right and left lift linkage arrangements 126 and 128 either raise or lower the drawbar 120. A side shift linkage arrangement is coupled between the elevated frame section 124 and a rear location of the drawbar 120 and includes an extensible and retractable side swing hydraulic actuator 130. A blade or mold board 132 is coupled to the front frame 102 and powered by a circle drive assembly 134. The blade 132 includes an edge 133 configured to cut, separate, or move material. While a blade 132 is described herein, other types of implements are contemplated.
The drawbar 120 is raised or lowered by the right and left lift linkage arrangements 126 and 128 which in turn raises or lowers the blade 132 with respect to the surface. The actuator 130 raises or lowers one end of the blade 132 to adjust the slope of the blade.
The circle drive assembly 134 includes a rotation sensor 136, which in different embodiments, includes one or more switches that detect movement, speed, or position of the blade 132 with respect to the vehicle front frame 102. The rotation sensor 136 is electrically coupled to a controller 138, which in one embodiment is located in the cab 110. In other embodiments, the controller 138 is located in the front frame 102, the rear frame 104, or within an engine compartment housing the engine 118. In still other embodiments, the controller 138 is a distributed controller having separate individual controllers distributed at different locations on the vehicle. In addition, while the controller is generally hardwired by electrical wiring or cabling to sensors and other related components, in other embodiments the controller includes a wireless transmitter and/or receiver to communicate with a controlled or sensing component or device which either provides information to the controller or transmits controller information to controlled devices.
A blade slope/position sensor 140 is configured to detect the slope and/or position of the blade 132 and to provide slope and/or position information to the controller 138. In different embodiments, the blade slope/position sensor 140 is coupled to a support frame for the blade 132 of the hydraulic actuator 130 to provide the slope information. A mainfall sensor 142 is configured to detect the grading angle of the vehicle 100 with respect to gravity and to provide grading angle information to the controller 138. The mainfall sensor 142 is configured to measure one or more of angles of slope, tilt, elevation, or depression with respect to gravity. In one embodiment, the mainfall sensor 142 includes an inertial measurement unit (IMU) configured to determine a roll position and a pitch position with respect to gravity. In other embodiments, the mainfall sensor includes other inclination measuring devices for measuring an angle of the vehicle, such as an inclinometer. The mainfall sensor 142 provides a signal including roll and pitch information of the straightline axis between wheel centers and consequently roll and pitch information of the vehicle 100. The roll and pitch information is used by the ECU 150 to adjust the position of the blade 132.
In other embodiments, the vehicle 100 includes angle sensors at both the front frame 102 and the rear frame 104 to determine the position of the front frame 102 with respect to the rear frame 104 during articulation. In these embodiments, grade control is achieved using one or more of implement position, front frame position, and rear frame position.
An antenna 144 is located at a top portion of the cab 110 and is configured to receive signals from different types of machine control systems including sonic systems, laser systems, and global positioning systems (GPS). While the antenna 144 is illustrated, other locations of the antenna 144 are included as is known by those skilled in the art. For instance, when the vehicle 100 is using a sonic system, a sonic tracker 146 is used detect reflected sound waves transmitted by the sonic system through with the sonic tracker 146. In a vehicle 100 using a laser system, a mast (not shown) located on the blade supports a laser tracker located at a distance above the blade 132. In one embodiment, the mast includes a length to support a laser tracker at a height similar to the height of a roof of the cab. A GPS system includes a GPS tracker located on a mast similar to that provided for the laser tracker system. Consequently, the present disclosure applies vehicle motor grader systems using both relatively “simple” 2D cross slope systems and to “high end” 3D grade control systems.
In additional embodiments, the grade control system includes devices, apparatus, or systems configured to determine the mainfall of the vehicle, as well as devices, apparatus, or systems configured to determine the slope and/or the position of the blade. For instance, blade position is determined by one or more sensors. In one embodiment, an inertial measurement unit to determine blade position is used. Consequently, other systems to determine mainfall and blade slope/position are contemplated.
A ground image sensor 148 is fixedly mounted to the front frame 102 at a location generally unobstructed by any part of the vehicle 100. The ground image sensor 148 includes one or more of a transmitter, receiver, or a transceiver directed to the ground in front of and being approached by the vehicle 100. In different embodiments, the ground image sensor 148 includes one or more of a two dimensional camera, a radar device, and a laser scanning device, and a light detection and ranging (LIDAR) scanner. The ground image sensor 148 is configured to provide an image of the ground being approached which is transmitted to an electronic control unit (ECU) 150 of
As illustrated in
In different embodiments, the server 145 is located at a facility maintained by the manufacturer of the vehicle, a manufacturer of the ECU 150, or a server facility maintained by a third party where the facility includes a plurality of servers serving unassociated users, often called “cloud” computing facilities. The antenna 144 is shown in
In different embodiments, the data stored in the memory 159 includes mapping data provided by the locations and directions traveled by each of the vehicles 100, 151, and 153. The mapping data is based on paths graded by the vehicle. In some embodiments, positions of the implement made by the implement when grading along the path are included in the mapping data. This data is processed by the ECU 150 to configure a map, which is accessible by each of the vehicles for use vehicle's control system to improve productivity. In one embodiment, the mapping data is transmitted in real time as the vehicle traverses the path. In other embodiments, the mapping data is stored in the server memory 159, which is accessible by one or more of the vehicles 100, 151, and 153 by known wireless techniques. In still other embodiments, the mapping data is stored locally in one or more of the vehicles and subsequently transmitted to the server memory or directly to one or more of the other vehicles.
The map information is used in conjunction with grade information by the vehicle's ECU 150 to determine one or more paths for the vehicle or vehicles when grading the surface. The ECU 150 of the vehicle selected to make a second or later pass along a path previously traveled determines a preferred path to be taken by the vehicle. In one embodiment, blade height information, blade angle, or both, are stored during a first path is compared to the preferred final contour of the surface being graded and used to determine a second preferred path. In one or more embodiments, two or more vehicles operate simultaneously along different parts of the terrain being graded to optimize productivity.
The ECU 150, in different embodiments, includes a computer, computer system, or other programmable devices. In other embodiments, the ECU 150 can include one or more processors (e.g. microprocessors), and an associated memory 161, which can be internal to the processor of external to the processor. The memory 161 can include random access memory (RAM) devices comprising the memory storage of the ECU 150, as well as any other types of memory, e.g., cache memories, non-volatile or backup memories, programmable memories, or flash memories, and read-only memories. In addition, the memory can include a memory storage physically located elsewhere from the processing devices and can include any cache memory in a processing device, as well as any storage capacity used as a virtual memory, e.g., as stored on a mass storage device or another computer coupled to ECU 150. The mass storage device can include a cache or other dataspace which can include databases. Memory storage, in other embodiments, is located in the “cloud”, where the memory is located at a distant location which provides the stored information wirelessly to the ECU 150.
The ECU 150 executes or otherwise relies upon computer software applications, components, programs, objects, modules, or data structures, etc. Software routines resident in the included memory of the ECU 150 or other memory are executed in response to the signals received. The computer software applications, in other embodiments, are located in the cloud. The executed software includes one or more specific applications, components, programs, objects, modules or sequences of instructions typically referred to as “program code”. The program code includes one or more instructions located in memory and other storage devices which execute the instructions which are resident in memory, which are responsive to other instructions generated by the system, or which are provided a user interface operated by the user. The ECU 150 is configured to execute the stored program instructions.
The ECU 150 is also operatively connected to a blade lift valves assembly 162 (see
To achieve better productivity and to reduce operator error, the ECU 150 is coupled to the transmission control unit 152 to control the amount of power applied to the wheels of the vehicle 100. The ECU 150 is further operatively connected to an engine control unit 164 which is, in part, configured to control the engine speed of the engine 116. A throttle 166 is operatively connected to the engine control unit 164. In one embodiment, the throttle 166 is a manually operated throttle located in the cab 110 which is adjusted by the operator of vehicle 100. In another embodiment, the throttle 166 is additionally a machine controlled throttle which is automatically controlled by the ECU 150 in response to grade information and vehicle speed information.
The ECU 150 provides engine control instructions to the engine control unit 164 and transmission control instruction to the transmission control unit 152 to adjust the speed of the vehicle in response to grade information provided by one of the machine control systems including the sonic system 154, the laser system 156, and the GPS system 158. In other embodiments, other machine control systems are used. Vehicle direction information is determined by the ECU 150 in response to direction information provided by the steering device 114.
Vehicle speed information is provided to the ECU 150, in part, by the transmission control unit 152 which is operatively connected to a transmission output speed sensor 168. The transmission output speed sensor 168 provides a sensed speed of an output shaft of the transmission, as is known by those skilled in the art. Additional transmission speed sensors are used in other embodiments including an input transmission speed sensor which provides speed information of the transmission input shaft.
Additional vehicle speed information is provided to the ECU 150 by the engine control unit 164. The engine control unit 164 is operatively connected to an engine speed sensor 170 which provides engine speed information to the engine control unit 164.
A current vehicle speed is determined at the ECU 150 using speed information provided by one of or both of the transmission control unit 152 and the engine control unit 164. The speed of the vehicle 100 is increased by speed control commands provided by the ECU 150 when the grade control system is on target to ensure maximum productivity.
As the vehicle moves along the path 198, the wheels 106 encounter portions of different irregularities at the same time, and consequently the wheels 106 are at different heights with respect to the intended grade of the surface 200. These different wheel heights correspondingly affect the location of the edge 133 of the blade 132 with respect to the intended surface 200.
The edge 133 is therefore inclined with respect to the ground surface by two factors that change as the vehicle 100 moves along the path 198. The first factor is based on the angle of the vehicle with respect to gravity as determined by the mainfall sensor 142. The second factor is based on the angle of the blade 132 with respect to the longitudinal axis of the vehicle 100. The blade angle with respect to the vehicle includes a first angle with respect to the horizontal axis defined by the wheel axis and a second angle defined with respect to the longitudinal axis of the vehicle, which is generally the same as the direction of the path 198, which is known as the cross-slope angle.
As the vehicle 100 moves along the path 198, the sensor 148 generates image data which is transmitted to the ECU 150. The ECU 150 is configured to process the received image data to determine the location and size of any positive or negative irregularity including length, height, depth, and distance to the irregularity. The ECU 150 determines the upcoming or anticipated ground contour with the image sensor 148 that can include both positive and negative irregularities. The memory 161 includes, in one or more embodiments, an object detector and an edge detector. The object detector and edge detector are each software applications or program code which are used by the processor ECU 150 to determine the content of the images transmitted by the image sensor 148 at block 220. The object detector is configured to determine the location of objects, positive and negative irregularities, found in the images and the edge detector is configured to determine the relationship between the objects found in the images. Distance of the vehicle 100, and particularly the blade 132 to the irregularities is also determined. Object detection software and edge detector software that determine the features appearing in the images are known by those skilled in the art.
Using one or more of the identified objects, edges, and distances, the time to arrive at the anticipated ground contour, which may include irregularities, is determined by the ECU 150 at block 222. This determined time of arrival is used to by the ECU 150 to adjust the position of the blade 132 at the appropriate time.
In different embodiments, the ECU 150 includes an object detector configured to distinguish the properties of different types of surface materials which are used to adjust the position of the blade 132. In one example, the object detector is configured to determine different types of aggregate materials including but not limited to sand, pebbles, packed soil, gravel, and others. The object detector determines the type of material and adjusts blade position to accommodate for the determined type of material.
The ECU 150 is further configured to determine, based on the received image content, whether the upcoming ground contour both a positive and a negative irregularity at block 224. If it does not, the ECU 150 determines the time to the positive or negative irregularity at block 226. Once the time has been determined the ECU 150 adjusts the blade angle based on a height of the positive irregularity or a depth of the negative ground irregularity using the determined time to arrival at the irregularity at block 228. After adjustment, the surface having the irregularity is adjusted at block 230.
If the upcoming surface includes both a positive and a negative ground irregularity, the height of the positive ground irregularity and the depth of the negative ground irregularity is determined at block 232. Once determined, the ECU 150 adjusts the blade position based on a weighted average of the height of the positive ground irregularity and the depth of the negative ground irregularity and the determined time at block 234. After adjustment, the surface is graded at block 230.
At block 234, the process takes into account the likelihood that the front tires 106 encounter both a positive irregularity and a negative irregularity at the same time. Because one wheel is elevated and the other wheel is lowered with respect to a final grade target, the ECU 150 accounts for the difference in heights which affects the poisoning of the blade. For instance, if only the positive irregularity is used to make a determination of blade position, the negative irregularity may not receive any material to fill in the depression. Consequently, the weighted average is used to reduce the number of times the vehicle passes over the same surface area to achieve a final grade needed to meet the desired grade target.
While exemplary embodiments incorporating the principles of the present disclosure have been described hereinabove, the present disclosure is not limited to the described embodiments. Instead, this application is intended to cover any variations, uses, or adaptations of the disclosure using its general principles. Further, this application is intended to cover such departures from the present disclosure as come within known or customary practice in the art to which this disclosure pertains and which fall within the limits of the appended claims.