Control method for material throwing machine, processor, material throwing machine and storage medium

By establishing a follow-up relationship model between the rotation angle of the material throwing arm and the unloading plate expansion angle of the material throwing arm and the unloading plate of the material throwing machine, the problem of high operation dependence in the existing technology is solved and the material throwing is improved Mechanical efficiency and material filling uniformity.

CN118929098APending Publication Date: 2024-11-12ZOOMLION HEAVY MASCH CO LTD

Patent Information

Application Number
CN202410984355.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

The existing material throwing machinery has high operation dependence, and the operator needs to repeatedly switch the control buttons to ensure that the material falls in the load storage area, resulting in operation fatigue and inefficiency.

Method used

By establishing a follow-up relationship model between the rotation angle of the material throwing arm and the expansion angle of the unloading plate, receiving the rotation instructions of the material throwing arm and the unloading plate expansion and collection instructions, controlling the movement of the material throwing arm and the unloading plate based on the target angle and the current angle, realizing the The material blanking points are distributed in a straight line.

Benefits of technology

Reliance on operators is reduced, the operating efficiency of material throwing machinery is improved, the operation fatigue is reduced, and the uniform filling of material storage area is achieved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118929098A_ABST
    Figure CN118929098A_ABST
Patent Text Reader

Abstract

The invention discloses a control method for a throwing machine, a processor, the throwing machine and a storage medium, and belongs to the technical field of throwing machines. The control method comprises the steps that a material throwing arm rotation instruction is received, and the material throwing arm rotation instruction comprises a target rotation angle of a material throwing arm; the current rotation angle of a material throwing arm, the pitching angle of the material throwing arm and the current unfolding angle of a discharging plate are obtained; based on a predetermined follow-up relation model of the rotation angle of the throwing arm and the unfolding angle of the unloading plate, the target unfolding angle of the unloading plate is determined according to the target rotation angle, the current rotation angle, the pitching angle and the current unfolding angle; and the material throwing arm and the discharging plate are controlled to act according to the target rotation angle and the target unfolding angle. According to the material throwing machine, the material falling points of the materials thrown by the material throwing machine can be distributed along the straight line all the time so as to fill the material storage area, the dependence of the material throwing machine on operators is reduced, and the working efficiency of the material throwing machine is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the technical field of material throwing machines, and in particular to a control method, a processor, a material throwing machine and a storage medium for a material throwing machine. Background Art

[0002] At present, when throwing materials (such as silage machines) are performing throwing operations, the operator's control level is required to be high. Usually, the operator needs to repeatedly switch the control buttons to control the throwing arm and the unloading plate to ensure that the landing point of the thrown materials by the throwing machine always enters the loading storage area. In order to evenly fill the material storage area, the ideal filling method is that the landing points of the thrown materials are evenly distributed along a straight line in the loading storage area. However, this operation method is highly dependent on the operator's technical level and is prone to operator fatigue. Summary of the invention

[0003] The purpose of the embodiments of the present application is to provide a control method, a processor, a material throwing machine and a storage medium for a material throwing machine, so as to solve the problem that the prior art is highly dependent on operators.

[0004] In order to achieve the above-mentioned purpose, a first aspect of an embodiment of the present application provides a control method for a material throwing machine, wherein the material throwing machine includes a material throwing arm and a discharge plate arranged at the end of the material throwing arm, and the control method includes:

[0005] Receiving a throwing arm rotation instruction, wherein the throwing arm rotation instruction includes a target rotation angle of the throwing arm;

[0006] Get the current rotation angle of the throwing arm, the pitch angle of the throwing arm, and the current expansion angle of the unloading plate;

[0007] Based on a predetermined follow-up relationship model between the swing angle of the throwing arm and the deployment angle of the unloading plate, a target deployment angle of the unloading plate is determined according to the target swing angle, the current swing angle, the pitch angle and the current deployment angle;

[0008] The actions of the throwing arm and the unloading plate are controlled respectively according to the target rotation angle and the target expansion angle.

[0009] In the embodiment of the present application, the follow-up relationship model includes the following formula (1):

[0010] cos(β1)·(1+tan(γ)tan(α))=cos(β2)·(1+tan(γ)tan(θ)) (1)

[0011] Among them, β1 is the current rotation angle, γ is the pitch angle, α is the current deployment angle, β2 is the target rotation angle, and θ is the target deployment angle.

[0012] In an embodiment of the present application, the control method also includes: receiving a discharge plate extension and retraction instruction, wherein the discharge plate extension and retraction instruction includes an updated expansion angle of the discharge plate indicating a change in the blanking path; controlling the discharge plate movement according to the updated expansion angle to switch the blanking path of the throwing machine.

[0013] In an embodiment of the present application, the throwing machine also includes a rotating mechanism connected to the throwing arm, and the control method also includes: obtaining the center point position of the rotating mechanism, the center position of the rotating shaft of the unloading plate, a first intersection point and a second intersection point, wherein the first intersection point and the second intersection point are the intersection points of the pitch plane of the throwing arm and the boundary line of the preset dropping area; determining the current dropping point of the throwing machine according to the center point position, the center position of the rotating shaft, the first intersection point, the second intersection point, the pitch angle and the current deployment angle; when the current dropping point is located in the preset dropping area, receiving the throwing arm rotation command and / or the unloading plate extension and retraction command.

