CN103321428B - Intelligent control device, system and method for arm support and engineering machinery - Google Patents

Abstract

The invention discloses an intelligent control device, system and method for an arm support and engineering machinery. The arm support comprises a plurality of sections of arm sections which are connected with each other, and the device comprises: a receiver for receiving a signal indicative of a typical pose of the boom; and the controller is connected with the receiver and is used for determining the inclination angle of each arm section corresponding to the typical posture according to the typical posture and controlling each arm section to be unfolded to the corresponding inclination angle. Through the technical scheme, the arm support can be automatically unfolded to the typical posture only by selecting the arm support, manual intervention is not needed, the workload of the arm support is greatly reduced, the requirements on the operation level and experience of the arm support are reduced, and the work efficiency is improved.

Description

A kind of intelligent arm support control, system, method and engineering machinery

Technical field

The present invention relates to engineering machinery field, particularly, relate to a kind of intelligent arm support control, system, method and engineering machinery.

Background technology

Concrete mixer becomes the engineering machinery of modern architecture construction extensive use, due to its application characteristic and complexity, needs to be manipulated it by the tractor driver of specialty.Current tractor driver is manipulated jib motion by remote controller, and remote controller is arranged different buttons and control different arms joint respectively, tractor driver is operated jib by button.When needs carry out quick position to arm support tail end, the experience of tractor driver and qualification just seem extremely important.When a certain arm joint is when moving to a direction, needing tractor driver always according to corresponding operational and controlled key button, although tractor driver can be made like this to keep intensive concentration, ensureing arm support safe motion, but add the workload of tractor driver.And in pump truck construction, have a lot of jib attitude often to use, therefore, tractor driver is many times doing some repetitive works, and operating efficiency is lower.

Summary of the invention

The object of this invention is to provide a kind of intelligent arm support control, system, method and engineering machinery, to realize the Automated condtrol that jib launches, reduce the workload of tractor driver, increase work efficiency.

To achieve these goals, the invention provides a kind of intelligent arm support control, this jib comprises interconnective single oil cylinder joint, and described device comprises: receiver, for receiving the signal of the typical attitude of instruction jib; Controller, is connected with described receiver, for according to described typical attitude, determines corresponding with the described typical attitude inclination angle often saved arm and save, and controls often to save arm joint and be deployed into corresponding inclination angle.

The present invention also provides a kind of jib intelligence control system, and this system comprises: input unit, for selecting the typical attitude of jib; And above-mentioned control device, be connected with described input unit.

The present invention also provides a kind of engineering machinery comprising said system.

The present invention also provides a kind of jib intelligent control method, and this jib comprises interconnective single oil cylinder joint, and described method comprises: the signal receiving the typical attitude of instruction jib; According to described typical attitude, determine corresponding with the described typical attitude inclination angle often saved arm and save; And control often to save the inclination angle that arm joint is deployed into correspondence.

By technique scheme, tractor driver can only by selecting a certain typical attitude of jib, jib just can Automatic-expanding to this attitude, without the need to manual intervention, greatly reduce the workload of tractor driver, reduce the requirement of operant level to tractor driver and experience, improve operating efficiency.

Other features and advantages of the present invention are described in detail in detailed description of the invention part subsequently.

Accompanying drawing explanation

Accompanying drawing is used to provide a further understanding of the present invention, and forms a part for manual, is used from explanation the present invention, but is not construed as limiting the invention with detailed description of the invention one below.In the accompanying drawings:

Fig. 1 is jib structure schematic diagram under a certain typical attitude;

Fig. 2 is the structure chart of intelligent arm support control;

Fig. 3 is the flow chart of jib typical case attitude method of deploying;

Fig. 4 is the flow chart of jib any attitude method of deploying;

Fig. 5 is the flow chart of the optimized algorithm for calculating arm joint adjustment angle;

Fig. 6 is the flow chart of jib Repossession method; And

Fig. 7 is the structure chart of jib intelligence control system.

Detailed description of the invention

Below in conjunction with accompanying drawing, the specific embodiment of the present invention is described in detail.Should be understood that, detailed description of the invention described herein, only for instruction and explanation of the present invention, is not limited to the present invention.

