Excavator working device track parameter solving and control method and device and medium
By constructing the plane parameters of the excavator to solve the coordinate system and adjusting the body inclination angle, calculating the initial and target state attitude trajectory parameters, the problem of complex calculation of the excavator trajectory parameter solution is solved and the control efficiency is improved.
Patent Information
- Application Number
- CN202410995319.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-24
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-07-24
AI Technical Summary
In the prior art, the calculation of excavator trajectory parameters is complex and the calculation is large, resulting in high requirements on the computing power and performance of the controller, which affects performance.
By obtaining the first hinge point of the excavator, the coordinate system is solved by solving the coordinate system, the body inclination angle and working surface slope are adjusted, the initial and target state attitude trajectory parameters are calculated, and the trajectory of the excavator working device is controlled.
The complexity of trajectory parameter solution calculation is simplified, the performance requirements for the controller are reduced, and the control efficiency of the excavator is improved.
Smart Images

Figure CN118958429A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of excavator control, and in particular to a method, device and medium for solving and controlling trajectory parameters of an excavator working device. Background Art
[0002] Excavators are important engineering machinery equipment, widely used in infrastructure construction, mining and other fields, and play an important role. When the excavator is leveling the bucket tip or bottom, it is necessary to solve the trajectory parameters of the target position of the working device, and then control the working device to achieve the bucket tip or bottom close to the working surface.
[0003] In the process of realizing the present invention, the inventors found that the prior art has the following defects: At present, for the solution calculation of the conventional method, the calculation is relatively complex and the amount of calculation is large, and the computing power and performance requirements of the controller are high, which is not conducive to improving performance. Summary of the invention
[0004] The present invention provides a method, device and medium for solving and controlling trajectory parameters of an excavator working device, so as to simplify the complexity of trajectory parameter solving calculation and better realize the control of the excavator.
[0005] According to one aspect of the present invention, a method for solving trajectory parameters of an excavator working device is provided, which includes:
[0006] Obtaining a first hinge point of the current excavator, and using the first hinge point as a coordinate origin to construct a current plane parameter solution coordinate system;
[0007] Wherein, the first hinge point is the hinge point between the boom and the frame of the current excavator, and the X-axis of the current plane parameter solution coordinate system is parallel to the current working surface;
[0008] Obtaining the body inclination angle and the working surface slope corresponding to the current excavator, adjusting the current plane parameter solution coordinate system, and obtaining the current standard plane parameter solution coordinate system;
[0009] Obtain the initial excavator joint description angle, and calculate the initial state posture trajectory parameters in the current standard plane parameter solution coordinate system;
[0010] The initial state posture trajectory parameters include: the initial projection distance of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate, and the initial projection distance of the boom on the ordinate;
[0011] Acquire the current excavator joint description angle and the current excavator operation mode, and calculate the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, so as to control the excavator working device according to the target state posture trajectory parameters;
[0012] Among them, the target state posture trajectory parameters include: the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate, the change in the projection distance of the boom on the ordinate, the difference between the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate and the change in the projection distance of the boom on the ordinate, and the horizontal distance of the working point.
[0013] According to another aspect of the present invention, a method for controlling a trajectory of an excavator working device is provided, comprising:
[0014] According to the horizontal distance of the working point, the current of the boom action proportional valve, the reference current of the boom action proportional valve, and the reference current of the bucket action proportional valve are calculated;
[0015] Obtain the difference between the projection distance change of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate and the projection distance change of the boom on the ordinate, perform current adjustment processing on the boom action proportional valve reference current, and obtain the boom action proportional valve adjustment current;
[0016] Obtaining the difference between the angle at which the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface and the actual rotation angle of the bucket relative to the initial state, and performing current adjustment processing on the reference current of the bucket action proportional valve to obtain the bucket action proportional valve adjustment current;
[0017] The trajectory of the excavator working device is controlled according to the boom action proportional valve current, the arm action proportional valve adjustment current and the bucket action proportional valve adjustment current.
[0018] According to another aspect of the present invention, a device for solving trajectory parameters of an excavator working device is provided, comprising:
[0019] A current plane parameter solving coordinate system building module is used to obtain a first hinge point of the current excavator and use the first hinge point as a coordinate origin to build a current plane parameter solving coordinate system;
[0020] Wherein, the first hinge point is the hinge point between the boom and the frame of the current excavator, and the X-axis of the current plane parameter solution coordinate system is parallel to the current working surface;
[0021] A current standard plane parameter solution coordinate system determination module is used to obtain the body inclination angle and working surface slope corresponding to the current excavator, and adjust the current plane parameter solution coordinate system to obtain the current standard plane parameter solution coordinate system;
[0022] The initial state posture trajectory parameter calculation module is used to obtain the initial excavator joint description angle and calculate the initial state posture trajectory parameters in the current standard plane parameter solution coordinate system;
[0023] The initial state posture trajectory parameters include: the initial projection distance of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate, and the initial projection distance of the boom on the ordinate;
[0024] The target state posture trajectory parameter calculation module is used to obtain the current excavator joint description angle and the current excavator operation mode, and calculate the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, so as to control the excavator working device according to the target state posture trajectory parameters;
[0025] Among them, the target state posture trajectory parameters include: the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate, the change in the projection distance of the boom on the ordinate, the difference between the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate and the change in the projection distance of the boom on the ordinate, and the horizontal distance of the working point.
[0026] According to another aspect of the present invention, there is provided a trajectory control device for an excavator working device, comprising:
[0027] The current calculation module is used to calculate the current of the boom action proportional valve, the reference current of the boom action proportional valve, and the reference current of the bucket action proportional valve according to the horizontal distance of the working point;
[0028] A boom action proportional valve adjustment current determination module is used to obtain the difference between the projection distance change of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate and the projection distance change of the boom on the ordinate, and to perform current adjustment processing on the boom action proportional valve reference current to obtain the boom action proportional valve adjustment current;
[0029] A bucket action proportional valve adjustment current determination module is used to obtain the difference between the angle that the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface and the actual rotation angle of the bucket relative to the initial state, and to perform current adjustment processing on the bucket action proportional valve reference current to obtain the bucket action proportional valve adjustment current;
[0030] The trajectory control module is used to control the trajectory of the excavator working device according to the boom action proportional valve current, the arm action proportional valve adjustment current and the bucket action proportional valve adjustment current.
[0031] According to another aspect of the present invention, an electronic device is provided, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein when the processor executes the computer program, the method for solving the trajectory parameters of the excavator working device described in any embodiment of the present invention is implemented, or the method for controlling the trajectory of the excavator working device described in any embodiment of the present invention is implemented.
[0032] According to another aspect of the present invention, a computer-readable storage medium is provided, wherein the computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the method for solving the trajectory parameters of an excavator working device described in any embodiment of the present invention, or to implement the method for controlling the trajectory of an excavator working device described in any embodiment of the present invention when executed.
[0033] The technical solution of the embodiment of the present invention is to obtain the first hinge point of the current excavator and use the first hinge point as the coordinate origin to construct the current plane parameter solution coordinate system; obtain the body inclination angle and working surface slope corresponding to the current excavator, adjust the current plane parameter solution coordinate system, and obtain the current standard plane parameter solution coordinate system; obtain the initial excavator joint description angle, and calculate the initial state posture trajectory parameters in the current standard plane parameter solution coordinate system; obtain the current excavator joint description angle and the current excavator's working mode, and calculate the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, so as to control the excavator working device according to the target state posture trajectory parameters. The problem of complex and large amount of calculation for solving the excavator trajectory parameters is solved, the complexity of the trajectory parameter solution calculation is reduced, and the excavator control is better realized.
[0034] It should be understood that the contents described in this section are not intended to identify the key or important features of the embodiments of the present invention, nor are they intended to limit the scope of the present invention. Other features of the present invention will become easily understood through the following description. BRIEF DESCRIPTION OF THE DRAWINGS
[0035] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0036] Figure 1ais a flow chart of a method for solving trajectory parameters of an excavator working device provided according to a first embodiment of the present invention;
[0037] Figure 1b is a schematic structural diagram of a coordinate system for solving current plane parameters of a current excavator in a method provided in Embodiment 1 of the present invention;
[0038] Figure 1c is a schematic structural diagram of a coordinate system for solving the current standard plane parameters of a current excavator in the method provided in Embodiment 1 of the present invention;
[0039] Figure 2 is a flow chart of a method for controlling a trajectory of an excavator working device provided according to a second embodiment of the present invention;
[0040] Figure 3 is a schematic structural diagram of a device for solving trajectory parameters of an excavator working device provided according to a third embodiment of the present invention;
[0041] Figure 4 is a structural schematic diagram of a trajectory control device for an excavator working device provided according to a fourth embodiment of the present invention;
[0042] Figure 5 It is a schematic diagram of the structure of an electronic device provided according to Embodiment 5 of the present invention. DETAILED DESCRIPTION
[0043] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.
[0044] It should be noted that the terms "target", "current", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0045] Embodiment 1
[0046] Figure 1a A flow chart of a method for solving the trajectory parameters of an excavator working device is provided for the first embodiment of the present invention. This embodiment is applicable to the situation where the trajectory parameters of the excavator working device are solved when the excavator is performing bucket tip or bucket bottom operations. The method can be executed by a device for solving the trajectory parameters of the excavator working device, and the device for solving the trajectory parameters of the excavator working device can be implemented in the form of hardware and / or software.
[0047] Correspondingly, such as Figure 1a As shown, the method includes:
[0048] S110, obtaining a first hinge point of the current excavator, and using the first hinge point as a coordinate origin to construct a current plane parameter solution coordinate system.
[0049] The first hinge point is the hinge point between the boom and the frame of the current excavator, and the X-axis of the current plane parameter solution coordinate system is parallel to the current working surface.
[0050] In this embodiment, Figure 1b The schematic diagram of the structure of the coordinate system for solving the current plane parameters of the current excavator. Figure 1b In the figure, the hinge point between the boom and the frame of the current excavator constitutes the first hinge point, that is, point C in the figure, that is, point C is used as the coordinate origin.
[0051] Furthermore, the X-axis of the current plane parameter solution coordinate system is constructed. Specifically, the X-axis is parallel to the current working surface, and the Y-axis is perpendicular to the current working surface.
[0052] exist Figure 1b In the current excavator, the excavator includes a boom, a bucket and a bucket. The hinge point between the bucket and the boom is point F. The hinge point between the bucket and the bucket is point Q.
[0053] S120, obtaining the body inclination angle and the working surface slope corresponding to the current excavator, adjusting the current plane parameter solution coordinate system, and obtaining the current standard plane parameter solution coordinate system.
[0054] The body tilt angle may be the tilt angle of the excavator body, and the body tilt angle may include the body pitch angle and the body pitch angle. The working surface slope may describe the slope of the working surface where the excavator is currently located.
[0055] Optionally, the method of obtaining the vehicle body inclination angle and the working surface slope corresponding to the current excavator, adjusting the current plane parameter solution coordinate system, and obtaining the current standard plane parameter solution coordinate system includes: if the vehicle body inclination angle is the vehicle body downward pitch angle, then according to formula a 1 =a-σ 1Calculate the first adjustment boom angle a 1 , and adjust the current plane parameter solution coordinate system according to the first adjustment boom angle to obtain the current standard plane parameter solution coordinate system; where σ 1 represents the downward pitch angle of the vehicle body; a represents the boom angle in the current plane parameter solution coordinate system; if the vehicle body tilt angle is the upward pitch angle of the vehicle body, then according to formula a 2 =a+σ 2 Calculate the second adjustment boom angle a 2 , and adjust the current plane parameter solution coordinate system according to the second adjustment boom angle to obtain the current standard plane parameter solution coordinate system; where σ 2 Indicates the upward angle of the vehicle body; if the working surface slope is the working surface slope downward angle η, the coordinate axes of the current plane parameter solution coordinate system are adjusted according to the clockwise rotation angle η to obtain the current standard plane parameter solution coordinate system; if the working surface slope is the working surface slope upward angle η, the coordinate axes of the current plane parameter solution coordinate system are adjusted according to the counterclockwise rotation angle η to obtain the current standard plane parameter solution coordinate system.
[0056] For example, assuming that the vehicle body inclination angle is the vehicle body pitch angle, the vehicle body pitch angle is 45 degrees, that is, σ 1 = 45 degrees, the boom angle in the current plane parameter solution coordinate system is 90 degrees, then according to formula a 1 =a-σ 1 =45 degrees, to calculate the first adjustment boom angle as 45 degrees. Further, the current plane parameter solution coordinate system can be adjusted according to the first adjustment boom angle of 45 degrees to obtain the current standard plane parameter solution coordinate system.
[0057] Similarly, assuming that the body tilt angle is the body tilt angle, the body tilt angle is 45 degrees, that is, σ 2 = 45 degrees, the boom angle in the current plane parameter solution coordinate system is 90 degrees, then according to formula a 2 =a+σ 2 =135 degrees, to calculate the second adjustment boom angle as 135 degrees. Further, the current plane parameter solution coordinate system can be adjusted according to the second adjustment boom angle 135 degrees to obtain the current standard plane parameter solution coordinate system.
[0058] Correspondingly, if the working surface slope is the working surface slope downward angle η, assuming η=50 degrees, the coordinate axis of the current plane parameter solution coordinate system can be adjusted by rotating 50 degrees clockwise to obtain the current standard plane parameter solution coordinate system.
[0059] In addition, if the working surface slope is the working surface slope upward angle η, assuming η = 40 degrees, then the coordinate axis of the current plane parameter solution coordinate system is adjusted by rotating 40 degrees counterclockwise to obtain the current standard plane parameter solution coordinate system.
[0060] In this embodiment, Figure 1c Schematic diagram of the structure of the coordinate system for solving the current standard plane parameters of the current excavator.
[0061] S130, obtaining an initial excavator joint description angle, and calculating initial state posture trajectory parameters in the current standard plane parameter solution coordinate system.
[0062] The initial state posture trajectory parameters may include an initial projection distance of a line connecting a boom swing pin and a bucket operation point relative to the ordinate, and an initial projection distance of the boom on the ordinate.
[0063] The initial state posture trajectory parameters may be trajectory parameters used to describe the initial state posture of the current excavator.
[0064] Specifically, the initial excavator joint description angle includes: in the current standard plane parameter solution coordinate system, the angle between the boom and the X-axis, the angle between the arm and the boom, the angle between the line between the hinge point of the arm and the boom and the bucket working point and the angle between the hinge point between the arm and the boom and the vertical line of the working surface, the angle between the line between the hinge point of the arm and the boom and the bucket working point and the hinge point between the arm and the boom and the hinge point between the arm and the bucket, the line between the hinge point of the arm and the boom and the bucket working point, and the line between the hinge point of the arm and the boom and the coordinate origin.
[0065] exist Figure 1c In the equation, α represents the angle between the boom and the X-axis; β represents the angle between the boom and the boom; θ 1 (That is, Figure 1c The θ) in the formula represents the angle between the line between the hinge point of the bucket arm and the boom and the bucket working point and the line between the hinge point between the bucket arm and the boom and the vertical line of the working surface; μ represents the angle between the line between the hinge point of the bucket arm and the boom and the bucket working point and the line between the hinge point between the bucket arm and the boom and the hinge point between the bucket arm and the bucket; l FV Indicates the line between the hinge point of the dipper stick and the boom and the working point of the bucket; l FC Represents the line between the hinge point of the boom and the arm and the coordinate origin; φ 1 (That is, Figure 1c The φ) in φ represents the angle between the hinge point between the boom and the vertical line of the working surface and the line connecting the hinge point between the bucket arm and the boom and the hinge point between the bucket arm and bucket.
[0066] Specifically, the initial excavator joint description angle is obtained, and the initial state posture trajectory parameters are calculated in the current standard plane parameter solution coordinate system, including: according to the formula In the current standard plane parameter solution coordinate system, the initial projection distance h of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate is calculated. 0 , and the initial projection distance h of the boom on the ordinate 1 .
[0067] In this embodiment, the formula To carry out h 0 and h 1 Calculation.
[0068] S140, obtaining the current excavator joint description angle and the current excavator operation mode, and calculating the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, so as to control the excavator working device according to the target state posture trajectory parameters.
[0069] Among them, the target state posture trajectory parameters include: the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate, the change in the projection distance of the boom on the ordinate, the difference between the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate and the change in the projection distance of the boom on the ordinate, and the horizontal distance of the working point.
[0070] In this embodiment, the current operation mode of the excavator may include bucket tip leveling operation or bucket bottom leveling operation. For different operation modes, different target state posture trajectory parameters are calculated.
[0071] Specifically, if the current operation mode of the excavator is bucket tip leveling operation, the current excavator joint description angle is obtained, and the target state posture trajectory parameters corresponding to the current excavator are calculated based on the initial state posture trajectory parameters.
[0072] Specifically, the current excavator joint description angle is obtained; wherein the current excavator joint description angle includes: the change in the angle between the boom and the X-axis is Δα; the change in the angle between the arm and the boom is Δβ; according to the initial state posture trajectory parameters, through the formula To calculate the projection distance change Δh' of the line connecting the bucket arm rotation pin and the bucket operation point corresponding to the current excavator relative to the ordinate 0 , the change in the projection distance of the boom on the ordinate Δh 1 ', the difference H between the projection distance change of the arm pivot pin and the bucket operation point connection line relative to the ordinate and the projection distance change of the boom on the ordinate, and the horizontal distance l of the operation point Vx; where φ x It indicates the angle between the hinge point between the boom and the vertical line of the working surface and the hinge point between the boom and the boom and the hinge point between the boom and the bucket when the bucket tip or the bucket bottom is working on the flat ground; θ x It indicates the angle between the line between the hinge point of the bucket arm and boom and the bucket working point and the vertical line between the hinge point between the bucket arm and boom and the working surface when the bucket tip or bucket bottom is working on the flat ground; h 0x It indicates the projection distance of the line connecting the bucket arm pivot pin and the bucket working point relative to the ordinate when the bucket tip or bucket bottom is working on flat ground; h 1x It indicates the projection distance of the boom on the vertical coordinate when the bucket tip is operating on flat ground.
[0073] In this embodiment, according to the initial state posture trajectory parameter h 0 and h 1 , and by the formula To carry out Δh' 0 , Δh 1 ', H and l Vx Calculation.
[0074] In addition, if the current operation mode of the excavator is bucket bottom leveling operation, the current excavator joint description angle is obtained, and the target state posture trajectory parameters corresponding to the current excavator are calculated according to the initial state posture trajectory parameters. In detail, the target state posture trajectory parameters also include the angle that the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface.
[0075] Optionally, the method of obtaining the joint description angle of the current excavator and the operation mode of the current excavator, and calculating the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, includes: if the operation mode of the current excavator is bucket bottom leveling operation, obtaining the joint description angle of the current excavator; according to the initial state posture trajectory parameters, calculating the target state posture trajectory parameters according to the formula To calculate the projection distance change Δh' of the line connecting the bucket arm rotation pin and the bucket operation point corresponding to the current excavator relative to the ordinate 0 , the change in the projection distance of the boom on the ordinate Δh 1 ", the difference between the change in the projection distance of the arm pivot pin and the bucket operation point relative to the ordinate and the change in the projection distance of the boom on the ordinate, the horizontal distance l of the operation point Vx , and the angle ε that the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface x ; Among them, h 1 ' x It indicates the projection distance of the boom on the ordinate when the bucket bottom is operating on flat ground; ε indicates the angle between the bucket and the boom.
[0076] In this embodiment, according to the initial state posture trajectory parameter h 0 and h 1 , and by the formula To carry out Δh' 0 , Δh 1 "、H、l Vx and ε x Calculation.
[0077] In this embodiment, no matter the bucket tip or bucket bottom is leveling the ground, the corresponding target state posture trajectory parameters can be calculated, and then the excavator working device can be controlled according to the target state posture trajectory parameters.
[0078] The technical solution of the embodiment of the present invention is to obtain the first hinge point of the current excavator and use the first hinge point as the coordinate origin to construct the current plane parameter solution coordinate system; obtain the body inclination angle and working surface slope corresponding to the current excavator, adjust the current plane parameter solution coordinate system, and obtain the current standard plane parameter solution coordinate system; obtain the initial excavator joint description angle, and calculate the initial state posture trajectory parameters in the current standard plane parameter solution coordinate system; obtain the current excavator joint description angle and the current excavator's working mode, and calculate the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, so as to control the excavator working device according to the target state posture trajectory parameters. The problem of complex and large amount of calculation for solving the excavator trajectory parameters is solved, the complexity of the trajectory parameter solution calculation is reduced, and the excavator control is better realized.
[0079] Embodiment 2
[0080] Figure 2 A flow chart of a method for controlling the trajectory of an excavator working device is provided for the second embodiment of the present invention. This embodiment is applicable to the situation where the trajectory of an excavator working device is to be controlled. The method can be executed by a trajectory control device for an excavator working device, and the trajectory control device for an excavator working device can be implemented in the form of hardware and / or software.
[0081] Correspondingly, such as Figure 2 As shown, the method includes:
[0082] S210, calculating the boom action proportional valve current, the arm action proportional valve reference current, and the bucket action proportional valve reference current according to the horizontal distance of the working point.
[0083] S220, obtaining the difference between the projection distance change of the connecting line between the boom pivot pin and the bucket operation point relative to the ordinate and the projection distance change of the boom on the ordinate, performing current adjustment processing on the boom action proportional valve reference current, and obtaining the boom action proportional valve adjustment current.
[0084] S230, obtaining the difference between the angle required for the bucket bottom to remain parallel to the working surface relative to the initial state and the actual rotation angle of the bucket relative to the initial state, and performing current adjustment processing on the bucket action proportional valve reference current to obtain the bucket action proportional valve adjustment current.
[0085] S240, controlling the trajectory of the excavator working device according to the boom action proportional valve current, the arm action proportional valve adjustment current and the bucket action proportional valve adjustment current.
[0086] In this embodiment, in the controller of the current excavator, a boom action proportional valve current curve, a boom action proportional valve reference current curve, and a bucket action proportional valve reference current curve are stored with the horizontal distance of the working point as the horizontal coordinate.
[0087] In this embodiment, a bucket tip operation mode or a bucket bottom operation mode may be included. In the bucket tip operation mode, the bucket remains stationary and the bucket motion proportional valve current adjustment is not performed. In the bucket bottom operation mode, the bucket motion proportional valve current adjustment is required.
[0088] In detail, when adjusting the reference current of the boom action proportional valve, if the change in the projection distance of the line connecting the boom swing pin and the bucket operating point relative to the vertical coordinate is greater than the change in the projection distance of the boom on the vertical coordinate, and the difference in the change relative to the previous moment in history shows an increasing trend, then the reference current of the boom action proportional valve is increased to obtain the boom action proportional valve adjustment current.
[0089] In addition, if the change in the projection distance of the line connecting the boom swing pin and the bucket operating point relative to the vertical coordinate is smaller than the change in the projection distance of the boom on the vertical coordinate, and the difference in change relative to the previous moment in history tends to increase, then the reference current of the boom action proportional valve is reduced to obtain the adjustment current of the boom action proportional valve.
[0090] Furthermore, when adjusting the reference current of the bucket action proportional valve, if the angle required for the bucket bottom to remain parallel to the working surface relative to the initial state is greater than the actual rotation angle of the bucket relative to the initial state, and the angle difference relative to a previous moment in history tends to increase, then the reference current of the bucket action proportional valve is increased to obtain the bucket action proportional valve adjustment current.
[0091] Correspondingly, if the angle required for the bucket bottom to remain parallel to the working surface relative to the initial state is smaller than the actual rotation angle of the bucket relative to the initial state, and the angle difference relative to a previous moment in history tends to increase, then the reference current of the bucket action proportional valve is reduced to obtain the bucket action proportional valve adjustment current.
[0092] The technical solution of the embodiment of the present invention calculates the boom action proportional valve current, the arm action proportional valve reference current, and the bucket action proportional valve reference current according to the horizontal distance of the working point; obtains the difference between the projection distance change of the boom rotation pin and the bucket working point connection line relative to the vertical coordinate and the projection distance change of the boom on the vertical coordinate, performs current adjustment processing on the boom action proportional valve reference current, and obtains the boom action proportional valve adjustment current; obtains the difference between the angle that the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface and the actual rotation angle of the bucket relative to the initial state, performs current adjustment processing on the bucket action proportional valve reference current, and obtains the bucket action proportional valve adjustment current; and controls the trajectory of the excavator working device according to the boom action proportional valve current, the arm action proportional valve adjustment current, and the bucket action proportional valve adjustment current. Better trajectory control of the excavator working device is achieved based on the calculated horizontal distance of the working point, the difference between the change in the projection distance of the boom slewing pin and the bucket working point relative to the ordinate and the change in the projection distance of the boom on the ordinate, and the difference between the angle at which the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface and the actual rotation angle of the bucket relative to the initial state.
[0093] Embodiment 3
[0094] Figure 3 This is a schematic diagram of the structure of a device for solving trajectory parameters of an excavator working device provided in the third embodiment of the present invention. The device for solving trajectory parameters of an excavator working device provided in this embodiment can be implemented by software and / or hardware, and can be configured in a terminal device or a server to implement a method for solving trajectory parameters of an excavator working device in the embodiment of the present invention. Figure 3 As shown, the device includes: a current plane parameter solution coordinate system construction module 310, a current standard plane parameter solution coordinate system determination module 320, an initial state posture trajectory parameter calculation module 330 and a target state posture trajectory parameter calculation module 340.
[0095] The current plane parameter solution coordinate system construction module 310 is used to obtain the first hinge point of the current excavator and use the first hinge point as the coordinate origin to construct the current plane parameter solution coordinate system;
[0096] Wherein, the first hinge point is the hinge point between the boom and the frame of the current excavator, and the X-axis of the current plane parameter solution coordinate system is parallel to the current working surface;
[0097] The current standard plane parameter solution coordinate system determination module 320 is used to obtain the body inclination angle and the working surface slope corresponding to the current excavator, and adjust the current plane parameter solution coordinate system to obtain the current standard plane parameter solution coordinate system;
[0098] The initial state posture trajectory parameter calculation module 330 is used to obtain the initial excavator joint description angle and calculate the initial state posture trajectory parameters in the current standard plane parameter solution coordinate system;
[0099] The initial state posture trajectory parameters include: the initial projection distance of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate, and the initial projection distance of the boom on the ordinate;
[0100] The target state posture trajectory parameter calculation module 340 is used to obtain the current excavator joint description angle and the current excavator operation mode, and calculate the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, so as to control the excavator working device according to the target state posture trajectory parameters;
[0101] Among them, the target state posture trajectory parameters include: the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate, the change in the projection distance of the boom on the ordinate, the difference between the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate and the change in the projection distance of the boom on the ordinate, and the horizontal distance of the working point.
[0102] The technical solution of the embodiment of the present invention is to obtain the first hinge point of the current excavator and use the first hinge point as the coordinate origin to construct the current plane parameter solution coordinate system; obtain the body inclination angle and working surface slope corresponding to the current excavator, adjust the current plane parameter solution coordinate system, and obtain the current standard plane parameter solution coordinate system; obtain the initial excavator joint description angle, and calculate the initial state posture trajectory parameters in the current standard plane parameter solution coordinate system; obtain the current excavator joint description angle and the current excavator's working mode, and calculate the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, so as to control the excavator working device according to the target state posture trajectory parameters. The problem of complex and large amount of calculation for solving the excavator trajectory parameters is solved, the complexity of the trajectory parameter solution calculation is reduced, and the excavator control is better realized.
[0103] Based on the above embodiments, the current standard plane parameter solution coordinate system determination module 320 can be specifically used to: if the vehicle body inclination angle is the vehicle body pitch angle, then according to formula a1 =a-σ 1 Calculate the first adjustment boom angle a 1 , and adjust the current plane parameter solution coordinate system according to the first adjustment boom angle to obtain the current standard plane parameter solution coordinate system; where σ 1 represents the downward pitch angle of the vehicle body; a represents the boom angle in the current plane parameter solution coordinate system; if the vehicle body tilt angle is the upward pitch angle of the vehicle body, then according to formula a 2 =a+σ 2 Calculate the second adjustment boom angle a 2 , and adjust the current plane parameter solution coordinate system according to the second adjustment boom angle to obtain the current standard plane parameter solution coordinate system; where σ 2 Indicates the upward angle of the vehicle body; if the working surface slope is the downward angle of the working surface slope, the coordinate axes of the current plane parameter solution coordinate system are adjusted according to the clockwise rotation angle to obtain the current standard plane parameter solution coordinate system; if the working surface slope is the upward angle of the working surface slope, the coordinate axes of the current plane parameter solution coordinate system are adjusted according to the counterclockwise rotation angle to obtain the current standard plane parameter solution coordinate system.
[0104] Based on the above embodiments, the initial excavator joint description angle may include: in the current standard plane parameter solution coordinate system, the angle between the boom and the X-axis, the angle between the arm and the boom, the angle between the line between the hinge point of the arm and the boom and the bucket working point and the angle between the hinge point between the arm and the boom and the vertical line of the working surface, the angle between the line between the hinge point of the arm and the boom and the bucket working point and the angle between the hinge point between the arm and the boom and the hinge point between the arm and the bucket, the line between the hinge point of the arm and the boom and the bucket working point, and the line between the hinge point of the arm and the boom and the coordinate origin.
[0105] Based on the above embodiments, the initial state posture trajectory parameter calculation module 330 can be specifically used to: According to the formula In the current standard plane parameter solution coordinate system, the initial projection distance h of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate is calculated. 0 , and the initial projection distance h of the boom on the ordinate 1 ; Among them, α represents the angle between the boom and the X-axis; β represents the angle between the stick and the boom; θ 1 represents the angle between the line between the hinge point of the bucket and boom and the bucket working point and the line between the hinge point between the bucket and boom and the vertical line of the working surface; μ represents the angle between the line between the hinge point of the bucket and boom and the bucket working point and the line between the hinge point between the bucket and boom and the hinge point between the bucket and bucket; l FVIndicates the line between the hinge point of the dipper stick and the boom and the working point of the bucket; l FC Represents the line between the hinge point of the boom and the arm and the coordinate origin; φ 1 It represents the angle between the hinge point between the boom and the vertical line of the working surface and the hinge point between the arm and boom and the hinge point between the arm and bucket.
[0106] On the basis of the above embodiments, the target state posture trajectory parameter calculation module 340 can be specifically used for: if the current operation mode of the excavator is bucket tip leveling operation, then obtain the current excavator joint description angle; wherein the current excavator joint description angle includes: the change in the angle between the boom and the X-axis is Δα; the change in the angle between the boom and the boom is Δβ; according to the initial state posture trajectory parameters, through the formula To calculate the projection distance change Δh' of the line connecting the bucket arm rotation pin and the bucket operation point corresponding to the current excavator relative to the ordinate 0 , the change in the projection distance of the boom on the ordinate Δh 1 ', the difference H between the projection distance change of the arm pivot pin and the bucket operation point connection line relative to the ordinate and the projection distance change of the boom on the ordinate, and the horizontal distance l of the operation point Vx ; where φ x It indicates the angle between the hinge point between the boom and the vertical line of the working surface and the hinge point between the boom and the boom and the hinge point between the boom and the bucket when the bucket tip or the bucket bottom is working on the flat ground; θ x It indicates the angle between the line between the hinge point of the bucket arm and boom and the bucket working point and the vertical line between the hinge point between the bucket arm and boom and the working surface when the bucket tip or bucket bottom is working on the flat ground; h 0x It indicates the projection distance of the line connecting the bucket arm pivot pin and the bucket working point relative to the ordinate when the bucket tip or bucket bottom is working on flat ground; h 1x It indicates the projection distance of the boom on the vertical coordinate when the bucket tip is operating on flat ground.
[0107] On the basis of the above embodiments, the target state posture trajectory parameters also include: the angle that the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface.
[0108] On the basis of the above embodiments, the target state posture trajectory parameter calculation module 340 can be specifically used for: obtaining the current excavator joint description angle and the current excavator operation mode, and calculating the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, including: if the current excavator operation mode is bucket bottom leveling operation, obtaining the current excavator joint description angle; according to the initial state posture trajectory parameters, by formula To calculate the projection distance change Δh' of the line connecting the bucket arm rotation pin and the bucket operation point corresponding to the current excavator relative to the ordinate 0 , the change in the projection distance of the boom on the ordinate Δh 1 ", the difference between the change in the projection distance of the arm pivot pin and the bucket operation point relative to the ordinate and the change in the projection distance of the boom on the ordinate, the horizontal distance l of the operation point Vx , and the angle ε that the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface x ; Among them, h 1 ' x It indicates the projection distance of the boom on the ordinate when the bucket bottom is operating on flat ground; ε indicates the angle between the bucket and the boom.
[0109] The excavator working device trajectory parameter solving device provided in the embodiment of the present invention can execute the excavator working device trajectory parameter solving method provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.
[0110] Embodiment 4
[0111] Figure 4 This is a schematic diagram of the structure of an excavator working device trajectory control device provided in the fourth embodiment of the present invention. The excavator working device trajectory control device provided in this embodiment can be implemented by software and / or hardware, and can be configured in a terminal device or a server to implement an excavator working device trajectory control method in the embodiment of the present invention. Figure 4 As shown, the device includes: a current calculation module 410, a boom action proportional valve adjustment current determination module 420, a bucket action proportional valve adjustment current determination module 430 and a trajectory control module 440.
[0112] The current calculation module 410 is used to calculate the arm action proportional valve current, the boom action proportional valve reference current, and the bucket action proportional valve reference current according to the horizontal distance of the working point;
[0113] A boom action proportional valve adjustment current determination module 420 is used to obtain the difference between the projection distance change of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate and the projection distance change of the boom on the ordinate, and to perform current adjustment processing on the boom action proportional valve reference current to obtain the boom action proportional valve adjustment current;
[0114] A bucket action proportional valve adjustment current determination module 430 is used to obtain the difference between the angle that the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface and the actual rotation angle of the bucket relative to the initial state, and to perform current adjustment processing on the bucket action proportional valve reference current to obtain the bucket action proportional valve adjustment current;
[0115] The trajectory control module 440 is used to control the trajectory of the excavator working device according to the boom action proportional valve current, the arm action proportional valve adjustment current and the bucket action proportional valve adjustment current.
[0116] The technical solution of the embodiment of the present invention calculates the boom action proportional valve current, the arm action proportional valve reference current, and the bucket action proportional valve reference current according to the horizontal distance of the working point; obtains the difference between the projection distance change of the boom rotation pin and the bucket working point connection line relative to the vertical coordinate and the projection distance change of the boom on the vertical coordinate, performs current adjustment processing on the boom action proportional valve reference current, and obtains the boom action proportional valve adjustment current; obtains the difference between the angle that the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface and the actual rotation angle of the bucket relative to the initial state, performs current adjustment processing on the bucket action proportional valve reference current, and obtains the bucket action proportional valve adjustment current; and controls the trajectory of the excavator working device according to the boom action proportional valve current, the arm action proportional valve adjustment current, and the bucket action proportional valve adjustment current. Better trajectory control of the excavator working device is achieved based on the calculated horizontal distance of the working point, the difference between the change in the projection distance of the boom slewing pin and the bucket working point relative to the ordinate and the change in the projection distance of the boom on the ordinate, and the difference between the angle at which the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface and the actual rotation angle of the bucket relative to the initial state.
[0117] The excavator working device trajectory control device provided in the embodiment of the present invention can execute the excavator working device trajectory control method provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.
[0118] Embodiment 5
[0119] Figure 5 A schematic diagram of the structure of an electronic device 10 that can be used to implement the fifth embodiment of the present invention is shown. The electronic device is intended to represent various forms of digital computers, such as laptop computers, desktop computers, workbenches, personal digital assistants, servers, blade servers, mainframe computers, and other suitable computers. The electronic device can also represent various forms of mobile devices, such as personal digital processing, cellular phones, smart phones, wearable devices (such as helmets, glasses, watches, etc.) and other similar computing devices. The components shown herein, their connections and relationships, and their functions are merely examples and are not intended to limit the implementation of the present invention described and / or required herein.
[0120] like Figure 5As shown, the electronic device 10 includes at least one processor 11, and a memory connected to the at least one processor 11, such as a read-only memory (ROM) 12, a random access memory (RAM) 13, etc., wherein the memory stores a computer program that can be executed by at least one processor, and the processor 11 can perform various appropriate actions and processes according to the computer program stored in the read-only memory (ROM) 12 or the computer program loaded from the storage unit 18 to the random access memory (RAM) 13. In the RAM 13, various programs and data required for the operation of the electronic device 10 can also be stored. The processor 11, the ROM 12, and the RAM 13 are connected to each other through a bus 14. An input / output (I / O) interface 15 is also connected to the bus 14.
[0121] A number of components in the electronic device 10 are connected to the I / O interface 15, including: an input unit 16, such as a keyboard, a mouse, etc.; an output unit 17, such as various types of displays, speakers, etc.; a storage unit 18, such as a disk, an optical disk, etc.; and a communication unit 19, such as a network card, a modem, a wireless communication transceiver, etc. The communication unit 19 allows the electronic device 10 to exchange information / data with other devices through a computer network such as the Internet and / or various telecommunication networks.
[0122] The processor 11 may be a variety of general and / or special processing components with processing and computing capabilities. Some examples of the processor 11 include, but are not limited to, a central processing unit (CPU), a graphics processing unit (GPU), various special artificial intelligence (AI) computing chips, various processors running machine learning model algorithms, a digital signal processor (DSP), and any appropriate processor, controller, microcontroller, etc. The processor 11 executes the various methods and processes described above, such as the excavator working device trajectory parameter solution and control method.
[0123] In some embodiments, the excavator working device trajectory parameter solution and control method can be implemented as a computer program, which is tangibly contained in a computer-readable storage medium, such as a storage unit 18. In some embodiments, part or all of the computer program can be loaded and / or installed on the electronic device 10 via the ROM 12 and / or the communication unit 19. When the computer program is loaded into the RAM 13 and executed by the processor 11, one or more steps of the excavator working device trajectory parameter solution and control method described above can be performed. Alternatively, in other embodiments, the processor 11 can be configured to execute the excavator working device trajectory parameter solution and control method in any other appropriate manner (for example, by means of firmware).
[0124] The method comprises: obtaining a first hinge point of the current excavator, and using the first hinge point as a coordinate origin to construct a current plane parameter solution coordinate system; wherein the first hinge point is a hinge point between a boom and a frame of the current excavator, and an X-axis of the current plane parameter solution coordinate system is parallel to a current working surface; obtaining a body inclination angle and a working surface slope corresponding to the current excavator, adjusting the current plane parameter solution coordinate system, and obtaining a current standard plane parameter solution coordinate system; obtaining an initial excavator joint description angle, and calculating an initial state posture trajectory parameter in the current standard plane parameter solution coordinate system; wherein the initial state posture trajectory parameter comprises: a relative angle between a bucket arm rotation pin and a line connecting a bucket working point; The initial projection distance on the ordinate and the initial projection distance of the boom on the ordinate; the current excavator joint description angle and the current excavator operation mode are obtained, and the target state posture trajectory parameters corresponding to the current excavator are calculated according to the initial state posture trajectory parameters, so as to control the excavator working device according to the target state posture trajectory parameters; wherein the target state posture trajectory parameters include: the projection distance change of the connecting line between the boom swivel pin and the bucket working point relative to the ordinate, the projection distance change of the boom on the ordinate, the difference between the projection distance change of the connecting line between the boom swivel pin and the bucket working point relative to the ordinate and the projection distance change of the boom on the ordinate, and the horizontal distance of the working point.
[0125] Alternatively, the method further includes: calculating the boom action proportional valve current, the arm action proportional valve reference current, and the bucket action proportional valve reference current according to the horizontal distance of the working point; obtaining the difference between the projection distance change of the boom rotation pin and the bucket working point connection line relative to the vertical coordinate and the projection distance change of the boom on the vertical coordinate, performing current adjustment processing on the boom action proportional valve reference current to obtain the boom action proportional valve adjustment current; obtaining the difference between the angle required for the bucket bottom to rotate relative to the initial state to keep it parallel to the working surface and the actual rotation angle of the bucket relative to the initial state, performing current adjustment processing on the bucket action proportional valve reference current to obtain the bucket action proportional valve adjustment current; and controlling the trajectory of the excavator working device according to the boom action proportional valve current, the arm action proportional valve adjustment current, and the bucket action proportional valve adjustment current.
[0126] Various implementations of the systems and techniques described above herein can be implemented in digital electronic circuit systems, integrated circuit systems, field programmable gate arrays (FPGAs), application specific integrated circuits (ASICs), application specific standard products (ASSPs), systems on chips (SOCs), load programmable logic devices (CPLDs), computer hardware, firmware, software, and / or combinations thereof. These various implementations can include: being implemented in one or more computer programs that can be executed and / or interpreted on a programmable system including at least one programmable processor, which can be a special purpose or general purpose programmable processor that can receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
[0127] Computer programs for implementing the methods of the present invention may be written in any combination of one or more programming languages. These computer programs may be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, so that when the computer program is executed by the processor, the functions / operations specified in the flow chart and / or block diagram are implemented. The computer program may be executed entirely on the machine, partially on the machine, partially on the machine and partially on a remote machine as a stand-alone software package, or entirely on a remote machine or server.
[0128] In the context of the present invention, a computer-readable storage medium may be a tangible medium that may contain or store a computer program for use by or in combination with an instruction execution system, device or equipment. A computer-readable storage medium may include, but is not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices or equipment, or any suitable combination of the foregoing. Alternatively, a computer-readable storage medium may be a machine-readable signal medium. A more specific example of a machine-readable storage medium may include an electrical connection based on one or more lines, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.
[0129] To provide interaction with a user, the systems and techniques described herein may be implemented on an electronic device having: a display device (e.g., a CRT (cathode ray tube) or LCD (liquid crystal display) monitor) for displaying information to the user; and a keyboard and a pointing device (e.g., a mouse or trackball) through which the user can provide input to the electronic device. Other types of devices may also be used to provide interaction with the user; for example, the feedback provided to the user may be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and input from the user may be received in any form (including acoustic input, voice input, or tactile input).
[0130] The systems and techniques described herein may be implemented in a computing system that includes backend components (e.g., as a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes frontend components (e.g., a user computer with a graphical user interface or a web browser through which a user can interact with implementations of the systems and techniques described herein), or a computing system that includes any combination of such backend components, middleware components, or frontend components. The components of the system may be interconnected by any form or medium of digital data communication (e.g., a communication network). Examples of communication networks include: a local area network (LAN), a wide area network (WAN), a blockchain network, and the Internet.
[0131] A computing system may include a client and a server. The client and the server are generally remote from each other and usually interact through a communication network. The client and server relationship is generated by computer programs running on the corresponding computers and having a client-server relationship with each other. The server may be a cloud server, also known as a cloud computing server or cloud host, which is a host product in the cloud computing service system to solve the defects of difficult management and weak business scalability in traditional physical hosts and VPS services.
[0132] It should be understood that the various forms of processes shown above can be used to reorder, add or delete steps. For example, the steps described in the present invention can be executed in parallel, sequentially or in different orders, as long as the desired results of the technical solution of the present invention can be achieved, and this document does not limit this.
[0133] The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
[0134] Embodiment 6
[0135] Embodiment 6 of the present invention also provides a computer-readable storage medium, wherein the computer-readable instructions are used to execute a method for solving and controlling trajectory parameters of an excavator working device when executed by a computer processor, the method comprising: obtaining a first hinge point of the current excavator, and using the first hinge point as a coordinate origin to construct a current plane parameter solving coordinate system; wherein the first hinge point is a hinge point between the boom and the frame of the current excavator, and the X-axis of the current plane parameter solving coordinate system is parallel to the current working surface; obtaining a vehicle body inclination angle and a working surface slope corresponding to the current excavator, adjusting the current plane parameter solving coordinate system, and obtaining a current standard plane parameter solving coordinate system; obtaining an initial excavator joint description angle, and calculating the initial state posture trajectory parameters in the current standard plane parameter solving coordinate system. ; Wherein, the initial state posture trajectory parameters include: the initial projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate, and the initial projection distance of the boom on the ordinate; obtain the current excavator joint description angle and the current excavator operation mode, and calculate the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, so as to control the excavator working device according to the target state posture trajectory parameters; wherein, the target state posture trajectory parameters include: the projection distance change of the line connecting the boom swivel pin and the bucket working point relative to the ordinate, the projection distance change of the boom on the ordinate, the difference between the projection distance change of the line connecting the boom swivel pin and the bucket working point relative to the ordinate and the projection distance change of the boom on the ordinate, and the horizontal distance of the working point.
[0136] Alternatively, the method further includes: calculating the boom action proportional valve current, the arm action proportional valve reference current, and the bucket action proportional valve reference current according to the horizontal distance of the working point; obtaining the difference between the projection distance change of the boom rotation pin and the bucket working point connection line relative to the vertical coordinate and the projection distance change of the boom on the vertical coordinate, performing current adjustment processing on the boom action proportional valve reference current to obtain the boom action proportional valve adjustment current; obtaining the difference between the angle required for the bucket bottom to rotate relative to the initial state to keep it parallel to the working surface and the actual rotation angle of the bucket relative to the initial state, performing current adjustment processing on the bucket action proportional valve reference current to obtain the bucket action proportional valve adjustment current; and controlling the trajectory of the excavator working device according to the boom action proportional valve current, the arm action proportional valve adjustment current, and the bucket action proportional valve adjustment current.
[0137] Of course, the computer-readable storage medium provided in the embodiment of the present invention has computer executable instructions that are not limited to the method operations described above, and can also execute related operations in the excavator working device trajectory parameter solution and control method provided in any embodiment of the present invention.
[0138] Through the above description of the implementation methods, the technicians in the relevant field can clearly understand that the present invention can be implemented by means of software and necessary general hardware, and of course it can also be implemented by hardware, but in many cases the former is a better implementation method. Based on such an understanding, the technical solution of the present invention, in essence, or the part that contributes to the prior art, can be embodied in the form of a software product, and the computer software product can be stored in a computer-readable storage medium, such as a computer floppy disk, a read-only memory (ROM), a random access memory (RAM), a flash memory (FLASH), a hard disk or an optical disk, etc., including a number of instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to execute the methods described in each embodiment of the present invention.
[0139] It is worth noting that in the above-mentioned embodiment of the excavator working device trajectory parameter solving and control device, the various units and modules included are only divided according to functional logic, but are not limited to the above-mentioned division, as long as the corresponding functions can be achieved; in addition, the specific names of the functional units are only for the convenience of distinguishing each other, and are not used to limit the scope of protection of the present invention.
[0140] The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims
1. A method for solving trajectory parameters of an excavator working device, characterized in that: include: Obtaining a first hinge point of the current excavator, and using the first hinge point as a coordinate origin to construct a current plane parameter solution coordinate system; Wherein, the first hinge point is the hinge point between the boom and the frame of the current excavator, and the X-axis of the current plane parameter solution coordinate system is parallel to the current working surface; Obtaining the body inclination angle and the working surface slope corresponding to the current excavator, adjusting the current plane parameter solution coordinate system, and obtaining the current standard plane parameter solution coordinate system; Obtain the initial excavator joint description angle, and calculate the initial state posture trajectory parameters in the current standard plane parameter solution coordinate system; The initial state posture trajectory parameters include: the initial projection distance of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate, and the initial projection distance of the boom on the ordinate; Acquire the current excavator joint description angle and the current excavator operation mode, and calculate the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, so as to control the excavator working device according to the target state posture trajectory parameters; Among them, the target state posture trajectory parameters include: the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate, the change in the projection distance of the boom on the ordinate, the difference between the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate and the change in the projection distance of the boom on the ordinate, and the horizontal distance of the working point.
2. The method according to claim 1, characterized in that The method of obtaining the vehicle body inclination angle and the working surface slope corresponding to the current excavator and adjusting the current plane parameter solution coordinate system to obtain the current standard plane parameter solution coordinate system includes: If the vehicle body tilt angle is the vehicle body pitch angle, the first adjustment arm angle a1 is calculated according to the formula a1=a-σ1, and the current plane parameter solution coordinate system is adjusted according to the first adjustment arm angle to obtain the current standard plane parameter solution coordinate system; Among them, σ1 represents the downward pitch angle of the vehicle body; a represents the boom angle in the current plane parameter solution coordinate system; If the vehicle body inclination angle is the vehicle body tilt angle, the second adjustment arm angle a2 is calculated according to the formula a2=a+σ2, and the current plane parameter solution coordinate system is adjusted according to the second adjustment arm angle to obtain the current standard plane parameter solution coordinate system; Among them, σ2 represents the tilt angle of the vehicle body; If the working surface slope is the working surface slope downward angle η, the coordinate axis of the current plane parameter solution coordinate system is adjusted according to the clockwise rotation angle η to obtain the current standard plane parameter solution coordinate system; If the working surface slope is the working surface slope upward angle η, the coordinate axes of the current plane parameter solution coordinate system are adjusted according to the counterclockwise rotation angle η to obtain the current standard plane parameter solution coordinate system.
3. The method according to claim 2, characterized in that The initial excavator joint description angle includes: in the current standard plane parameter solution coordinate system, the angle between the boom and the X-axis, the angle between the arm and the boom, the angle between the connecting line between the hinge point of the boom and the boom and the bucket working point and the angle between the hinge point between the boom and the boom and the vertical line of the working surface, the angle between the connecting line between the hinge point of the boom and the boom and the bucket working point and the connecting line between the hinge point between the boom and the boom and the hinge point between the boom and the bucket, the connecting line between the hinge point of the boom and the boom and the bucket working point, and the connecting line between the hinge point of the boom and the boom and the coordinate origin; The initial excavator joint description angle is obtained, and the initial state posture trajectory parameters are calculated in the current standard plane parameter solution coordinate system, including: According to the formula In the current standard plane parameter solution coordinate system, the initial projection distance h0 of the connecting line between the bucket arm swivel pin and the bucket operation point relative to the ordinate, and the initial projection distance h1 of the boom on the ordinate are calculated; Among them, α represents the angle between the boom and the X-axis; β represents the angle between the arm and the boom; θ1 represents the angle between the line between the hinge point of the arm and the boom and the bucket working point and the line between the hinge point between the arm and the boom and the vertical line of the working surface; μ represents the angle between the line between the hinge point of the arm and the boom and the bucket working point and the line between the hinge point between the arm and the boom and the hinge point between the arm and the bucket; l FV Indicates the line between the hinge point of the dipper stick and the boom and the working point of the bucket; l FC It represents the line between the hinge point of the boom and the coordinate origin; φ1 represents the angle between the hinge point between the boom and the vertical line of the working surface and the line between the hinge point between the boom and the boom and the hinge point between the boom and bucket.
4. The method according to claim 3, characterized in that The obtaining of the current excavator joint description angle and the current excavator operation mode, and calculating the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, includes: If the current excavator operation mode is bucket tip leveling operation, the current excavator joint description angle is obtained; Among them, the current excavator joint description angle includes: the change in the angle between the boom and the X-axis is Δα; the change in the angle between the arm and the boom is Δβ; According to the initial state posture trajectory parameters, through the formula To calculate the projection distance change Δh'0 of the connecting line between the bucket pivot pin and the bucket operation point corresponding to the current excavator relative to the ordinate, the projection distance change Δh1' of the boom on the ordinate, the difference H between the projection distance change of the connecting line between the bucket pivot pin and the bucket operation point relative to the ordinate and the projection distance change of the boom on the ordinate, and the horizontal distance l of the operation point Vx ; Among them, φ x It indicates the angle between the hinge point between the boom and the vertical line of the working surface and the hinge point between the boom and the boom and the hinge point between the boom and the bucket when the bucket tip or the bucket bottom is working on the flat ground; θ x It indicates the angle between the line between the hinge point of the bucket arm and boom and the bucket working point and the vertical line between the hinge point between the bucket arm and boom and the working surface when the bucket tip or bucket bottom is working on the flat ground; h 0x It indicates the projection distance of the line connecting the bucket arm pivot pin and the bucket working point relative to the ordinate when the bucket tip or bucket bottom is working on flat ground; h 1x It indicates the projection distance of the boom on the vertical coordinate when the bucket tip is operating on flat ground.
5. The method according to claim 4, characterized in that The target state posture trajectory parameters also include: the angle that the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface; The obtaining of the current excavator joint description angle and the current excavator operation mode, and calculating the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, includes: If the current excavator operation mode is bucket bottom leveling operation, obtain the current excavator joint description angle; According to the initial state posture trajectory parameters, through the formula To calculate the projection distance change Δh'0 of the connecting line between the bucket pivot pin and the bucket operation point corresponding to the current excavator relative to the ordinate, the projection distance change Δh1" of the boom on the ordinate, the difference H between the projection distance change of the connecting line between the bucket pivot pin and the bucket operation point relative to the ordinate and the projection distance change of the boom on the ordinate, and the horizontal distance l of the operation point Vx , and the angle ε that the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface x ; Among them, h1' x It indicates the projection distance of the boom on the ordinate when the bucket bottom is operating on flat ground; ε indicates the angle between the bucket and the boom.
6. A method for controlling the trajectory of an excavator working device, characterized in that: include: According to the horizontal distance of the working point, the current of the boom action proportional valve, the reference current of the boom action proportional valve, and the reference current of the bucket action proportional valve are calculated; Obtain the difference between the projection distance change of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate and the projection distance change of the boom on the ordinate, perform current adjustment processing on the boom action proportional valve reference current, and obtain the boom action proportional valve adjustment current; Obtaining the difference between the angle at which the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface and the actual rotation angle of the bucket relative to the initial state, and performing current adjustment processing on the reference current of the bucket action proportional valve to obtain the bucket action proportional valve adjustment current; The trajectory of the excavator working device is controlled according to the boom action proportional valve current, the arm action proportional valve adjustment current and the bucket action proportional valve adjustment current.
7. A device for solving trajectory parameters of an excavator working device, characterized in that: include: A current plane parameter solving coordinate system building module is used to obtain a first hinge point of the current excavator and use the first hinge point as a coordinate origin to build a current plane parameter solving coordinate system; Wherein, the first hinge point is the hinge point between the boom and the frame of the current excavator, and the X-axis of the current plane parameter solution coordinate system is parallel to the current working surface; A current standard plane parameter solution coordinate system determination module is used to obtain the body inclination angle and working surface slope corresponding to the current excavator, and adjust the current plane parameter solution coordinate system to obtain the current standard plane parameter solution coordinate system; The initial state posture trajectory parameter calculation module is used to obtain the initial excavator joint description angle and calculate the initial state posture trajectory parameters in the current standard plane parameter solution coordinate system; The initial state posture trajectory parameters include: the initial projection distance of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate, and the initial projection distance of the boom on the ordinate; The target state posture trajectory parameter calculation module is used to obtain the current excavator joint description angle and the current excavator operation mode, and calculate the target state posture trajectory parameters corresponding to the current excavator according to the initial state posture trajectory parameters, so as to control the excavator working device according to the target state posture trajectory parameters; Among them, the target state posture trajectory parameters include: the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate, the change in the projection distance of the boom on the ordinate, the difference between the change in the projection distance of the line connecting the boom swivel pin and the bucket working point relative to the ordinate and the change in the projection distance of the boom on the ordinate, and the horizontal distance of the working point.
8. A trajectory control device for an excavator working device, characterized in that: include: The current calculation module is used to calculate the current of the boom action proportional valve, the reference current of the boom action proportional valve, and the reference current of the bucket action proportional valve according to the horizontal distance of the working point; A boom action proportional valve adjustment current determination module is used to obtain the difference between the projection distance change of the connecting line between the bucket arm rotation pin and the bucket operation point relative to the ordinate and the projection distance change of the boom on the ordinate, and to perform current adjustment processing on the boom action proportional valve reference current to obtain the boom action proportional valve adjustment current; A bucket action proportional valve adjustment current determination module is used to obtain the difference between the angle that the bucket bottom needs to rotate relative to the initial state to keep it parallel to the working surface and the actual rotation angle of the bucket relative to the initial state, and to perform current adjustment processing on the bucket action proportional valve reference current to obtain the bucket action proportional valve adjustment current; The trajectory control module is used to control the trajectory of the excavator working device according to the boom action proportional valve current, the arm action proportional valve adjustment current and the bucket action proportional valve adjustment current.
9. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the method for solving the trajectory parameters of the excavator working device according to any one of claims 1 to 5 is implemented, or the method for controlling the trajectory of the excavator working device according to claim 6 is implemented.
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the method for solving the trajectory parameters of an excavator working device as described in any one of claims 1 to 5, or to implement the method for controlling the trajectory of an excavator working device as described in claim 6 when executed.
Citation Information
Patent Citations
Excavator bucket tooth tip positioning method and device and excavator
CN114045893A
Excavating track following automatic control system and method of electric excavating robot
CN114482181A
Intelligent excavator control system and working device trajectory planning control method
CN114991236A
Method, device and equipment for determining operation track of excavator bucket and storage medium
CN117306614A
Excavator optimal operation track planning method, device, equipment and medium
CN117739991A