[0014] In an embodiment of the present application, determining the current drop point of the throwing machine according to the center point position, the center position of the rotating shaft, the first intersection point, the second intersection point, the pitch angle and the current deployment angle includes: determining the first distance between the center point position and the center position of the rotating shaft; determining the second distance between the center position of the rotating shaft and the third intersection point and determining the third distance between the center point position and the third intersection point according to the first distance and the pitch angle, the third intersection point being the intersection point of a first straight line perpendicular to the horizontal plane through the center position of the rotating shaft and a second straight line parallel to the horizontal plane through the center point position; determining the fourth distance between the third intersection point and the fourth intersection point, the fourth intersection point being the intersection point of the first straight line and the third straight line through the first intersection point and the second intersection point; determining the fourth distance as the coordinate value of the current drop point in the first preset direction of the pitch plane coordinate system corresponding to the throwing arm; adding the second distance and the fourth distance to obtain the fifth distance; determining the sixth distance according to the fifth distance and the current deployment angle; adding the third distance and the sixth distance to obtain the coordinate value of the current drop point in the second preset direction of the pitch plane coordinate system.

[0015] In an embodiment of the present application, the throwing machine also includes a position acquisition device and a display device. The current dropping point is the dropping point in the throwing arm coordinate system corresponding to the throwing arm. The control method also includes: determining a conversion matrix between the throwing arm coordinate system and the position acquisition device coordinate system corresponding to the position acquisition device; based on the conversion matrix, performing a coordinate system conversion on the current dropping point so that the current dropping point is converted from the throwing arm coordinate system to the position acquisition device coordinate system to obtain the current dropping point in the position acquisition device coordinate system; and acquiring image data of a preset dropping area acquired by the position acquisition device; displaying the current dropping point in the position acquisition device coordinate system through the display device, and displaying the preset dropping area according to the image data of the preset dropping area.

[0016] In an embodiment of the present application, determining the transformation matrix between the throwing arm coordinate system and the position acquisition device coordinate system corresponding to the position acquisition device includes: calibrating the posture of the position acquisition device so that the first plane of the throwing arm coordinate system is parallel to the second plane of the position acquisition device coordinate system, the first plane is a plane determined according to the first preset direction and the second preset direction of the throwing arm coordinate system, and the second plane is a plane determined according to the third preset direction and the fourth preset direction of the position acquisition device coordinate system; based on the pitch angle, determining the transformation matrix between the throwing arm coordinate system and the position acquisition device coordinate system.

[0017] A second aspect of an embodiment of the present application provides a processor configured to execute the above-mentioned control method for the material throwing machine.

[0018] A third aspect of an embodiment of the present application provides a material throwing machine, comprising: a material throwing arm; a discharge plate, arranged at the end of the material throwing arm; and a processor.

[0019] A fourth aspect of an embodiment of the present application provides a machine-readable storage medium, on which instructions are stored, and the instructions are used to enable a machine to execute the above-mentioned control method for a material throwing machine.

[0020] The above technical solution receives a throwing arm rotation instruction including a target rotation angle of the throwing arm, and then obtains the current rotation angle of the throwing arm, the pitch angle of the throwing arm, and the current expansion angle of the discharge plate, and then determines the target expansion angle of the discharge plate according to the target rotation angle, the current rotation angle, the pitch angle, and the current expansion angle based on a predetermined follow-up relationship model between the throwing arm rotation angle and the discharge plate expansion angle, and finally controls the throwing arm and the discharge plate movements respectively according to the target rotation angle and the target expansion angle. The present application can achieve synchronous follow-up of the discharge plate expansion angle by controlling the rotation angle of the throwing arm, so that the landing points of the materials thrown by the throwing machine are always distributed along a straight line to fill the material storage area, which not only reduces the dependence of the throwing machine on the operator (the operator is relatively less prone to fatigue), but also improves the operating efficiency of the throwing machine.

[0021] Other features and advantages of the embodiments of the present application will be described in detail in the subsequent specific implementation section. BRIEF DESCRIPTION OF THE DRAWINGS

[0022] The accompanying drawings are used to provide a further understanding of the embodiments of the present application and constitute a part of the specification. Together with the following specific implementations, they are used to explain the embodiments of the present application, but do not constitute a limitation on the embodiments of the present application. In the accompanying drawings:

[0023] Figure 1 A schematic diagram of a flow chart of a control method for a material throwing machine according to an embodiment of the present application is schematically shown;

[0024] Figure 2 A schematic diagram of the geometric structure of a throwing arm according to an embodiment of the present application is schematically shown;

[0025] Figure 3 A schematic diagram showing a material drop path and a material drop point position effect diagram displayed by a display device according to an embodiment of the present application is shown;

[0026] Figure 4 A schematic diagram of the follow-up relationship between the rotation angle of the throwing arm and the unfolding angle of the discharge plate according to an embodiment of the present application is schematically shown;

[0027] Figure 5 A schematic diagram of the zero position of a throwing arm according to an embodiment of the present application is schematically shown. DETAILED DESCRIPTION

[0028] In order to make the purpose, technical scheme and advantages of the embodiments of the present application clearer, the technical scheme in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. It should be understood that the specific implementation methods described herein are only used to illustrate and explain the embodiments of the present application, and are not used to limit the embodiments of the present application. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of this application.

[0029] It should be noted that if the embodiments of the present application involve directional indications (such as up, down, left, right, front, back...), the directional indications are only used to explain the relative position relationship, movement status, etc. between the components under a certain specific posture (as shown in the accompanying drawings). If the specific posture changes, the directional indication will also change accordingly.

[0030] In addition, if there are descriptions involving "first", "second", etc. in the embodiments of the present application, the descriptions of "first", "second", etc. are only used for descriptive purposes and cannot be understood as indicating or suggesting their relative importance or implicitly indicating the number of technical features indicated. Therefore, the features defined as "first" and "second" may explicitly or implicitly include at least one of the features. In addition, the technical solutions between the various embodiments can be combined with each other, but they must be based on the ability of ordinary technicians in the field to implement them. When the combination of technical solutions is contradictory or cannot be implemented, it should be deemed that such combination of technical solutions does not exist and is not within the scope of protection required by this application.

