The application discloses a mechanical arm path planning and
automatic control method, comprising the following steps: installing an inclination sensor on a swing arm, a bucket rod and a rocker position of an
excavator respectively, and measuring a bucket relative angle, a bucket rod relative angle and a swing arm relative angle after calibration; establishing a vehicle body reference coordinate
system with a swing arm rear
hinge point as an origin; establishing a local coordinate
system of each degree of freedom according to a right-hand rule, and converting to the vehicle body reference coordinate
system; recording Xa coordinates and Za coordinates of a current position of a bucket tooth tip in the vehicle body reference coordinate system, confirming Xb coordinates and Zb coordinates of a target position, obtaining a plurality of intermediate process points after
discretization, calculating a control amount through an error solution of the target position and the current position, controlling the movement of each degree of freedom, and realizing the vertical movement of the
excavator bucket tooth
tip position. The application can control the swing arm lifting, the bucket rod retraction and swing, and the bucket retraction and swing, realize the automatic vertical lifting function of the
excavator tooth
tip position, and effectively improve the working efficiency of the excavator.