CN102152307A - Inclination-angle-constraint-based kinematic calibration method for Stewart parallel robot - Google Patents
Inclination-angle-constraint-based kinematic calibration method for Stewart parallel robot Download PDFInfo
- Publication number
- CN102152307A CN102152307A CN 201110024569 CN201110024569A CN102152307A CN 102152307 A CN102152307 A CN 102152307A CN 201110024569 CN201110024569 CN 201110024569 CN 201110024569 A CN201110024569 A CN 201110024569A CN 102152307 A CN102152307 A CN 102152307A
- Authority
- CN
- China
- Prior art keywords
- alpha
- prime
- parallel robot
- constraint
- bar
- 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.)
- Granted
Links
Images
Landscapes
- Manipulator (AREA)
- Numerical Control (AREA)
- Feedback Control In General (AREA)
Abstract
The invention discloses an inclination-angle-constraint-based kinematic calibration method for a Stewart parallel robot. The method comprises the following steps of: firstly, theoretically establishing a novel kinematic constraint, which is an inclination angle constant constraint, namely keeping two inclination angles of a motion platform of the Stewart parallel robot relative to a horizontal plane constant group by group; secondly, using a servo regulating way to physically realize the established kinematic constraint in a high-precision way; thirdly, establishing a calibration model on the basis of a principle of least square according to the kinematic constraint; and finally, identifying a model parameter by solving a nonlinear least square optimizing problem and compensating for the model parameter in a robot control software. By making full use of a characteristic that a repeating precision of a measuring instrument is superior to a position measuring precision of the measuring instrument, the method has the advantages of good calibration effect, simple measurement, high automatism in the calibrating process and the like.
Description
Technical field:
The invention belongs to automatic field, relate to a kind of Stewart Kinematics of Parallel Robot scaling method, particularly a kind of scaling method based on the inclination angle constraint.
Background technology:
Advantage such as the Stewart parallel robot has the structural rigidity height, bearing capacity is strong, dynamic property good and accumulated error is little has obtained extensive use in fields such as industrial production, scientific research and services for life.Kinematic accuracy is to weigh an important indicator of parallel robot service behaviour, and it is subjected to robot parts manufacturing and all multifactor combined influences such as alignment error, departure, joint and hinge gap, thermal deformation and vibration.Wherein, the manufacturing of parts and alignment error are to influence the move main factor of terminal pose (position and attitude) precision of parallel robot, can carry out identification and compensation by the method that kinematics is demarcated.
The basic principle that kinematics is demarcated is: according to the difference instrument error functional between actual detected information and the ideal model output, utilize the actual geometric parameter of certain mathematical method identification parallel robot, and by revising the purpose that the model nominal value of controlling in the software reaches accuracy compensation.Complete kinematics calibration process comprises measurement, modeling, identification and four steps of compensation usually.Characteristics according to measuring process can be divided into existing scaling method outer demarcation method and self-calibrating method two big classes.Outer demarcation method need be used all or part of posture information of the direct or indirect measurement parallel robot motion platform of external observation equipment, based on the structure of the residual error between measured value and model calculated value object function, set up peg model then by minimizing object function.This scaling method has advantages such as principle is simple, feasibility strong, demarcation is effective.Yet, obtaining very difficulty of high-precision space rigid body posture information, required measurement device costs dearly and measurement process complexity usually.Self-calibrating method has avoided detecting the move difficulty of terminal posture information of parallel robot, usually based on the robot interior movable information or utilize mechanical locking to apply kinematic constraint and set up peg model.With respect to traditional outer demarcation method, these class methods have that measuring process is simple, good economy performance and be convenient to realize advantage such as precision online compensation.Yet, redundant sensor is installed on parallel robot passive joint hinge is obtained internal motion information not a duck soup, need consider in advance in the design phase of robot, can't be applicable to the robot device who has built moulding, and still need and consider the influence of the installation of redundant sensor the passive joint mechanical strength.Utilize mechanical locking to apply kinematic constraint and will reduce parallel manipulator robot end freedom of motion, require robot that the ability that the joint has passive operation and provides amount of exercise to measure is provided, thereby can't be applicable to numerous parallel robots that drive in " motor+ball-screw " mode.Simultaneously, use mechanical locking will reduce the originally narrow and small working space of parallel robot greatly, the selection limited space that makes calibration measurements position shape is unfavorable for fully encouraging the architectural characteristic of robot.In addition, rely on mechanical locking to realize kinematic constraint in calibration process, produce leverage easily between member and cause deformation, the lighter influences the accuracy of calibration result, also may destroy the passive joint hinge of " fragility " relatively when serious.
Summary of the invention:
The application's invention has proposed a kind of Stewart Kinematics of Parallel Robot scaling method that utilizes servo regulative mode to realize the constant constraint in inclination angle on the basis of the relatively more existing kinematics scaling method pluses and minuses of analysis-by-synthesis.It has avoided the move difficulty of terminal posture information of accurate measurement parallel robot, overcome and relied on mechanical locking to realize many defectives of kinematic constraint, the characteristics that general measure instrument repeatable accuracy is better than positional precision have been made full use of, the demarcation effect does not rely on the positional precision of measuring instrument, demarcates and measuring process automaticity height.
The present invention is achieved by the following technical solutions: a kind of Stewart Kinematics of Parallel Robot scaling method based on the inclination angle constraint may further comprise the steps:
Step (1) tectonic movement constraint: can come tectonic movement to retrain from parallel robot internal motion variable (comprise passive joint corner that fixed platform and motion platform are installed etc.) and terminal movement locus two aspects.The present invention is based on the latter considers, a kind of novel kinematic constraint has been proposed---the constant constraint in inclination angle, its basic thought can be expressed as: choose many groups and measure position shape in calibration process, measure shape place, position at each that belongs to same group, two inclination angles of horizontal plane are constant relative to the earth to keep motion platform; And, make that corresponding inclination angle value is inequality not between on the same group the measurement position shape.Make α
X 'And α
Y 'Two inclination angles of the relative horizontal plane of expression parallel robot motion platform, then the mathematical description of the constant constraint in inclination angle is:
In the formula:
M---measure position shape packet count, m ∈ N, the arbitrary value of the desirable m that satisfies condition 〉=2;
N---the position shape number in every group, n ∈ N, the arbitrary value of the desirable n that satisfies condition 〉=2 and mn 〉=16;
Step (2) is utilized servo regulative mode physics realization kinematic constraint: basic principle can be expressed as: use the checkout equipment of externally measured instrument as parallel robot output information, make up the metrical information feedback channel, design servo adjustment control, form measured closed loop servo regulating system.According to the deviation between measured and the set-point, produce the initiatively regulated quantity in joint of parallel robot by servo adjustment control, import the pose output that correspondingly changes motion platform by the continuous active joint of adjusting, make it to satisfy the kinematic constraint form of being constructed.
Specifically, the method that realizes kinematic constraint by servo regulative mode is described with the constant example that is constrained in inclination angle.A double-shaft tilt angle instrument (mounting means as shown in Figure 1) is installed on the parallel robot motion platform, is made up inclination angle closed-loop regulating system as shown in Figure 2.Wherein, Guan Jian tilt adjustment process can be divided into three phases:
At first, data acquisition and pretreatment stage.Inclinator sends to the parallel robot upper control computer by serial communication (perhaps other communication modes) with measurement data, carries out the data preliminary treatment by host computer then.The mode of taking is: remove the maximum and the minimum of a value of many group measurement data, ask for the measurement result of average as this then.
Secondly, the long update stage of drive rod command bar.Whether host computer procedure at first judges the deviation of measurement of dip angle value and set-point less than the given limits of error, if satisfy, then the tilt adjustment process finishes.Otherwise, the set-point of robot pose vector when calculating next step adjusting, and further calculate bar long vector set-point against separating model by kinematics.Host computer sends to slave computer with the long set-point of bar, begins the long measured value of bar of waiting for that reception is uploaded by slave computer then.If both deviations are returned collection, processing and the judgement of carrying out inclination data less than the long regulating error limit of given bar, and begin next step long renewal of command bar; Otherwise, continue to send the current long set-point of bar, limit less than the long regulating error of the bar of setting until the deviation of long measured value of bar and set-point.
At last, the long adjusting stage of bar.Slave computer constitutes a position closed loop control loop by servomotor controller, motor, encoder, data acquisition channel.Behind the long set-point of bar that receives the host computer transmission, slave computer compares set-point and the long measured value of bar that is obtained by the motor encoder feedback, produce the long deviation of bar, regulate strategy according to PID and produce speed command, flexible by servo controller control driven by motor ball-screw, make bar reach set-point.
Step (3) is set up peg model.To should keep constant amount as the kinematic constraint variable in the kinematic constraint of being constructed, foundation can reflect the residual vector of measuring kinematic constraint variable difference between the shape of position on the same group.Quadratic sum minimum with the control residual vector is a purpose structure object function, sets up the peg model that satisfies the principle of least square, and kinematics demarcation problem is converted into the non-linear least square optimization problem.
Step (4) identification model parameter and compensation.By finding the solution the parameter identification of non-linear least square problem realization peg model, realize the kinematic accuracy compensation of robot by design (name) value of revising kinematics model parameter in the parallel robot control software.
The present invention has tangible creativeness and beneficial effect.The constant constraint in the parallel robot of Stewart described in invention inclination angle is a kind of novel kinematic constraint, can be used as to set up rationally the theoretical foundation of peg model efficiently.Described method high-precision kinematic constraint of being constructed of having realized on the basis of the repeatable accuracy that makes full use of measuring instrument of realizing kinematic constraint based on servo regulative mode, avoided the accurately dependence of measurement of parallel robot posture information, thoroughly restrained many drawbacks that clothes use mechanical locking to bring, solved the key issue of restriction based on kinematic constraint scaling method practicality.The described method of setting up the method for peg model and carrying out identification of Model Parameters and compensation can effectively obtain the parallel robot mechanism parameter error, significantly improves the pose accuracy of robot.
Description of drawings:
The mounting means signal of Fig. 1 double-shaft tilt angle instrument;
The theory diagram of Fig. 2 inclination angle servo adjustment system;
Fig. 3 demarcates the coordinate system signal;
Inclinator X-axis measurement data contrast before and after Fig. 4 demarcates;
Inclinator Y-axis measurement data contrast before and after Fig. 5 demarcates.
The specific embodiment:
Below in conjunction with accompanying drawing the present invention is done and to describe in further detail:
Referring to Fig. 1-5, a kind of Stewart Kinematics of Parallel Robot scaling method based on the inclination angle constraint may further comprise the steps:
At first, clearly demarcate the mode of setting up of coordinate system, as shown in Figure 3, wherein:
Kinetic coordinate system M
1-x
1' y
1' z
1'---with the joint hinge M on the motion platform
1As coordinate origin; x
1' beam warp is crossed M
2Point, and edge
Direction; x
1' y
1' plane is by M
1, M
2And M
6Determine, set up kinetic coordinate system for 3 according to the right-handed system principle;
Central motion coordinate system O
m-x
2' y
2' z
2'---will be M
1-x
1' y
1' z
1' around self z
1' axle 5 π/6 that turn clockwise move to the nominal geometric center O of motion platform then
mObtaining is O
m-x
2' y
2' z
2';
Fixed coordinate system B
1-x
1y
1z
1---with the joint hinge B on the pedestal
1As coordinate origin, z
1Axle is defined as gravity in the other direction, by z
1Axle and B
2Point is determined x
1z
1Fixed coordinate system is set up according to the right-handed system principle in the plane;
Center fixation coordinate system O
b-x
2y
2z
2---will be B
1-x
1y
1z
1Around self z
1Axle 5 π/6 that turn clockwise move to the nominal geometric center O of pedestal then
bObtaining is O
b-x
2y
2z
2
Inclinator coordinate system O
I-x
I' y
I' z
I'---coordinate origin is an inclinator diaxon intersection point, x
I' axle is that of inclinator measures axle, x
I' y
IThe plane of determining is intersected on ' plane for the inclinator diaxon.The installation site of inclinator and towards being is arbitrarily regulated for the ease of the pose of realizing motion platform, can make inclinator coordinate origin O
INominal geometric center O with motion platform
mOverlap x
I' axle is approximately perpendicular to straight line M
1M
6, x
I' y
I' plane approximation is parallel to plane M
1M
2M
6
The position coordinates of joint hinge on the Stewart parallel robot motion platform in the central motion coordinate system, the joint hinge on the pedestal position coordinates and the long deviation of fixed bar of each drive rod of robot in the center fixation coordinate system constituted and needed the mechanism parameter of identification vector, is designated as q
α
Secondly, introduce the servo control method in inclination angle in detail:
The Step1 inclination data is gathered and preliminary treatment: gathering the measurement of dip angle data is the prerequisites of carrying out the servo adjusting in inclination angle, also is link the most consuming time in the whole calibrating procedure.Because inclinator measuring principle difference, its data acquiring frequency is also inequality.Under the prerequisite that guarantees the inclinator repeatable accuracy, should improve data acquiring frequency as much as possible.Simultaneously,,, after collecting 3 groups of measurement data, host computer promptly compares, with the median of gained inclination deviation result as this measurement with inclination angle setting value in the starting stage of tilt adjustment in order to accelerate tilt adjustment speed; After entering the inclination angle accurate adjustment stage, in order to guarantee the accuracy of measurement result, by host computer gather after 7 groups of data again with set-point relatively, reject maximum and minimum of a value in the inclination deviation, carry out arithmetic average then, as the result of this measurement.
Step2 parallel robot drive rod command bar is long to be upgraded: order
With
Deviation between actual output of expression inclinator and the set-point is at first judged
Whether this condition satisfies, wherein ε
αFor the tilt adjustment limits of error of setting, identical with the repeatable accuracy of inclinator.If condition satisfies, finish the tilt adjustment process, and the current long measured value of bar of record parallel robot; Otherwise, utilize the long measured value of bar to calculate the current pose vector p of motion platform by direct kinematics
Now=[p
xp
yp
zφ θ ψ]
T, p wherein
x, p
y, p
zBe the position coordinates of central motion coordinate origin under the center fixation coordinate system, φ, θ, ψ are respectively toppling direction angle, flip angle and the anglec of rotation of motion platform.According to the mounting means of inclinator as can be known, the model calculated value of inclinator diaxon output
With
Be respectively:
In the formula:
S---SIN function sin writes a Chinese character in simplified form, below identical;
C---cosine function cos writes a Chinese character in simplified form, below identical;
Thereby can get:
With inclination deviation
Respectively with
Stack back substitution following formula, the set-point of φ and θ in the time of can obtaining next step adjusting:
Make remaining pose component remain unchanged, the set-point of motion platform pose vector was when then next step was regulated:
p
Next=[p
xp
yp
zφ
Nextθ
Nextψ]
TFormula (five);
Further separate model, can calculate the set-point l of rod long vector according to Kinematics of Parallel Robot is contrary
Next
When host computer with the long set-point l of bar
NextAfter sending to slave computer, just begin the long measured value of bar of waiting for that reception is uploaded by slave computer.If the deviation that host computer procedure is judged both during less than 1 μ m, is returned collection, processing and the judgement of carrying out inclination data, and is begun next step long renewal of command bar; Otherwise, continue to send l
NextDeviation up to long measured value of bar and set-point satisfies the long regulating error limit of the bar of setting.Measuring average of shape place, position at one in the calibration process needs 4~5 times the long renewal of command bar can finish whole tilt adjustment process.
The Step3 bar is long to be regulated: in the long adjustment process of bar, slave computer constitutes a position closed loop control loop by servomotor controller, motor, encoder, data acquisition channel.Behind the long set-point of bar that receives the host computer transmission, slave computer compares set-point and the long measured value of bar that is obtained by the motor encoder feedback, produce the long deviation of bar, regulate strategy according to PID and produce speed command, flexible by servo controller control driven by motor ball-screw, make bar reach set-point.By selecting the precision ball screw of high-precision motor encoder and fine pitch for use, can effectively guarantee the long precision of regulating of bar.
Once more, the concrete method of setting up peg model of introducing:
According to the constant constraint in the described inclination angle of formula (), choose the inclination angle of the relative horizontal plane of central motion coordinate system
With
As the kinematic constraint variable, they can be calculated by direct kinematics by the bar long vector of actual measurement; Set up the residual vector of kinematic constraint variable according to following formula:
In the formula:
i——i=1,2,...,m;
j——j=1,2,...,n;
According to the principle of least square, the structure object function:
Kinematics demarcation problem is converted into the non-linear least square optimization problem shown in the following formula:
In the formula:
q
α---Stewart parallel robot mechanism parameter vector to be identified;
Formula (eight) is the peg model of setting up based on the constant constraint in inclination angle.
At last, the identification of peg model parameter and compensation:
Object function shown in the formula (seven) is the quadratic function about residual vector, can effectively find the solution by Levenberg-Marquardt (L-M) algorithm for this type of non-linear least square optimization problem.The L-M algorithm is the correction on Gauss-Newton method basis, and what its direction of search was smooth changes between Newton method and these two kinds of extreme cases of steepest descent method, has good numerical stability.After relatively obtaining parameter error with the model parameter nominal value, in parallel robot control software, revise, can effectively compensate the pose accuracy of robot.
Fig. 4 and Fig. 5 have showed the inclinator diaxon actual measured results that is installed in before and after the demarcation on the Stewart parallel robot motion platform respectively.Utilize the mechanism parameter nominal value of parallel robot and identifier as the control model parameter before and after demarcating respectively, measure the actual inclination angle of motion platforms at a plurality of constant shapes places of inclination angle nominal value.As can be seen, because the mechanism parameter of parallel robot exists than mistake before demarcating, make that the pose position error of motion platform is bigger, thereby cause the fluctuating of fluctuating of the actual measured value of inclinator diaxon in a big way, the uniformity at inclination angle is relatively poor; And through after demarcating, the mechanism parameter error of parallel robot has obtained effective compensation, and the pose positioning accuracy of motion platform significantly improves, and makes the fluctuation range of inclinator measured value obviously reduce, and reaches unanimity.
Above content is to further describing that the present invention did in conjunction with concrete preferred implementation; can not assert that the specific embodiment of the present invention only limits to this; for the general technical staff of the technical field of the invention; without departing from the inventive concept of the premise; can also make some simple deduction or replace, all should be considered as belonging to the present invention and determine scope of patent protection by claims of being submitted to.
Claims (4)
1. the Stewart Kinematics of Parallel Robot scaling method based on the inclination angle constraint is characterized in that, may further comprise the steps:
(1) tectonic movement constraint: choose many groups and measure position shapes in calibration process, measure shape place, position at each that belongs to same group, two inclination angles of horizontal plane are constant relative to the earth to keep motion platform; And, make that corresponding inclination angle value is inequality not between on the same group the measurement position shape; Make α
X 'And α
Y 'Two inclination angles of the relative horizontal plane of expression parallel robot motion platform, then the mathematical description of the constant constraint in inclination angle is:
In the formula:
M---measure position shape packet count, m ∈ N, the arbitrary value of the desirable m that satisfies condition 〉=2;
N---the position shape number in every group, n ∈ N, the arbitrary value of the desirable n that satisfies condition 〉=2 and mn 〉=16;
(2) utilize servo regulative mode physics realization kinematic constraint: use the checkout equipment of externally measured instrument, make up the metrical information feedback channel, design servo adjustment control, form measured closed loop servo regulating system as parallel robot output information.According to the deviation between measured and the set-point, produce the initiatively regulated quantity in joint of parallel robot by servo adjustment control, import the pose output that correspondingly changes motion platform by the continuous active joint of adjusting, make it to satisfy the kinematic constraint form of being constructed; Satisfy measurement position shape place of kinematic constraint at each, respectively drive sensor measurement joint variable initiatively on the joint by being installed in parallel robot;
(3) set up peg model: will should keep constant amount as the kinematic constraint variable in the kinematic constraint of being constructed, foundation can reflect the residual vector of measuring kinematic constraint variable difference between the shape of position on the same group; Quadratic sum minimum with the control residual vector is a purpose structure object function, sets up peg model based on the principle of least square, and kinematics demarcation problem is converted into the non-linear least square optimization problem;
(4) identification model parameter and compensation:, finally realize the kinematic accuracy compensation of robot by the design load of revising kinematics model parameter in the parallel robot control software by finding the solution the parameter identification of non-linear least square problem realization peg model.
2. a kind of according to claim 1 Stewart Kinematics of Parallel Robot scaling method based on the inclination angle constraint is characterized in that described step (2) may further comprise the steps:
A double-shaft tilt angle instrument is installed on Stewart parallel robot motion platform, is made up the inclination angle closed-loop regulating system;
Set up the relevant coordinate system of demarcating at first, in the following manner:
Kinetic coordinate system M
1-x
1' y
1' z
1'---with the joint hinge M on the motion platform
1As coordinate origin; x
1' beam warp is crossed M
2Point, and along M
1 Direction; x
1' y
1' plane is by M
1, M
2And M
6Determine, set up kinetic coordinate system for 3 according to the right-handed system principle;
Central motion coordinate system O
m-x
2' y
2' z
2'---will be M
1-x
1' y
1' z
1' around self z
1' axle 5 π/6 that turn clockwise move to the nominal geometric center O of motion platform then
mObtaining is O
m-x
2' y
2' z
2';
Fixed coordinate system B
1-x
1y
1z
1---with the joint hinge B on the pedestal
1As coordinate origin, z
1Axle is defined as gravity in the other direction, by z
1Axle and B
2Point is determined x
1z
1Fixed coordinate system is set up according to the right-handed system principle in the plane;
Center fixation coordinate system O
b-x
2y
2z
2---will be B
1-x
1y
1z
1Around self z
1Axle 5 π/6 that turn clockwise move to the nominal geometric center O of pedestal then
bObtaining is O
b-x
2y
2z
2
Inclinator coordinate system O
I-x
I' y
I' z
I'---coordinate origin is an inclinator diaxon intersection point, x
I' axle is that of inclinator measures axle, x
I' y
IThe plane of determining is intersected on ' plane for the inclinator diaxon; Inclinator on motion platform the installation site and towards being arbitrarily, regulate for the ease of the pose of realizing motion platform, can make inclinator coordinate origin O
INominal geometric center O with motion platform
mOverlap x
I' axle is approximately perpendicular to straight line M
1M
6, x
I' y
I' plane approximation is parallel to plane M
1M
2M
6
The position coordinates of joint hinge on the Stewart parallel robot motion platform in the central motion coordinate system, the joint hinge on the pedestal position coordinates and the long deviation of fixed bar of each drive rod of robot in the center fixation coordinate system constituted and needed the mechanism parameter of identification vector, is designated as q
α
Secondly, crucial tilt adjustment method is divided into following three steps:
The Step1 inclination data is gathered and preliminary treatment: because the measuring principle of dissimilar inclinator foundations is different, its data acquiring frequency is also inequality; Under the prerequisite that guarantees the inclinator repeatable accuracy, should improve data acquiring frequency as far as possible; Simultaneously, in order to accelerate tilt adjustment speed, in the starting stage of tilt adjustment, after collecting 3 groups of measurement data, the parallel robot upper control computer promptly compares, the median of 3 groups of inclination deviations of gained result as this measurement with inclination angle setting value; And in the inclination angle accurate adjustment stage, in order to guarantee the accuracy of measurement result, by host computer gather after 7 groups of data again with set-point relatively, maximum and the minimum of a value rejected in the inclination deviation are carried out arithmetic average then, as the result of this measurement;
Step2 parallel robot drive rod command bar is long to be upgraded: order
With
Deviation between actual output of expression inclinator and the set-point is at first judged
Whether this condition satisfies, wherein ε
αFor the tilt adjustment limits of error of setting, identical with the repeatable accuracy of inclinator; If condition satisfies, finish the tilt adjustment process, and the current long measured value of bar of record parallel robot; Otherwise, utilize the long measured value of bar to calculate the current pose vector p of motion platform by direct kinematics
Now=[p
xp
yp
zφ θ ψ]
T, p wherein
x, p
y, p
zBe the position coordinates of central motion coordinate origin under the center fixation coordinate system, φ, θ, ψ are respectively toppling direction angle, flip angle and the anglec of rotation of motion platform.According to the mounting means of inclinator as can be known, the model calculated value of inclinator diaxon output
With
For:
In the formula:
S---SIN function sin writes a Chinese character in simplified form, below identical;
C---cosine function cos writes a Chinese character in simplified form, below identical;
Thereby can get:
With inclination deviation
Respectively with
Stack back substitution following formula, the set-point of φ and θ in the time of can obtaining next step adjusting:
Make remaining pose component remain unchanged, the motion platform pose with the set-point of amount was when then next step was regulated:
p
Next=[p
xp
yp
zφ
Nextθ
Nextψ]
TFormula (five);
Further separate model, can calculate the set-point l of rod long vector according to Kinematics of Parallel Robot is contrary
Next
When host computer with the long set-point l of bar
NextAfter sending to the next control computer, just begin the long measured value of bar of waiting for that reception is uploaded by slave computer; If the deviation that host computer procedure is judged both during less than 1 μ m, is returned collection, processing and the judgement of carrying out inclination data, and is begun next step long renewal of command bar; Otherwise, continue to send l
NextDeviation up to long measured value of bar and set-point satisfies the long regulating error limit of the bar of setting;
The Step3 bar is long to be regulated: in the long adjustment process of bar, slave computer constitutes a position closed loop control loop by servomotor controller, motor, encoder and data acquisition channel; Behind the long set-point of bar that receives the host computer transmission, slave computer compares set-point and the long measured value of bar that is obtained by the motor encoder feedback, produce the long deviation of bar, regulate strategy according to PID and produce speed command, flexible by servo controller control driven by motor ball-screw, make bar reach set-point.
3. a kind of according to claim 1 Stewart Kinematics of Parallel Robot scaling method based on the inclination angle constraint is characterized in that described step (3) comprising:
According to the constant constraint in the described inclination angle of formula (), choose the inclination angle of the relative horizontal plane of central motion coordinate system
With
As the kinematic constraint variable, they can be calculated by direct kinematics by the bar long vector of actual measurement; Set up the residual vector of kinematic constraint variable according to following formula:
In the formula:
i——i=1,2,...,m;
j——j=1,2,...,n;
According to the principle of least square, the structure object function:
Kinematics demarcation problem is converted into the non-linear least square optimization problem shown in the following formula:
In the formula:
q
α---Stewart parallel robot mechanism parameter vector to be identified;
Formula (eight) is the peg model of setting up based on the constant constraint in inclination angle.
4. a kind of according to claim 1 Stewart Kinematics of Parallel Robot scaling method based on the inclination angle constraint is characterized in that described step (4) comprising:
Object function shown in the formula (seven) is the quadratic function about residual vector, can effectively find the solution by classical Levenberg-Marquardt (L-M) algorithm for this type of non-linear least square optimization problem; The L-M algorithm is the correction on Gauss-Newton method basis, and what its direction of search was smooth changes between Newton method and these two kinds of extreme cases of steepest descent method, has good numerical stability; Obtain the identifier of mechanism parameter by the solving-optimizing problem after, relatively can obtain the mechanism parameter error, revise the motion model parameters in the parallel robot control software then, effectively compensate the pose accuracy of robot with the mechanism parameter nominal value.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110024569A CN102152307B (en) | 2011-01-24 | 2011-01-24 | Inclination-angle-constraint-based kinematic calibration method for Stewart parallel robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110024569A CN102152307B (en) | 2011-01-24 | 2011-01-24 | Inclination-angle-constraint-based kinematic calibration method for Stewart parallel robot |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102152307A true CN102152307A (en) | 2011-08-17 |
CN102152307B CN102152307B (en) | 2012-09-05 |
Family
ID=44434138
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110024569A Expired - Fee Related CN102152307B (en) | 2011-01-24 | 2011-01-24 | Inclination-angle-constraint-based kinematic calibration method for Stewart parallel robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102152307B (en) |
Cited By (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102841556A (en) * | 2012-09-26 | 2012-12-26 | 苏州工业园区职业技术学院 | Two-axis medium-low full-automatic dispensing robot servo controller |
CN102968665A (en) * | 2012-12-05 | 2013-03-13 | 苏州大学 | Forward kinematics solving method of parallel robot |
CN103389646A (en) * | 2013-07-05 | 2013-11-13 | 西安交通大学 | Closed-loop identification method for servo feed system |
CN104236794A (en) * | 2014-10-13 | 2014-12-24 | 大连交通大学 | Six-dimensional force transducer calibration device |
CN104423318A (en) * | 2013-09-10 | 2015-03-18 | 西门子公司 | Operating machine with redundant axes and resolution of the redundancy in real time |
CN104634293A (en) * | 2015-01-29 | 2015-05-20 | 淮阴工学院 | Computing method for calibrating hinge coordinates of parallel machine tool |
CN104827480A (en) * | 2014-02-11 | 2015-08-12 | 泰科电子(上海)有限公司 | Automatic calibration method of robot system |
CN104933232A (en) * | 2015-06-03 | 2015-09-23 | 西安交通大学 | Angle compensation kinematics solving method of one kind of rod end floating type six-freedom-degree parallel robots |
CN104932536A (en) * | 2015-05-25 | 2015-09-23 | 盐城工学院 | Method for judging whether rod length conditions of Stewart parallel mechanism meet actual configuration |
CN105301967A (en) * | 2015-11-27 | 2016-02-03 | 西安交通大学 | Smooth control method of starting and shutdown processes of Stewart platform |
CN105425582A (en) * | 2015-11-04 | 2016-03-23 | 北京航空航天大学 | Kalman filtering based online calibrating method of Stewart mechanism |
CN105999594A (en) * | 2016-06-28 | 2016-10-12 | 安徽扫宝智能科技有限公司 | Intelligent fire fighting robot |
CN106372443A (en) * | 2016-10-09 | 2017-02-01 | 江苏安全技术职业学院 | Kinematic forward solution method of Stewart parallel mechanism |
CN107703747A (en) * | 2017-10-09 | 2018-02-16 | 东南大学 | A kind of heavy-load robot kinetic parameter self-calibrating method towards agitating friction weldering application |
CN109291051A (en) * | 2018-03-30 | 2019-02-01 | 上海大学 | A kind of series-parallel robot terminal angle closed loop control method angle sensor based |
CN109895101A (en) * | 2019-04-09 | 2019-06-18 | 大连理工大学 | A kind of articulated manipulator inverse kinematics numerical value unique solution acquiring method |
CN109960284A (en) * | 2017-12-22 | 2019-07-02 | 广州中国科学院先进技术研究所 | A kind of high-accuracy parallel connection platform and its controller |
WO2020024600A1 (en) * | 2018-07-30 | 2020-02-06 | 成都飞机工业(集团)有限责任公司 | Normal vector attitude adjustment and offset compensation method for drilling and riveting device having double parallel rod |
CN110850834A (en) * | 2019-12-02 | 2020-02-28 | 合肥工业大学 | Modeling method, modeling system, control method and control system of parallel robot |
CN111775145A (en) * | 2020-06-01 | 2020-10-16 | 上海大学 | Control system of series-parallel robot |
CN112405501A (en) * | 2020-11-13 | 2021-02-26 | 重庆邮电大学 | Series-parallel six-freedom-degree force feedback device with differential gear train |
CN112596382A (en) * | 2020-11-03 | 2021-04-02 | 北京无线电测量研究所 | Geometric parameter optimization calibration method and system for series servo mechanism |
CN112767493A (en) * | 2020-12-30 | 2021-05-07 | 浙江大学 | Machine vision calibration method for kinematic parameters of Stewart platform |
CN113049002A (en) * | 2020-10-22 | 2021-06-29 | 中国计量科学研究院 | Conical motion testing method of tilt sensor |
CN113183137A (en) * | 2020-06-28 | 2021-07-30 | 中国科学院长春光学精密机械与物理研究所 | Parameter calibration device and method for six-degree-of-freedom parallel mechanism |
CN113376665A (en) * | 2019-08-23 | 2021-09-10 | 北京建筑大学 | Reliability verification method for GNSS accurate positioning of position of cross arm of building tower crane |
CN113742857A (en) * | 2021-08-04 | 2021-12-03 | 温州大学 | Parameter identification method and system of cable robot system |
CN114526755A (en) * | 2021-12-17 | 2022-05-24 | 中国计量科学研究院 | Parallel motion platform linear axis calibration method based on inertial measurement unit |
CN115953477A (en) * | 2022-12-20 | 2023-04-11 | 苏州方石科技有限公司 | Coordinate data processing method and device |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009291878A (en) * | 2008-06-04 | 2009-12-17 | Jtekt Corp | Parallel mechanism and its calibration method |
CN101804640A (en) * | 2010-03-17 | 2010-08-18 | 昆山工研院工业机器人研究所有限公司 | Self-zeroing method for robot |
CN101870110A (en) * | 2010-07-01 | 2010-10-27 | 三一重工股份有限公司 | Control method and control device of mechanical articulated arm |
-
2011
- 2011-01-24 CN CN201110024569A patent/CN102152307B/en not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009291878A (en) * | 2008-06-04 | 2009-12-17 | Jtekt Corp | Parallel mechanism and its calibration method |
CN101804640A (en) * | 2010-03-17 | 2010-08-18 | 昆山工研院工业机器人研究所有限公司 | Self-zeroing method for robot |
CN101870110A (en) * | 2010-07-01 | 2010-10-27 | 三一重工股份有限公司 | Control method and control device of mechanical articulated arm |
Non-Patent Citations (1)
Title |
---|
《西安交通大学学报》 20081231 任晓栋等 利用姿态约束的并联机器人运动学标定方法 , 2 * |
Cited By (49)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102841556A (en) * | 2012-09-26 | 2012-12-26 | 苏州工业园区职业技术学院 | Two-axis medium-low full-automatic dispensing robot servo controller |
CN102968665B (en) * | 2012-12-05 | 2015-11-25 | 苏州大学 | The positive kinematics method for solving of parallel robot |
CN102968665A (en) * | 2012-12-05 | 2013-03-13 | 苏州大学 | Forward kinematics solving method of parallel robot |
CN103389646B (en) * | 2013-07-05 | 2015-12-09 | 西安交通大学 | A kind of servo feed system closed-loop identification method |
CN103389646A (en) * | 2013-07-05 | 2013-11-13 | 西安交通大学 | Closed-loop identification method for servo feed system |
CN104423318B (en) * | 2013-09-10 | 2017-05-17 | 西门子公司 | Operating machine with redundant axes and resolution of the redundancy in real time |
CN104423318A (en) * | 2013-09-10 | 2015-03-18 | 西门子公司 | Operating machine with redundant axes and resolution of the redundancy in real time |
US9555546B2 (en) | 2013-09-10 | 2017-01-31 | Siemens Aktiengesellschaft | Operating machine with redundant axes and resolution of the redundancy in real time |
CN104827480A (en) * | 2014-02-11 | 2015-08-12 | 泰科电子(上海)有限公司 | Automatic calibration method of robot system |
CN104236794B (en) * | 2014-10-13 | 2016-04-06 | 大连交通大学 | A kind of six-dimension force sensor calibration device |
CN104236794A (en) * | 2014-10-13 | 2014-12-24 | 大连交通大学 | Six-dimensional force transducer calibration device |
CN104634293A (en) * | 2015-01-29 | 2015-05-20 | 淮阴工学院 | Computing method for calibrating hinge coordinates of parallel machine tool |
CN104932536A (en) * | 2015-05-25 | 2015-09-23 | 盐城工学院 | Method for judging whether rod length conditions of Stewart parallel mechanism meet actual configuration |
CN104932536B (en) * | 2015-05-25 | 2016-06-29 | 盐城工学院 | Whether Stewart parallel institution bar elongate member meets the method for discrimination of actual bit shape |
CN104933232B (en) * | 2015-06-03 | 2018-04-17 | 西安交通大学 | A kind of kinematics solution method of rod end float type six-degree-of-freedom parallel robot with angle compensation |
CN104933232A (en) * | 2015-06-03 | 2015-09-23 | 西安交通大学 | Angle compensation kinematics solving method of one kind of rod end floating type six-freedom-degree parallel robots |
CN105425582A (en) * | 2015-11-04 | 2016-03-23 | 北京航空航天大学 | Kalman filtering based online calibrating method of Stewart mechanism |
CN105425582B (en) * | 2015-11-04 | 2018-03-13 | 北京航空航天大学 | A kind of Stewart mechanisms online calibration method based on Kalman filtering |
CN105301967A (en) * | 2015-11-27 | 2016-02-03 | 西安交通大学 | Smooth control method of starting and shutdown processes of Stewart platform |
CN105301967B (en) * | 2015-11-27 | 2017-10-20 | 西安交通大学 | A kind of smooth control method of Stewart platforms start up and shutdown |
CN105999594B (en) * | 2016-06-28 | 2019-04-26 | 新昌县联航机械有限公司 | A kind of Intelligent fire-fighting robot |
CN105999594A (en) * | 2016-06-28 | 2016-10-12 | 安徽扫宝智能科技有限公司 | Intelligent fire fighting robot |
CN106372443B (en) * | 2016-10-09 | 2021-04-02 | 江苏安全技术职业学院 | Stewart parallel mechanism kinematics forward solution method |
CN106372443A (en) * | 2016-10-09 | 2017-02-01 | 江苏安全技术职业学院 | Kinematic forward solution method of Stewart parallel mechanism |
CN107703747A (en) * | 2017-10-09 | 2018-02-16 | 东南大学 | A kind of heavy-load robot kinetic parameter self-calibrating method towards agitating friction weldering application |
CN109960284A (en) * | 2017-12-22 | 2019-07-02 | 广州中国科学院先进技术研究所 | A kind of high-accuracy parallel connection platform and its controller |
CN109291051A (en) * | 2018-03-30 | 2019-02-01 | 上海大学 | A kind of series-parallel robot terminal angle closed loop control method angle sensor based |
CN109291051B (en) * | 2018-03-30 | 2022-07-08 | 上海大学 | Angle sensor-based closed-loop control method for tail end attitude of series-parallel robot |
WO2020024600A1 (en) * | 2018-07-30 | 2020-02-06 | 成都飞机工业(集团)有限责任公司 | Normal vector attitude adjustment and offset compensation method for drilling and riveting device having double parallel rod |
CN109895101A (en) * | 2019-04-09 | 2019-06-18 | 大连理工大学 | A kind of articulated manipulator inverse kinematics numerical value unique solution acquiring method |
CN109895101B (en) * | 2019-04-09 | 2020-09-11 | 大连理工大学 | Unique solution method for inverse kinematics numerical value of joint type mechanical arm |
CN113376665B (en) * | 2019-08-23 | 2022-07-22 | 北京建筑大学 | Reliability verification method for GNSS (global navigation satellite system) accurate positioning of position of cross arm of building tower crane |
CN113376665A (en) * | 2019-08-23 | 2021-09-10 | 北京建筑大学 | Reliability verification method for GNSS accurate positioning of position of cross arm of building tower crane |
CN110850834A (en) * | 2019-12-02 | 2020-02-28 | 合肥工业大学 | Modeling method, modeling system, control method and control system of parallel robot |
CN110850834B (en) * | 2019-12-02 | 2021-08-03 | 合肥工业大学 | Modeling method, modeling system, control method and control system of parallel robot |
CN111775145A (en) * | 2020-06-01 | 2020-10-16 | 上海大学 | Control system of series-parallel robot |
CN113183137A (en) * | 2020-06-28 | 2021-07-30 | 中国科学院长春光学精密机械与物理研究所 | Parameter calibration device and method for six-degree-of-freedom parallel mechanism |
CN113049002A (en) * | 2020-10-22 | 2021-06-29 | 中国计量科学研究院 | Conical motion testing method of tilt sensor |
CN113049002B (en) * | 2020-10-22 | 2023-06-09 | 中国计量科学研究院 | Conical motion testing method of inclination angle sensor |
CN112596382B (en) * | 2020-11-03 | 2022-11-25 | 北京无线电测量研究所 | Geometric parameter optimization calibration method and system for series servo mechanism |
CN112596382A (en) * | 2020-11-03 | 2021-04-02 | 北京无线电测量研究所 | Geometric parameter optimization calibration method and system for series servo mechanism |
CN112405501A (en) * | 2020-11-13 | 2021-02-26 | 重庆邮电大学 | Series-parallel six-freedom-degree force feedback device with differential gear train |
CN112767493A (en) * | 2020-12-30 | 2021-05-07 | 浙江大学 | Machine vision calibration method for kinematic parameters of Stewart platform |
CN113742857A (en) * | 2021-08-04 | 2021-12-03 | 温州大学 | Parameter identification method and system of cable robot system |
CN113742857B (en) * | 2021-08-04 | 2023-08-22 | 温州大学 | Parameter identification method and system for cable robot system |
CN114526755A (en) * | 2021-12-17 | 2022-05-24 | 中国计量科学研究院 | Parallel motion platform linear axis calibration method based on inertial measurement unit |
CN114526755B (en) * | 2021-12-17 | 2024-04-02 | 中国计量科学研究院 | Parallel motion platform linear axis calibration method based on inertial measurement unit |
CN115953477A (en) * | 2022-12-20 | 2023-04-11 | 苏州方石科技有限公司 | Coordinate data processing method and device |
CN115953477B (en) * | 2022-12-20 | 2024-05-14 | 苏州方石科技有限公司 | Coordinate data processing method and device |
Also Published As
Publication number | Publication date |
---|---|
CN102152307B (en) | 2012-09-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102152307B (en) | Inclination-angle-constraint-based kinematic calibration method for Stewart parallel robot | |
CN102348541B (en) | Robot apparatus and control method therefor | |
CN107943042B (en) | Automatic construction method and device for geomagnetic fingerprint database | |
US8406921B2 (en) | Method and device for controlling a manipulator | |
CN107223220A (en) | Cloud platform control method, device and head | |
US12097737B2 (en) | Leveling control method for multi-point support platform | |
CN101890718B (en) | Initialization method for redundant manipulator motion planning | |
CN110253574B (en) | Multi-task mechanical arm pose detection and error compensation method | |
CN110421566A (en) | A kind of robot precision's compensation method based on degree of approximation interpolation by weighted average method | |
CN112327942B (en) | Automatic leveling method for triaxial air-bearing satellite simulation platform | |
CN103792956B (en) | Method and device controlling spatial motion of intelligent arm | |
CN103869834B (en) | Three-axis air-bearing table barycenter intelligent adjusting method based on empirical modal method | |
CN107618678A (en) | Attitude control information consolidation method of estimation under attitude of satellite angular deviation | |
CN110361829A (en) | A kind of telescope Pointing Calibration method and telescope | |
CN108673502A (en) | A kind of mechanical arm motion control method based on Unknown Model Dynamic Observer | |
Isaksson et al. | Improving the kinematic performance of the SCARA-Tau PKM | |
CN103759922B (en) | A kind of space remote sensor scan mirror pointing accuracy measuring method | |
CN114211503A (en) | Rope-driven flexible robot track control method and system based on visual feedback | |
Belyaev et al. | Hybrid control algorithm based on LQR and genetic algorithm for active support weight compensation system | |
CN105425582A (en) | Kalman filtering based online calibrating method of Stewart mechanism | |
CN114833828B (en) | Inertial parameter identification method, equipment and medium for two-degree-of-freedom system | |
CN113552796B (en) | PID control performance comprehensive evaluation method considering uncertainty | |
CN105372992B (en) | A kind of drive lacking sliding-mode control of suspention floating material servomechanism | |
Zhang et al. | Development of pneumatic force-controlled actuator for automatic robot polishing complex curved plexiglass parts | |
CN113282005A (en) | Brushless holder regulation and control method and device, computer equipment and storage medium |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20120905 Termination date: 20150124 |
|
EXPY | Termination of patent right or utility model |