Fig. 1 shows the jib diagram under a certain typical attitude, and wherein, typical attitude usually can the attitude often used in the course of the work of index arm frame.As shown in Figure 1, described jib can comprise interconnective single oil cylinder joint, such as, and an arm OA, two arm AB, three arm BC, four arm CD and five arm DE.Wherein, α ₁be an arm and turntable plane included angle (namely and horizontal plane angle), α ₂, α ₃, α ₄, α ₅be respectively the angle between two arms and an arm, the angle between three arms and two arms, the angle between four arms and three arms, angle between five arms and four arms.α _2H, α _3H, α _4H, α _5Hbe respectively the angle between two arms and horizontal plane, the angle between three arms and horizontal plane, the angle between four arms and horizontal plane, angle between five arms and horizontal plane.Each arm joint also can be referred to as inclination angle with the angle of horizontal plane.α _2H, α _3H, α _4H, α _5Hthe judgment criterion of symbol for from horizontal plane, pointing to each joint arm counterclockwise is just, when direction is contrary, gets negative value accordingly, as the α in Fig. 1 _4Hand α _5Hbe negative value.

Composition graphs 1, can draw α _2H, α _3H, α _4H, α _5Hdesign formulas, as follows:

α _2H＝α ₁-(π-α ₂)＝α ₁+α ₂-π（1）

α _3H＝α _2H-(π-α ₃)＝α ₁+α ₂+α ₃-2π（2）

α _4H＝α _3H-(π-α ₄)＝α ₁+α ₂+α ₃+α ₄-3π（3）

α _5H＝α _4H-(π-α ₅)＝α ₁+α ₂+α ₃+α ₄+α ₅-4π（4）

Arm support tail end E point coordinates (x _e, y _e) can be calculated by following formula:

x _E＝L _OAcosα ₁+L _ABcosα _2H+L _BCcosα ₃H+L _CDcosα _4H+L _DEcosα _5H（5）

y _E＝L _OAsinα ₁+L _ABsinα _2H+L _BCsinα _3H+L _CDsinα _4H+L _DEsinα _5H（6）

Wherein, L _oAbe an arm brachium, L _aBbe two arm brachiums, L _bCbe three arm brachiums, L _cDbe four arm brachiums, L _dEbe five arm brachiums.

As can be seen from above formula, when jib attitude one timing, i.e. α ₁, α ₂, α ₃, α ₄, α ₅determined value, just can according to α ₁, α ₂, α ₃, α ₄, α ₅calculate the inclination angle of each arm joint and the coordinate of arm support tail end.

Therefore, in an embodiment of the invention, some typical attitudes jib often can used store (such as, store in a database), comprise inclination angle (or angle) and the arm support tail end coordinate of each arm joint be stored under typical attitude, thus, when jib is deployed under a certain typical attitude by needs, only needs call the inclination angle (or angle) that the stored each arm corresponding with this typical attitude saves, and then each arm joint are deployed into corresponding inclination angle (or angle).

For this reason, the invention provides a kind of intelligent arm support control.As shown in Figure 2, this device 10 can comprise: receiver 101, for receiving the signal of the typical attitude of instruction jib; Controller 102, is connected with described receiver 101, for according to described typical attitude, determines corresponding with the described typical attitude inclination angle often saved arm and save, and controls often to save arm joint and be deployed into corresponding inclination angle.

In order to ensure that each joint arm does not interfere in expansion process, avoid arm joint end to save with pump truck upper-loading or other arms to contact, thus preventing jib, oil cylinder or pump truck upper-loading from damaging, described receiver 101 can also receive the signal of the critical angle do not interfered between instruction alternate arm joint; And controller 102 is also for controlling often to save before arm joint is deployed into corresponding inclination angle, adjustment arm joint make alternate arm save between angle be more than or equal to described critical angle.That is, if the angle between each arm joint is less than corresponding critical angle, each arm joint is first adjusted to corresponding critical angle by controller 102, and then launches each arm joint according to the inclination angle (or angle) under typical attitude.

Wherein, described critical angle is the angle making to meet the following conditions between described alternate arm joint: the height of the dried up plane of end-to-end distance of last arm joint is greater than the arm joint length of a rear arm joint.

Composition graphs 1, above-mentioned condition can be represented as:

L _OAsinα ₁＞L _AB（7）

L _OAsinα ₁+L _ABsinα _2H＞L _BC（8）

L _OAsinα ₁+L _ABsinα _2H+L _BCsinα _3H＞L _CD（9）

L _OAsinα ₁+L _ABsinα _2H+L _BCsinα _3H+L _CDsinα _4H＞L _DE（10）

Can draw thus:

${\mathrm{\α}}_1>\arcsin \frac{L_{\mathrm{AB}}}{L_{\mathrm{OA}}}---\left(11\right)$

${\mathrm{\α}}_{2H}>\arcsin \frac{L_{\mathrm{BC}}-L_{\mathrm{OA}}\sin {\mathrm{\α}}_1}{L_{\mathrm{AB}}}---\left(12\right)$

${\mathrm{\α}}_{3H}>\arcsin \frac{L_{\mathrm{CD}}-L_{\mathrm{OA}}\sin {\mathrm{\α}}_1-L_{\mathrm{AB}}\sin {\mathrm{\α}}_{2H}}{L_{\mathrm{BC}}}---\left(13\right)$