[0031] Figure 1 The following schematically shows a flow chart of a control method for a material throwing machine according to an embodiment of the present application. Figure 1As shown, an embodiment of the present application provides a control method for a throwing machine, the throwing machine includes a throwing arm and a discharge plate arranged at the end of the throwing arm, and the control method is applied to a processor as an example for description, and the method may include the following steps:

[0032] Step S101: receiving a throwing arm rotation instruction, wherein the throwing arm rotation instruction includes a target rotation angle of the throwing arm.

[0033] Step S102: Obtain the current rotation angle of the throwing arm, the pitch angle of the throwing arm, and the current deployment angle of the discharge plate.

[0034] Step S103: Based on the predetermined follow-up relationship model between the rotation angle of the throwing arm and the deployment angle of the discharge plate, the target deployment angle of the discharge plate is determined according to the target rotation angle, the current rotation angle, the pitch angle and the current deployment angle.

[0035] Step S104: Controlling the actions of the throwing arm and the unloading plate respectively according to the target rotation angle and the target deployment angle.

[0036] The control method for a throwing machine provided in an embodiment of the present application can be used for a throwing machine. The throwing machine can be a mechanical device such as a silage machine that can throw materials. The throwing machine includes a throwing arm and a discharge plate. The discharge plate is arranged at the end of the throwing arm. By controlling the rotation of the throwing arm and controlling the discharge plate to expand and retract with the rotation of the throwing arm, the position of the material dropping point can be distributed along a straight line parallel to the forward direction of the throwing machine. The rotation angle of the throwing arm is the rotation angle of the throwing arm relative to the zero position of the throwing machine. The zero position can be pre-set to a position on the side of the throwing machine body that is close to the preset dropping area and perpendicular to the forward direction of the throwing machine. The expansion angle of the discharge plate refers to the angle between the material ejection direction and the vertical direction. By controlling the expansion angle of the discharge plate, the position of the material dropping point can be distributed along a straight line perpendicular to the forward direction of the throwing machine. The pitch angle of the throwing arm is the angle between the line connecting the end of the discharge plate and the center point of the rotating mechanism and the horizontal direction.

[0037] In an embodiment of the present application, in order to allow the operator to control the rotation angle of the throwing arm, the throwing machine may also be provided with a control handle, a human-computer interaction device or other control devices that can be used to input the throwing arm rotation command. In this way, when the operator controls the throwing arm rotation through the control handle, the human-computer interaction device or other control devices, the processor can receive the throwing arm rotation command. The throwing arm rotation command includes the target rotation angle of the throwing arm, which is used to indicate the angle to which the throwing arm needs to rotate. The processor can also obtain the current rotation angle of the throwing arm collected by the rotation angle sensor, the pitch angle of the throwing arm collected by the angle sensor arranged on the throwing arm, and the current unfolding angle of the unloading plate collected by the angle sensor arranged on the unloading plate.

[0038] Subsequently, based on the predetermined follow-up relationship model between the swing angle of the throwing arm and the unfolding angle of the unloading plate, the processor can determine the target unfolding angle of the unloading plate according to the target swing angle, the current swing angle, the pitch angle and the current unfolding angle, and then control the throwing arm to rotate to the target swing angle, and control the unloading plate to unfold to the target unfolding angle, so that the material falls into the preset drop area, and the drop points are distributed along a straight line parallel to the forward direction of the throwing machine. It can be understood that the drop point here refers to the position where the material falls in the preset drop area.

[0039] The above technical solution receives a throwing arm rotation instruction including a target rotation angle of the throwing arm, and then obtains the current rotation angle of the throwing arm, the pitch angle of the throwing arm, and the current expansion angle of the discharge plate, and then determines the target expansion angle of the discharge plate according to the target rotation angle, the current rotation angle, the pitch angle, and the current expansion angle based on a predetermined follow-up relationship model between the throwing arm rotation angle and the discharge plate expansion angle, and finally controls the throwing arm and the discharge plate movements respectively according to the target rotation angle and the target expansion angle. The present application can achieve synchronous follow-up of the discharge plate expansion angle by controlling the rotation angle of the throwing arm, so that the landing points of the materials thrown by the throwing machine are always distributed along a straight line to fill the material storage area, thereby reducing the dependence of the throwing machine on the operator and improving the operating efficiency of the throwing machine.

[0040] Figure 2 The schematic diagram of the geometric structure of a throwing arm according to an embodiment of the present application is shown. Figure 2 As shown, in an embodiment of the present application, the throwing machine also includes a rotating mechanism connected to the throwing arm, and the control method also includes: obtaining the center point position of the rotating mechanism, the center position of the rotating shaft of the unloading plate, a first intersection point and a second intersection point, wherein the first intersection point and the second intersection point are the intersection points of the pitch plane of the throwing arm and the boundary line of the preset dropping area; determining the current dropping point of the throwing machine according to the center point position, the center position of the rotating shaft, the first intersection point, the second intersection point, the pitch angle and the current deployment angle; when the current dropping point is located in the preset dropping area, receiving the throwing arm rotation command and / or the unloading plate extension and retraction command.

[0041] When the throwing machine is performing the throwing operation, it is necessary to throw the material into the preset dropping area. Among them, the preset dropping area can be a transport vehicle bucket or other areas for storing materials. Therefore, the processor can determine whether the current dropping point is located in the preset dropping area to reduce the possibility of material spillage. Specifically, the throwing machine also includes a slewing mechanism connected to the throwing arm. The slewing mechanism can be used to drive the throwing arm to rotate. The processor can obtain the center point position O of the slewing mechanism and the center position A of the rotating shaft of the discharge plate, as well as the first intersection D and the second intersection F determined according to the pitch plane of the throwing arm and the boundary line of the preset dropping area. Further, the processor can determine the current dropping point E of the throwing machine according to the center point position O, the center position A of the rotating shaft, the first intersection D, the second intersection F, the pitch angle γ and the current expansion angle α, and receive the throwing arm rotation instruction and / or the discharge plate extension and retraction instruction when the current dropping point E is located in the preset dropping area.

