Linkage End Effecter Tracking Mechanism for Slopes

摘要

In a work machine having a frame with a lift boom and a stick boom supporting an implement pivotally connected to the opposite end of the stick boom by a pivot pin. A controller determines the position of the pivot pin, detects a motion command signal from an operator control, determines an ending position of the pivot pin based on the motion command signal, and causes the lift boom and stick boom to rotate to orientation angles that will place the pivot pin at the ending position. When operating on a slope, the frame orientation with respect to gravity is determined so that horizontal and vertical motion commands cause the pivot pin and implement to move horizontally and vertically with respect to gravity regardless of the frame orientation. The implement can be maintained at a target orientation as the pivot pin moves by evaluating an orientation angle of the implement.

主权项

1. A work machine comprising:
a frame; a lift boom having a first end and an oppositely disposed second end, with the first end of the lift boom pivotally connected to the frame by a first pivot pin; a stick boom having a first end and an oppositely disposed second end, with the first end of the stick boom pivotally connected to the second end of the lift boom by a second pivot pin; an implement pivotally connected to the second end of the stick boom by a third pivot pin; a lift boom actuation mechanism operatively connected to the lift boom and operable to pivot the lift boom about the first pivot pin relative to the frame; a stick boom actuation mechanism operatively connected to the stick boom and operable to pivot the stick boom about the second pivot pin relative to the lift boom; a first operator control configured to transmit motion command signals; and a controller operatively connected to the lift boom actuation mechanism, the stick boom actuation mechanism and the first operator control,
the controller being configured to determine a current position of the third pivot pin relative to the first pivot pin based on a first lift boom orientation angle and a first stick boom orientation angle,the controller being configured to detect the motion command signals from the first operator control,the controller being configured to determine an ending position of the third pivot pin relative to the first pivot pin in response to detecting the motion command signals, andthe controller being configured to actuate the lift boom actuation mechanism to rotate the lift boom to a second lift boom orientation angle and to actuate the stick boom actuation mechanism to rotate the stick boom to a second stick boom orientation angle to move the third pivot pin from the current position to the ending position.