The present disclosure relates to machine. An embodiment of the present disclosure relates to a system and method for stabilizing a ground-engaging blade of a work vehicle.
Work vehicles with ground-engaging blades may be used to shape and smooth ground surfaces. Such work vehicles may be supported by wheels or tracks which may encounter raised and lowered features on the ground as the work vehicles move, which cause the work vehicle to pitch forwards (downwards) or backwards (upwards). This pitching may be transmitted to the ground-engaging blade, causing it to move upwards and downwards and create unintended vertical variations on the ground surface instead of a smooth surface. This effect may be amplified for those work vehicles with a ground engaging blade in front of the work vehicles' tires or tracks, as unintended pitching of the vehicle may cause the blade to create ground variations which then cause further unintended pitching when encountered by the tires and tracks. If this self-reinforcing effect goes uncorrected by an operator, it may create a “washboard” type surface on the ground.
According to an aspect of the present disclosure, a work vehicle may include a chassis, a ground-engaging blade, a sensor, and a controller. The ground-engaging blade may be movably connected to the chassis via a linkage configured to allow the blade to be raised or lowered relative to the chassis. The sensor may be connected to the chassis at a fixed relative position to the chassis and configured to provide a pitch signal indicative of a rotational velocity in a pitch direction. The controller may be configured to receive the pitch signal and send a command to raise or lower the blade, the command may be based on a first gain and the pitch signal when the pitch signal indicates a rotational velocity in a first direction and a second gain and the pitch signal when the pitch signal indicates a rotational velocity in a second direction.
According to another aspect of the present disclosure, the command may be based on a pitch-command relationship which is based on kinematics of the linkage.
According to another aspect of the present disclosure, the work vehicle may further include a hydraulic cylinder and a hydraulic valve. The hydraulic cylinder may be connected to the linkage and configured to raise or lower the blade when provided with hydraulic fluid from the hydraulic valve. The command may be based on a pitch-command relationship which is based on a relationship between the command and a flow rate from the hydraulic valve to the hydraulic cylinder.
According to another aspect of the present disclosure, the controller may be further configured so that the first direction refers to when the chassis is pitching forward and the second direction refers to when the chassis is pitching backward. The magnitude of the first gain may be greater than the magnitude of the second gain.
According to another aspect of the present disclosure, the work vehicle may include ground-engaging tracks connected to the chassis. The ratio of the first gain to the second gain may be substantially the same as a ratio of a longitudinal distance from a rearmost ground-engaging portion of the tracks to the blade to a longitudinal distance from the center of gravity of the work vehicle to the blade.
According to another aspect of the present disclosure, the work vehicle may include ground-engaging tracks connected to the chassis. The ratio of the first gain to the second gain may be between 80% and 120% of a ratio of a longitudinal distance from the rearmost portion of the tracks engaged with the ground to the blade to a longitudinal distance from the center of gravity of the work vehicle to the blade.
According to another aspect of the present disclosure, the command is not based on a signal from a sensor connected at a fixed relative position to the blade and indicative of a position or a rotational velocity of the blade.
According to another aspect of the present disclosure, the work vehicle may include a blade sensor connected to the blade at a fixed relative position to the blade and configured to provide a position signal indicative of a vertical position of the blade or an angle of the blade relative to the direction of gravity. The command may be based on the position signal, the first gain, and the pitch signal when the pitch signal indicates a rotational velocity in a first direction and the command may be based on the position signal, the second gain, and the pitch signal when the pitch signal indicates a rotational velocity in a second direction.
According to another aspect of the present disclosure, a method of controlling a work vehicle with a ground-engaging blade may include receiving a pitch signal indicative of a rotational velocity of a chassis of the work vehicle in a pitch direction and determining a command signal which will counteract the effect of the rotational velocity of the chassis on the ground-engaging blade connected to the work vehicle based on a first gain and the pitch signal if the pitch signal indicates a rotational velocity in a first direction and based on a second gain and the pitch signal if the pitch signal indicates a rotational velocity in a second direction.
According to another aspect of the present disclosure, the first direction may be the chassis pitching forward and the second direction may be the chassis pitching backward. The magnitude of the first gain may be greater than the magnitude of the second gain.
According to another aspect of the present disclosure, the ratio of the first gain to the second gain may be substantially the same as a ratio of a longitudinal distance from a rearmost ground-engaging portion of chassis-connected tracks to the blade to a longitudinal distance from the center of gravity of the work vehicle to the blade.
According to another aspect of the present disclosure, the ratio of the first gain to the second gain may be between 80% and 120% of a ratio of a longitudinal distance from a rearmost ground-engaging portion of chassis-connected tracks to the blade to a longitudinal distance from the center of gravity of the work vehicle to the blade.
According to another aspect of the present disclosure, the determining step may not be based on a signal from a sensor connected to the blade at a fixed relative position to the blade and indicative of a position or a rotational velocity of the blade.
According to another aspect of the present disclosure, a work vehicle may include a chassis, a ground-engaging blade, a hydraulic cylinder, an electrohydraulic valve assembly, a rotational velocity sensor, and a controller. The ground-engaging blade may be movably connected to the chassis via a linkage configured to allow the blade to be raised and lowered relative to the chassis. The hydraulic cylinder may be connected to the linkage and configured to raise and lower the blade. The electrohydraulic valve assembly may be hydraulically connected to the hydraulic cylinder and configured to actuate the hydraulic cylinder. The rotational velocity sensor may be connected to the chassis and configured to provide a pitch signal indicative of a rotational velocity of the sensor in a pitch direction. The controller may be configured to receive the pitch signal, determine a command signal based on a first gain and the pitch signal if the pitch signal indicates a rotational velocity in a first direction and based on a second gain and the pitch signal if the pitch signal indicates a rotational velocity in a second direction, and communicate the command signal to the electrohydraulic valve assembly.
According to another aspect of the present disclosure, the work vehicle may include a position sensor. The position sensor may be connected to the linkage at a fixed relative position to the linkage. The position sensor may be configured to provide a position signal indicative of a position or an angle of at least one member of the linkage. The command signal may be based on the position signal.
According to another aspect of the present disclosure, the work vehicle may include a position sensor. The position sensor may be connected to the blade at a fixed relative position to the blade. The position sensor may be configured to provide a position signal indicative of a position or an angle of the blade. The command signal may be based on the position signal.
According to another aspect of the present disclosure, the first direction may be the chassis pitching forward. The second direction may be the chassis pitching backward. The magnitude of the first gain may be greater than the magnitude of the second gain.
According to another aspect of the present disclosure, the work vehicle may include ground-engaging tracks connected to the chassis. The ratio of the first gain to the second gain may be substantially the same as a ratio of a longitudinal distance from a rearmost ground-engaging portion of the tracks to the blade to a longitudinal distance from the center of gravity of the work vehicle to the blade.
According to another aspect of the present disclosure, the work vehicle may include ground-engaging tracks connected to the chassis. The ratio of the first gain to the second gain may be between 80% and 120% of a ratio of a longitudinal distance from the rearmost portion of the tracks engaged with the ground to the blade to a longitudinal distance from the center of gravity of the work vehicle to the blade.
According to another aspect of the present disclosure, the command signal is not based on a signal from a sensor connected to the blade at a fixed relative position to the blade and indicative of a position or a rotational velocity of the blade.
According to another aspect of the present disclosure, the work vehicle may be a crawler dozer.
The above and other features will become apparent from the following description and accompanying drawings.
The detailed description of the drawings refers to the accompanying figures in which:
Like reference numerals are used to indicate like elements throughout the several figures.
Work vehicle 100 is supported on the ground by undercarriage 114. Undercarriage 114 includes left track 116 and right track 118, which engage the ground and provide tractive force for work vehicle 100. Left track 116 and right track 118 may be comprised of shoes with grousers that sink into the ground to increase traction, and interconnecting components that allow the tracks to rotate about front idlers 120, track rollers 122, rear sprockets 124 and top idlers 126. Such interconnecting components may include links, pins, bushings, and guides, to name a few components. Front idlers 120, track rollers 122, and rear sprockets 124, on both the left and right sides of work vehicle 100, provide support for work vehicle 100 on the ground. Front idlers 120, track rollers 122, rear sprockets 124, and top idlers 126 are all pivotally connected to the remainder of work vehicle 100 and rotationally coupled to their respective tracks so as to rotate with those tracks. Track frame 128 provides structural support to these components and the remainder of undercarriage 114.
Front idlers 120 are positioned at the longitudinal front of left track 116 and right track 118 and provide a rotating surface for the tracks to rotate about and a support point to transfer force between work vehicle 100 and the ground. Left track 116 and right track 118 rotate about front idlers 120 as they transition between their vertically lower and vertically upper portions parallel to the ground, so approximately half of the outer diameter of each of front idlers 120 is engaged with left track 116 or right track 118. This engagement may be through a sprocket and pin arrangement, where pins included in left track 116 and right track 118 are engaged by recesses in front idlers 120 so as to transfer force. This engagement also results in the vertical height of left track 116 and right track 118 being only slightly larger than the outer diameter of each of front idlers 120 at the longitudinal front of left track 116 and right track 118. Frontmost engaging point 130 of left track 116 and right track 118 can be approximated as the point on each track vertically below the center of front idlers 120, which is generally the frontmost point of left track 116 and right track 118 which engages the ground. When work vehicle 100 encounters a ground feature when traveling in a forward direction, left track 116 and right track 118 may first encounter it at frontmost engaging point 130. If the ground feature is at a higher elevation than the surrounding ground surface (i.e., an upward ground feature), work vehicle 100 may begin pitching backward (which may also be referred to as pitching upward) when frontmost engaging point 130 reaches the ground feature. If the ground feature is at a lower elevation than the surrounding ground surface (i.e., a downward ground feature), work vehicle 100 may continue forward without pitching until the center of gravity of work vehicle 100 is vertically above the edge of the downward ground feature. At that point, work vehicle 100 may pitch forward (which may also be referred to as pitching downward) until frontmost engaging point 130 contacts the ground. In this embodiment, front idlers 120 are not powered and thus are freely driven by left track 116 and right track 118. In alternative embodiments, front idlers 120 may be powered, such as by an electric or hydraulic motor, or may have an included braking mechanism configured to resist rotation and thereby slow left track 116 and right track 118.
Track rollers 122 are longitudinally positioned between front idlers 120 and rear sprockets 124 along the bottom left and bottom right sides of work vehicle 100. Each of track rollers 122 may be rotationally coupled to left track 116 or right track 118 through engagement between an upper surface of the tracks and a lower surface of track rollers 122. This configuration may allow track rollers 122 to provide support to work vehicle 100, and in particular may allow for the transfer of forces in the vertical direction between work vehicle 100 and the ground. This configuration also resists the upward deflection of left track 116 and right track 118 as they traverse an upward ground feature whose longitudinal length is less than the distance between front idlers 120 and rear sprockets 124.
Rear sprockets 124 may be positioned at the longitudinal rear of left track 116 and right track 118 and, similar to front idlers 120, provide a rotating surface for the tracks to rotate about and a support point to transfer force between work vehicle 100 and the ground. Left track 116 and right track 118 rotate about rear sprockets 124 as they transition between their vertically lower and vertically upper portions parallel to the ground, so approximately half of the outer diameter of each of rear sprockets 124 is engaged with left track 116 or right track 118. This engagement may be through a sprocket and pin arrangement, where pins included in left track 116 and right track 118 are engaged by recesses in rear sprockets 124 so as to transfer force. This engagement also results in the vertical height of left track 116 and right track 118 being only slightly larger than the outer diameter of each of rear sprockets 124 at the longitudinal back or rear of left track 116 and right track 118. Rearmost engaging point 132 of left track 116 and right track 118 can be approximated as the point on each track vertically below the center of rear sprockets 124, which is generally the rearmost point of left track 116 and right track 118 which engages the ground. When work vehicle 100 encounters a ground feature when traveling in a reverse or backward direction, left track 116 and right track 118 may first encounter it at rearmost engaging point 132. If the ground feature is at a higher elevation than the surrounding ground surface, work vehicle 100 may begin pitching forward when rearmost engaging point 132 reaches the ground feature. If the ground feature is at a lower elevation than the surrounding ground surface, work vehicle 100 may continue backward without pitching until the center of gravity of work vehicle 100 is vertically above the edge of the downward ground feature. At that point, work vehicle 100 may pitch backward until rearmost engaging point 132 contacts the ground.
In this embodiment, each of rear sprockets 124 may be powered by a rotationally coupled hydraulic motor so as to drive left track 116 and right track 118 and thereby control propulsion and traction for work vehicle 100. Each of the left and right hydraulic motors may receive pressurized hydraulic fluid from a hydrostatic pump whose direction of flow and displacement controls the direction of rotation and speed of rotation for the left and right hydraulic motors. Each hydrostatic pump may be driven by engine 134 of work vehicle 100, and may be controlled by an operator in operator station 136 issuing commands which may be received by controller 138 and communicated to the left and right hydrostatic pumps by controller 138. In alternative embodiments, each of rear sprockets 124 may be driven by a rotationally coupled electric motor or a mechanical system transmitting power from engine 134.
Top idlers 126 are longitudinally positioned between front idlers 120 and rear sprockets 124 along the left and right sides of work vehicle 100 above track rollers 122. Similar to track rollers 122, each of top idlers 126 may be rotationally coupled to left track 116 or right track 118 through engagement between a lower surface of the tracks and an upper surface of top idlers 126. This configuration may allow top idlers 126 to support left track 116 and right track 118 for the longitudinal span between front idlers 120 and rear sprockets 124, and prevent downward deflection of the upper portion of left track 116 and right track 118 parallel to the ground between front idlers 120 and rear sprockets 124.
Undercarriage 114 is affixed to, and provides support and tractive effort for, chassis 140 of work vehicle 100. Chassis 140 is the frame which provides structural support and rigidity to work vehicle 100, allowing for the transfer of force between blade 142 and left track 116 and right track 118. In this embodiment, chassis 140 is a weldment comprised of multiple formed and joined steel members, but in alternative embodiments it may be comprised of any number of different materials or configurations. Sensor 144 is affixed to chassis 140 of work vehicle 100 and configured to provide a signal indicative of the movement and orientation of chassis 140. In alternative embodiments, sensor 144 may not be affixed directly to chassis 140, but may instead be connected to chassis 140 through intermediate components or structures, such as rubberized mounts. In these alternative embodiments, sensor 144 is not directly affixed to chassis 140 but is still connected to chassis 140 at a fixed relative position so as to experience the same motion as chassis 140.
Sensor 144 is configured to provide a signal indicative of the angular velocity of chassis 140 in the direction of pitch 108. This signal may be referred to as a pitch signal. Controller 138 may actuate blade 142 based on this pitch signal, as further described with regard to
Blade 142 is a work implement which may engage the ground or material to move or shape it. Blade 142 may be used to move material from one location to another and to create features on the ground, including flat areas, grades, hills, roads, or more complexly shaped features. In this embodiment, blade 142 of work vehicle 100 may be referred to as a six-way blade, six-way adjustable blade, or power-angle-tilt (PAT) blade. Blade 142 may be hydraulically actuated to move vertically up or vertically down (which may also be referred to as blade lift, or raise and lower), roll left or roll right (which may be referred to as blade tilt, or tilt left and tilt right), and yaw left or yaw right (which may be referred to as blade angle, or angle left and angle right). Alternative embodiments may utilize a blade with fewer hydraulically controlled degrees of freedom, such as a 4-way blade that may not be angled, or actuated in the direction of yaw 112.
Blade 142 is movably connected to chassis 140 of work vehicle 100 through linkage 146, which supports and actuates blade 142 and is configured to allow blade 142 to be raised or lowered relative to chassis 140 (i.e., moved in the direction of vertical 110). Linkage 146 may include multiple structural members to carry forces between blade 142 and the remainder of work vehicle 100 and may provide attachment points for hydraulic cylinders which may actuate blade 142 in the lift, tilt, and angle directions.
Linkage 146 includes c-frame 148, a structural member with a C-shape positioned rearward of blade 142, with the C-shape opening toward the rear of work vehicle 100. Each rearward end of c-frame 148 is pivotally connected to chassis 140 of work vehicle 100, such as through a pin-bushing joint, allowing the front of c-frame 148 to be raised or lowered relative to work vehicle 100 about the pivotal connections at the rear of c-frame 148. The front portion of c-frame 148, which is approximately positioned at the lateral center of work vehicle 100, connects to blade 142 through a ball-socket joint. This allows blade 142 three degrees of freedom in its orientation relative to c-frame 148 (lift-tilt-angle) while still transferring rearward forces on blade 142 to the remainder of work vehicle 100.
Sensor 149 is connected to blade 142 above the ball-socket joint connecting blade 142 to c-frame 148. Sensor 149, like sensor 144, may be configured to measure orientation, angular velocity, or acceleration. Sensor 149 is an optional component which may be used in certain embodiments to directly sense an angular or linear position, velocity, or acceleration of blade 142. In alternative embodiments, a sensor may be configured to instead measure an angle of linkage 146, such as an angle between linkage 146 and chassis 140, in order to determine a position of blade 142. In other alternative embodiments, sensor 149 may be configured to measure a position of blade 142 by measuring a different angle, such as one between linkage 146 and blade 142, or the linear displacement of a cylinder attached to linkage 146 or blade 142. In other alternative embodiments, there may be no sensor configured to directly measure a position, velocity, or acceleration of blade 142 or linkage 146.
Blade 142 may be raised or lowered relative to work vehicle 100 by the actuation of lift cylinders 150, which may raise and lower c-frame 148 and thus raise and lower blade 142, which may also be referred to as blade lift. For each of lift cylinders 150, the rod end is pivotally connected to an upward projecting clevis of c-frame 148 and the head end is pivotally connected to the remainder of work vehicle 100 just below and forward of operator station 136. The configuration of linkage 146 and the positioning of the pivotal connections for the head end and rod end of lift cylinders 150 results in the extension of lift cylinders 150 lowering blade 142 and the retraction of lift cylinders 150 raising blade 142. In alternative embodiments, blade 142 may be raised or lowered by a different mechanism, or lift cylinders 150 may be configured differently, such as a configuration in which the extension of lift cylinders 150 raises blade 142 and the retraction of lift cylinders 150 lowers blade 142.
Blade 142 may be tilted relative to work vehicle 100 by the actuation of tilt cylinder 152, which may also be referred to as moving blade 142 in the direction of roll 104. For tilt cylinder 152, the rod end is pivotally connected to a clevis positioned on the back and left sides of blade 142 above the ball-socket joint between blade 142 and c-frame 148 and the head end is pivotally connected to an upward projecting portion of linkage 146. The positioning of the pivotal connections for the head end and the rod end of tilt cylinder 152 result in the extension of tilt cylinder 152 tilting blade 142 to the left or counterclockwise when viewed from operator station 136 and the retraction of tilt cylinder 152 tilting blade 142 to the right or clockwise when viewed from operator station 136. In alternative embodiments, blade 142 may be tilted by a different mechanism (e.g., an electrical or hydraulic motor) or tilt cylinder 152 may be configured differently, such as a configuration in which it is mounted vertically and positioned on the left or right side of blade 142, or a configuration with two tilt cylinders.
Blade 142 may be angled relative to work vehicle 100 by the actuation of angle cylinders 154, which may also be referred to as rotating blade 142 in the direction of yaw 112. For each of angle cylinders 154, the rod end is pivotally connected to a clevis of blade 142 while the head end is pivotally connected to a clevis of c-frame 148. One of angle cylinders 154 is positioned on the left side of work vehicle 100, left of the ball-socket joint between blade 142 and c-frame 148, and the other of angle cylinders 154 is positioned on the right side of work vehicle 100, right of the ball-socket joint between blade 142 and c-frame 148. This positioning results in the extension of the left of angle cylinders 154 and the retraction of the right of angle cylinders 154 angling blade 142 rightward, or yawing blade 142 clockwise when viewed from above, and the retraction of left of angle cylinder 150 and the extension of the right of angle cylinders 154 angling blade 142 leftward, or yawing blade 142 counterclockwise when viewed from above. In alternative embodiments, blade 142 may be angled by a different mechanism or angle cylinders 154 may be configured differently.
Due to the geometry of linkage 146 in this embodiment, blade 142 is not raised or lowered in a perfectly vertical line with respect to work vehicle 100. Instead, a point on blade 142 would trace a curve as blade 142 is raised and lowered. This means that the vertical component of the velocity of blade 142 is not perfectly proportional to the linear velocity with which lift cylinders 150 are extending or retracting, and the vertical component of blade 142's velocity may vary even when the linear velocity of lift cylinders 150 is constant. This also means that lift cylinders 150 have a mechanical advantage which varies depending on the position of linkage 146. Given a kinematic model of blade 142 and linkage 146 (e.g., formula(s) or table(s) providing a relationship between the position and/or movement of portions of blade 142 and linkage 146) and the state of blade 142 and linkage 146 (e.g., sensor(s) sensing one or more positions, angles, or orientations of blade 142 or linkage 146, such as sensor 149), at least with respect to blade lift, controller 138 may compensate for such non-linearity. Incomplete or simplified kinematic models may be used if there is a need to only focus on particular motion relationships (e.g., only those affecting blade lift) or if only a limited compensation accuracy is desired. Controller 138 may utilize this compensation and a desired velocity, for example a command to raise blade 142 at a particular vertical velocity, to issue a command that may achieve a flow rate into lift cylinders 150 that results in blade 142 being raised at the particular vertical velocity regardless of the current position of linkage 146. For example, controller 138 may issue commands which vary the flow rate into lift cylinders 150 in order to achieve a substantially constant vertical velocity of blade 142.
Similarly, due to the positioning of tilt cylinder 152 and angle cylinders 154 and the configuration of their connection to blade 142, the angular velocity of blade tilt and angle is not perfectly proportional to the linear velocity of tilt cylinder 152 and angle cylinders 154, respectively, and the angular velocity of tilt and angle may vary even when the linear velocity of tilt cylinder 152 and angle cylinders 154, respectively, is constant. This also means that tilt cylinder 152 and angle cylinders 154 each has a mechanical advantage which varies depending on the position of blade 142. Much like with lift cylinders 150, given a kinematic model of blade 142 and linkage 146, and the state of blade 142 and linkage 146, at least with respect to blade tilt and angle, controller 138 may compensate for such non-linearity. Incomplete or simplified kinematic models may be used if there is a need to only focus on particular motion relationships (e.g., only those affecting blade tilt and angle) or if only limited compensation accuracy is required. Controller 138 may utilize this compensation and a desired angular velocity, for example a command to tilt or angle blade 142 at a particular angular velocity, to issue commands that may vary the flow rate into tilt cylinder 152 or angle cylinders 154 to result in blade 142 being tilted or angled at the particular angular velocity regardless of the current position of blade 142 or linkage 146.
In alternative embodiments, blade 142 may be connected to the remainder of work vehicle 100 in a manner which tends to make the blade lift velocity (in direction of vertical 110), tilt angular velocity (in the direction of roll 104), or angle angular velocity (in the direction of yaw 112) proportional to the linear velocity of lift cylinders 150, tilt cylinder 152, or angle cylinders 154, respectively. This may be achieved with particular designs of linkage 146 and positioning of the pivotal connections of lift cylinders 150, tilt cylinder 152, and angle cylinders 154. In such alternative embodiments, controller 138 may not need to compensate for non-linear responses of blade 142 to the actuation of lift cylinders 150, tilt cylinder 152, and angle cylinders 154, or the need for compensation may be reduced.
Each of lift cylinders 150, tilt cylinder 152, and angle cylinders 154 is a double acting hydraulic cylinder. One end of each cylinder may be referred to as a head end, and the end of each cylinder opposite the head end may be referred to as a rod end. Each of the head end and the rod end may be fixedly connected to another component or, as in this embodiment, pivotally connected to another component, such as a through a pin-bushing or pin-bearing coupling, to name but two examples of pivotal connections. As a double acting hydraulic cylinder, each may exert a force in the extending or retracting direction. Directing pressurized hydraulic fluid into a head chamber of the cylinders will tend to exert a force in the extending direction, while directing pressurized hydraulic fluid into a rod chamber of the cylinders will tend to exert a force in the retracting direction. The head chamber and the rod chamber may both be located within a barrel of the hydraulic cylinder, and may both be part of a larger cavity which is separated by a movable piston connected to a rod of the hydraulic cylinder. The volumes of each of the head chamber and the rod chamber change with movement of the piston, while movement of the piston results in extension or retraction of the hydraulic cylinder. The control of these cylinders will be described in further detail with regard to
In the embodiment illustrated in
Controller 138, which may be referred to as a vehicle control unit (VCU), is in communication with a number of components on work vehicle 100, including hydraulic components such as electrohydraulic pilot valve 160, electrical components such as operator inputs within operator station 136, sensor 144, sensor 149, and other components. Controller 138 is electrically connected to these other components by a wiring harness such that messages, commands, and electrical power may be transmitted between controller 138 and the remainder of work vehicle 100. Controller 138 may be connected to some of these sensors or other controllers, such as an engine control unit (ECU), through a controller area network (CAN). Controller 138 may then send and receive messages over the CAN to communicate with other components on the CAN.
In alternative embodiments, controller 138 may send a command to actuate blade 142 in a number of different manners. As one example, controller 138 may be in communication with a valve controller via a CAN and may send command signals to the valve controller in the form of CAN messages. The valve controller may receive these messages from controller 138 and send current to specific solenoids within electrohydraulic pilot valve 160 based on those messages. As another example, controller 138 may actuate blade 142 by actuating an input in operator station 136. For example, an operator may use a joystick to issue commands to actuate blade 142, and the joystick may generate hydraulic pressure signals, pilots, which are communicated to hydraulic control valve 156 to cause the actuation of blade 142. In such a configuration, controller 138 may be in communication with electrical devices (e.g., solenoids, motors) which may actuate a joystick in operator station 136. In this way, controller 138 may actuate blade 142 by actuating these electrical devices instead of communicating signals to electrohydraulic pilot valve 160.
As work vehicle 100 continues to drive over ground feature 162, frontmost engaging point 130 would cease to engage the ground and instead would remain suspended above the ground by a distance determined in part by the height of ground feature 162 relative to the surrounding ground surface and the position of work vehicle 100 on ground feature 162. At this point, although ground feature 162 is an upward ground feature, it has the effect of a downward ground feature at a lower elevation than the surrounding ground surface. Specifically, the area just past ground feature 162 is lower than ground feature 162. As the center of gravity for work vehicle 100 passes over the top of ground feature 162, work vehicle 100 will pitch forwards and rearmost engaging point 132 will leave the ground surface while frontmost engaging point 130 will fall until it contacts the ground surface.
During the process of work vehicle 100 driving over ground feature 162, blade 142 will rise and fall relative to the ground surface due to the pitching of work vehicle 100. As work vehicle 100 pitches backward, blade 142 will rise as c-frame 148 pitches backward with work vehicle 100, and as work vehicle 100 pitches forward, blade 142 will fall as c-frame 148 pitches forward with work vehicle 100. If the operator of work vehicle 100 fails to correct for ground feature 162 by commanding blade 142 to rise or fall in a manner that counteracts the effect of ground feature 162 on the height of blade 142, work vehicle 100 will create vertical variations on the ground surface instead of a smooth surface, such as a hill and a valley. As work vehicle 100 drives over this newly created hill and valley on the ground surface, blade 142 will once again be raised and lowered as work vehicle 100 pitches backward and forward, creating further vertical variations. This series of hills and valleys may be referred to as a “washboard” pattern.
While this is occurring, sensor 144 sends a signal indicative of the pitching of chassis 140 to controller 138. Controller 138 may also receive a signal from controls in operator station 138 which the operator may use to issue commands, for example a command to raise or lower blade 142. If controller 138 does not sense a command from the operator to raise or lower blade 142, but receives a pitch signal from sensor 144 indicating that chassis 140 is pitching, controller 138 may issue a command to electrohydraulic pilot valve 160 to raise or lower blade 142 to counteract the effect of pitch from chassis 140. In this manner, controller 138 may attempt to mitigate or attenuate the effect of pitching of chassis 140 on the height of blade 142 and thereby create a smoother ground surface, as further described with regard to
In this embodiment, each of sensor 144 and sensor 149 comprise three accelerometers, each measuring linear acceleration in one of three perpendicular directions, and three gyroscopes, each measuring angular velocity in one of three perpendicular directions. In this way, sensor 144 and sensor 149 may each directly measure the linear acceleration or angular velocity in any direction, including the directions of longitude 102, latitude 106, vertical 110, roll 104, pitch 108, and yaw 112. The linear acceleration of each accelerometer may be filtered to remove short term accelerations or otherwise analyzed to determine the direction of gravity, which exerts a constant acceleration on sensor 144 and sensor 149. The measurements from the accelerometers and gyroscopes of sensor 144 and sensor 149 may be combined or analyzed together to improve the accuracy and/or reduce the latency with which the direction of gravity may be determined. For example, the accelerometers may measure the direction of gravity with high accuracy over a period of time sufficient to remove the effects of short-term accelerations, while the gyroscopes may measure changes to the direction of gravity very quickly but be subject to drift if these changes are integrated to determine the direction and error is allowed to accumulate.
If the blade control input signal is in the deadband, which indicates that the operator is not issuing a command, controller 138 performs step 406 next. In step 406, controller 138 receives the pitch signal from sensor 144. As an example, controller 138 may receive a CAN message transmitted from sensor 144 to controller 138 via a wire harness. Controller 138 may be programmed to interpret the CAN message to read a value from 1 to 100, where 1 indicates a pitching velocity of 50 degrees a second forward/downward, 100 indicates a pitching velocity of 50 degrees a second backward/upward, and intermediate values indicate intermediate pitching velocities, with a pitching velocity of 0 degrees per second at 50 and 51.
In step 408, controller 138 determines a gain based on whether the pitch signal indicates that chassis 140 is pitching in a first direction (e.g., forwards/downwards) or a second direction (e.g., backwards/upwards). As an example, controller 138 may receive a voltage transmitted from sensor 144 to controller 138 via a wire harness, where a voltage from 0.5-2.5 volts indicates a pitching velocity in the forward/downward direction while a voltage from 2.5-4.5 volts indicates a pitching velocity in the backward/upward direction. Controller 138 may select a first value for the gain, or a first gain, if chassis 140 is pitching forwards/downwards and a second value for the gain, or a second gain, if chassis 140 is pitching backwards/upwards. The value of the gain for each direction of pitching may vary depending on the design of work vehicle 100 and controller 138. For example, the gain may be 4 for a pitching velocity in the forward/downward direction and 2.5 for a pitching velocity in the backward/upward direction.
The value for the first gain and the value for the second gain may be selected based on empirical data for work vehicle 100, the conditions in which work vehicle 100 is operating (e.g., gravel, hard soil, sandy soil), or measurements or characteristics of work vehicle 100 (e.g., hydraulic system responsiveness or speed, weight, length, height, center of gravity), to name but a few possibilities. Additionally, the value of the first gain and second gain may be dependent on each other. As one example, the first gain may be determined for work vehicle 100, and then the second gain may be determined based on the first gain and a characteristic of work vehicle 100. The first gain may be determined based on empirical data for work vehicle 100 or an analogous work vehicle. The second gain may be determined based on the ratio of the longitudinal distance between the rearmost engaging point 132 and blade 142 and the longitudinal distance between the center of gravity for work vehicle 100 and blade 142. This assumes that work vehicle 100 will pitch forwards/downwards approximately about its center of gravity, but will pitch backwards/upwards about an axis closer to rear sprockets 124 when moving in a forward direction.
In alternative embodiments, step 408 may also be based on the direction that work vehicle 100 is traveling. For example, the first gain may be chosen if work vehicle 100 is pitching forwards/downwards and is traveling in a forward direction or if work vehicle 100 is pitching backwards/upwards and is traveling in a reverse direction. Conversely, the second gain may be chosen if work vehicle 100 is pitching backwards/upwards and is traveling in a forward direction or if work vehicle is pitching forwards/downwards and is traveling in a reverse direction.
In alternative embodiments, the gain may also be based on the speed of work vehicle 100 or the magnitude of the pitch signal. For example, the gain may be increased for greater speeds of work vehicle 100 and decreased for lesser speeds of work vehicle 100. As another example, the gain may be increased as the magnitude of the pitch signal increases and decreased as the magnitude of the pitch signal decreases. As another example, the gain may be selected based on a PID (proportional-integral-derivative) control. In these alternate embodiments, the first gain may correspond to a first set of gains or first set of gain constants (e.g., values for PID controller) when work vehicle 100 is pitching forwards/downwards and the second gain may correspond to a second set of gains or second set of gain constants when work vehicle 100 is pitching backwards/upwards.
In step 410, controller 138 may receive a position signal from sensor 149. Sensor 149 may provide a position signal indicating an orientation of blade 142 with respect to the direction of gravity (i.e., inclination). Sensor 149 may provide this signal to controller 138 in the form of a CAN message or a voltage, to name but two possibilities. In alternative embodiments, sensor 149 may be configured to measure any number of angles or positions of blade 142 or linkage 146, including by measuring other components, such as measuring the linear displacement of lift cylinders 150. As an example, sensor 149 may be a rotary position sensor connected in part to chassis 140 and in part to c-frame 148 so as to enable it to measure the angle of linkage 146 relative to chassis 140. As another example, sensor 149 may be a linear displacement sensor connected to one of lift cylinders 150 and configured to measure the extension and retraction of one of lift cylinders 150.
In step 412, controller 138 may determine a kinematic correction based on the position signal from sensor 149. Controller 138 may determine the kinematic correction through the usage of lookup tables or equations, to name but two possibilities. For example, controller 138 may access a lookup table stored in memory which correlates the current position of blade 142 relative to chassis 140 with the sensitivity of blade 142 to movement of lift cylinders 150 (e.g., the ratio of vertical motion of blade 142 to linear motion of lift cylinders 150). This sensitivity may be used to adjust the command signal from controller 138 to achieve a desired vertical velocity. For example, controller 138 may receive a signal from sensor 149 indicating that blade 142 is at an angle of 10 degrees relative to gravity while sensor 144 indicates that chassis 140 is at an angle of 5 degrees relative to gravity, and may determine that the current sensitivity of blade 142 is 0.25 by looking up the difference (+5 degrees) in a lookup table. If it is desired to lower blade 142 at a rate of 100 mm/s, controller 138 may send a command signal to electrohydraulic pilot valve 160 which causes hydraulic control valve 156 to meter hydraulic fluid to lift cylinders 150 so as to cause them to retract at 400 mm/s (100/0.25). This lookup may also be referred to as a pitch-command relationship, as it relates a command necessary to effectuate a particular pitch of the blade. As another example, controller 138 may calculate the sensitivity of blade 142 to movement of lift cylinders 150 based on an equation or a series of equations which describe or approximate the motion of portions of blade 142 or linkage 146.
In alternative embodiments, step 410 and step 412 may not be performed and step 414 may be modified so that it does not rely upon kinematic correction, such as in
In step 414, controller 138 calculates a command signal based on the pitch signal received in step 406, the gain determined in step 408, and the kinematic correction determined in step 412. In one embodiment, controller 138 may perform this determination by multiplying the pitch signal by the gain and the kinematic correction. In other embodiments, controller 138 may determine the command signal through one or more equations, and may utilize one or more lookup tables in the determination.
In step 416, the command signal determined in step 414 is sent by controller 138 to electrohydraulic pilot valve 160. This command signal may be in the form of a CAN message to another controller which directly controls electrohydraulic pilot valve 160 or may be a current carried by a wire harness directly to a solenoid in electrohydraulic pilot valve 160. This command signal may be used to change the pressure of one or more pilots from electrohydraulic pilot valve 160 to hydraulic control valve 156, and thereby change the metering of hydraulic fluid to a hydraulic function such as lift cylinders 150 to raise or lower blade 142. After step 416, controller 138 may return to step 402 and thereby loop control system 400.
If the blade control input signal is in the deadband, which indicates that the operator is not issuing a command, controller 138 may perform step 506 next. In step 506, controller 138 receives the pitch signal from sensor 144. In step 508, controller 138 determines a gain based on whether the pitch signal indicates that chassis 140 is pitching in a first direction (e.g., forwards/downwards) or a second direction (e.g., backwards/upwards). Controller 138 may select a first value for the gain, or a first gain, if chassis 140 is pitching forwards/downwards and a second value for the gain, or a second gain, if chassis 140 is pitching backwards/upwards. In step 510, controller 138 calculates a command signal based on the pitch signal received in step 506 and the gain determined in step 508. Controller 138 performs this determination by multiplying the pitch signal by the gain. In alternative embodiments, controller 138 may determine the command signal through one or more equations, and may utilize one or more lookup tables in the determination.
In step 512, controller 138 sends the command signal determined in step 510 to electrohydraulic pilot valve 160 to change the metering of hydraulic fluid by hydraulic control valve 156 to lift cylinders 150. This may counteract the effect of pitching of chassis 140 on the vertical position of blade 142, and thereby mitigate the effect of such pitching on the smoothness of the surface being worked by work vehicle 100. After step 512, controller 138 may return to step 502 and thereby loop control system 500. The embodiment in
As one example of an application of control system 500, controller 138 may receive a signal from a blade control input and determine that the signal is less than 5% of its maximum value, and therefore within the deadband for that control. Controller 138 may next receive a pitch signal from sensor 144 indicating that chassis 140 is pitching 20 degrees per second in the forward/downward direction. Controller 138 may apply a gain of 4 to pitching in this direction, resulting in a command signal of 80. This command signal may represent a command to raise blade 142 by 80% of the maximum rate it may be raised. This command signal may then be communicated to electrohydraulic pilot valve 160, for example by an electrical current sent by controller 138 via a wiring harness to a solenoid in electrohydraulic pilot valve 160. The command signal of 80 may be converted, for example through the use of a lookup table, to a corresponding electrical current.
If the blade control input signal is in the deadband, which indicates that the operator is not issuing a command, controller 138 may perform step 606 next. In step 606, controller 138 receives the pitch signal from sensor 144. In step 608, controller 138 determines a gain based on whether the pitch signal indicates that chassis 140 is pitching in a first direction (e.g., forwards/downwards) or a second direction (e.g., backwards/upwards). Controller 138 may select a first value for the gain, or a first gain, if chassis 140 is pitching forwards/downwards and a second value for the gain, or a second gain, if chassis 140 is pitching backwards/upwards.
In step 610, controller 138 receives a position signal from sensor 149. This position signal may be in the form of a CAN message which indicates the inclination of blade 142, or the angle of blade 142 with respect to the direction of gravity. Sensor 149 may determine this inclination through the use of accelerometers which measure the direction of gravity and then calculating the angle of sensor 149 relative to that direction.
In step 612, controller 138 determines a position correction based on the position signal received in step 610. As control system 600 performs corrections to mitigate the effects of the pitching of chassis 140 on the grade produced by blade 142, the position of blade 142 may drift from its initial position due to such corrections. In step 612, controller 138 may determine whether the position of blade 142 needs to be corrected, and if so by what amount. In this embodiment, controller 138 may compare the position of blade 142 received in step 610 with the position of blade 142 at the time that the operator last issued a blade control input outside the deadband. This last-commanded position may be stored by controller 138 when step 604 indicates that the blade control input signal is outside the deadband. Controller 138 may then calculate a position correction based on the comparison, which in this embodiment may be done by multiplying the difference between the current position of blade 142 and the last-commanded position of blade 142 by a gain. In alternative embodiments, other methods of determining a position correction may be employed, including by using a PID (proportional-integral-derivative) control, equations, variable gains, or lookup tables.
In step 614, controller 138 calculates a command signal based on the pitch signal received in step 606, the gain determined in step 608, and the position correction determined in step 612. Controller 138 performs this determination by multiplying the pitch signal by the gain and adding the position correction. In alternative embodiments, controller 138 may determine the command signal by multiplying all three values or through the use of one or more equations and/or lookup tables.
In step 616, controller 138 sends the command signal determined in step 614 to electrohydraulic pilot valve 160 to change the metering of hydraulic fluid by hydraulic control valve 156 to lift cylinders 150. After step 616, controller 138 may return to step 602 and thereby loop control system 600. Control system 600 may counteract the effect of pitching of chassis 140 on the vertical position of blade 142, and thereby mitigate the effect of such pitching on the smoothness of the surface being worked by work vehicle 100, while also eventually returning blade 142 to the vertical position it held at the time of the last operator command.
While the disclosure has been illustrated and described in detail in the drawings and foregoing description, such illustration and description is not restrictive in character, it being understood that illustrative embodiment(s) have been shown and described and that all changes and modifications that come within the spirit of the disclosure are desired to be protected. Alternative embodiments of the present disclosure may not include all of the features described yet still benefit from at least some of the advantages of such features. Those of ordinary skill in the art may devise their own implementations that incorporate one or more of the features of the present disclosure and fall within the spirit and scope of the appended claims.
Number | Name | Date | Kind |
---|---|---|---|
2941319 | Beemer et al. | Jun 1960 | A |
4535847 | Hasegawa et al. | Aug 1985 | A |
5462125 | Stratton et al. | Oct 1995 | A |
5499684 | Stratton | Mar 1996 | A |
5551518 | Stratton | Sep 1996 | A |
5816335 | Yamamoto | Oct 1998 | A |
5862868 | Yamamoto et al. | Jan 1999 | A |
5987371 | Bailey et al. | Nov 1999 | A |
6035241 | Yamamoto | Mar 2000 | A |
6112145 | Zachman | Aug 2000 | A |
6164117 | Passwater et al. | Dec 2000 | A |
6181999 | Yamamoto | Jan 2001 | B1 |
6269885 | Barber et al. | Aug 2001 | B1 |
6609315 | Hendron et al. | Aug 2003 | B1 |
6757994 | Hendron | Jul 2004 | B1 |
6763619 | Hendron et al. | Jul 2004 | B2 |
6845311 | Stratton | Jan 2005 | B1 |
7121355 | Lumpkins et al. | Oct 2006 | B2 |
7206681 | Casey et al. | Apr 2007 | B2 |
7317977 | Matrosov | Jan 2008 | B2 |
7588088 | Zachman | Sep 2009 | B2 |
7643923 | Buehlmann et al. | Jan 2010 | B2 |
8060299 | Gharsalli et al. | Nov 2011 | B2 |
8082084 | Nichols | Dec 2011 | B2 |
8141650 | Breiner et al. | Mar 2012 | B2 |
8145391 | Omelchenko et al. | Mar 2012 | B2 |
8275524 | Krause et al. | Sep 2012 | B2 |
8340873 | Finley et al. | Dec 2012 | B2 |
8352132 | Omelchenko et al. | Jan 2013 | B2 |
8406963 | Farmer et al. | Mar 2013 | B2 |
8412418 | Kumagai et al. | Apr 2013 | B2 |
8437926 | Shintani | May 2013 | B2 |
8473166 | Zhdanov et al. | Jun 2013 | B2 |
8594879 | Roberge et al. | Nov 2013 | B2 |
8634991 | Douglas | Jan 2014 | B2 |
8700273 | Farmer | Apr 2014 | B2 |
8706363 | Stratton | Apr 2014 | B2 |
8738242 | Konno | May 2014 | B2 |
8919455 | Hendron et al. | Dec 2014 | B2 |
20080087447 | Piekutowski | Apr 2008 | A1 |
20080127530 | Kelly | Jun 2008 | A1 |
20090112410 | Shull | Apr 2009 | A1 |
20110153170 | Dishman et al. | Jun 2011 | A1 |
20110169949 | McCain et al. | Jul 2011 | A1 |
20110213529 | Krause et al. | Sep 2011 | A1 |
20120059554 | Omelchenko et al. | Mar 2012 | A1 |
20120073843 | Kure | Mar 2012 | A1 |
20130080112 | Friend | Mar 2013 | A1 |
20130158818 | Callaway | Jun 2013 | A1 |
20140019013 | Liu et al. | Jan 2014 | A1 |
20140326471 | Zhu | Nov 2014 | A1 |
Number | Date | Country |
---|---|---|
1118719 | Jul 2001 | EP |
Entry |
---|
Earthmoving Report: Cat K2 Dozers Offer Finely Tuned Finish Grading. Earthmoving Report [online]. Feb. 28, 2012. [retrieved on May 19, 2014] http://www.constructionequipment.com/earthmoving-report-cat-K2-dozers-offer-finely-tuned-finish-grading. |
Cat |New Cat® D6K2 Track—Type Tractor Offers Refined Blade Control and Enhanced . . . [online]. Apr. 2014. [retrieved on May 19, 2014] http://www.cat.com/en GB/news/press-release/new-cat-d6k2-tracktypetractoroffersrefine. |
Number | Date | Country | |
---|---|---|---|
20160230366 A1 | Aug 2016 | US |