[0042] Continue to refer to Figure 2 As shown, in an embodiment of the present application, determining the current drop point of the throwing machine according to the center point position, the center position of the rotating shaft, the first intersection point, the second intersection point, the pitch angle and the current deployment angle includes: determining a first distance between the center point position and the center position of the rotating shaft; determining a second distance between the center position of the rotating shaft and a third intersection point and determining a third distance between the center point position and the third intersection point according to the first distance and the pitch angle, the third intersection point being the intersection point of a first straight line perpendicular to the horizontal plane through the center position of the rotating shaft and a second straight line parallel to the horizontal plane through the center point position; determining a fourth distance between the third intersection point and the fourth intersection point, the fourth intersection point being the intersection point of the first straight line and the third straight line through the first intersection point and the second intersection point; determining the fourth distance as the coordinate value of the current drop point in the first preset direction of the pitch plane coordinate system corresponding to the throwing arm; adding the second distance and the fourth distance to obtain the fifth distance; determining the sixth distance according to the fifth distance and the current deployment angle; adding the third distance and the sixth distance to obtain the coordinate value of the current drop point in the second preset direction of the pitch plane coordinate system.

[0043] The processor can determine the current drop point of the throwing mechanism according to the center point position O, the center position A of the rotating shaft, the first intersection point D, the second intersection point F, the pitch angle γ and the current deployment angle α. It can be understood that the current drop point is the drop point in the throwing arm coordinate system corresponding to the throwing arm. The throwing arm coordinate system takes the center point position of the slewing mechanism as the origin, and the definition of the throwing arm coordinate system follows the right-hand rule. In the throwing arm coordinate system X′Y′Z′, the pitch plane of the throwing arm can be intercepted as the pitch plane coordinate system, that is, the Y′OZ′ coordinate system. Among them, Y′ is the first preset direction of the throwing arm coordinate system, Z′ is the second preset direction of the throwing arm coordinate system, and O is the origin of the throwing arm coordinate system. In this way, the processor can determine the position of the current drop point in the pitch plane coordinate system.

[0044] Specifically, according to the structural parameters of the throwing machine, the processor can determine the first distance OA between the center point position O and the center position A of the rotating shaft. Then, according to the first distance OA and the pitch angle γ, the processor can determine the second distance AB between the center position A of the rotating shaft and the third intersection point B, and determine the third distance OB between the center point position O and the third intersection point B. The third intersection point B is the intersection of a first straight line perpendicular to the horizontal plane through the center position A of the rotating shaft and a second straight line parallel to the horizontal plane through the center point position O. The second distance AB satisfies formula (1):

[0045] AB=OA·sinγ (1)

[0046] Among them, AB is the second distance, OA is the first distance, and y is the pitch angle.

[0047] The third distance OB satisfies formula (2):

[0048] OB=OA·cosγ (2)

[0049] Wherein, OB is the third distance, OA is the first distance, and y is the pitch angle.

[0050] The fourth intersection C is the intersection of the first straight line and the third straight line passing through the first intersection D and the second intersection F, and the third intersection B and the fourth intersection C are both located on the first straight line. Therefore, the processor can determine the fourth distance BC between the third intersection B and the fourth intersection C, and determine the fourth distance BC as the coordinate value of the current drop point E in the first preset direction Y′ of the pitch plane coordinate system corresponding to the throwing arm. At the same time, the processor can add the second distance AB and the fourth distance BC to obtain the fifth distance AC, and then determine the sixth distance CE according to the fifth distance AC and the current deployment angle α. The sixth distance CE satisfies formula (3):

[0051] CE=AC·tanα (3)

[0052] Among them, CE is the sixth distance, AC is the fifth distance, and α is the current deployment angle.

[0053] In this way, after adding the third distance OB to the sixth distance CE, the coordinate value of the current drop point E in the second preset direction Z′ of the pitch plane coordinate system can be obtained. It can be understood that since the position of the current drop point E is determined in the pitch plane coordinate system, it is only necessary to determine the coordinate value of the current drop point E in the first preset direction and the second preset direction at this time. Therefore, when converted to the throwing arm coordinate system, the coordinate value of the current drop point E in the fifth preset direction X′ of the throwing arm coordinate system is 0. In this way, the processor can determine the position of the current drop point, which is convenient for subsequent judgment of whether the current drop point is located in the preset drop area.

[0054] In an embodiment of the present application, the throwing machine also includes a position acquisition device and a display device. The current dropping point is the dropping point in the throwing arm coordinate system corresponding to the throwing arm. The control method also includes: determining a conversion matrix between the throwing arm coordinate system and the position acquisition device coordinate system corresponding to the position acquisition device; based on the conversion matrix, performing a coordinate system conversion on the current dropping point so that the current dropping point is converted from the throwing arm coordinate system to the position acquisition device coordinate system to obtain the current dropping point in the position acquisition device coordinate system; and acquiring image data of a preset dropping area acquired by the position acquisition device; displaying the current dropping point in the position acquisition device coordinate system through the display device, and displaying the preset dropping area according to the image data of the preset dropping area.

[0055] Specifically, the throwing machine is also provided with a visual assistance system. The visual assistance system includes a position acquisition device and a display device. The position acquisition device is arranged on the bottom plate of the throwing arm near the unloading plate. The definition of the position acquisition device coordinate system corresponding to the position acquisition device follows the right-hand rule. The position acquisition device adopts a three-dimensional visual sensor or a sensor with RGB-D perception, which can be used to obtain image data of a preset blanking area, and then display the preset blanking area according to the image data of the preset blanking area through a display device. Among them, the coordinate system where the image data is located is a pixel coordinate system.

