Patent Application
20160208460
The present disclosure relates to motor graders, and more specifically, to a system and method for calibrating a blade of a motor grader.
Motor graders are utilized for displacement and leveling of materials, such as sand, gravel, dirt across a variety of applications. A motor grader has a blade assembly suspended on a frame of a chassis. The blade assembly includes a blade that is maneuvered by an operator. The motor grader includes hydraulic actuator system that exerts force for maneuvering the blade. The blade is set for pitch, roll and height positioning for carrying out operations as per an operator's input.
Currently, conventional systems utilize various sensors, such as a GPS (global positioning system), IMU (Inertial Measurement Unit) sensors for detecting the pitch, the roll and a cutting depth of the blade assembly during operational procedures. Further, the conventional systems suffer from operational complexity and also involve additional costs due to sophisticated GPS based systems. There is a need for a GPS independent system and method for calibrating the blade of the motor grader.
Russian Patent Publication Number 2469151, discloses a method of determining a blade height with the help of rigidly mounted GPS satellite navigation. The piston displacement sensors are used to continuously determine the extension stroke of traction frame suspension hydraulic cylinder rods and the input is given to a controller. Data of said piston displacement sensor is fed to controller to compute coordinates of blade cutting edge points in the motor grader coordinate system. Simultaneously, a satellite navigation system and antennas rigidly attached to motor grader main frame are used to define the motor grader blade position and coordinates of origin for the system of global coordinates. After detection of all three coordinates, the computation is done for accurate determination of the blade height relative to the global coordinates, Therefore, there is a need for a GPS independent system and method for calibrating the blade of the motor grader.
In one aspect of the present disclosure, a method for calibrating a blade of a motor grader is disclosed. The method comprises resting the blade on a ground plane in a first configuration and then a second configuration, calculating coordinates of a left blade tip and a right blade tip of the blade with reference to coordinates of a frame, while the blade being rested on the ground plane in each of the first configuration and the second configuration, determining a pitch offset, a roll offset and a height offset from the coordinates of the left blade tip and the right blade tip of the blade, and transforming the coordinates of the frame to coordinates of the ground plane using the pitch offset, the roll offset, and the height offset. The transforming equalizes height for the left blade tip with respect to the right blade tip as a constant in each of the first and second configurations and the constant determines a cut depth of the blade in the ground.
Other features and aspects of this disclosure will be apparent from the following description and the accompanying drawings.
Referring to
Referring to
Referring to
Referring to
Referring to FIG, 3, the left link arm sensor 52, the left lift cylinder position sensor 60, the left yoke sensor 56, the retainer pitch sensor 66 and the pitch cylinder angle sensor 68 provide coordinates of the left blade tip 48, i.e. XL, YL, ZL. The right link arm sensor 54, the right lift cylinder position sensor 62, the right yoke sensor 58, the retainer pitch sensor 66 and the pitch cylinder angle sensor 68 provide coordinates of the right blade tip 50, i.e. XR, YR, ZR.
Referring to
Referring to
Referring to
The coordinates of the left blade tip 48 in the first configuration and the second configuration, i.e. (XL, YL, ZL), (X′L, Y′L, Z′L) and the coordinates of the right blade tip 50 in the first configuration and the second configuration, i.e. (XR, YR, ZR), (X′R, Z′R) are used for calculating the pitch offset, the roll offset and the height offset as described in subsequent description (in
Referring to
At step 72, the blade 22 is rested on the ground plane in the first configuration and then the second configuration. In an embodiment, the blade 22 is rested on the ground in the first configuration and the second configuration (as described in
At step 74, coordinates of the left blade tip 48 and the right blade tip 50 of the blade 22 are calculated, while the blade 22 being rested on the ground plane in each of the first and the second configurations. In an embodiment, the coordinates of the left blade tip 48 and the right blade tip 50 are calculated in the first configuration and the second configuration, i.e. (XL, YL, ZL), (X′L, Y′L, Z′L), (XR, YR, ZR), (X′R, Y′R, Z′R) respectively.
At step 76, the pitch offset, the roll offset and the height offset are determined. The pitch offset is calculated by measuring a slope of a best fit line through coordinates of the left blade tip 48 and the right blade tip 50 projected on a side view plane (XY). The roll offset is calculated using the average of each blade line segment slope in the YZ plane. The height offset is calculated by averaging new Y coordinates for both the left blade tip 48 and the right blade tip 50.
The pitch offset set is calculated by first subtracting each left Y coordinate from the mean of all left Y coordinates. Mean Y coordinate=mean YL. The pitch slope is the slope of a best fit line through points (XL, mean YL−YL) and (X′L, mean YL−Y′L). The pitch offset is atan (pitch slope). This is repeated for the right points, and the final desired pitch offset is the average of the left and right pitch offsets. All points are then transformed using the pitch offset to obtain pitched left coordinates and pitched right coordinates: (XPL, YPL, ZPL), (X′PR, Y′PL, Z′PL), (XPR, YPR, ZPR), (X′PR, Y′PR, Z′PR), pitched left points are paired with the pitched right points to calculate the roll offset, (YPL, ZL) and (YPR, ZR) are used to calculate roll. Delta Y=YPR−YPL. Delta Z=ZR−ZL. The roll angle is atan (delta Y/delta Z). (Y′PL, Z′L) and (Y′PR, Z′R) are used to calculate roll' in the same way. The desired final roll offset is the average of all roll calculations obtained from the different configurations.
At step 78, the coordinates of the frame 14, i.e. XF, YF, ZF are transformed to the coordinates of the ground plane, i.e. XG, YG, ZG (not shown) using the pitch offset, the roll offset and the height offset (also vertical offset) as described below:
Apply est_pitch and est_roll of the frame 14 with respect to ground plane to get coordinates of the blade 22 in the ground coordinate system.
The average of the transformed Y coordinates provides the estimated ground plane Y position in this coordinate system. The vertical offset is the negative value of the average transformed Y coordinates.
Transformed_left_vec=Rotx*Rotz*Left_vec;
Transformed_right_vec=Rotx*Rotz*Right_vec; and
Ground coordinates=Rotx*Rotz*frame_height_coordinate+vertical offset.
After applying the transformation, the left blade tip 48 and the right blade tip 50 of the blade 22 having a constant height that determines a desired cut depth of the blade 22 with respect to the ground.
The method 70 disclosed herein offers an effective way of calibration of the blade 22 without requiring costly setups, such as laser mast, high accuracy GPS systems, among others. Further, the method 70 offers advancements in calibration of the blade 22 using the sensors disposed in the motor grader 10. The method 70 enables efficient calibration of the blade 22 that reduces equipment runtime costs and better operator assistance. Due to non use of GPS systems in the proposed disclosure, the blade calibration is easily completed regardless of the weather conditions where the GPS systems might have connectivity issues.
While aspects of the present disclosure have been particularly shown and described with reference to the embodiments above, it will be understood by those skilled in the art that various additional embodiments may be contemplated by the modification of the disclosed machines, systems and methods without departing from the spirit and scope of what is disclosed. Such embodiments should be understood to fall within the scope of the present disclosure as determined based upon the claims and any equivalents thereof.
