Automatic rotation control method, device, system, engineering machinery and storage medium
By converting the starting and ending rotation angles to 0°-360° and combining the relationship between the starting and ending positions, the engineering machinery is automatically controlled to rotate at the minimum angle, solving the problems of manual operation and unidirectional rotation in existing technologies, and realizing low-power and high-efficiency automated control.
Patent Information
- Application Number
- CN202110145520.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-02-02
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2041-02-02
AI Technical Summary
The existing slewing control method of construction machinery relies on manual operation, has a low degree of automation, and can only rotate in one direction when automatically controlled, resulting in low work efficiency and high power consumption.
By converting the starting and ending rotation angles to 0°-360° and combining the relationship between the starting and ending positions, the minimum angle and direction of the slewing mechanism of the engineering machinery are determined, and it is automatically controlled to rotate at the minimum angle, and the rotation direction is adjusted when the limit is exceeded.
It has enabled automated control of construction machinery, reduced operating power consumption, improved work efficiency and operation accuracy, freed up manpower, and enhanced the level of intelligence.
Smart Images

Figure CN112811315B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of engineering machinery, and in particular to an automatic swing control method, device, system, engineering machinery and storage medium of engineering machinery. Background Art
[0002] For the rotation of construction machinery, such as tower cranes and cranes, the existing technical solutions are generally manual control or automatic control.
[0003] Human control is done through linkage consoles or remote controls. However, both methods cannot get rid of the influence of human control of construction machinery, and their automation level is low; relying on human vision to operate construction machinery has limitations in operation;
[0004] In automatic control, the construction machinery rotates at the angle difference (e.g. 280°) between the current position (e.g. 40° rotation angle) and the target position (e.g. 320° rotation angle), that is, it can only rotate in one direction, with low working efficiency and high power consumption. Summary of the invention
[0005] The purpose of the embodiments of the present invention is to provide an automatic rotation control method, device, system, engineering machinery and storage medium for engineering machinery, which reduces the operating power consumption of engineering machinery, improves operation accuracy, and effectively improves the work efficiency and intelligence level of automatic operation of engineering machinery.
[0006] In order to achieve the above-mentioned object, an embodiment of the present invention provides an automatic rotation control method for an engineering machine, wherein the engineering machine includes a rotation mechanism, and the control method includes: setting a starting rotation position angle θ0 and an end rotation position angle θ t Converted to 0°-360°; at least according to the converted starting point rotation position angle θ 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The first rotation angle θ and the first rotation direction of the rotation mechanism of the engineering machinery are determined based on the size relationship between them; and the rotation mechanism of the engineering machinery is controlled to rotate at a minimum angle at least according to the determined first rotation angle θ and the first rotation direction.
[0007] Preferably, the at least one starting point rotation position angle θ is converted 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The relationship between the magnitudes of θ and θ and the first rotation direction of the rotary mechanism of the engineering machinery includes:
[0008] At 0°≤θ 00 <180°, and θ 00 ≤θ tt <θ 00 When the angle is +180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0009] θ=θ0+|θ tt -θ 00 |;
[0010] At 0°≤θ 00 <180°, and θ tt <θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0011] θ=θ0-|θ tt -θ 00 |;
[0012] At 0°≤θ 00 <180°, and θ tt >θ 00 When the first rotation direction is +180°, the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0013] θ=θ0-360°+|θ tt -θ 00 |.
[0014] Preferably, the at least one starting point rotation position angle θ is converted 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The relationship between the magnitudes of θ and θ and the first rotation direction of the rotary mechanism of the engineering machinery includes:
[0015] At 180°≤θ 00 ≤360°, and θ 00 -180°<θ tt ≤θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0016] θ=θ0-|θ tt -θ 00 |;
[0017] At 180°≤θ 00 ≤360°, and θ tt <θ00 When the first rotation direction is -180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0018] θ=θ0+360°-|θ tt -θ 00 |;
[0019] At 180°≤θ 00 ≤360°, and θ tt >θ 00 When , the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0020] θ=θ0+|θ tt -θ 00 |.
[0021] Preferably, controlling the slewing mechanism of the engineering machinery to slew at a minimum angle at least according to the determined first slewing angle θ and the first slewing direction comprises: when the determined first slewing angle θ exceeds a limit range of the action of the engineering machinery, controlling the slewing mechanism of the engineering machinery to slew in a second slewing direction to a second slewing angle θ1, wherein the second slewing direction is opposite to the first slewing direction, and the second slewing angle θ1 is determined by the following formula:
[0022] At 0°≤θ 00 <180°,θ 00 ≤θ tt <θ 00 +180°
[0023] θ1=θ0-360°+|θ-θ0|;
[0024] At 0°≤θ 00 <180°,θ tt <θ 00 hour,
[0025] θ1=θ0+360°+|θ-θ0|;
[0026] At 0°≤θ 00 <180°,θ tt >θ 00 +180°
[0027] θ1=θ0+360°-|θ-θ0|.
[0028] Preferably, controlling the slewing mechanism of the engineering machinery to slew at a minimum angle at least according to the determined first slewing angle θ and the first slewing direction comprises: when the determined first slewing angle θ exceeds a limit range of the action of the engineering machinery, controlling the slewing mechanism of the engineering machinery to slew in a second slewing direction to a second slewing angle θ1, wherein the second slewing direction is opposite to the first slewing direction, and the second slewing angle θ1 is determined by the following formula:
[0029] At 180°≤θ 00 ≤360°, θ 00 -180°<θ tt ≤θ 00 hour,
[0030] θ1=θ0+360°-|θ-θ0|;
[0031] At 180°≤θ 00 ≤360°, θ tt <θ 00 -180°
[0032] θ1=θ0-360°+|θ-θ0|;
[0033] At 180°≤θ 00 ≤360°, θ tt >θ 00 hour,
[0034] θ1=θ0-360°+|θ-θ0|.
[0035] The embodiment of the present invention also provides an automatic rotation control device for engineering machinery, the engineering machinery includes a rotation mechanism, the device includes: a conversion unit, a processing unit and a control unit, wherein the conversion unit is used to convert the starting rotation position angle θ0 and the end rotation position angle θ t The processing unit is used to convert the starting point rotation position angle θ to 0°-360° at least according to the converted starting point rotation position angle θ 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The size relationship between them is used to determine the first rotation angle θ and the first rotation direction of the rotation mechanism of the engineering machinery; the control unit is used to control the rotation mechanism of the engineering machinery to rotate at a minimum angle based on at least the determined first rotation angle θ and the first rotation direction.
[0036] Preferably, the processing unit is used for:
[0037] At 0°≤θ 00 <180°, and θ 00 ≤θtt <θ 00 When the angle is +180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0038] θ=θ0+|θ tt -θ 00 |;
[0039] At 0°≤θ 00 <180°, and θ tt <θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0040] θ=θ0-|θ tt -θ 00 |;
[0041] At 0°≤θ 00 <180°, and θ tt >θ 00 When the first rotation direction is +180°, the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0042] θ=θ0-360°+|θ tt -θ 00 |.
[0043] Preferably, the processing unit is used for:
[0044] At 180°≤θ 00 ≤360°, and θ 00 -180°<θ tt ≤θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0045] θ=θ0-|θ tt -θ 00 |;
[0046] At 180°≤θ 00 ≤360°, and θ tt <θ 00 When the first rotation direction is -180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0047] θ=θ0+360°-|θ tt -θ 00 |;
[0048] At 180°≤θ 00 ≤360°, and θ tt >θ 00When , the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0049] θ=θ0+|θ tt -θ 00 |.
[0050] Preferably, the control unit is used to: when the determined first rotation angle θ exceeds the limit range of the engineering machinery action, control the rotation mechanism of the engineering machinery to rotate in a second rotation direction to a second rotation angle θ1, wherein the second rotation direction is opposite to the first rotation direction, and the second rotation angle θ1 is determined by the following formula:
[0051] At 0°≤θ 00 <180°,θ 00 ≤θ tt <θ 00 +180°
[0052] θ1=θ0-360°+|θ-θ0|;
[0053] At 0°≤θ 00 <180°,θ tt <θ 00 hour,
[0054] θ1=θ0+360°+|θ-θ0|;
[0055] At 0°≤θ 00 <180°,θ tt >θ 00 +180°
[0056] θ1=θ0+360°-|θ-θ0|.
[0057] Preferably, the control unit is used to: when the determined first rotation angle θ exceeds the limit range of the engineering machinery action, control the rotation mechanism of the engineering machinery to rotate in a second rotation direction to a second rotation angle θ1, wherein the second rotation direction is opposite to the first rotation direction, and the second rotation angle θ1 is determined by the following formula:
[0058] At 180°≤θ 00 ≤360°, θ 00 -180°<θ tt ≤θ 00 hour,
[0059] θ1=θ0+360°-|θ-θ0|;
[0060] At 180°≤θ 00 ≤360°, θ tt <θ 00-180°
[0061] θ1=θ0-360°+|θ-θ0|;
[0062] At 180°≤θ 00 ≤360°, θ tt >θ 00 hour,
[0063] θ1=θ0-360°+|θ-θ0|.
[0064] The embodiment of the present invention further provides an automatic rotation control system for engineering machinery, the system comprising: the automatic rotation control device for engineering machinery as described above; and an interactive device for inputting the starting rotation position angle θ0 and the end rotation position angle θ t ; A display device for displaying the current rotation angle of the rotation mechanism of the engineering machinery.
[0065] An embodiment of the present invention further provides an engineering machine, which includes the automatic swing control device for the engineering machine described above.
[0066] An embodiment of the present invention further provides a machine-readable storage medium, on which instructions are stored, and the instructions are used to enable a machine to execute the automatic rotation control method of the engineering machinery described above.
[0067] Through the above technical scheme, the automatic rotation control method, device, system, engineering machinery and storage medium of the engineering machinery provided by the present invention can be used to automatically control the engineering machinery to rotate at the minimum angle, which can greatly shorten the operating distance of the engineering machinery, reduce the operating power consumption of the engineering machinery, effectively save energy, and effectively improve the working efficiency of the automatic operation of the engineering machinery. Moreover, since there is no need for manual control of the rotation of the engineering machinery, human labor is liberated, the operation accuracy is improved, and the level of intelligence is further improved.
[0068] Other features and advantages of the embodiments of the present invention will be described in detail in the subsequent detailed description. BRIEF DESCRIPTION OF THE DRAWINGS
[0069] The accompanying drawings are used to provide a further understanding of the embodiments of the present invention and constitute a part of the specification. Together with the following specific implementations, they are used to explain the embodiments of the present invention, but do not constitute a limitation on the embodiments of the present invention. In the accompanying drawings:
[0070] Figure 1 is a flow chart of an automatic rotation control method for engineering machinery provided by an embodiment of the present invention;
[0071] Figure 2 is a structural block diagram of an automatic rotation control device for engineering machinery provided by an embodiment of the present invention;
[0072] Figure 3 It is a structural block diagram of an automatic swing control system for engineering machinery provided by one embodiment of the present invention.
[0073] Description of Reference Numerals
[0074] 101 conversion unit 102 processing unit
[0075] 103 Control unit 201 Automatic rotation control device for construction machinery
[0076] 202 interactive device 203 display device
[0077] 204 Embedded Industrial Computer 205 Angle Sensor
[0078] 206 Rotating Mechanism 207 Safety Monitoring System
[0079] 208 PLC controller DETAILED DESCRIPTION
[0080] The specific implementation of the embodiment of the present invention is described in detail below in conjunction with the accompanying drawings. It should be understood that the specific implementation described here is only used to illustrate and explain the embodiment of the present invention, and is not used to limit the embodiment of the present invention.
[0081] Figure 1 FIG. 1 is a flow chart of an automatic rotation control method for engineering machinery provided by an embodiment of the present invention. Figure 1 As shown, the engineering machinery includes a slewing mechanism, and the control method includes:
[0082] Step S11: The starting point rotation position angle θ0 and the end point rotation position angle θ t Convert to 0°-360°;
[0083] For example, for the starting point rotation position angle θ0, let the converted starting point rotation position angle be θ 00 , if 360°<θ0≤540°, then θ 00 =θ0-360°; if -540°<θ0≤-360°, then θ 00 =θ0+720°; if -360°<θ0≤0°, then θ 00 =θ0+360°;
[0084] Similar to the starting point rotation position angle θ0, for the end point rotation position angle θ t , let the angle of the converted end point rotation position be θ tt , if 360°<θ t ≤540°, then θ tt =θt -360°; if -540°<θ t ≤-360°, then θ tt =θ t +720°; if -360°<θ t ≤0°, then θ tt =θ t +360°.
[0085] Step S12, at least according to the converted starting point rotation position angle θ 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The relationship between the magnitudes of the two determines a first rotation angle θ and a first rotation direction of the rotation mechanism of the engineering machinery;
[0086] For example, the converted starting point can be rotated to a position angle θ 00 It is divided into two angle ranges, the two angle ranges are 0°≤θ 00 <180° and 180°≤θ 00 ≤360°. For 0°≤θ 00 When <180°, determine the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The size relationship between them is used to determine the different first rotation angles θ and the first rotation directions, that is:
[0087] At 0°≤θ 00 <180°, and θ 00 ≤θ tt <θ 00 When the angle is +180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0088] θ=θ0+|θ tt -θ 00 |;
[0089] At 0°≤θ 00 <180°, and θ tt <θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0090] θ=θ0-|θ tt -θ 00 |;
[0091] At 0°≤θ 00 <180°, and θ tt >θ00 When the first rotation direction is +180°, the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0092] θ=θ0-360°+|θ tt -θ 00 |.
[0093] For 180°≤θ 00 When ≤360°, determine the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The size relationship between them is used to determine the different first rotation angles θ and the first rotation directions, that is:
[0094] At 180°≤θ 00 ≤360°, and θ 00 -180°<θ tt ≤θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0095] θ=θ0-|θ tt -θ 00 |;
[0096] At 180°≤θ 00 ≤360°, and θ tt <θ 00 When the first rotation direction is -180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0097] θ=θ0+360°-|θ tt -θ 00 |;
[0098] At 180°≤θ 00 ≤360°, and θ tt >θ 00 When , the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0099] θ=θ0+|θ tt -θ 00 |.
[0100] Step S13, controlling the slewing mechanism of the engineering machine to slew at a minimum angle at least according to the determined first slewing angle θ and the first slewing direction.
[0101] For example, the slewing mechanism of the engineering machinery can be directly controlled to slew in the first slewing direction to a first slewing angle θ. However, the slewing angle of most engineering machinery has a boundary limit range, such as (-540°, 540°), and cannot be slewed counterclockwise or clockwise all the time. If the first slewing angle θ exceeds the limit range of the engineering machinery's movement, the slewing mechanism of the engineering machinery can be controlled to slew in the second slewing direction to a second slewing angle θ1, wherein the second slewing direction is opposite to the first slewing direction, and the method for determining the second slewing angle θ1 is still determined by the converted starting slewing position angle θ. 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The size relationship between them varies, for example:
[0102] At 0°≤θ 00 <180°,θ 00 ≤θ tt <θ 00 When the angle is +180°, the second rotation angle θ1 is determined by the following formula:
[0103] θ1=θ0-360°+|θ-θ0|;
[0104] At 0°≤θ 00 <180°,θ tt <θ 00 When , the second rotation angle θ1 is determined by the following formula:
[0105] θ1=θ0+360°+|θ-θ0|;
[0106] At 0°≤θ 00 <180°,θ tt >θ 00 When the angle is +180°, the second rotation angle θ1 is determined by the following formula:
[0107] θ1=θ0+360°-|θ-θ0|.
[0108] At 180°≤θ 00 ≤360°, θ 00 -180°<θ tt ≤θ 00 When , the second rotation angle θ1 is determined by the following formula:
[0109] θ1=θ0+360°-|θ-θ0|;
[0110] At 180°≤θ 00 ≤360°, θ tt <θ 00When -180°, the second rotation angle θ1 is determined by the following formula:
[0111] θ1=θ0-360°+|θ-θ0|;
[0112] At 180°≤θ 00 ≤360°, θ tt >θ 00 When , the second rotation angle θ1 is determined by the following formula:
[0113] θ1=θ0-360°+|θ-θ0|.
[0114] It can be understood that the converted starting point rotation position angle θ recorded above is 00 The angle range division method and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The determination methods of the size relationship between are examples and are not intended to limit this. Through the above technical solution, the engineering machinery can be automatically controlled to rotate at the minimum angle, which can greatly reduce the operating distance of the engineering machinery, reduce the operating power consumption of the engineering machinery, and effectively save energy. In addition, since there is no need to manually control the rotation of the engineering machinery, human labor is liberated, the operation accuracy is improved, and the working efficiency of the automatic operation of the engineering machinery is effectively improved, and the level of intelligence is further improved.
[0115] Figure 2 FIG. 1 is a structural block diagram of an automatic rotation control device for engineering machinery provided by an embodiment of the present invention. Figure 2 As shown, the engineering machinery includes a slewing mechanism, and the device includes: a conversion unit 101, a processing unit 102 and a control unit 103, wherein the conversion unit 101 is used to convert the starting rotation position angle θ0 and the end rotation position angle θ t The processing unit 102 is used to convert the starting point rotation position angle θ to 0°-360° at least according to the converted 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The size relationship between them is used to determine the first rotation angle θ and the first rotation direction of the rotation mechanism of the engineering machinery; the control unit 103 is used to control the rotation mechanism of the engineering machinery to rotate at a minimum angle based on at least the determined first rotation angle θ and the first rotation direction.
[0116] Preferably, the processing unit 102 is used for:
[0117] At 0°≤θ 00 <180°, and θ 00 ≤θ tt<θ 00 When the angle is +180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0118] θ=θ0+|θ tt -θ 00 |;
[0119] At 0°≤θ 00 <180°, and θ tt <θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0120] θ=θ0-|θ tt -θ 00 |;
[0121] At 0°≤θ 00 <180°, and θ tt >θ 00 When the first rotation direction is +180°, the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0122] θ=θ0-360°+|θ tt -θ 00 |.
[0123] Preferably, the processing unit 102 is used for:
[0124] At 180°≤θ 00 ≤360°, and θ 00 -180°<θ tt ≤θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0125] θ=θ0-|θ tt -θ 00 |;
[0126] At 180°≤θ 00 ≤360°, and θ tt <θ 00 When the first rotation direction is -180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0127] θ=θ0+360°-|θ tt -θ 00 |;
[0128] At 180°≤θ 00 ≤360°, and θ tt >θ 00When , the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0129] θ=θ0+|θ tt -θ 00 |.
[0130] Preferably, the control unit 103 is used to: when the determined first rotation angle θ exceeds the limit range of the engineering machinery action, control the rotation mechanism of the engineering machinery to rotate in a second rotation direction to a second rotation angle θ1, wherein the second rotation direction is opposite to the first rotation direction, and the second rotation angle θ1 is determined by the following formula:
[0131] At 0°≤θ 00 <180°,θ 00 ≤θ tt <θ 00 +180°
[0132] θ1=θ0-360°+|θ-θ0|;
[0133] At 0°≤θ 00 <180°,θ tt <θ 00 hour,
[0134] θ1=θ0+360°+|θ-θ0|;
[0135] At 0°≤θ 00 <180°,θ tt >θ 00 +180°
[0136] θ1=θ0+360°-|θ-θ0|.
[0137] Preferably, the control unit 103 is used to: when the determined first rotation angle θ exceeds the limit range of the engineering machinery action, control the rotation mechanism of the engineering machinery to rotate in a second rotation direction to a second rotation angle θ1, wherein the second rotation direction is opposite to the first rotation direction, and the second rotation angle θ1 is determined by the following formula:
[0138] At 180°≤θ 00 ≤360°, θ 00 -180°<θ tt ≤θ 00 hour,
[0139] θ1=θ0+360°-|θ-θ0|;
[0140] At 180°≤θ 00 ≤360°, θ tt <θ00 -180°
[0141] θ1=θ0-360°+|θ-θ0|;
[0142] At 180°≤θ 00 ≤360°, θ tt >θ 00 hour,
[0143] θ1=θ0-360°+|θ-θ0|.
[0144] Figure 3 FIG. 1 is a block diagram of an automatic slewing control system for engineering machinery provided by an embodiment of the present invention. Figure 3 As shown, the system comprises: the automatic rotation control device 201 of the engineering machinery described above; and an interactive device 202 for inputting the starting rotation position angle θ0 and the end rotation position angle θ t ; Display device 203, used to display the current rotation angle of the engineering machinery.
[0145] For example, the present invention can be provided with an embedded industrial computer 204, including the automatic rotation control device 201 of the engineering machinery described above, which is used to execute the automatic rotation control method of the engineering machinery described above; and also includes an interactive device 202, the operator can set the starting rotation position angle θ0 and the end rotation position angle θ t , and click the automatic operation button to let the engineering machinery execute the automatic operation command; it also includes a display device 203, which can display the current rotation angle information.
[0146] In addition, the system can use the angle sensor 205 to detect the rotation angle of the rotary mechanism 206 of the engineering machinery in real time, and then send the measured rotation angle value to the safety monitoring system 207 in real time, and the safety monitoring system 207 sends the obtained data to the PLC controller 208. The PLC controller 208 and the embedded industrial computer 204 communicate based on the CAN communication protocol, and can send, for example, the measured rotation angle value, that is, the current rotation angle information to the embedded industrial computer 204 for display, and can also receive the control command of the embedded industrial computer 204 to control the rotation of the rotary mechanism 206 of the engineering machinery.
[0147] An embodiment of the present invention further provides an engineering machine, characterized in that the engineering machine comprises the automatic swing control device for the engineering machine described above.
[0148] An embodiment of the present invention further provides a machine-readable storage medium, on which instructions are stored, and the instructions are used to enable a machine to execute the automatic rotation control method of the engineering machinery described above.
[0149] The embodiments of the automatic swing control device of engineering machinery, the automatic swing control system of engineering machinery, engineering machinery and machine-readable storage medium described above are similar to the embodiments of the automatic swing control method of engineering machinery described above, and will not be repeated here.
[0150] The automatic swing control device of the engineering machinery includes a processor and a memory. The conversion unit 101, the processing unit 102 and the control unit 103 are all stored in the memory as program units, and the processor executes the program units stored in the memory to realize corresponding functions.
[0151] The processor includes a kernel, which calls the corresponding program unit from the memory. One or more kernels can be set, and the rotation of the engineering machinery can be controlled by adjusting the kernel parameters.
[0152] The memory may include non-permanent memory in a computer-readable medium, random access memory (RAM) and / or non-volatile memory, such as read-only memory (ROM) or flash RAM, and the memory includes at least one memory chip.
[0153] An embodiment of the present invention provides a processor, which is used to run a program, wherein the automatic rotation control method of the engineering machinery is executed when the program is run.
[0154] An embodiment of the present invention provides a device, the device including a processor, a memory, and a program stored in the memory and executable on the processor, and when the processor executes the program, the following steps are implemented:
[0155] The starting rotation position angle θ0 and the end rotation position angle θ t Converted to 0°-360°; at least according to the converted starting point rotation position angle θ 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The first rotation angle θ and the first rotation direction of the rotation mechanism of the engineering machinery are determined based on the size relationship between them; and the rotation mechanism of the engineering machinery is controlled to rotate at a minimum angle at least according to the determined first rotation angle θ and the first rotation direction.
[0156] Preferably, the at least one starting point rotation position angle θ is converted 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The relationship between the magnitudes of θ and θ and the first rotation direction of the rotary mechanism of the engineering machinery includes:
[0157] At 0°≤θ 00 <180°, and θ 00 ≤θ tt <θ 00 When the angle is +180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0158] θ=θ0+|θ tt -θ 00 |;
[0159] At 0°≤θ 00 <180°, and θ tt <θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0160] θ=θ0-|θ tt -θ 00 |;
[0161] At 0°≤θ 00 <180°, and θ tt >θ 00 When the first rotation direction is +180°, the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0162] θ=θ0-360°+|θ tt -θ 00 |.
[0163] Preferably, the at least one starting point rotation position angle θ is converted 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The relationship between the magnitudes of θ and θ and the first rotation direction of the rotary mechanism of the engineering machinery includes:
[0164] At 180°≤θ 00 ≤360°, and θ 00 -180°<θ tt ≤θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0165] θ=θ0-|θ tt -θ 00 |;
[0166] At 180°≤θ 00 ≤360°, and θ tt <θ 00When the first rotation direction is -180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0167] θ=θ0+360°-|θ tt -θ 00 |;
[0168] At 180°≤θ 00 ≤360°, and θ tt >θ 00 When , the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0169] θ=θ0+|θ tt -θ 00 |.
[0170] Preferably, controlling the slewing mechanism of the engineering machinery to slew at a minimum angle at least according to the determined first slewing angle θ and the first slewing direction comprises: when the determined first slewing angle θ exceeds a limit range of the action of the engineering machinery, controlling the slewing mechanism of the engineering machinery to slew in a second slewing direction to a second slewing angle θ1, wherein the second slewing direction is opposite to the first slewing direction, and the second slewing angle θ1 is determined by the following formula:
[0171] At 0°≤θ 00 <180°,θ 00 ≤θ tt <θ 00 +180°
[0172] θ1=θ0-360°+|θ-θ0|;
[0173] At 0°≤θ 00 <180°,θ tt <θ 00 hour,
[0174] θ1=θ0+360°+|θ-θ0|;
[0175] At 0°≤θ 00 <180°,θ tt >θ 00 +180°
[0176] θ1=θ0+360°-|θ-θ0|.
[0177] Preferably, controlling the slewing mechanism of the engineering machinery to slew at a minimum angle at least according to the determined first slewing angle θ and the first slewing direction comprises: when the determined first slewing angle θ exceeds a limit range of the action of the engineering machinery, controlling the slewing mechanism of the engineering machinery to slew in a second slewing direction to a second slewing angle θ1, wherein the second slewing direction is opposite to the first slewing direction, and the second slewing angle θ1 is determined by the following formula:
[0178] At 180°≤θ 00 ≤360°, θ 00 -180°<θ tt ≤θ 00 hour,
[0179] θ1=θ0+360°-|θ-θ0|;
[0180] At 180°≤θ 00 ≤360°, θ tt <θ 00 -180°
[0181] θ1=θ0-360°+|θ-θ0|;
[0182] At 180°≤θ 00 ≤360°, θ tt >θ 00 hour,
[0183] θ1=θ0-360°+|θ-θ0|.
[0184] The devices in this article can be servers, PCs, PADs, mobile phones, etc.
[0185] The present application also provides a computer program product, which, when executed on a data processing device, is suitable for executing a program for initializing the following method steps:
[0186] The starting rotation position angle θ0 and the end rotation position angle θ t Converted to 0°-360°; at least according to the converted starting point rotation position angle θ 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The first rotation angle θ and the first rotation direction of the rotation mechanism of the engineering machinery are determined based on the size relationship between them; and the rotation mechanism of the engineering machinery is controlled to rotate at a minimum angle at least according to the determined first rotation angle θ and the first rotation direction.
[0187] Preferably, the at least one starting point rotation position angle θ is converted 00The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The relationship between the magnitudes of θ and θ and the first rotation direction of the rotary mechanism of the engineering machinery includes:
[0188] At 0°≤θ 00 <180°, and θ 00 ≤θ tt <θ 00 When the angle is +180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0189] θ=θ0+|θ tt -θ 00 |;
[0190] At 0°≤θ 00 <180°, and θ tt <θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0191] θ=θ0-|θ tt -θ 00 |;
[0192] At 0°≤θ 00 <180°, and θ tt >θ 00 When the first rotation direction is +180°, the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0193] θ=θ0-360°+|θ tt -θ 00 |.
[0194] Preferably, the at least one starting point rotation position angle θ is converted 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The relationship between the magnitudes of θ and θ and the first rotation direction of the rotary mechanism of the engineering machinery includes:
[0195] At 180°≤θ 00 ≤360°, and θ 00 -180°<θ tt ≤θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula:
[0196] θ=θ0-|θtt -θ 00 |;
[0197] At 180°≤θ 00 ≤360°, and θ tt <θ 00 When the first rotation direction is -180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0198] θ=θ0+360°-|θ tt -θ 00 |;
[0199] At 180°≤θ 00 ≤360°, and θ tt >θ 00 When , the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula:
[0200] θ=θ0+|θ tt -θ 00 |.
[0201] Preferably, controlling the slewing mechanism of the engineering machinery to slew at a minimum angle at least according to the determined first slewing angle θ and the first slewing direction comprises: when the determined first slewing angle θ exceeds a limit range of the action of the engineering machinery, controlling the slewing mechanism of the engineering machinery to slew in a second slewing direction to a second slewing angle θ1, wherein the second slewing direction is opposite to the first slewing direction, and the second slewing angle θ1 is determined by the following formula:
[0202] At 0°≤θ 00 <180°,θ 00 ≤θ tt <θ 00 +180°
[0203] θ1=θ0-360°+|θ-θ0|;
[0204] At 0°≤θ 00 <180°,θ tt <θ 00 hour,
[0205] θ1=θ0+360°+|θ-θ0|;
[0206] At 0°≤θ 00 <180°,θ tt >θ 00 +180°
[0207] θ1=θ0+360°-|θ-θ0|.
[0208] Preferably, controlling the slewing mechanism of the engineering machinery to slew at a minimum angle at least according to the determined first slewing angle θ and the first slewing direction comprises: when the determined first slewing angle θ exceeds a limit range of the action of the engineering machinery, controlling the slewing mechanism of the engineering machinery to slew in a second slewing direction to a second slewing angle θ1, wherein the second slewing direction is opposite to the first slewing direction, and the second slewing angle θ1 is determined by the following formula:
[0209] At 180°≤θ 00 ≤360°, θ 00 -180°<θ tt ≤θ 00 hour,
[0210] θ1=θ0+360°-|θ-θ0|;
[0211] At 180°≤θ 00 ≤360°, θ tt <θ 00 -180°
[0212] θ1=θ0-360°+|θ-θ0|;
[0213] At 180°≤θ 00 ≤360°, θ tt >θ 00 hour,
[0214] θ1=θ0-360°+|θ-θ0|.
[0215] 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.
[0216] 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.
[0217] 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 including 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.
[0218] 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.
[0219] In a typical configuration, a computing device includes one or more processors (CPU), input / output interfaces, network interfaces, and memory.
[0220] 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.
[0221] 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 magnetic 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.
[0222] 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.
[0223] 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. An automatic slewing control method for an engineering machine, the engineering machine comprising a slewing mechanism, characterized in that: The control method includes: The starting rotation position angle θ0 of the rotation mechanism and the end rotation position angle θ t Convert to 0°-360°; At least according to the converted starting point rotation position angle θ 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The relationship between the magnitudes of the two determines a first rotation angle θ and a first rotation direction of the rotation mechanism of the engineering machinery; At least according to the determined first rotation angle θ and the first rotation direction, the rotation mechanism of the engineering machine is controlled to rotate at a minimum angle, Wherein, controlling the slewing mechanism of the engineering machinery to slew at a minimum angle at least according to the determined first slewing angle θ and the first slewing direction comprises: When the determined first rotation angle θ exceeds the limit range of the engineering machine action, the rotation mechanism of the engineering machine is controlled to rotate in a second rotation direction to a second rotation angle θ1, wherein the second rotation direction is opposite to the first rotation direction, and the second rotation angle θ1 is determined by the following formula: At 0°≤θ 00 <180°,θ 00 ≤θ tt <θ 00 +180°, ; At 0°≤θ 00 <180°,θ tt <θ 00 hour, ; At 0°≤θ 00 <180°,θ tt >θ 00 +180°, 。 2. The automatic rotation control method of construction machinery according to claim 1, characterized in that: The at least one starting point rotation position angle θ converted 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The relationship between the magnitudes of θ and θ and the first rotation direction of the rotary mechanism of the engineering machinery includes: At 0°≤θ 00 <180°, and θ 00 ≤θ tt <θ 00 When the angle is +180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula: ; At 0°≤θ 00 <180°, and θ tt <θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula: ; At 0°≤θ 00 <180°, and θ tt >θ 00 When the first rotation direction is +180°, the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula: 。 3. The automatic rotation control method of engineering machinery according to claim 1, characterized in that: The at least one starting point rotation position angle θ converted 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The relationship between the magnitudes of θ and θ and the first rotation direction of the rotary mechanism of the engineering machinery includes: At 180°≤θ 00 ≤360°, and θ 00 -180°<θ tt ≤θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula: ; At 180°≤θ 00 ≤360°, and θ tt <θ 00 When the first rotation direction is -180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula: ; At 180°≤θ 00 ≤360°, and θ tt >θ 00 When , the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula: 。 4. The automatic rotation control method of engineering machinery according to claim 3, characterized in that: The step of controlling the slewing mechanism of the engineering machine to slew at a minimum angle at least according to the determined first slewing angle θ and the first slewing direction comprises: When the determined first rotation angle θ exceeds the limit range of the engineering machine action, the rotation mechanism of the engineering machine is controlled to rotate in a second rotation direction to a second rotation angle θ1, wherein the second rotation direction is opposite to the first rotation direction, and the second rotation angle θ1 is determined by the following formula: At 180°≤θ 00 ≤360°, θ 00 -180°<θ tt ≤θ 00 hour, ; At 180°≤θ 00 ≤360°, θ tt <θ 00 -180° ; At 180°≤θ 00 ≤360°, θ tt >θ 00 hour, 。 5. An automatic slewing control device for an engineering machine, the engineering machine comprising a slewing mechanism, characterized in that: The automatic rotation control device is arranged in an embedded industrial computer, and the device comprises: A conversion unit, a processing unit and a control unit, wherein: The conversion unit is used to convert the starting rotation position angle θ0 of the rotation mechanism and the end rotation position angle θ t Convert to 0°-360°; The processing unit is used to at least convert the starting point rotation position angle θ 00 The angle range and the converted end point rotation position angle θ tt and the converted starting point rotation position angle θ 00 The relationship between the magnitudes of the two determines a first rotation angle θ and a first rotation direction of the rotation mechanism of the engineering machinery; The control unit is used to control the slewing mechanism of the engineering machine to slew at a minimum angle according to at least the determined first slewing angle θ and the first slewing direction, Wherein, the control unit is used for: When the determined first rotation angle θ exceeds the limit range of the engineering machine action, the rotation mechanism of the engineering machine is controlled to rotate in a second rotation direction to a second rotation angle θ1, wherein the second rotation direction is opposite to the first rotation direction, and the second rotation angle θ1 is determined by the following formula: At 0°≤θ 00 <180°,θ 00 ≤θ tt <θ 00 +180°, ; At 0°≤θ 00 <180°,θ tt <θ 00 hour, ; At 0°≤θ 00 <180°,θ tt >θ 00 +180°, 。 6. The automatic swing control device for construction machinery according to claim 5, characterized in that: The processing unit is used for: At 0°≤θ 00 <180°, and θ 00 ≤θ tt <θ 00 When the angle is +180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula: ; At 0°≤θ 00 <180°, and θ tt <θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula: ; At 0°≤θ 00 <180°, and θ tt >θ 00 When the first rotation direction is +180°, the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula: 。 7. The automatic swing control device for construction machinery according to claim 5, characterized in that: The processing unit is used for: At 180°≤θ 00 ≤360°, and θ 00 -180°<θ tt ≤θ 00 When , the first rotation direction is clockwise, and the first rotation angle θ is determined by the following formula: ; At 180°≤θ 00 ≤360°, and θ tt <θ 00 When the first rotation direction is -180°, the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula: ; At 180°≤θ 00 ≤360°, and θ tt >θ 00 When , the first rotation direction is counterclockwise, and the first rotation angle θ is determined by the following formula: 。 8. The automatic swing control device for construction machinery according to claim 7, characterized in that: The control unit is used for: When the determined first rotation angle θ exceeds the limit range of the engineering machine action, the rotation mechanism of the engineering machine is controlled to rotate in a second rotation direction to a second rotation angle θ1, wherein the second rotation direction is opposite to the first rotation direction, and the second rotation angle θ1 is determined by the following formula: At 180°≤θ 00 ≤360°, θ 00 -180°<θ tt ≤θ 00 hour, ; At 180°≤θ 00 ≤360°, θ tt <θ 00 -180° ; At 180°≤θ 00 ≤360°, θ tt >θ 00 hour, 。 9. An automatic slewing control system for engineering machinery, characterized in that: The system includes: The automatic swing control device for engineering machinery according to any one of claims 5 to 8; and Interactive device, used to input the starting rotation position angle θ0 and the end rotation position angle θ t ; The display device is used to display the current rotation angle of the rotation mechanism of the engineering machinery.
10. An engineering machine, characterized in that: The engineering machinery comprises the automatic swing control device for engineering machinery as described in any one of claims 5-8.
11. A machine-readable storage medium having instructions stored thereon, the instructions being used to enable a machine to execute the automatic rotation control method for engineering machinery as described in any one of claims 1 to 4.