[0056] Furthermore, the processor can determine the conversion matrix between the throwing arm coordinate system and the position acquisition device coordinate system corresponding to the position acquisition device, and then perform coordinate system conversion on the current material drop point based on the conversion matrix, so that the current material drop point is converted from the throwing arm coordinate system to the position acquisition device coordinate system, and the current material drop point in the position acquisition device coordinate system is obtained, so that the current material drop point in the position acquisition device coordinate system is displayed through the display device. It should be noted that the display image of the display device is in the pixel coordinate system, so after obtaining the current material drop point in the position acquisition device coordinate system, it is also necessary to determine the conversion matrix between the pixel coordinate system and the position acquisition device coordinate system according to the internal parameters of the position acquisition device, so as to convert the current material drop point in the position acquisition device coordinate system into the current material drop point in the pixel coordinate system based on the conversion matrix between the pixel coordinate system and the position acquisition device coordinate system, so that the current material drop point in the pixel coordinate system is displayed through the display device.

[0057] Figure 3 The following schematically shows a drawing showing a material drop path and a material drop point position displayed by a display device according to an embodiment of the present application. Figure 3As shown, it can be understood that, since the position acquisition device is fixedly installed on the throwing arm, during the throwing operation of the throwing machine, the material dropping path is always at a fixed position in the display image of the display device. That is to say, in the pixel coordinate system, the direction of the material dropping path remains unchanged, the current material dropping point is distributed along the direction of the material dropping path, and the specific position of the current material dropping point changes with the action of the throwing arm and the unloading plate.

[0058] In addition, the position acquisition device can also obtain the position of the preset blanking area. For example, based on the preset blanking area boundary line in the point cloud space, the plane can be plane-fitted to split the boundary line plane, and then the preset blanking area boundary line can be extracted based on geometric prior knowledge. This process can be implemented with reference to the prior art and will not be repeated here. Based on the fact that the position of the preset blanking area is the position in the coordinate system of the position acquisition device, the processor can also convert the position of the preset blanking area from the position acquisition device coordinate system to the throwing arm coordinate system based on the conversion matrix to obtain the preset blanking area in the throwing arm coordinate system. In this way, in the throwing arm coordinate system, the processor can further determine the coordinates of the current blanking point relative to the preset blanking area. In this way, through the conversion between the throwing arm coordinate system, the position acquisition device coordinate system and the pixel coordinate system, the operator can input the throwing arm rotation command and / or the unloading plate extension and retraction command according to the display image of the display device to achieve control of the distribution of the blanking point.

[0059] In an embodiment of the present application, determining the transformation matrix between the throwing arm coordinate system and the position acquisition device coordinate system corresponding to the position acquisition device includes: calibrating the posture of the position acquisition device so that the first plane of the throwing arm coordinate system is parallel to the second plane of the position acquisition device coordinate system, the first plane is a plane determined according to the first preset direction and the second preset direction of the throwing arm coordinate system, and the second plane is a plane determined according to the third preset direction and the fourth preset direction of the position acquisition device coordinate system; based on the pitch angle, determining the transformation matrix between the throwing arm coordinate system and the position acquisition device coordinate system.

[0060] Specifically, due to factors such as the position installation error of the position acquisition device, it is usually necessary to determine the conversion matrix between the position acquisition device coordinate system and the throwing arm coordinate system before processing the data acquired by the position acquisition device, that is, the rotation transformation matrix and the translation transformation matrix. Among them, the rotation transformation matrix usually needs to determine the rotation transformation matrix in three directions of the position acquisition device coordinate system respectively. In order to simplify the determination process of the rotation transformation matrix, the embodiment of the present application can calibrate the position acquisition device so that the first plane of the throwing arm coordinate system is parallel to the second plane of the position acquisition device coordinate system, so that the rotation transformation matrix retains only one dimension, simplifying the determination process of the conversion matrix. Among them, the first plane is a plane determined according to the first preset direction Y' and the second preset direction Z' of the throwing arm coordinate system, and the second plane is a plane determined according to the third preset direction Y and the fourth preset direction Z of the position acquisition device coordinate system. During the rotation of the throwing arm, the throwing arm coordinate system rotates around the first preset direction Y'. At this time, according to the pitch angle, the processor can determine the conversion matrix between the throwing arm coordinate system and the position acquisition device coordinate system.

[0061] Figure 4 The following diagram schematically shows the relationship between the rotation angle of the throwing arm and the unfolding angle of the unloading plate according to an embodiment of the present application. Figure 4 As shown, in the embodiment of the present application, the follow-up relationship model includes the following formula (4):

[0062] cos(β1)·(1+tan(γ)tan(α))=cos(β2)·(1+tan(γ)tan(θ)) (4)

[0063] Among them, β1 is the current rotation angle, γ is the pitch angle, α is the current deployment angle, β2 is the target rotation angle, and θ is the target deployment angle.

[0064] Specifically, Figure 5 The schematic diagram of the zero position of a throwing arm according to an embodiment of the present application is schematically shown. Figure 5 As shown, before performing the throwing operation, first, the processor can control the throwing arm to rotate to the zero position, and determine whether the current dropping point is located in the preset dropping area. When the current dropping point is located in the preset dropping area, the current pitch angle of the throwing arm is locked. If the current dropping point is not located in the preset dropping area, adjust the deployment angle of the discharge plate or the pitch angle of the throwing arm until the current dropping point is located in the preset dropping area, and lock the pitch angle of the throwing arm when the current dropping point is located in the preset dropping area. It should be noted that the deployment angle of the discharge plate in this process should be less than the maximum deployment angle of the discharge plate.