${\mathrm{\α}}_{4H}>\arcsin \frac{L_{\mathrm{DE}}-L_{\mathrm{OA}}\sin {\mathrm{\α}}_1-L_{\mathrm{AB}}\sin {\mathrm{\α}}_{2H}-L_{\mathrm{BC}}\sin {\mathrm{\α}}_{3H}}{L_{\mathrm{CD}}}---\left(14\right)$

First α is determined by formula (11) ₁threshold α ₁₀, then determine α successively by formula (12), (13), (14) _2H, α _3H, α _4Hthreshold α _2H0, α _3H0, α _4H0.Convolution (1), (2), (3) determine the critical angle α of two arms and an arm, three arms and two arms, four arms and three arms respectively again ₂₀, α ₃₀, α ₄₀, as follows:

α ₂₀＝π-α ₁₀+α _2H0（15）

α ₃₀＝2π-α ₁₀-α ₂₀+α _3H0（16）

α ₄₀＝3π-α ₁₀-α ₂₀-α ₃₀+α _4H0（17）

Just can determine critical angle α thus ₁₀, α ₂₀, α ₃₀, α ₄₀.

In addition, described controller 102 can also control according to actual needs all arms joint simultaneously launch or according to preset expansion order launch successively, and can control all arms joint launch with identical or different speed.

Embodiment above describes when storing typical attitude, by selecting a certain typical attitude, and can by jib Automatic-expanding to required attitude.Referring to Fig. 2 and Fig. 3 be described in not yet store typical attitude when, how to carry out the method for jib Automatic-expanding.

First, the final angle (or inclination angle) between the critical angle do not interfered between each arm joint, each arm joint can be set, each arm joint launches simultaneously or launch in order and the information such as development rate (can set different development rate by selecting different gear) of each arm joint.Afterwards, receiver 101 can receive above-mentioned information, and described information is sent to controller 102.Then, controller 102 first judges whether meet critical angle condition between each arm joint, if do not met, first each arm joint is adjusted to critical angle, and then launches, otherwise, directly launch.Arm joint is deployed into a certain attitude according to arm joint expansion order, development rate and final angle by controller 102.After completing expansion, the information such as this attitude and the critical angle of each arm joint under this attitude, final angle (or inclination angle), expansion order and development rate can store in a database, so that carry out afterwards choosing and calling by controller 102.After storing multiple typical attitude in this way, according to method of carrying out jib expansion according to typical attitude mentioned above, the Automatic-expanding of jib can be realized.

In addition, in order to ensure the safety in jib Automatic-expanding process, on each arm joint, obstacle detector can be installed.Thus, described receiver 101 can also receive the signal that instruction arm joint exists obstruction around; And described controller 102 can also when receiving described instruction arm joint and there is the signal of obstruction around, output alarm signal, to warn tractor driver.In addition, can also on each arm joint mounting distance checkout gear, carry out the distance of detection arm pitch from obstruction.Thus, described receiver 101 can also receive the signal of the distance between instruction arm joint and obstruction; And described controller 102 when described distance is less than or equal to a preset value, not only can also send alarm signal, but also stop arm joint launches, and guarantees safety during jib Automatic-expanding thus.

Thus, by intelligent arm support control provided by the invention, tractor driver can only by selecting a certain typical attitude of jib, jib just can Automatic-expanding to this attitude, without the need to manual intervention, greatly reduce the workload of tractor driver, reduce the requirement of operant level to tractor driver and experience, improve operating efficiency.

The present invention, also based on above-described typical attitude, proposes a kind of method realizing jib any attitude and launch, describes the method in detail below with reference to Fig. 2 and Fig. 4.

First, tractor driver can select a kind of typical attitude according to wanting the coordinates of targets of the arm support tail end arrived.Then, controller 102 can according to this typical attitude, and determine the coordinate of arm support tail end under described typical attitude, such as, E point coordinates, is designated as (x _e, y _e).

Receiver 101 can receive the signal of the target location coordinate of instruction arm support tail end, such as, be designated as (x _e', y _e').Then, controller 102 can according to this target location coordinate (x _e', y _e') and the typical attitude determined before under the coordinate (x of arm support tail end _e, y _e), calculate the changes in coordinates amount of the arm support tail end of expection, be designated as (Δ x _e, Δ y _e).

According to the ending coordinates (x that equation (5) and (6) above illustrate _e, y _e) save inclination alpha with each arm ₁, α _2H, α _3H, α _4H, α _5Hbetween relation, coordinates of targets (x can be drawn _e', y _e') the target-angle α that saves with each arm ₁', α _2H', α _3H', α _4H', α _5H' between relation, as shown in equation (15) and (16):

