CN103147577B - Control method, equipment, system and construction machinery for multi-joint mechanical arm support - Google Patents
Control method, equipment, system and construction machinery for multi-joint mechanical arm support Download PDFInfo
- Publication number
- CN103147577B CN103147577B CN201310061674.8A CN201310061674A CN103147577B CN 103147577 B CN103147577 B CN 103147577B CN 201310061674 A CN201310061674 A CN 201310061674A CN 103147577 B CN103147577 B CN 103147577B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- arm support
- tail end
- trajectory path
- sub
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 56
- 238000010276 construction Methods 0.000 title abstract description 4
- 230000033001 locomotion Effects 0.000 claims description 204
- 238000006073 displacement reaction Methods 0.000 claims description 137
- 230000001133 acceleration Effects 0.000 claims description 60
- 239000011159 matrix material Substances 0.000 claims description 11
- 238000006243 chemical reaction Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 description 7
- 230000004048 modification Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000035772 mutation Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
Landscapes
- Manipulator (AREA)
Abstract
The invention discloses a control method, equipment, a system, and construction machinery for a multi-joint mechanical arm support. The control method mainly comprises the steps that a moving track path of the tail end of the mechanical arm support is divided into a plurality of sub track paths; aiming at each sub track path, the length value that the tail end of the mechanical arm support can move within a set duration, and current position information of each joint of the mechanical arm support is collected to calculate the required moving angle information of each joint of the mechanical arm support under the position information of subgoals capable of being reached by the tail end of the mechanical arm support; the obtained angle information of each joint in converted into control instructions, so that each joint of the mechanical arm support is controlled to move; the track path of the tail end of the mechanical arm support is subjected to discrete programming; and aiming at the sub track paths after programming, the moving angle information of each other joint of the mechanical arm support are determined according to the inverse kinematic principle. Therefore, the operation stability of the tail end of the arm support is guaranteed sufficiently, and the control precision for the tail end of the multi-joint mechanical arm support is improved.
Description
Technical field
The present invention relates to engineering machinery field, particularly relate to the control method of a kind of multi-joint class machinery jib, equipment, system and engineering machinery.
Background technology
In existing construction machinery product, as: concrete mixer, concrete sprayer, automobile crane and hydraulic crawler excavator etc., the groundwork device of big machinery is multi-joint hydraulic press mechanical arm.This class hydraulic machinery arm system has that number of degrees of freedom is many, quality is large, flexibility is large and the feature such as inertia is large, in use have that complicated operation degree is high, security requirement high, and work long hours under the engineering construction environment of complexity, carry out the operation of high strength, therefore, when controlling the multi-joint hydraulic machinery jib of this kind of big machinery, require higher to the stationarity of the harmony of operator, accuracy and control.
At present, general in the following ways to the control mode of multi-joint hydraulic press mechanical arm:
As shown in Figure 1, be the structural representation of the control system of multi-joint hydraulic press mechanical arm in prior art, include in described control system: wireless remotely-controlled device, receiving equipment, PLC control appliance and single banked direction control valves.Wherein: Digiplex, generate for the operational order according to operator the control instruction controlling jib, and send to receiving equipment;
Receiving equipment, for wirelessly receiving the control instruction of Digiplex, and sends to PLC control appliance by this control instruction;
PLC control appliance, sends to single banked direction control valves for the control signal control instruction received being converted into hydraulic circuit valve.
The operating principle that this control system is concrete is:
The operator of big machinery visually observing or the movement locus of end by micro-judgment determination multi-joint hydraulic press mechanical arm according to self;
According to the movement locus formation control instruction determined, and by the control signal of wireless remote control device input to arm support tail end, by the control appliance of arm support tail end when receiving this control instruction, the control instruction received is converted into the flow of PWM Current Control hydraulic multitandem valve, realize the motion control to each joint such as hydraulic motor, hydraulic jack corresponding to multi-joint hydraulic press mechanical arm, and then realize the control to arm support tail end.
Due to this multi-joint arm frame system Shi Duo redundant degree of freedom mechanism, complete same task to realize with different attitudes and motion path, but the operation of dependence completely that sends of control instruction visually observes or experience is determined, therefore, the control of multi-joint jib is depended on completely to the operating experience of operator, be difficult to ensure the soften requirement of operating machine, easily occur in operation rocking more greatly, infringement jib structure, make the end of multi-joint jib accurately can not arrive target location, occur the problem that operating efficiency is low.
Summary of the invention
Embodiments provide a kind of multi-joint class machinery control method of jib, equipment, system and engineering machinery, the end for solving the multi-joint jib occurred when controlling multi-joint jib in prior art accurately can not arrive the low problem of operating efficiency that target location causes.
A control method for multi-joint class machinery jib, comprising:
Utilize the method for analog mechanical arm support tail end movement of setting, the trajectory path of mechanical arm support tail end movement be divided into into N strip trajectory path, wherein, N be not less than 1 positive integer;
For each strip trajectory path of other except the Article 1 sub-trajectory path obtained, perform following operation respectively:
According to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate displacement line speed, the displacement line acceleration of mechanical jib motion in current sub-trajectory path, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle;
The current location information in each joint of collection machinery jib, utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, wherein, the sub-goal positional information that described Current mechanical arm support tail end can arrive can the length value of movement determine according to the Current mechanical arm support tail end determined;
The angle information in each joint obtained is converted into control instruction, and electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves.
A control appliance for multi-joint class machinery jib, comprising:
Divide module, for utilizing the method for the analog mechanical arm support tail end movement of setting, the trajectory path of mechanical arm support tail end movement is divided into into N strip trajectory path, wherein, N be not less than 1 positive integer;
Control module, for for each strip trajectory path of other except the Article 1 sub-trajectory path obtained, performs following operation respectively:
According to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate displacement line speed, the displacement line acceleration of mechanical jib motion in current sub-trajectory path, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle;
The current location information in each joint of collection machinery jib, utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, wherein, the sub-goal positional information that described Current mechanical arm support tail end can arrive can the length value of movement determine according to the Current mechanical arm support tail end determined;
The angle information in each joint obtained is converted into control instruction, and electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves.
A control system for multi-joint class machinery jib, comprising:
Collecting device, for the positional information in collection machinery jib each joint current;
Control appliance, for utilizing the method for the analog mechanical arm support tail end movement of setting, is divided into into N strip trajectory path by the trajectory path of mechanical arm support tail end movement, wherein, N be not less than 1 positive integer;
For each strip trajectory path of other except the Article 1 sub-trajectory path obtained, perform following operation respectively: according to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate displacement line speed, the displacement line acceleration of mechanical jib motion in current sub-trajectory path, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle;
Utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, the angle information in each joint obtained is converted into control instruction, triggers electro-hydraulic proportional valve;
Electro-hydraulic proportional valve, for the control instruction of receiving control apparatus, and each joint motions of controller mechanical arm frame.
There is an engineering machinery for multi-joint class machinery jib, comprise the control system of above-mentioned multi-joint class machinery jib.
Beneficial effect of the present invention is as follows:
The embodiment of the present invention is by dividing the trajectory path of mechanical arm support tail end movement, obtain many strips trajectory path, for each strip trajectory path of other except the Article 1 sub-trajectory path obtained, perform following operation respectively: according to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate the displacement line speed of mechanical jib motion in current sub-trajectory path, displacement line acceleration, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle, and the current location information in each joint of collection machinery jib, utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, the angle information in each joint obtained is converted into control instruction, electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves, compared with prior art, the trajectory path of arm support tail end is carried out discrete programming, and determine the angle information of other each joint movements according to inverse kinematics principle for the sub-trajectory path after planning, adequately achieve the flexibility of arm support tail end motion and each joint motions, ensure arm support tail end traveling comfort, the speed of reducing is undergone mutation the impact to mechanical jib brought, improve the control accuracy to multi-joint mechanical arm frame end.
Accompanying drawing explanation
Fig. 1 is the structural representation of the control system of multi-joint hydraulic press mechanical arm in prior art;
Fig. 2 is the flow chart of the control method of a kind of multi-joint class machinery jib of the embodiment of the present invention one;
Fig. 3 is the structural representation of the control appliance of a kind of multi-joint class machinery jib of the embodiment of the present invention two;
Fig. 4 is the structural representation of the control system of a kind of multi-joint class machinery jib of the embodiment of the present invention three.
Detailed description of the invention
In order to realize object of the present invention, embodiments provide the control method of a kind of multi-joint class machinery jib, equipment, system and engineering machinery, by the trajectory path of mechanical arm support tail end movement is divided, obtain many strips trajectory path, for each strip trajectory path of other except the Article 1 sub-trajectory path obtained, perform following operation respectively: according to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate the displacement line speed of mechanical jib motion in current sub-trajectory path, displacement line acceleration, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle, and the current location information in each joint of collection machinery jib, utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, the angle information in each joint obtained is converted into control instruction, electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves.
Compared with prior art, the trajectory path of arm support tail end is carried out discrete programming, and determine the angle information of other each joint movements according to inverse kinematics principle for the sub-trajectory path after planning, adequately achieve the flexibility of arm support tail end motion and each joint motions, ensure arm support tail end traveling comfort, the speed of reducing is undergone mutation the impact to mechanical jib brought, and improves the control accuracy to multi-joint mechanical arm frame end.
Below in conjunction with Figure of description, each embodiment of the present invention is described in detail.
Embodiment one:
As shown in Figure 2, be the flow chart of the control method of a kind of multi-joint class machinery jib of the embodiment of the present invention one, described method comprises:
Step 101: the method utilizing the analog mechanical arm support tail end movement of setting, is divided into into N strip trajectory path by the trajectory path of mechanical arm support tail end movement.
Wherein, N be not less than 1 positive integer.
In a step 101, before the trajectory path of mechanical arm support tail end movement carries out discrete operations, described method also comprises: the trajectory path determining mechanical arm support tail end movement.
Particularly, determine that the method for the trajectory path of mechanical arm support tail end movement includes but not limited to: the positional information according to the current place of mechanical arm support tail end is determined with the target location moved to.
After the trajectory path determining mechanical arm support tail end movement, can carry out analogue enlargement in the following manner to the trajectory path of the mechanical arm support tail end movement determined, wherein, the method for the analog mechanical arm support tail end movement of described setting specifically includes but not limited to:
First kind of way: crawl triggering mode.Spatialization is carried out in the position at mechanical arm support tail end place, determine the X-axis at mechanical arm support tail end place, Y-axis and Z axis, respectively from the positive and negative direction of X-axis, the positive and negative direction of Y-axis and the positive and negative direction of Z axis provide arbitrary signal, mechanical arm support tail end is moved towards either direction with the track of straight line, until this blackout, the trajectory path of this mechanical arm support tail end can be obtained.
The second way: read skimulated motion trail file.Routing information in scene to be moved for mechanical arm support tail end is processed, and adopt curve-fitting method that the routing information after process is changed into the movement locus file of mechanical arm support tail end, using the movement locus file that the obtains trajectory path as mechanical arm support tail end movement.
The third mode: sampling generates the trajectory path of movement.Point trigger-type is adopted to obtain the desired motion track of mechanical arm support tail end, utilize existing software equipment in the process obtaining desired motion track, gather the positional information of mechanical arm support tail end on fixed time period, will the motion track information of positional information as mechanical arm support tail end be collected.
4th kind of mode: automatic orbit key point mode.By mechanical arm support tail end manually to original position, open software controlled device, select shape and the parameter of crucial line segment, again mechanical arm support tail end is moved in the key point of expectation, determine to record the routing information from original position to this key point, move in circles, the multiple routing informations obtained are integrated and obtains the trajectory path of mechanical arm support tail end from original position to final position.
More preferably, some key points are calibrated at the trajectory path determined, and by mechanical arm support tail end from a key point to the simulated operation of another key point, judge the shape in the sub-trajectory path between two key points, and determine the origin coordinates information in this sub-trajectory path and stop coordinate information, the traveling time of calculating machine arm support tail end on each strip trajectory path.
When the shape of group trajectory path is straight line, utilize discrete mode, according to origin coordinates information and termination coordinate information, portable cord speed, the linear acceleration of this space line, often set the sub-trajectory line segment of movement in moving period of unit, calculated the coordinate value of the sub-trajectory straightway impact point often setting movement in moving period of unit by coordinate.
Such as: the sub-trajectory path from A1 point to A2 point is straight line, so determine the co-ordinate position information of A1 point and the co-ordinate position information of A2 point, and the mode adopting mathematics discrete, calculate the sub-trajectory line segment of the sub-trajectory path movement in moving period of setting unit from A1 to A2: A1 to A11, A11 to A12 etc., and calculated the coordinate information of the sub-trajectory straightway impact point often setting movement in moving period of unit by coordinate, i.e. the coordinate information of A11, the coordinate information etc. of A12.
When the shape of group trajectory path is circular arc, utilize discrete mode, according to origin coordinates information and the termination coordinate information of this space circular arc, obtain centre coordinate information, the normal direction information of space circular arc, space circular arc radius information, utilize portable cord speed, linear acceleration, calculate the sub-trajectory arc section often setting movement in moving period of unit, calculated the coordinate information of the sub-trajectory circular arc line segment impact point often setting movement in moving period of unit by Coordinate Conversion.
Such as: the sub-trajectory path from A1 point to A2 point is circular arc, so determine the co-ordinate position information of A1 point and the co-ordinate position information of A2 point, and obtain the centre coordinate information of circular arc A1A2, the normal direction information of space circular arc, space circular arc radius information, adopt the mode that mathematics is discrete, utilize portable cord speed, linear acceleration, calculate the sub-trajectory arc section of the sub-trajectory path movement in moving period of setting unit from A1 to A2: A1 to A11, A11 to A12 etc., and the coordinate information of the sub-trajectory arc section impact point often setting movement in moving period of unit is calculated by coordinate, the i.e. coordinate information of A11, the coordinate information etc. of A12.
More preferably, after discrete processes is carried out to each strip trajectory path, the continuous print sub-trajectory line segment obtained after discrete or sub-trajectory circular arc are stored in track queue as a strip trajectory path information.
It should be noted that, for the trajectory path of the mechanical arm support tail end movement determined, also antithetical phrase trajectory path can be utilized to carry out discrete mode, obtain for the trajectory path line segment and/or trajectory path circular arc with trajectory path, like this by the trajectory path line segment determined and/or trajectory path circular arc, improve the precision of controller tool arm support tail end movement.
Step 102: for each strip trajectory path of other except the Article 1 sub-trajectory path obtained, circulation performs following operation:
Step 1021: according to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate displacement line speed, the displacement line acceleration of mechanical jib motion in current sub-trajectory path, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle.
Particularly, in step 1021, obtain displacement line speed, the displacement line acceleration of mechanical jib motion in current sub-trajectory path in the following manner, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle:
Wherein:
l
targetfor displacement of targets distance, L
progressfor the range difference between actual displacement distance and displacement of targets distance, V
a upper linear velocityfor mechanical jib motion is in a upper strip trajectory path top offset linear velocity, V
linear velocityfor mechanical jib motion is in current sub-trajectory path top offset linear velocity, a
maxfor the peak acceleration of mechanical arm support tail end movement, t is mechanical jib end movement traveling time on current sub-trajectory path, and Δ s is the length value that Current mechanical arm support tail end needs movement.
More preferably, obtaining the displacement line speed of mechanical jib end movement in current sub-trajectory path, after displacement line acceleration, the maximum line velocity of the displacement line speed obtained and setting is compared, and the max line acceleration of the displacement line acceleration obtained and setting is compared, when the little linear velocity of the displacement obtained is greater than the maximum line velocity of setting, and/or the displacement line acceleration obtained is when being greater than the max line acceleration of setting, maximum linear velocity and linear acceleration is utilized to recalculate the mechanical jib displacement line speed of motion in current sub-trajectory path and displacement line acceleration.
More preferably, can the length value determination Current mechanical arm support tail end of the movement sub-goal positional information that can arrive according to the Current mechanical arm support tail end calculated, specifically comprise:
First, after the operation execution of mechanical arm support tail end on a upper strip trajectory path terminates, the positional information at the place of Current mechanical arm support tail end is gathered;
Secondly, according to described positional information and calculate Current mechanical arm support tail end can the length value of movement, obtain the mechanical jib sub-goal positional information that movement can arrive on current sub-trajectory path.
Step 1022: the current location information in each joint of collection machinery jib, utilize the computation of inverse-kinematics method of setting, calculate the angle information of each joint of mechanical arm frame current needs movement during the sub-goal positional information that can arrive at Current mechanical arm support tail end.
In step 1022, the angle information of the current needs in each joint of mechanical arm frame movement when profit determines the sub-goal positional information that can arrive at Current mechanical arm support tail end with the following methods:
First, according to the current location information in mechanical each joint of jib collected, utilize Jacobian matrix algorithm, obtain the matrix about each joint position information.
Particularly, concerning one degree of freedom is the mechanical jib of n, analyze from kinematics angle, can obtain its kinematical equation is X=JQ, and wherein: X is the position coordinates of arm support tail end at cartesian space, Q is the angle/motion vector in each joint;
And Jacobian matrix is 6*n rank matrixes, the joint variable in joint variable space can be converted to the joint variable of cartesian space by it;
Then to the differentiate of kinematical equation differential, and resolve and obtain inverse kinetics solution
wherein: J
+for pseudo inverse matrix, be n*6 matrix, and
the gradient vector of optimization object function H (θ),
Eventually through calculating the optimal motion velocity amplitude that can obtain each joint of mechanical arm frame.
Secondly, utilize Arithmetic of inverse kinematics, calculate the angle information of each joint of mechanical arm frame current needs movement during the sub-goal positional information that can arrive at Current mechanical arm support tail end.
More preferably, for each strip trajectory path, when determining the angle information for each joint of mechanical jib current needs movement in this sub-trajectory path, can revise by the current angle information of movement that needs each joint of mechanical jib determined, like this, the control instruction determined by the angle information of revised each joint of mechanical arm frame current needs movement, will improve the precision of mechanical arm support tail end arrival target location.
After the angle information calculating the current needs movement of each joint of mechanical jib, before the angle information in each joint obtained is converted into control instruction, described method also comprises:
For each joint, perform following operation:
First, three smooth track function # (t)=a are utilized
0+ a
1t+a
2t
2+ a
3t
3, calculate the curve meeting the movement locus in this joint, wherein, a
0, a
1, a
2and a
3represent the coefficient of three smooth track functions, t represents the traveling time that mechanical jib is current.
Particularly, the smooth track function in each joint need meet following constraints when calculating:
The i.e. position coordinates constraints of the geometric locus two-end-point in this joint and movement velocity constraints,
Wherein, θ
0for the moveable maximal angle value in this joint, θ
ffor the moveable minimum angles value in this joint, V
0for the moveable maximum speed value in this joint, V
ffor the moveable minimum speed value in this joint.
According to constraints, solve and obtain each coefficient in three smooth track functions:
Secondly, the path curves in this joint calculated is converted to the angle information that this joint needs movement.
More preferably, determine that this joint needs the angle information of movement in current track path according to each coefficient obtained.
Step 1023: the angle information in each joint obtained is converted into control instruction, electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves.
More preferably, in a strip trajectory path, after mobile end, when starting to move in next strip trajectory path, following operation is performed at mechanical arm support tail end:
The first step: judge whether the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is greater than setting numerical value.
Second step: when the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is greater than setting numerical value, then calculate the range difference between actual displacement distance and displacement of targets distance in a upper strip trajectory path, and according to the range difference calculated, mechanical arm support tail end in upper strip trajectory path centerline velocities and a linear acceleration, update stored in the length value in the current sub-trajectory path in track queue, and operate for the current sub-trajectory path after renewal in the updated.
When the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is not more than setting numerical value, triggers and operate for the current sub-trajectory path in track queue.
It should be noted that, when mechanical arm support tail end is started working, for the Article 1 sub-trajectory path of this trajectory path mode of operation from except the mode of operation in Article 1 sub-trajectory path different, be specially:
Described for Article 1 sub-trajectory path, perform following operation:
First: the first sub-goal positional information determining Article 1 sub-trajectory path.
Second: the current location information in each joint of collection machinery jib, and according to the setting initial plant degree of mechanical arm support tail end movement and linear acceleration, calculate the angle information of each joint current needs movement when mechanical arm support tail end arrives position corresponding to the first sub-goal positional information.
3rd: the angle information in each joint obtained is converted into control instruction, electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves.
By the scheme of the embodiment of the present invention one, utilize the algorithm of setting, the trajectory path of mechanical arm support tail end movement is carried out discrete processes, obtain many strips trajectory path, for each strip trajectory path, perform following operation: according to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate the displacement line speed of mechanical jib motion in current sub-trajectory path, displacement line acceleration, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle, and the current location information in each joint of collection machinery jib, utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, the angle information in each joint obtained is converted into control instruction, electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves, compared with prior art, the trajectory path of arm support tail end is carried out discrete programming, and determine the angle information of other each joint movements according to inverse kinematics principle for the sub-trajectory path after planning, adequately achieve the flexibility of arm support tail end motion and each joint motions, ensure arm support tail end traveling comfort, the speed of reducing is undergone mutation the impact to mechanical jib brought, improve the control accuracy to multi-joint mechanical arm frame end.
Embodiment two:
As shown in Figure 3, be the structural representation of the control appliance of a kind of multi-joint class machinery jib of the embodiment of the present invention two, described equipment comprises: discrete processes module 11 and control module 12, wherein:
Discrete processes module 11, for utilizing the method for the analog mechanical arm support tail end movement of setting, is divided into into N strip trajectory path by the trajectory path of mechanical arm support tail end movement, wherein, N be not less than 1 positive integer;
Control module 12, for for each strip trajectory path of other except the Article 1 sub-trajectory path obtained, performs following operation respectively:
According to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate displacement line speed, the displacement line acceleration of mechanical jib motion in current sub-trajectory path, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle;
The current location information in each joint of collection machinery jib, utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, wherein, the sub-goal positional information that described Current mechanical arm support tail end can arrive can the length value of movement determine according to the Current mechanical arm support tail end determined;
The angle information in each joint obtained is converted into control instruction, and electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves.
More preferably, the trajectory path of described mechanical arm support tail end movement determines with the target position information moved to according to the positional information at the current place of mechanical jib.
Particularly, described discrete processes module 11, specifically comprises:
Divide submodule 21, for described trajectory path is divided into N strip trajectory path, and determines the origin coordinates information in this sub-trajectory path and stop coordinate information, the traveling time of calculating machine arm support tail end on each strip trajectory path;
Judge submodule 22, for judging that M strip trajectory path is straight line or circular arc;
Calculating sub module 23, if be straight line for judged result, then utilize discrete mode, according to origin coordinates information and termination coordinate information, portable cord speed, the linear acceleration of this space line, often set the sub-trajectory line segment of movement in moving period of unit, calculated the coordinate value of the sub-trajectory straightway impact point often setting movement in moving period of unit by coordinate;
If judged result is circular arc, then utilize discrete mode, according to origin coordinates information and the termination coordinate information of this space circular arc, obtain centre coordinate information, the normal direction information of space circular arc, space circular arc radius information, utilize portable cord speed, linear acceleration, calculate the sub-trajectory arc section often setting movement in moving period of unit, calculated the coordinate information of the sub-trajectory circular arc line segment impact point often setting movement in moving period of unit by Coordinate Conversion;
Sub module stored 24, for being stored in the continuous print sub-trajectory line segment obtained after discrete or sub-trajectory circular arc in track queue as a strip trajectory path information.
Particularly, described control module 12, specifically for determining the first sub-goal positional information in Article 1 sub-trajectory path, the current location information in each joint of collection machinery jib, and according to setting initial plant degree and the linear acceleration of mechanical arm support tail end movement, calculate the angle information of the current needs in each joint movement when mechanical arm support tail end arrives position corresponding to the first sub-goal positional information, and the angle information in each joint obtained is converted into control instruction, electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves.
Described control module 12, specifically for calculating the displacement line speed of mechanical jib end movement in current sub-trajectory path, displacement line acceleration in the following manner, and Current mechanical arm support tail end needs the length value of movement within the setting-up time cycle:
Wherein:
l
targetfor displacement of targets distance, L
progressfor the range difference between actual displacement distance and displacement of targets distance, V
a upper linear velocityfor mechanical jib motion is in a upper strip trajectory path top offset linear velocity, V
linear velocityfor mechanical jib motion is in current sub-trajectory path top offset linear velocity, a
maxfor the peak acceleration of mechanical arm support tail end movement, t is mechanical jib motion moving period on a upper strip trajectory path, and Δ s is the length value that Current mechanical arm support tail end needs movement.
Described control module 12, after terminating when the operation execution of mechanical arm support tail end on a upper strip trajectory path, gather the positional information at the place of Current mechanical arm support tail end, and according to described positional information and calculate Current mechanical arm support tail end can the length value of movement, obtain the mechanical jib sub-goal positional information that movement can arrive on current sub-trajectory path.
Described control module 12, specifically for the current location information according to mechanical each joint of jib collected, utilize Jacobian matrix algorithm, obtain the matrix about each joint position information, and utilize Arithmetic of inverse kinematics, calculate the angle information of each joint of mechanical arm frame current needs movement during the sub-goal positional information that can arrive at Current mechanical arm support tail end.
More preferably, described equipment also comprises: interpolation module 13, wherein:
Interpolation module 13, for for each joint, performs following operation:
Utilize three smooth track function # (t)=a
0+ a
1t+a
2t
2+ a
3t
3, calculate the curve meeting the movement locus in this joint, wherein, a
0, a
1, a
2and a
3represent the coefficient of three smooth track functions, t represents the traveling time that mechanical jib is current, the path curves in this joint calculated is converted to the angle information that this joint needs movement.
More preferably, described equipment also comprises: more new module 14, wherein:
More new module 14, for on a strip trajectory path operation after execution terminates, before starting for current sub-trajectory path operations execution, judge whether the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is greater than setting numerical value;
When the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is greater than setting numerical value, then calculate the range difference between actual displacement distance and displacement of targets distance in a upper strip trajectory path, and according to the range difference calculated, mechanical arm support tail end in upper strip trajectory path centerline velocities and a linear acceleration, update stored in the length value in the current sub-trajectory path in track queue;
When the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is not more than setting numerical value, trigger control module.
Embodiment three:
As shown in Figure 4, be the structural representation of the control system of a kind of multi-joint class machinery jib of the embodiment of the present invention three, described system comprises: collecting device 31, control appliance 32 and electro-hydraulic proportional valve 33, wherein:
Collecting device 31, for the positional information in collection machinery jib each joint current.
Control appliance 32, for utilizing the method for the analog mechanical arm support tail end movement of setting, is divided into into N strip trajectory path by the trajectory path of mechanical arm support tail end movement, wherein, N be not less than 1 positive integer;
For each strip trajectory path of other except the Article 1 sub-trajectory path obtained, perform following operation respectively: according to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate displacement line speed, the displacement line acceleration of mechanical jib motion in current sub-trajectory path, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle;
Utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, the angle information in each joint obtained is converted into control instruction, triggers electro-hydraulic proportional valve;
Electro-hydraulic proportional valve 33, for the control instruction of receiving control apparatus, and each joint motions of controller mechanical arm frame.
Particularly, control instruction is received by CAN.
More preferably, described collecting device 31 can be displacement transducer 41 and rotary coding sensor 42.
Described system also comprises: I/O analog input and output card 34, wherein:
I/O analog input and output card 34, the angle value for collecting device being collected mechanical each joint of jib is converted into the discernible signal message of control appliance, exports control appliance to.
Described system also comprises: touch display screen 35, wherein,
Touch display screen, for carrying out man-machine information interaction by VGA serial ports, comprises the display of the input of controling parameters, the output of state parameter and jib threedimensional model.
Described system also comprises: wireless remote controlled receiver 36, wherein:
Wireless remote controlled receiver 36, for receiving jib end-of-pipe control signal by CAN.
It should be noted that, described control appliance can be RT-Linux built-in industrial control machine.
The present invention also provides a kind of engineering machinery with multi-joint class machinery jib, comprises the control system of above-mentioned multi-joint class machinery jib.
Obviously, those skilled in the art can carry out various change and modification to the present invention and not depart from the spirit and scope of the present invention.Like this, if these amendments of the present invention and modification belong within the scope of the claims in the present invention and equivalent technologies thereof, then the present invention is also intended to comprise these change and modification.
Claims (18)
1. a control method for multi-joint class machinery jib, is characterized in that, comprising:
Utilize the method for analog mechanical arm support tail end movement of setting, the trajectory path of mechanical arm support tail end movement be divided into into N strip trajectory path, wherein, N be not less than 1 positive integer;
For each strip trajectory path of other except the Article 1 sub-trajectory path obtained, perform following operation respectively:
According to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate displacement line speed, the displacement line acceleration of mechanical jib motion in current sub-trajectory path, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle;
The current location information in each joint of collection machinery jib, utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, wherein, the sub-goal positional information that described Current mechanical arm support tail end can arrive can the length value of movement determine according to the Current mechanical arm support tail end that calculates;
The angle information in each joint obtained is converted into control instruction, and electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves;
Wherein, for Article 1 sub-trajectory path, perform following operation, specifically comprise:
Determine the first sub-goal positional information in Article 1 sub-trajectory path;
The current location information in each joint of collection machinery jib, and according to the setting initial plant degree of mechanical arm support tail end movement and linear acceleration, calculate the angle information of each joint current needs movement when mechanical arm support tail end arrives position corresponding to the first sub-goal positional information;
The angle information in each joint obtained is converted into control instruction, and electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves.
2. the method for claim 1, is characterized in that, the trajectory path of described mechanical arm support tail end movement determines with the target position information moved to according to the positional information at the current place of mechanical arm support tail end.
3. the method for claim 1, is characterized in that, the described trajectory path by mechanical arm support tail end movement is divided into into N strip trajectory path, specifically comprises:
Described trajectory path is divided into N strip trajectory path, and determines the origin coordinates information in this sub-trajectory path and stop coordinate information, the traveling time of calculating machine arm support tail end on each strip trajectory path;
Judge that M strip trajectory path is straight line or circular arc;
If straight line, utilize discrete mode, according to origin coordinates information and termination coordinate information, portable cord speed, the linear acceleration of this space line, often set the sub-trajectory line segment of movement in moving period of unit, calculated the coordinate value of the sub-trajectory straightway impact point often setting movement in moving period of unit by coordinate;
If circular arc, utilize discrete mode, according to origin coordinates information and the termination coordinate information of this space circular arc, obtain centre coordinate information, the normal direction information of space circular arc, space circular arc radius information, utilize portable cord speed, linear acceleration, calculate the sub-trajectory arc section often setting movement in moving period of unit, calculated the coordinate information of the sub-trajectory circular arc line segment impact point often setting movement in moving period of unit by Coordinate Conversion;
The continuous print sub-trajectory line segment obtained after discrete or sub-trajectory circular arc are stored in track queue as a strip trajectory path information.
4. the method for claim 1, it is characterized in that, described according to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate the displacement line speed of mechanical jib end movement in current sub-trajectory path, displacement line acceleration, and within the setting-up time cycle, Current mechanical arm support tail end needs the length value of movement, specifically comprises:
A
acceleration=(V
linear velocity-V
a upper linear velocity)/t;
△ s=(V
linear velocity+ V
a upper linear velocity) * 0.5*t;
Wherein:
l
targetfor displacement of targets distance, L
progressfor the range difference between actual displacement distance and displacement of targets distance, V
a upper linear velocityfor mechanical jib motion is in a upper strip trajectory path top offset linear velocity, V
linear velocityfor mechanical jib motion is in current sub-trajectory path top offset linear velocity, a
maxfor the peak acceleration of mechanical arm support tail end movement, t is mechanical jib motion moving period on current sub-trajectory path, and △ s is the length value that Current mechanical arm support tail end needs movement.
5. method as claimed in claim 4, is characterized in that, the sub-goal positional information that described Current mechanical arm support tail end can arrive can the length value of movement determine according to the Current mechanical arm support tail end calculated, and specifically comprises:
After the operation execution of mechanical arm support tail end on a upper strip trajectory path terminates, gather the positional information at the place of Current mechanical arm support tail end;
According to described positional information and calculate Current mechanical arm support tail end can the length value of movement, obtain the mechanical jib sub-goal positional information that movement can arrive on current sub-trajectory path.
6. the method for claim 1, it is characterized in that, the current location information in described each joint of collection machinery jib, utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, specifically comprise:
According to the current location information in mechanical each joint of jib collected, utilize Jacobian matrix algorithm, obtain the matrix about each joint position information;
Utilize Arithmetic of inverse kinematics, calculate the angle information of each joint of mechanical arm frame current needs movement during the sub-goal positional information that can arrive at Current mechanical arm support tail end.
7. method as claimed in claim 6, is characterized in that, after the angle information calculating the current needs movement of each joint of mechanical jib, before the angle information in each joint obtained is converted into control instruction, described method also comprises:
For each joint, perform following operation:
Utilize three smooth track function # (t)=a
0+ a
1t+a
2t
2+ a
3t
3, calculate the curve meeting the movement locus in this joint, wherein, a
0, a
1, a
2and a
3represent the coefficient of three smooth track functions, t represents the traveling time that mechanical jib is current;
The path curves in this joint calculated is converted to the angle information that this joint needs movement.
8. the method as described in as arbitrary in claim 1 ~ 7, is characterized in that, described on after a strip trajectory path operation execution terminates, before performing for current sub-trajectory path operations and starting, described method also comprises:
Judge whether the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is greater than setting numerical value;
When the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is greater than setting numerical value, then calculate the range difference between actual displacement distance and displacement of targets distance in a upper strip trajectory path, and according to the range difference calculated, mechanical arm support tail end in upper strip trajectory path centerline velocities and a linear acceleration, update stored in the length value in the current sub-trajectory path in track queue;
When the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is not more than setting numerical value, triggers and operate for the current sub-trajectory path in track queue.
9. a control appliance for multi-joint class machinery jib, is characterized in that, comprising:
Divide module, for utilizing the method for the analog mechanical arm support tail end movement of setting, the trajectory path of mechanical arm support tail end movement is divided into into N strip trajectory path, wherein, N be not less than 1 positive integer;
Control module, for for each strip trajectory path of other except the Article 1 sub-trajectory path obtained, performs following operation respectively:
According to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate displacement line speed, the displacement line acceleration of mechanical jib motion in current sub-trajectory path, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle;
The current location information in each joint of collection machinery jib, utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, wherein, the sub-goal positional information that described Current mechanical arm support tail end can arrive can the length value of movement determine according to the Current mechanical arm support tail end determined;
The angle information in each joint obtained is converted into control instruction, and electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves;
Wherein, for Article 1 sub-trajectory path, perform following operation, specifically comprise:
Determine the first sub-goal positional information in Article 1 sub-trajectory path;
The current location information in each joint of collection machinery jib, and according to the setting initial plant degree of mechanical arm support tail end movement and linear acceleration, calculate the angle information of each joint current needs movement when mechanical arm support tail end arrives position corresponding to the first sub-goal positional information;
The angle information in each joint obtained is converted into control instruction, and electro-hydraulic proportional valve corresponding to each joint of controller mechanical arm frame moves.
10. equipment as claimed in claim 9, is characterized in that, the trajectory path of described mechanical arm support tail end movement determines with the target position information moved to according to the positional information at the current place of mechanical jib.
11. equipment as claimed in claim 9, it is characterized in that, described division module, specifically comprises:
Divide submodule, for described trajectory path is divided into N strip trajectory path, and determines the origin coordinates information in this sub-trajectory path and stop coordinate information, the traveling time of calculating machine arm support tail end on each strip trajectory path;
Judge submodule, for judging that M strip trajectory path is straight line or circular arc;
Calculating sub module, if be straight line for judged result, then utilize discrete mode, according to origin coordinates information and termination coordinate information, portable cord speed, the linear acceleration of this space line, often set the sub-trajectory line segment of movement in moving period of unit, calculated the coordinate value of the sub-trajectory straightway impact point often setting movement in moving period of unit by coordinate;
If judged result is circular arc, then utilize discrete mode, according to origin coordinates information and the termination coordinate information of this space circular arc, obtain centre coordinate information, the normal direction information of space circular arc, space circular arc radius information, utilize portable cord speed, linear acceleration, calculate the sub-trajectory arc section often setting movement in moving period of unit, calculated the coordinate information of the sub-trajectory circular arc line segment impact point often setting movement in moving period of unit by Coordinate Conversion;
Sub module stored, for being stored in the continuous print sub-trajectory line segment obtained after discrete or sub-trajectory circular arc in track queue as a strip trajectory path information.
12. equipment as claimed in claim 9, is characterized in that,
Described control module, specifically for calculating the displacement line speed of mechanical jib end movement in current sub-trajectory path, displacement line acceleration in the following manner, and Current mechanical arm support tail end needs the length value of movement within the setting-up time cycle:
A
acceleration=(V
linear velocity-V
a upper linear velocity)/t;
△ s=(V
linear velocity+ V
a upper linear velocity) * 0.5*t;
Wherein:
l
targetfor displacement of targets distance, L
progressfor the range difference between actual displacement distance and displacement of targets distance, V
a upper linear velocityfor mechanical jib motion is in a upper strip trajectory path top offset linear velocity, V
linear velocityfor mechanical jib motion is in current sub-trajectory path top offset linear velocity, a
maxfor the peak acceleration of mechanical arm support tail end movement, t is mechanical jib motion moving period on a upper strip trajectory path, and △ s is the length value that Current mechanical arm support tail end needs movement.
13. equipment as claimed in claim 12, is characterized in that,
Described control module, after terminating when the operation execution of mechanical arm support tail end on a upper strip trajectory path, gather the positional information at the place of Current mechanical arm support tail end, and according to described positional information and calculate Current mechanical arm support tail end can the length value of movement, obtain the mechanical jib sub-goal positional information that movement can arrive on current sub-trajectory path.
14. equipment as claimed in claim 9, is characterized in that,
Described control module, specifically for the current location information according to mechanical each joint of jib collected, utilize Jacobian matrix algorithm, obtain the matrix about each joint position information, and utilize Arithmetic of inverse kinematics, calculate the angle information of each joint of mechanical arm frame current needs movement during the sub-goal positional information that can arrive at Current mechanical arm support tail end.
15. equipment as claimed in claim 14, it is characterized in that, described equipment also comprises:
Interpolation module, for for each joint, performs following operation:
Utilize three smooth track function # (t)=a
0+ a
1t+a
2t
2+ a
3t
3, calculate the curve meeting the movement locus in this joint, wherein, a
0, a
1, a
2and a
3represent the coefficient of three smooth track functions, t represents the traveling time that mechanical jib is current, the path curves in this joint calculated is converted to the angle information that this joint needs movement.
16. as arbitrary in claim 9 ~ 15 as described in equipment, it is characterized in that, described equipment also comprises:
More new module, for on a strip trajectory path operation after execution terminates, before starting for current sub-trajectory path operations execution, judge whether the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is greater than setting numerical value;
When the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is greater than setting numerical value, then calculate the range difference between actual displacement distance and displacement of targets distance in a upper strip trajectory path, and according to the range difference calculated, mechanical arm support tail end in upper strip trajectory path centerline velocities and a linear acceleration, update stored in the length value in the current sub-trajectory path in track queue;
When the difference of mechanical arm support tail end actual displacement Distance geometry displacement of targets distance in a upper strip trajectory path is not more than setting numerical value, trigger control module.
The control system of 17. 1 kinds of multi-joint class machinery jibs, is characterized in that, comprising:
Collecting device, for the positional information in collection machinery jib each joint current;
Control appliance, for utilizing the method for the analog mechanical arm support tail end movement of setting, is divided into into N strip trajectory path by the trajectory path of mechanical arm support tail end movement, wherein, N be not less than 1 positive integer;
For each strip trajectory path of other except the Article 1 sub-trajectory path obtained, perform following operation respectively: according to the displacement of targets distance of mechanical jib motion on a upper strip trajectory path, actual displacement distance, displacement line speed and displacement line acceleration, calculate displacement line speed, the displacement line acceleration of mechanical jib motion in current sub-trajectory path, and Current mechanical arm support tail end can the length value of movement within the setting-up time cycle;
Utilize the computation of inverse-kinematics method of setting, calculate the angle information of the current needs in each joint of the mechanical arm frame movement when the sub-goal positional information that Current mechanical arm support tail end can arrive, the angle information in each joint obtained is converted into control instruction, triggers electro-hydraulic proportional valve;
Wherein, for Article 1 sub-trajectory path, perform following operation, specifically comprise:
Determine the first sub-goal positional information in Article 1 sub-trajectory path;
The current location information in each joint of collection machinery jib, and according to the setting initial plant degree of mechanical arm support tail end movement and linear acceleration, calculate the angle information of each joint current needs movement when mechanical arm support tail end arrives position corresponding to the first sub-goal positional information;
The angle information in each joint obtained is converted into control instruction, triggers electro-hydraulic proportional valve;
Electro-hydraulic proportional valve, for the control instruction of receiving control apparatus, and each joint motions of controller mechanical arm frame.
18. 1 kinds have multi-joint class machinery jib engineering machinery, it is characterized in that, comprise multi-joint class as claimed in claim 17 machinery jib control system.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310061674.8A CN103147577B (en) | 2013-02-27 | 2013-02-27 | Control method, equipment, system and construction machinery for multi-joint mechanical arm support |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310061674.8A CN103147577B (en) | 2013-02-27 | 2013-02-27 | Control method, equipment, system and construction machinery for multi-joint mechanical arm support |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103147577A CN103147577A (en) | 2013-06-12 |
CN103147577B true CN103147577B (en) | 2015-04-01 |
Family
ID=48545868
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310061674.8A Active CN103147577B (en) | 2013-02-27 | 2013-02-27 | Control method, equipment, system and construction machinery for multi-joint mechanical arm support |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103147577B (en) |
Families Citing this family (32)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105013735B (en) * | 2014-09-10 | 2017-03-01 | 山东鲁能智能技术有限公司 | The water flush control method of the transformer station water flushing device people based on laser ranging |
CN105013734B (en) * | 2014-09-10 | 2017-02-15 | 国家电网公司 | Washing control method for transformer substation washing robot based on ultrasonic distance measurement |
CN105988420B (en) * | 2015-02-06 | 2019-04-05 | 北京朗信智能科技有限公司 | A kind of manipulator twin shaft track interpolation |
CN105275926B (en) * | 2015-11-12 | 2017-09-15 | 北汽福田汽车股份有限公司 | A kind of arm support control method and system |
CN106346478A (en) * | 2016-11-09 | 2017-01-25 | 广州视源电子科技股份有限公司 | Control method and device for mechanical arm |
CN106625666B (en) * | 2016-12-16 | 2019-03-01 | 广州视源电子科技股份有限公司 | The control method and device of redundant mechanical arm |
DE102017208245A1 (en) * | 2017-05-16 | 2018-11-22 | Continental Automotive Gmbh | Method and device for the goal-based prediction of dynamic objects |
CN107390695B (en) * | 2017-08-10 | 2020-11-24 | 三一海洋重工有限公司 | Crane motion trajectory planning method and device |
CN107679277A (en) * | 2017-08-31 | 2018-02-09 | 合肥工业大学 | Double-crane system dynamic modeling algorithm and nonsingular interval parameter design method |
CN107882103B (en) * | 2017-10-26 | 2019-09-10 | 南京工业大学 | A kind of excavator 3 d pose is shown and Remote Automatic Control System |
CN107963197B (en) * | 2017-11-30 | 2020-07-14 | 三一汽车制造有限公司 | Control method and control system for anchoring parking support arm |
CN108116529B (en) * | 2017-12-19 | 2020-02-07 | 奇瑞汽车股份有限公司 | Analysis method of movement mechanism |
CN109025307B (en) * | 2018-08-20 | 2020-09-15 | 长沙湾流智能科技有限公司 | Arm support action control method, arm support action control system and engineering machinery |
CN109109014A (en) * | 2018-08-21 | 2019-01-01 | 北京芯合科技有限公司 | A kind of control system and method for variable-arm long industrial robot |
CN109138032B (en) * | 2018-09-04 | 2020-11-10 | 鲍尤智 | Environment-friendly dredging workboat based on swing power |
CN109375584B (en) * | 2018-09-28 | 2020-08-07 | 湖南希法工程机械有限公司 | Arm support joint control method and system, engineering machinery and machine readable storage medium |
CN109469328A (en) * | 2018-09-28 | 2019-03-15 | 湖南希法工程机械有限公司 | Arm support tail end position control method and system and engineering machinery comprising the system |
CN109375585A (en) * | 2018-09-28 | 2019-02-22 | 湖南希法工程机械有限公司 | Arm support tail end position control method and system and engineering machinery comprising the system |
CN109356614B (en) * | 2018-09-29 | 2020-05-15 | 湖南希法工程机械有限公司 | Tunnel injection machine control equipment and method and tunnel injection machine |
KR102221089B1 (en) * | 2018-12-05 | 2021-02-26 | (주)미래컴퍼니 | Method and system for remotely controlling surgical slave arm |
CN109826271B (en) * | 2019-01-16 | 2021-02-12 | 大连理工大学 | Intelligent excavator data display platform based on ROS |
CN109782767B (en) | 2019-01-25 | 2022-06-07 | 北京百度网讯科技有限公司 | Method and apparatus for outputting information |
CN109972688B (en) * | 2019-04-10 | 2021-06-18 | 北京拓疆者智能科技有限公司 | Excavation control method and device and excavator controller |
CN110125942B (en) * | 2019-06-21 | 2022-06-10 | 上海工程技术大学 | Plane trajectory tracking method for mobile snakelike mechanical arm |
CN111753374B (en) * | 2020-06-26 | 2023-08-25 | 北京百度网讯科技有限公司 | Speed determination method, device, equipment and computer storage medium |
CN112870595B (en) * | 2020-12-30 | 2022-07-08 | 国电南瑞科技股份有限公司 | Control method, device and system for elevating fire-fighting robot |
CN112891137A (en) * | 2021-01-21 | 2021-06-04 | 深圳华鹊景医疗科技有限公司 | Upper limb rehabilitation robot system, robot control method and device |
CN113021408B (en) * | 2021-03-23 | 2022-08-05 | 中联重科股份有限公司 | Method and device for compensating deflection of arm support and method and device for controlling arm support |
CN113377007A (en) * | 2021-06-17 | 2021-09-10 | 同济大学 | Fuzzy neural network-based concrete distributing robot control method |
CN114193452B (en) * | 2021-12-29 | 2024-04-26 | 佛山智异科技开发有限公司 | Multi-joint cloth arm support tail end track control method, system and storage medium |
CN117323571A (en) * | 2023-09-18 | 2024-01-02 | 深圳半岛医疗集团股份有限公司 | Method, device, equipment and medium for controlling movable part of therapeutic apparatus |
CN117484508B (en) * | 2023-12-11 | 2024-06-18 | 嘉兴布鲁艾诺机器人有限公司 | Intelligent control system and method for multi-joint robot for loading and unloading |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7128518B2 (en) * | 2002-10-21 | 2006-10-31 | Yanmar Co., Ltd. | Working vehicle |
CN101525944A (en) * | 2009-03-31 | 2009-09-09 | 北京易斯路电子有限公司 | Concrete pump truck intelligent arm support control system and control method thereof |
CN101824916A (en) * | 2010-03-26 | 2010-09-08 | 长沙中联重工科技发展股份有限公司 | Control system, method and electrical control system of composite motion of cantilever crane of concrete distributing equipment |
CN102538851A (en) * | 2011-12-15 | 2012-07-04 | 长沙中联消防机械有限公司 | Equipment, method and system for recording movement trace of boom and engineering machinery equipment |
-
2013
- 2013-02-27 CN CN201310061674.8A patent/CN103147577B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7128518B2 (en) * | 2002-10-21 | 2006-10-31 | Yanmar Co., Ltd. | Working vehicle |
CN101525944A (en) * | 2009-03-31 | 2009-09-09 | 北京易斯路电子有限公司 | Concrete pump truck intelligent arm support control system and control method thereof |
CN101824916A (en) * | 2010-03-26 | 2010-09-08 | 长沙中联重工科技发展股份有限公司 | Control system, method and electrical control system of composite motion of cantilever crane of concrete distributing equipment |
CN102538851A (en) * | 2011-12-15 | 2012-07-04 | 长沙中联消防机械有限公司 | Equipment, method and system for recording movement trace of boom and engineering machinery equipment |
Non-Patent Citations (2)
Title |
---|
冗余自由度机械臂的逆运动学控制、建模与仿真;梁聪慧;《建设机械技术与管理》;20120920(第9期);全文 * |
混凝土泵车智能臂架运动仿真与控制研究;唐修俊;《中国工程机械学报》;20080315(第1期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN103147577A (en) | 2013-06-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103147577B (en) | Control method, equipment, system and construction machinery for multi-joint mechanical arm support | |
CN105073349B (en) | Robot system control method and robot system | |
CN102189552B (en) | Robot system | |
US10166673B2 (en) | Portable apparatus for controlling robot and method thereof | |
CN103987485B (en) | Bead former and bead manufacturing process | |
CN105415387B (en) | Set the robot system of the action monitor area of robot | |
CN103176409B (en) | Method for fast and accurately realizing concrete pump truck cantilever crane movement locus | |
CN103148057B (en) | A kind of method, apparatus and system that multi-joint hydraulic press mechanical arm is controlled | |
CN106181964A (en) | Robot program production system | |
CN113246122A (en) | Digital twin practical training method and system of industrial robot | |
CN111152226B (en) | Robot working track planning method and system | |
KR101876845B1 (en) | Robot control apparatus | |
Činkelj et al. | Closed-loop control of hydraulic telescopic handler | |
CN105082134A (en) | Strangeness processing method for six-freedom-degree series robot based on multiple criteria | |
CN102354120B (en) | Simulation experimental apparatus for intelligent arm support system of concrete pump truck and method thereof | |
CN106272429A (en) | Additional shaft motion planning method in a kind of planer-type lifting machine people working cell | |
CN103429399A (en) | System for commanding a robot | |
JP6514273B2 (en) | Robot system that displays speed | |
CN107553484B (en) | Robot operation motion path planning method and system | |
WO2022139939A1 (en) | Robot planning | |
JP2014131825A (en) | Robot control device | |
WO2012153958A2 (en) | Method and apparatus for controlling the linear movement of an aerial work platform | |
CN104564913A (en) | Hydraulic control system for parallel six-degree-of-freedom turntable | |
CN111260772A (en) | Equipment anti-collision protection method, system and manufacturing system | |
CN114483105A (en) | Wet spraying construction method and wet spraying construction system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
EE01 | Entry into force of recordation of patent licensing contract | ||
EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20130612 Assignee: HUNAN ZOOMLION INTELLIGENT TECHNOLOGY Co.,Ltd. Assignor: ZOOMLION HEAVY INDUSTRY SCIENCE&TECHNOLOGY Co.,Ltd. Contract record no.: X2020430000001 Denomination of invention: Control method, equipment, system and construction machinery for multi-joint mechanical arm support Granted publication date: 20150401 License type: Common License Record date: 20200116 |