[0065] When performing the throwing operation, the throwing machine can move forward. Then, with the position of the throwing machine as a reference, the position 1 and position 2 of the preset material dropping area relative to the position of the throwing machine can be obtained. In order to ensure that the material dropping path determined according to the current dropping point C1 and the dropping point C2 at the next moment is parallel to the forward direction of the throwing machine, it is assumed that the current rotation angle of the throwing arm relative to the zero position is β1, the current deployment angle of the discharge plate is α (i.e. ∠C1A1B1), and the pitch angle of the throwing arm after locking is γ (i.e. ∠A1OC1). Then, when the throwing arm rotates to the target rotation angle β2 (i.e. ∠C1OC2) relative to the zero position, the target deployment angle θ (i.e. ∠C2A2B2) of the discharge plate can be determined according to formula (4).

[0066] In an embodiment of the present application, the control method also includes: receiving a discharge plate extension and retraction instruction, wherein the discharge plate extension and retraction instruction includes an updated expansion angle of the discharge plate indicating a change in the blanking path; controlling the discharge plate movement according to the updated expansion angle to switch the blanking path of the throwing machine.

[0067] The processor can also control the deployment angle of the stripper plate to switch the material dropping path of the throwing machine. Specifically, the processor can receive a stripper plate deployment instruction input by an operator. The stripper plate deployment instruction is an instruction for controlling the deployment angle of the stripper plate, including an updated deployment angle of the stripper plate indicating a change in the material dropping path. Therefore, after receiving the stripper plate deployment instruction, the processor can control the stripper plate action according to the updated deployment angle, so that the straight line determined according to the material dropping point at the next moment and the current material dropping point is perpendicular to the forward direction of the throwing machine, so as to switch the material dropping path of the throwing machine.

[0068] It can be understood that if the operator continuously inputs the unloading plate extension and retraction instructions, the processor can control the unloading plate movement according to the unloading plate extension and retraction instructions, so that the landing point of the material thrown by the throwing machine is always distributed along a straight line perpendicular to the forward direction of the throwing machine.

[0069] For example, if the throwing machine is a silage machine and the preset dropping area is the truck bucket, during the silage machine throwing operation, the silage machine is usually parallel to the driving direction of the truck. The operator controls the throwing arm to move and fill from the tail to the head of the truck bucket, or from the head to the tail of the truck bucket. During the filling process, the best distribution of the dropping points in the truck bucket is a straight line distribution along the length of the bucket. Therefore, the steps to achieve the best throwing and filling operation are as follows:

[0070] Step 1: Before starting the operation, the operator first adjusts the position of the throwing arm so that the truck bucket is within the field of view of the position acquisition device and can be seen on the display device. During the adjustment of the throwing arm, the drop point on the display device will be updated synchronously. When the drop point enters the specified position of the bucket, the pitch angle of the throwing arm is locked.

[0071] Step 2: Start throwing operation. Assuming that the silage machine is roughly parallel to the direction of travel of the transport truck, the operator can control it according to his filling method and operation experience. The specific control method is to input the throwing arm rotation command, and the material dropping point will automatically throw the material in a straight line along the direction of travel of the transport truck bucket; input the unloading plate extension and retraction command, and the material dropping point will be adjusted along the width direction of the transport truck bucket. This control method can maximize the filling of the transport truck bucket.

[0072] Step 3: Each time the operator manipulates the throwing arm, the image on the display device also synchronously updates the relative position changes between the dropping point and the truck bucket in real time to assist the operator in achieving accurate filling.

[0073] In summary, compared with the prior art, the technical solution provided by this application has the following advantages:

[0074] 1) This application can simplify the control method of the throwing arm, reduce the control complexity and dependence on the operator, and improve the efficiency of the throwing operation by establishing a follow-up relationship model between the rotation angle of the throwing arm and the expansion angle of the discharge plate.

[0075] 2) This application integrates a video perception assistance system, and the operator can control the throwing arm by observing the relative position of the dropping point on the display device and the preset dropping area, which can improve the convenience of the operator's operation.

[0076] 3) The material throwing and filling method provided in this application can meet the demand for maximizing the filling of the preset blanking area.

[0077] An embodiment of the present application also provides a processor configured to execute the above-mentioned control method for the material throwing machine.

[0078] Specifically, in an embodiment of the present application, the processor can be configured to: receive a throwing arm rotation instruction, wherein the throwing arm rotation instruction includes a target rotation angle of the throwing arm; obtain the current rotation angle of the throwing arm, the pitch angle of the throwing arm, and the current deployment angle of the unloading plate; based on a predetermined follow-up relationship model between the throwing arm rotation angle and the deployment angle of the unloading plate, determine the target deployment angle of the unloading plate according to the target rotation angle, the current rotation angle, the pitch angle and the current deployment angle; and control the throwing arm and the unloading plate movements according to the target rotation angle and the target deployment angle, respectively.

[0079] In one embodiment, the processor is further configured to: the follow-up relationship model includes the following formula (4):

[0080] cos(β1)·(1+tan(γ)tan(α))=cos(β2)·(1+tan(γ)tan(θ)) (4)

[0081] Among them, β1 is the current rotation angle, γ is the pitch angle, α is the current deployment angle, β2 is the target rotation angle, and θ is the target deployment angle.

[0082] In one embodiment, the processor is further configured to: receive a stripper plate extension and retraction instruction, wherein the stripper plate extension and retraction instruction includes an updated extension angle of the stripper plate indicating a change in the blanking path; and control the stripper plate movement according to the updated extension angle to switch the blanking path of the throwing machine.