x _E'＝L _OAcosα ₁'+L _ABcosα _2H'+L _BCcosα _3H'+L _CDcosα _4H'+L _DEcosα _5H'（15）

y _E'＝L _OAsinα ₁'+L _ABsinα _2H'+L _BCsinα _3H'+L _CDsinα _4H'+L _DEsinα _5H'（16）

Equation (15) and equation (5) are subtracted each other, equation (16) and equation (6) subtract each other, and can obtain changes in coordinates amount (the Δ x expected _e, Δ y _e) the target-angle α that saves with each arm ₁', α _2H', α _3H', α _4H', α _5H' and typical attitude under the inclination alpha of each arm joint ₁, α _2H, α _3H, α _4H, α _5Hbetween relation.Based on the maximum permissible value that this relation and the arm joint adjustment inclination angle that sequentially (each inclination angle change order) and each arm save change at every turn, controller 102 just can calculate the change of pitch angle amount needing controlled arm joint.

The optimized algorithm can taked when describing and calculate referring to Fig. 5 and need the change of pitch angle amount of controlled arm joint.As shown in Figure 5, controller 102 can obtain the inclination alpha of each arm joint according to the typical attitude selected ₁, α _2H, α _3H, α _4H, α _5H.

Suppose that the maximum permissible value that each inclination angle changes at every turn is respectively: Δ α _1max, Δ α _2max, Δ α _3max, Δ α _4max, Δ α _5max, the corresponding changes in coordinates amount Δ x of each maximum permissible value _e1, Δ x _e2, Δ x _e3, Δ x _e4, Δ x _e5with Δ y _e1, Δ y _e2, Δ y _e3, Δ y _e4, Δ y _e5.When under a certain attitude, if by an arm adjustment Δ α _1max, then the Δ x of ending coordinates _e=Δ x _e1, Δ y _e=Δ y _e1; If by an arm adjustment Δ α _1max, then by two arm adjustment Δ α _2max, then the Δ x of ending coordinates _e=Δ x _e1+ Δ x _e2, Δ y _e=Δ y _e1+ Δ y _e2.By that analogy, when all arm joints are all adjusted its maximum permission adjusted value, the Δ x of ending coordinates _e=Δ x _e1+ Δ x _e2+ Δ x _e3+ Δ x _e4+ Δ x _e5, and Δ y _e=Δ y _e1+ Δ y _e2+ Δ y _e3+ Δ y _e4+ Δ y _e5.

Controller 102 can according to Δ x _ewith Δ y _ejudge whether to need to adjust all angles.That is, Δ x is judged _ewhether be more than or equal to Δ x _e1+ Δ x _e2+ Δ x _e3+ Δ x _e4+ Δ x _e5, and Δ y _ewhether be more than or equal to Δ y _e1+ Δ y _e2+ Δ y _e3+ Δ y _e4+ Δ y _e5.If not, then show not need to carry out integrated regulation (also can be described as full adjustment) to all angles, now can determine according to Angulation changes order the change of pitch angle amount that needs controlled arm to save.

Such as, acquiescence arm joint regulates order to be that march forward Row sum-equal matrix successively from last arm joint.For the jib shown in Fig. 1, when adjusting, first adjusting five arm DE, five arm DE have adjusted Δ α _5maxstill cannot meet (the Δ x of expection afterwards _e, Δ y _e) time, then adjust four arm CD, by that analogy.

If five arm DE are adjusted Δ α _5maxafter the changes in coordinates amount of arm support tail end exceeded the changes in coordinates amount of expection, then illustrate and do not need to adjust again four joint arms joints above, only need to adjust this five arm DE, and this angle variable quantity is no more than Δ α _5max.Now, changes in coordinates amount (the Δ x of expection that can will draw according to equation (5), (6), (15) and (16) above _e, Δ y _e) the target-angle α that saves with each arm ₁', α _2H', α _3H', α _4H', α _5H' and typical attitude under the inclination alpha of each arm joint ₁, α _2H, α _3H, α _4H, α _5Hbetween relation be reduced to as follows:

