Intelligent boom control with end effector leveling for a feller buncher
An end effector leveling system for moving an end effector of a work machine with a boom assembly, a plurality of sensors, an input interface, and a controller. The plurality of sensors are configured to sense a current movement speed of the hoist boom, the stick boom, and the end effector. The input interface is configured to receive an end effector target angle input command for movement of the end effector at a constant target angle. The controller receives command signals from the input interface, determines based on the command signals a target tilt actuator velocity for actuating the tilt actuator, and an actual tilt actuator tilt velocity actuator and command the tilt actuator to move such that the end effector moves with an aggregate velocity derived from a weighting function of the target tilt actuator velocity and the actual tilt actuator velocity.
1 . An end effector leveling system for moving an end effector of a work machine, the work machine including a boom assembly with a hoist boom pivotally coupled to a machine frame and movable relative to the machine frame by a hoist actuator, a stick boom pivotally coupled to the hoist boom and movable relative to the hoist boom by a stick actuator, and the end effector pivotally coupled to the stick boom at a stick pin and movable relative to the stick boom by a tilt actuator, the control system comprising:
a plurality of sensors configured to sense one or more indicators of a current movement speed of the hoist boom, a current movement speed of the stick boom, and a current movement speed of the end effector;
an input interface configured to receive an end effector target angle input command from an operator for movement of the end effector at a constant target angle; and
a controller configured to:
receive, via the input interface, command signals corresponding to at least one of the hoist actuator velocity and the stick actuator velocity for a desired movement of the end effector, wherein the desired movement comprises the end effector moving at the constant target angle relative to one of a machine reference frame and a ground reference frame;
determine based upon the end effector target angle input command, a target tilt actuator velocity for actuating the tilt actuator;
determine based upon the sensed indicators, an actual tilt actuator velocity for actuating the tilt actuator; and
command the tilt actuator to move such that the end effector moves with an aggregate velocity derived from a weighting function of the target tilt actuator velocity and the actual tilt actuator velocity, the aggregate velocity corresponding to the desired movement.
2 . The system of claim 1 , wherein the desired movement of the end effector comprises a zero-tilt velocity movement relative to the machine reference frame in a horizontal and a vertical movement direction.
3 . The system of claim 1 , wherein a tilt velocity input command from an operator during operation updates the aggregate velocity.
4 . The system of claim 1 , wherein the target tilt actuator velocity is weighted more than the actual tilt actuator velocity for the aggregate velocity when the boom actuator and the stick actuator exceed a threshold acceleration.
5 . The system of claim 4 , wherein a weighted ratio of the target tilt actuator velocity and the actual tilt actuator velocity is approximately 65:35.
6 . The system of claim 1 , wherein the target tilt actuator velocity is weighted less than the actual tilt actuator velocity for the aggregate velocity when the boom actuator and the stick actuator exceed a threshold deceleration.
7 . The system of claim 6 , wherein a weighted ratio of the target tilt actuator velocity and the actual tilt actuator velocity is approximately 35:65.
8 . The system of claim 1 , wherein the target tilt actuator velocity and the actual tilt actuator velocity for the aggregate velocity are weighted substantially equal when the boom actuator and the stick actuator move at a steady state.
9 . The system of claim 1 , wherein a weighted ratio of the target tilt actuator velocity and the actual tilt actuator velocity is approximately 65:35 when the boom actuator and the stick actuator change movement directionally.
10 . The system of claim 1 , wherein the hoist actuator, the stick actuator and the tilt actuator are configured as a linear actuators;
wherein the sensed indicators of the current movement speed comprises of a first sensor to detect a current hoist linear actuator length, and a second sensor to detect a current stick linear actuator length;
wherein the controller receives a length signals from the first sensor and the second sensor; and filters the length signals for attenuations when the end effector is not engaged with a surface or an object to determine the actual tilt actuator velocity.
11 . The system of claim 10 , wherein the controller deactivates filtering the length signals when the length signals corresponding to a proximity to one of a full extension or a minimum stroke of the tilt actuator and the maximum stroke of the tilt actuator.
12 . The system of claim 9 , wherein the target tilt actuator position and the angle of the end effector automatically updates based on a work cycle phase.