[0083] In one embodiment, the processor is further configured to: obtain the center point position of the rotating mechanism, the center position of the rotating shaft of the unloading plate, the first intersection point and the second intersection point, wherein the first intersection point and the second intersection point are the intersection points of the pitch plane of the throwing arm and the boundary line of the preset dropping area; determine the current dropping point of the throwing mechanism according to the center point position, the center position of the rotating shaft, the first intersection point, the second intersection point, the pitch angle and the current deployment angle; when the current dropping point is located in the preset dropping area, receive the throwing arm rotation command and / or the unloading plate extension and retraction command.

[0084] In one embodiment, the processor is further configured to: determine a first distance between the center point position and the center position of the rotating shaft; determine a second distance between the center position of the rotating shaft and the third intersection and a third distance between the center point position and the third intersection based on the first distance and the pitch angle, the third intersection being the intersection of a first straight line perpendicular to the horizontal plane through the center position of the rotating shaft and a second straight line parallel to the horizontal plane through the center point position; determine a fourth distance between the third intersection and the fourth intersection, the fourth intersection being the intersection of the first straight line and the third straight line through the first intersection and the second intersection; determine the fourth distance as the coordinate value of the current drop point in the first preset direction of the pitch plane coordinate system corresponding to the throwing arm; add the second distance and the fourth distance to obtain the fifth distance; determine the sixth distance based on the fifth distance and the current deployment angle; add the third distance and the sixth distance to obtain the coordinate value of the current drop point in the second preset direction of the pitch plane coordinate system.

[0085] In one embodiment, the processor is further configured to: determine a transformation matrix between the throwing arm coordinate system and the position acquisition device coordinate system corresponding to the position acquisition device; based on the transformation matrix, perform a coordinate system transformation on the current material drop point, so that the current material drop point is transformed from the throwing arm coordinate system to the position acquisition device coordinate system to obtain the current material drop point in the position acquisition device coordinate system; and obtain image data of a preset material drop area collected by the position acquisition device; display the current material drop point in the position acquisition device coordinate system through a display device, and display the preset material drop area according to the image data of the preset material drop area.

[0086] In one embodiment, the processor is further configured to: calibrate the posture of the position acquisition device so that the first plane of the throwing arm coordinate system is parallel to the second plane of the position acquisition device coordinate system, the first plane is a plane determined according to the first preset direction and the second preset direction of the throwing arm coordinate system, and the second plane is a plane determined according to the third preset direction and the fourth preset direction of the position acquisition device coordinate system; based on the pitch angle, determine the transformation matrix between the throwing arm coordinate system and the position acquisition device coordinate system.

[0087] The above technical solution receives a throwing arm rotation instruction including a target rotation angle of the throwing arm, and then obtains the current rotation angle of the throwing arm, the pitch angle of the throwing arm, and the current expansion angle of the discharge plate, and then determines the target expansion angle of the discharge plate according to the target rotation angle, the current rotation angle, the pitch angle, and the current expansion angle based on a predetermined follow-up relationship model between the throwing arm rotation angle and the discharge plate expansion angle, and finally controls the throwing arm and the discharge plate movements respectively according to the target rotation angle and the target expansion angle. The present application can achieve synchronous follow-up of the discharge plate expansion angle by controlling the rotation angle of the throwing arm, so that the landing points of the materials thrown by the throwing machine are always distributed along a straight line to fill the material storage area, thereby reducing the dependence of the throwing machine on the operator and improving the operating efficiency of the throwing machine.

[0088] The embodiment of the present application also provides a throwing machine, which may include: a throwing arm; a discharge plate, which is arranged at the end of the throwing arm; and a processor.

[0089] An embodiment of the present application also provides a machine-readable storage medium, on which instructions are stored, and the instructions are used to enable a machine to execute the above-mentioned control method for the material throwing machine.

[0090] Those skilled in the art will appreciate that the embodiments of the present application may be provided as methods, systems, or computer program products. Therefore, the present application may adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment in combination with software and hardware. Moreover, the present application may adopt the form of a computer program product implemented in one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) that include computer-usable program code.

[0091] The present application is described with reference to the flowcharts and / or block diagrams of the methods, devices (systems), and computer program products according to the embodiments of the present application. It should be understood that each process and / or box in the flowchart and / or block diagram, as well as the combination of the processes and / or boxes in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.

[0092] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.

[0093] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.

[0094] In a typical configuration, a computing device includes one or more processors (CPU), input / output interfaces, network interfaces, and memory.

[0095] The memory may include non-permanent memory in a computer-readable medium, random access memory (RAM) and / or non-volatile memory in the form of read-only memory (ROM) or flash RAM. The memory is an example of a computer-readable medium.

[0096] Computer readable media include permanent and non-permanent, removable and non-removable media that can be implemented by any method or technology to store information. Information can be computer readable instructions, data structures, program modules or other data. Examples of computer storage media include, but are not limited to, phase change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other memory technology, compact disk read-only memory (CD-ROM), digital versatile disk (DVD) or other optical storage, magnetic cassettes, magnetic tape disk storage or other magnetic storage devices or any other non-transmission media that can be used to store information that can be accessed by a computing device. As defined herein, computer readable media does not include temporary computer readable media (transitory media), such as modulated data signals and carrier waves.

[0097] It should also be noted that the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, commodity or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, commodity or device. In the absence of more restrictions, the elements defined by the sentence "comprises a ..." do not exclude the existence of other identical elements in the process, method, commodity or device including the elements.

[0098] The above are only embodiments of the present application and are not intended to limit the present application. For those skilled in the art, the present application may have various changes and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application should be included within the scope of the claims of the present application.

Claims