Δx _E＝L _DE(cosα _5H'-cosα _5H)（17）

Δy _E＝L _DE(sinα _5H'-sinα _5H)（18）

Due to α _5H, Δ x _e, Δ y _eall known, therefore, the target-angle α that above formula (17) and (18) calculate five arms can be passed through _5H', use this α _5H' deduct α _5Hthe variable quantity at five arm inclination angles can be drawn.Alternatively, also peer-to-peer (17) and (18) can be out of shape, make it to become the mapping relations between the inclination angle of five arms under the changes in coordinates amount of expection, typical attitude and the change of pitch angle amount of five arms, in this case, can α be passed through _5H, Δ x _e, Δ y _edirectly calculate the variable quantity at five arm inclination angles.

If five arm DE are adjusted Δ α _5maxafter the changes in coordinates amount of arm support tail end also do not meet the changes in coordinates amount of expection, then show not only to need this five arm DE is adjusted Δ α _5max, and also need adjustment four arm.If four arm CD are adjusted Δ α _4maxafter the changes in coordinates amount of arm support tail end exceeded the changes in coordinates amount of expection, then illustrate and do not need to adjust again three joint arms joints above, only need adjustment five arm DE and four arm CD.Now, α _5H'=Δ α _5max+ α _5H, α _5H, α _4H, Δ x _e, Δ y _eall known, therefore, the target-angle α of four arm CD can be obtained _4H', use this α _4H' deduct α _4Hthe variable quantity at four arm inclination angles can be drawn.

Calculate three arms, two arms, an arm the method for change of pitch angle amount consistent with Method And Principle described above, just repeat no more herein.

Thus, can obtaining when not needing to carry out full adjustment, needing the change of pitch angle amount that controlled arm saves.Controller 102 according to calculated change of pitch angle amount, can adjust corresponding arm joint.

If according to Δ x _ewith Δ y _ejudge to need to adjust all angles, now, controller 102 is designated as n=1 by entirely adjusting number of times.Controller 102, to be adjusted by five joint arms after the maximum permission adjusted value of its correspondence as benchmark, continues to judge whether also to need entirely to adjust according to as above method, just accumulates entirely adjusting frequency n, until do not need entirely to adjust once needs.

The adjustment times N of finally accumulating n and the permission obtained compares by controller 102, if n > is N, the typical attitude of jib selected before then showing is unreasonable, selection should be re-started, now, controller 102 can export the signal that instruction re-starts the selection of typical attitude.If n≤N, then show that the number of times carrying out full adjustment is within acceptable scope, then, can calculate the change of pitch angle amount needing controlled arm joint.For five arms, its final change of pitch angle amount=n × Δ α _5max+ Δ α _5final, wherein, Δ α _5finalbe that five arms are from the incident angle after n time full adjustment to the change of pitch angle amount of target-angle position, computational methods and the mentioned above method calculating the change of pitch angle amount of needs controlled arm joint when not needing entirely to adjust of this change of pitch angle amount are similar, just repeat no more herein.After calculating the change of pitch angle amount needing controlled arm joint, controller 102 can adjust respective arms joint according to the change of pitch angle amount of the controlled arm joint of described needs.

Thus, by said method provided by the invention, on the basis of typical attitude, the Automatic-expanding of any attitude can be realized.In practical operation, also as required, on the basis of the Automatic-expanding of typical attitude, pose adjustment can be carried out by remote controller, that is, manually adjusts, control jib with this and be deployed into any attitude.

Alternatively, the maximum permissible value that the inclination angle that the current inclination that controller 102 can be saved by each arm, the changing coordinates of arm support tail end, coordinates of targets and the arm preset save adjustment order and each arm joint changes at every turn, calculate the change of pitch angle amount needing controlled arm joint, with this, jib is directly deployed into any attitude from current pose, and without the need to launching on the basis of typical attitude.

Such as, the current inclination of each arm joint and the changing coordinates of arm support tail end can be detected by installation detecting device on each arm joint.By the coordinates of targets of input unit input arm support tail end.Receiver 101 can receive above-mentioned parameter, and sends it to controller 102.The real-time parameter that controller 102 uses checkout gear to detect carrys out each parameter stored in alternative typical attitude storehouse, and on the basis of typical attitude, need controlled arm to save the similar method of change of pitch angle amount for calculating based on above-described, calculate the change of pitch angle amount needing controlled arm joint.Such as, when the maximum permissible value that changes of inclination angle saved according to arm joint adjustment order and each arm at every turn, determine that when only needing adjustment five arm can arrive target location, controller 102 can utilize formula (17) and (18) to calculate the target-angle α of five arms _5H', use this α _5H' deduct α _5Hthe variable quantity at five arm inclination angles can be drawn.It should be noted that, with above-mentioned method of carrying out the expansion of any attitude on the basis of typical attitude unlike, the method does not have the restriction of the full adjustment number of times of maximum permission, that is, under current pose, controller 102 can adjust, until arm support tail end meets coordinates of targets arm joint according to the change of pitch angle amount calculated.

After fulfiling assignment, jib need be regained.Thus, receiver 101 can also receive the signal of instruction retraction arm joint; And described controller 102 when receiving the signal of described instruction retraction arm joint, can also regain (as shown in Figure 6) according to the following arm joint that carries out: regain other arms joint except the first arm joint simultaneously, such as, two arm to five arms; Jib is returned back to initial position; And regain described first arm joint.

In addition, controller 102 also can before withdrawal jib, first judge current alternate arm joint between angle (such as, can determine according to typical attitude) whether be less than critical angle, angle between described current alternate arm joint is less than described critical angle, described controller 102 adjusts arm joint and makes the angle between alternate arm joint be more than or equal to described critical angle, and regains according to carrying out arm joint above afterwards, to prevent from interfering between each arm joint; And when the angle between described current alternate arm saves is more than or equal to described critical angle, directly carry out jib withdrawal.In addition, controller 102 also can control according to actual needs all arms joint regain with identical or different speed.

Fig. 7 shows the structure chart of jib intelligence control system according to the embodiment of the present invention.As shown in Figure 7, this system can comprise: input unit 20, for selecting the typical attitude of jib; And said arm shelf intelligent controller 10, be connected with described input unit 20.It should be noted that, input unit 20 not only may be used for the typical attitude selecting jib, tractor driver can also utilize this input unit 20 to input other information, such as, and the target-angle of each arm joint or angle, the coordinates of targets of arm support tail end, each arm joint movement velocity, each arm joint adjustment order etc.

In addition, although be not illustrated, described system can also comprise: camera head, is arranged on final section arm joint, for the work information of the movement state information and job site that gather arm support tail end; And display unit, for showing the described movement state information of described camera head collection and described work information.Thus, tractor driver can understand arm support tail end and hose movement state in real time, and when pumping, all right Real-Time Monitoring job site situation, cloth, material condition etc., facilitate tractor driver to understand condition of construction in real time.Display unit can also be arranged monitor video, such as: convergent-divergent, playback, selected parts etc.

Said system is also applied to engineering machinery by the present invention.

The present invention also provides a kind of jib intelligent control method, and wherein said jib comprises interconnective single oil cylinder joint, and described method comprises: the signal receiving the typical attitude of instruction jib; According to described typical attitude, determine corresponding with the described typical attitude inclination angle often saved arm and save; And control often to save the inclination angle that arm joint is deployed into correspondence.

Described method can also comprise: the signal receiving the critical angle do not interfered between instruction alternate arm joint; And before control described often joint arm joint is deployed into corresponding inclination angle, adjustment arm joint makes the angle between alternate arm joint be more than or equal to described critical angle, wherein, the described critical angle between described alternate arm joint makes to meet the following conditions between described alternate arm joint: the height of the dried up plane of end-to-end distance of last arm joint is greater than the arm joint length of a rear arm joint.

All arm joints can launch simultaneously or launch successively according to the expansion order preset, and all arms joint can launch with identical or different speed.

Described method can also comprise: receive the signal that instruction arm joint exists obstruction around; And when receiving described instruction arm joint and there is the signal of obstruction around, report to the police.In addition, described method can also comprise: the signal receiving the distance between instruction arm joint and obstruction; And when described distance is less than or equal to a preset value, stop arm joint launches.

Described method can also comprise: the signal receiving the target location coordinate of instruction arm support tail end; According to described typical attitude, determine the coordinate of arm support tail end under described typical attitude, and according to this coordinate and described target location coordinate, determine the changes in coordinates amount of the described arm support tail end of expecting; According to the described maximum permissible value often saving the described inclination angle of arm joint, default inclination angle change order and each inclination angle and change under the changes in coordinates amount of described expection, described typical attitude at every turn, calculate the change of pitch angle amount needing controlled arm joint, and according to described change of pitch angle amount adjustment respective arms joint.

Wherein, can comprise according to described change of pitch angle amount adjustment respective arms joint:

According to the described maximum permissible value often saving the described inclination angle of arm joint, default inclination angle change order and each inclination angle and change under the changes in coordinates amount of described expection, described typical attitude at every turn, judge whether to need the inclination angle that all arms save is carried out to integrated regulation and carried out the number of times of integrated regulation; And following at least one: the number of times carrying out integrated regulation when not needing the inclination angle saved all arms or carry out integrated regulation is less than the integrated regulation number of times not exceeding permission, according to described change of pitch angle amount adjustment respective arms joint; And when the number of times of described integrated regulation exceedes the integrated regulation number of times of described permission, export the signal that instruction reselects the typical attitude of jib.

Described method can also comprise: the signal receiving the critical angle do not interfered between instruction retraction arm joint and alternate arm joint; And when receiving the signal of described instruction retraction arm joint: according to working as leading angle between described typical attitude determination alternate arm joint; Judge described when whether leading angle is less than described critical angle; When described when leading angle be less than described critical angle, adjustment arm joint make alternate arm save between angle be more than or equal to described critical angle, and carry out afterwards arm joint regain; And when described when leading angle be more than or equal to described critical angle, directly carry out jib withdrawal; Wherein, carry out jib withdrawal according to following: regain other arms joint except the first arm joint simultaneously; Jib is returned back to initial position; And regain described first arm joint.

Thus, by intelligent arm support control provided by the invention, system, method and engineering machinery, tractor driver can only by selecting a certain typical attitude of jib, jib just can Automatic-expanding to this attitude, without the need to manual intervention, greatly reduce the workload of tractor driver, reduce the requirement of operant level to tractor driver and experience, improve operating efficiency.

Below the preferred embodiment of the present invention is described in detail by reference to the accompanying drawings; but; the present invention is not limited to the detail in above-mentioned embodiment; within the scope of technical conceive of the present invention; can carry out multiple simple variant to technical scheme of the present invention, these simple variant all belong to protection scope of the present invention.

It should be noted that in addition, each the concrete technical characteristic described in above-mentioned detailed description of the invention, in reconcilable situation, can be combined by any suitable mode.In order to avoid unnecessary repetition, the present invention illustrates no longer separately to various possible combination.

In addition, also can be combined between various different embodiment of the present invention, as long as it is without prejudice to thought of the present invention, it should be considered as content disclosed in this invention equally.

Claims (25)

1. an intelligent arm support control, this jib comprises interconnective single oil cylinder joint, and it is characterized in that, described device comprises:

Receiver, for receiving the signal of the typical attitude of instruction jib;

Memory, for being stored in inclination angle or the angle of the often joint arm joint under typical attitude; And

Controller, for when needing to call when being deployed into by jib under a certain typical attitude the inclination angle or angle that each arm corresponding with this typical attitude that described memory stores save, and controls the inclination angle or the angle that each arm joint are deployed into correspondence.

2. device according to claim 1, is characterized in that,

Described receiver is also for receiving the signal of the critical angle do not interfered between instruction alternate arm joint; And

Described controller also for controlling often to save before arm joint is deployed into corresponding inclination angle, adjustment arm joint make alternate arm save between angle be more than or equal to described critical angle.

3. device according to claim 2, is characterized in that, the described critical angle between described alternate arm joint makes to meet the following conditions between described alternate arm joint: the height of the dried up plane of end-to-end distance of last arm joint is greater than the arm joint length of a rear arm joint.

4. according to the device in claim 1-3 described in any one claim, it is characterized in that, described controller controls all arms joint and launches simultaneously or launch successively according to the expansion order preset.

5. device according to claim 4, is characterized in that, described controller controls all arms joint and launches with identical or different speed.

6., according to the device in claim 1-3 described in any one claim, it is characterized in that,

Also there is the signal of obstruction around for receiving instruction arm joint in described receiver; And

Described controller also for when receiving described instruction arm joint and around there is the signal of obstruction, output alarm signal.

7., according to the device in claim 1-3 described in any one claim, it is characterized in that,

Described receiver is also for receiving the signal of the distance between instruction arm joint and obstruction; And

Described controller is also for when described distance is less than or equal to a preset value, and stop arm joint launches.

8. device according to claim 1, is characterized in that,

Described receiver is also for receiving the signal of the target location coordinate of instruction arm support tail end; And

Described controller also for:

According to described typical attitude, determine the coordinate of arm support tail end under described typical attitude, and according to this coordinate and described target location coordinate, determine the changes in coordinates amount of the described arm support tail end of expecting;

According to the described maximum permissible value often saving the described inclination angle of arm joint, default inclination angle change order and each inclination angle and change under the changes in coordinates amount of described expection, described typical attitude at every turn, calculate the change of pitch angle amount needing controlled arm joint, and according to described change of pitch angle amount adjustment respective arms joint.

9. device according to claim 8, is characterized in that, comprises according to described change of pitch angle amount adjustment respective arms joint:

According to the described maximum permissible value often saving the described inclination angle of arm joint, default inclination angle change order and each inclination angle and change under the changes in coordinates amount of described expection, described typical attitude at every turn, judge whether to need the inclination angle that all arms save is carried out to integrated regulation and carried out the number of times of integrated regulation; And

Following at least one:

The number of times carrying out integrated regulation when not needing the inclination angle saved all arms or carry out integrated regulation is less than the integrated regulation number of times not exceeding permission, according to described change of pitch angle amount adjustment respective arms joint; And

When the number of times of described integrated regulation exceedes the integrated regulation number of times of described permission, export the signal that instruction reselects the typical attitude of jib.

10. device according to claim 1, is characterized in that,

Described receiver is also for receiving the signal of the critical angle do not interfered between instruction retraction arm joint and alternate arm joint; And

Described controller is also for when receiving the signal of described instruction retraction arm joint:

According to working as leading angle between described typical attitude determination alternate arm joint;

Judge described when whether leading angle is less than described critical angle;

When described when leading angle be less than described critical angle, adjustment arm joint make alternate arm save between angle be more than or equal to described critical angle, and carry out afterwards arm joint regain.

11. devices according to claim 10, is characterized in that, carry out jib withdrawal in such a way:

Regain other arms joint except the first arm joint simultaneously;

Jib is returned back to initial position; And

Regain described first arm joint.

12. 1 kinds of jib intelligence control systems, is characterized in that, this system comprises:

Input unit, for selecting the typical attitude of jib; And

According to the device in claim 1-11 described in any one claim, be connected with described input unit.

13. systems according to claim 12, is characterized in that, this system also comprises:

Camera head, is arranged on final section arm joint, for the work information of the movement state information and job site that gather arm support tail end; And

Display unit, for showing the described movement state information of described camera head collection and described work information.

14. 1 kinds of engineering machinery comprising the system any one of claim 12-13 described in claim.

15. 1 kinds of jib intelligent control methods, this jib comprises interconnective single oil cylinder joint, and it is characterized in that, described method comprises:

Receive the signal of the typical attitude of instruction jib;

According to described typical attitude, determine corresponding with the described typical attitude inclination angle often saved arm and save; And

Control often to save arm joint and be deployed into corresponding inclination angle.

16. methods according to claim 15, it is characterized in that, the method also comprises:

Receive the signal of the critical angle do not interfered between instruction alternate arm joint; And

Before control described often joint arm joint is deployed into corresponding inclination angle, adjustment arm saves and makes the angle between alternate arm joint be more than or equal to described critical angle.

17. methods according to claim 16, is characterized in that, the described critical angle between described alternate arm joint makes to meet the following conditions between described alternate arm joint: the height of the dried up plane of end-to-end distance of last arm joint is greater than the arm joint length of a rear arm joint.

18., according to the method in claim 15-17 described in any one claim, is characterized in that, all arm joints launch simultaneously or launch successively according to the expansion order preset.

19. methods according to claim 18, is characterized in that, all arm joints launch with identical or different speed.

20., according to the method in claim 15-17 described in any one claim, is characterized in that, the method also comprises:

Receive the signal that instruction arm joint exists obstruction around; And

When receiving described instruction arm joint and there is the signal of obstruction around, report to the police.

21., according to the method in claim 15-17 described in any one claim, is characterized in that, the method also comprises:

Receive the signal of the distance between instruction arm joint and obstruction; And

When described distance is less than or equal to a preset value, stop arm joint launches.

22. methods according to claim 15, it is characterized in that, the method also comprises:

Receive the signal of the target location coordinate of instruction arm support tail end;

According to described typical attitude, determine the coordinate of arm support tail end under described typical attitude, and according to this coordinate and described target location coordinate, determine the changes in coordinates amount of the described arm support tail end of expecting;

According to the described maximum permissible value often saving the described inclination angle of arm joint, default inclination angle change order and each inclination angle and change under the changes in coordinates amount of described expection, described typical attitude at every turn, calculate the change of pitch angle amount needing controlled arm joint, and according to described change of pitch angle amount adjustment respective arms joint.

23. methods according to claim 22, is characterized in that, comprise according to described change of pitch angle amount adjustment respective arms joint:

According to the described maximum permissible value often saving the described inclination angle of arm joint, default inclination angle change order and each inclination angle and change under the changes in coordinates amount of described expection, described typical attitude at every turn, judge whether to need the inclination angle that all arms save is carried out to integrated regulation and carried out the number of times of integrated regulation; And

Following at least one:

The number of times carrying out integrated regulation when not needing the inclination angle saved all arms or carry out integrated regulation is less than the integrated regulation number of times not exceeding permission, according to described change of pitch angle amount adjustment respective arms joint; And

When the number of times of described integrated regulation exceedes the integrated regulation number of times of described permission, export the signal that instruction reselects the typical attitude of jib.

24. methods according to claim 15, it is characterized in that, the method also comprises:

Receive the signal of the critical angle do not interfered between instruction retraction arm joint and alternate arm joint; And

When receiving the signal of described instruction retraction arm joint:

According to working as leading angle between described typical attitude determination alternate arm joint;

Judge described when whether leading angle is less than described critical angle;

When described when leading angle be less than described critical angle, adjustment arm joint make alternate arm save between angle be more than or equal to described critical angle, and carry out afterwards arm joint regain.

25. methods according to claim 24, is characterized in that, carry out jib withdrawal in such a way:

Regain other arms joint except the first arm joint simultaneously;

Jib is returned back to initial position; And

Regain described first arm joint.