1. A control method for a throwing machine, characterized in that: The throwing machine includes a throwing arm and a discharge plate arranged at the end of the throwing arm, and the control method includes: Receiving a throwing arm rotation instruction, wherein the throwing arm rotation instruction includes a target rotation angle of the throwing arm; Obtaining the current rotation angle of the throwing arm, the pitch angle of the throwing arm, and the current deployment angle of the unloading plate; Based on a predetermined follow-up relationship model between the rotation angle of the throwing arm and the deployment angle of the unloading plate, a target deployment angle of the unloading plate is determined according to the target rotation angle, the current rotation angle, the pitch angle and the current deployment angle; The actions of the throwing arm and the unloading plate are controlled respectively according to the target rotation angle and the target deployment angle.

2. The control method according to claim 1, characterized in that: The following dynamic relationship model includes the following formula (1): cos(β1)·(1+tan(γ)tan(α))=cos(β2)·(1+tan(γ)tan(θ)) (1) Among them, β1 is the current rotation angle, γ is the pitch angle, α is the current deployment angle, β2 is the target rotation angle, and θ is the target deployment angle.

3. The control method according to claim 1, characterized in that: The control method further comprises: receiving a stripper plate extension and retraction instruction, wherein the stripper plate extension and retraction instruction includes an updated extension angle of the stripper plate indicating a change in a material drop path; The action of the discharge plate is controlled according to the updated expansion angle to switch the material dropping path of the throwing machine.

4. The control method according to claim 1, characterized in that: The throwing machine also includes a slewing mechanism connected to the throwing arm, and the control method also includes: Obtaining the center point position of the slewing mechanism, the center position of the rotating shaft of the discharge plate, a first intersection point and a second intersection point, wherein the first intersection point and the second intersection point are the intersection points of the pitch plane of the throwing arm and the boundary line of the preset material dropping area; Determine the current drop point of the throwing machine according to the center point position, the center position of the rotating shaft, the first intersection point, the second intersection point, the pitch angle and the current deployment angle; When the current material dropping point is located in the preset material dropping area, a material throwing arm rotation instruction and / or a material discharge plate extension and retraction instruction is received.

5. The control method according to claim 4, characterized in that: Determining the current drop point of the throwing machine according to the center point position, the center position of the rotating shaft, the first intersection point, the second intersection point, the pitch angle and the current deployment angle includes: Determine a first distance between the center point position and the center position of the rotating shaft; Determine, according to the first distance and the pitch angle, a second distance between the center position of the rotation axis and a third intersection point and a third distance between the center point position and the third intersection point, wherein the third intersection point is an intersection point of a first straight line passing through the center position of the rotation axis and perpendicular to a horizontal plane and a second straight line passing through the center point position and parallel to the horizontal plane; determining a fourth distance between the third intersection point and a fourth intersection point, wherein the fourth intersection point is an intersection point of the first straight line and a third straight line passing through the first intersection point and the second intersection point; Determine the fourth distance as the coordinate value of the current material dropping point in the first preset direction of the pitch plane coordinate system corresponding to the material throwing arm; adding the second distance and the fourth distance to obtain a fifth distance; determining a sixth distance according to the fifth distance and the current deployment angle; The third distance is added to the sixth distance to obtain the coordinate value of the current material drop point in the second preset direction of the pitch plane coordinate system.

6. The control method according to claim 4, characterized in that: The throwing machine further includes a position acquisition device and a display device, the current dropping point is the dropping point in the throwing arm coordinate system corresponding to the throwing arm, and the control method further includes: Determine a conversion matrix between the throwing arm coordinate system and the position acquisition device coordinate system corresponding to the position acquisition device; Based on the conversion matrix, the coordinate system of the current material drop point is converted so that the current material drop point is converted from the throwing arm coordinate system to the position acquisition device coordinate system to obtain the current material drop point in the position acquisition device coordinate system; and Acquire image data of a preset blanking area collected by the position acquisition device; The current material-dropping point in the coordinate system of the position acquisition device is displayed by the display device, and the preset material-dropping area is displayed according to the image data of the preset material-dropping area.

7. The control method according to claim 6, characterized in that: The determination of the conversion matrix between the coordinate system of the throwing arm and the coordinate system of the position acquisition device corresponding to the position acquisition device comprises: Calibrate the position and posture of the position acquisition device so that a first plane of the throwing arm coordinate system is parallel to a second plane of the position acquisition device coordinate system, wherein the first plane is a plane determined according to a first preset direction and a second preset direction of the throwing arm coordinate system, and the second plane is a plane determined according to a third preset direction and a fourth preset direction of the position acquisition device coordinate system; Based on the pitch angle, a conversion matrix between the throwing arm coordinate system and the position acquisition device coordinate system is determined.

8. A processor, characterized in that: The method is configured to execute the control method for a material throwing machine according to any one of claims 1 to 7.

9. A throwing machine, characterized in that: include: Throwing arm; A discharge plate, arranged at the end of the throwing arm; as well as A processor according to claim 8.

10. A machine-readable storage medium, characterized in that: The machine-readable storage medium stores instructions for causing the machine to execute the control method for a material throwing machine according to any one of claims 1 to 7.

Citation Information

Patent Citations

  • Method and stereo vision system for managing unloading of agricultural materials from vehicle

    CN108021106A

  • Motion control method of mechanical arm of automatic throwing system of green feeding machine

    CN111090258A

  • Method and device for automatically tracing car hopper by throwing cylinder based on edge intelligence

    CN115268454A

  • Self-propelled agricultural machine has receiving tool for receiving harvest from field, contactless proximity sensor, and autopilot unit for guiding machine depending on detected crop edge

    DE102009041646A1

  • Methods for controlling crop overload

    DE102020124508A1

Cited By

  • Lightweight throwing tool automatic unloading method and system based on computer vision

    CN119769284A