CN110722562B - Space Jacobian matrix construction method for machine ginseng number identification - Google Patents
Space Jacobian matrix construction method for machine ginseng number identification Download PDFInfo
- Publication number
- CN110722562B CN110722562B CN201911029194.7A CN201911029194A CN110722562B CN 110722562 B CN110722562 B CN 110722562B CN 201911029194 A CN201911029194 A CN 201911029194A CN 110722562 B CN110722562 B CN 110722562B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- robot
- joint
- matrix
- pose
- 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
- 239000011159 matrix material Substances 0.000 title claims abstract description 126
- 238000010276 construction Methods 0.000 title claims abstract description 11
- 241000208340 Araliaceae Species 0.000 title description 2
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 title description 2
- 235000003140 Panax quinquefolius Nutrition 0.000 title description 2
- 235000008434 ginseng Nutrition 0.000 title description 2
- 230000009466 transformation Effects 0.000 claims abstract description 81
- 238000000034 method Methods 0.000 claims abstract description 37
- 238000013519 translation Methods 0.000 claims description 16
- 238000013461 design Methods 0.000 claims description 3
- 239000012636 effector Substances 0.000 claims description 3
- 238000011065 in-situ storage Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000011426 transformation method Methods 0.000 description 3
- 230000002349 favourable effect Effects 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 241000287196 Asthenes Species 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011900 installation process Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
The invention discloses a space Jacobian matrix construction method for robot number identification, which comprises the steps of S100, constructing a robot kinematics model; s200, analyzing differential motion characteristics of the robot joint based on a robot kinematic model, and establishing a homogeneous transformation matrix between coordinate systems under the condition of differential motion; and S300, assuming that a certain joint coordinate system generates differential motion, establishing a virtual coordinate system corresponding to the joint on the basis, establishing a transformation matrix between the two, further calculating the actual pose of the tail end of the robot relative to a base coordinate system, comparing the actual pose with theory pose, obtaining the pose error of the tail end of the robot relative to the base coordinate system caused by the motion amount error of the joint coordinate system, and constructing a space Jacobian matrix of the robot. The method of the invention is a robot space Jacobian matrix construction method based on a differential transformation principle and a virtual coordinate system method, has lower time consumption, and can quickly construct the space Jacobian matrix of the robot.
Description
Technical Field
The invention belongs to the technical field of robot calibration, and particularly relates to a space Jacobian matrix construction method for robot number identification.
Background
The motion accuracy of an industrial robot plays a crucial role in the reliability of its use in production. The geometric parameter error of each connecting rod of the robot is the most main link causing the positioning error of the robot, mainly originates from the deviation between the actual geometric parameter and the theoretical parameter value of the connecting rod in the manufacturing and installation process, and is generally regarded as the system error.
The identification of geometric parameter errors of all connecting rods of the robot is an important means for improving the motion precision of the robot, and the main work of parameter identification is to construct a machineThe transformation relation from error of robot parameter to error of joint coordinate system is divided into two steps, firstly, the transformation relation G from error of robot parameter to error of joint coordinate system is constructediThen constructing a transformation relation J from the robot joint coordinate system error to the terminal errori(i.e., a spatial Jacobian matrix or an object Jacobian matrix). After the transformation relation from the robot parameter error to the tail end error is obtained, the parameter error value of the robot can be solved by methods such as a least square method and the like. In the existing method for constructing the space Jacobian matrix of the robot, the object Jacobian matrix of the robot is generally constructed firstly, and then the space Jacobian matrix is constructed by utilizing the transformation relation between the object Jacobian matrix and the space Jacobian matrix, so that the time consumption of a parameter identification algorithm is long, and the technical requirement of robot calibration is difficult to adapt.
Disclosure of Invention
Aiming at the defects or the improvement requirements in the prior art, the invention provides a space Jacobian matrix construction method for robot parameter identification, which is based on a differential transformation principle and a virtual coordinate system method, has lower time consumption compared with the traditional method, can quickly construct the space Jacobian matrix of the robot, and provides favorable conditions for realizing the parameter identification of the robot.
In order to achieve the above object, the present invention provides a spatial jacobian matrix construction method for robot parameter identification, comprising the following steps:
s100, analyzing the influence of the rod length, the torsion angle, the offset and the joint angle in the D-H model of the robot on the relationship between the connecting rod and the joint of the robot, calculating a homogeneous transformation matrix of the adjacent joints of the robot by using translation and rotation operators, and constructing a robot kinematics model;
s200, analyzing differential motion characteristics of the robot joint based on a robot kinematic model, and establishing a homogeneous transformation matrix between coordinate systems under the condition of differential motion;
and S300, assuming that a certain joint coordinate system generates differential motion, establishing a virtual coordinate system corresponding to the joint on the basis, establishing a transformation matrix between the two, further calculating the actual pose of the tail end of the robot relative to a base coordinate system, comparing the actual pose with theory pose, obtaining the pose error of the tail end of the robot relative to the base coordinate system caused by the motion amount error of the joint coordinate system, and constructing a space Jacobian matrix of the robot.
Further, in step S200, the establishing of the homogeneous transformation matrix includes the following specific steps:
s201: the amplitude of translation and rotation in differential motion is small, so that the angular operation of the robot is approximately processed in differential transformation, when the joint angle is small, sin theta is approximately equal to theta, and cos theta is approximately equal to 1;
s202: differential rotation motion delta from joint i-1 to joint i of robotx δy δz]TAnd translational motion d ═ dxdy dz]TThe differential rotational movement δ ═ δx δy δz]TThe transformation matrix of (a) is:
wherein k is [ k ]x ky kz]T,δx=kxδθ,δy=kyδθ,δz=kzδθ;
The translational movement d ═ dx dy dz]TThe corresponding transformation matrix is:
further, by differentiating the rotational motion and the translational motion, a total transformation matrix of the differential motion between the robot joint coordinate systems is constructed as follows:
further, step S200 further includes:
s203: introduction of an antisymmetric matrix [ δ ]:
further, S300 includes the following specific steps:
s301: analyzing the error form of the robot joint coordinate system, and introducing a virtual coordinate system to indicate the pose error of the joint coordinate system;
s302: solving a homogeneous transformation relation between the virtual coordinate system and the original joint coordinate system by utilizing a basic principle of a differential variation method;
s303: solving the pose relation of the robot tail end coordinate system relative to the base coordinate system after the virtual coordinate system is introduced, and comparing the pose relation with the in-situ pose relation to obtain the pose deviation of the robot tail end coordinate system;
s304: and constructing a space Jacobian matrix of the robot according to the pose deviation of the terminal coordinate system of the robot.
Further, the space jacobian matrix j (q) of the robot in S304 is:
in the formula: j. the design is a squareliAnd JaiRespectively representing the amount of translation and the amount of rotation of the end effector due to the unit amount of joint motion of the joint i.
Further, in S301, a transformation matrix of the robot end joint n with respect to the base coordinate system is described as
In the formula:respectively representing transformation matrixes of the coordinate systems n, i and n relative to the coordinate systems 0, 0 and i;respectively representThe rotation matrix of (1);0Pi0、iPn0、0Pn0respectively representIs determined.
Further, in S302, assuming that the coordinate system i reaches the virtual coordinate system i ' after undergoing differential motion, the coordinate system n moves to n ', and at this time, the transformation matrix of the coordinate system n ' with respect to the base coordinate system is
In the formula:respectively representing transformation matrices of the coordinate systems i, i ', n ' relative to the coordinate systems o, i ';respectively representThe rotation matrix of (1);0Pi0、iPi′0、i′Pn′0respectively representIs determined.
Further, in S303, the pose deviation of the robot end coordinate system is:
0Dni=[0dni T 0δni T]T
wherein,0dniis a positional deviation equal to the position of the origin of the coordinate system n in the final state under the base coordinate system0Pno' subtracting the position of the origin of the coordinate system n in the initial state under the base coordinate system0Pno;0δniIn order to be the attitude deviation, to representThe rotation matrix of (2).
Further, in S100, the robot kinematic model is a transformation matrix of the robot link coordinate system i with respect to the link coordinate system i-1:
wherein: a isi-1Is the length of the connecting rod i-1; alpha is alphai-1Is the torsion angle of the connecting rod i-1; diThe offset distance of the connecting rod i relative to the connecting rod i-1 is shown; thetaiThe rotation angle of the connecting rod i relative to the connecting rod i-1 around the axis i; rot (x, alpha)i-1) Representing the rotation angle alpha around the x-axis of the coordinate systemi-1The corresponding homogeneous transformation matrix is specifically as follows:
Trans(x,ai-1) Representing the x-axis translation distance a around the coordinate systemi-1The corresponding homogeneous transformation matrix is specifically as follows:
Rot(z,θi) Representing the angle of rotation theta around the z-axis of the coordinate systemiThe corresponding homogeneous transformation matrix is specifically
Trans(z,di) Representing a translation distance d around the z-axis of the coordinate systemiThe corresponding homogeneous transformation matrix is specifically as follows:
in general, compared with the prior art, the above technical solution contemplated by the present invention can achieve the following beneficial effects:
1. the construction method of the space Jacobian matrix of the robot is based on the differential transformation principle and the virtual coordinate system method, has lower time consumption compared with the traditional method, can quickly construct the space Jacobian matrix of the robot, and provides favorable conditions for realizing parameter identification of the robot.
2. The space Jacobian matrix construction method analyzes the characteristic of differential motion of the robot joint by utilizing the basic principle of differential transformation, establishes a homogeneous transformation matrix between coordinate systems under the condition of differential motion, understands the generation of errors as the result of the differential motion of the coordinate systems, conveniently establishes a mathematical description method of the errors of the coordinate systems, and lays a foundation for solving the end pose errors.
3. The method for constructing the space Jacobian matrix establishes a virtual coordinate system corresponding to the joint, deduces a transformation matrix between the virtual coordinate system and the joint, further calculates the actual pose of the tail end of the robot relative to a base coordinate system, compares the actual pose with the theory pose, and constructs the space Jacobian matrix of the robot.
Drawings
FIG. 1 is a flowchart of a spatial Jacobian matrix construction method for robot parameter identification according to an embodiment of the present invention;
FIG. 2 is a schematic illustration of a robot linkage according to an embodiment of the present invention;
FIG. 3 is a schematic diagram illustrating the connection between the links according to an embodiment of the present invention;
FIG. 4 is a schematic diagram illustrating a coordinate system of a robot link according to an embodiment of the present invention;
FIG. 5 is a flowchart of solving a homogeneous transformation matrix based on a differential transformation method according to an embodiment of the present invention;
FIG. 6 is a schematic diagram of a differential transformation process in an embodiment of the present invention;
FIG. 7 is a schematic diagram of differential motion of joint coordinate system and virtual coordinate system according to an embodiment of the present invention;
FIG. 8 is a flowchart of constructing a spatial Jacobian matrix based on a virtual coordinate system method according to an embodiment of the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention. In addition, the technical features involved in the embodiments of the present invention described below may be combined with each other as long as they do not conflict with each other.
As shown in fig. 1, an embodiment of the present invention provides a method for constructing a space jacobian matrix for robot parameter identification, including the following steps:
s100: and establishing a kinematic model of the robot based on a D-H method. Analyzing the influence of the rod length a, the torsion angle alpha, the offset D and the joint angle theta on the relation between the robot connecting rod and the joint in the D-H model; calculating a homogeneous transformation matrix of adjacent joints of the robot by using translation and rotation operators, thereby obtaining a kinematic model of the robot;
s200: a homogeneous transformation matrix between coordinate systems under the condition of differential motion is deduced by using the basic principle of differential transformation. Analyzing the characteristic of differential motion of the robot joint, and establishing a homogeneous transformation matrix between coordinate systems under the condition of differential motion;
s300: and deducing a robot space Jacobian matrix formula by using a virtual coordinate system method. Assuming that a certain joint coordinate system generates differential motion, establishing a virtual coordinate system corresponding to the joint on the basis, deducing a transformation matrix between the two, further calculating the actual pose of the tail end of the robot relative to a base coordinate system, and comparing the actual pose with the theory of principle pose to finally construct a space Jacobian matrix of the robot.
Specifically, the method comprises the following steps:
(1) and establishing a kinematic model of the robot based on a D-H method.
As shown in FIG. 2, the link i-1 is formed by the joint axis i-1 and the common normal line length a of the joint axis ii-1And the angle alpha between the two axesi-1And (4) determining. a isi-1A length called link i-1, whose direction is defined as pointing from joint i-1 to joint i; alpha is alphai-1Referred to as the torsion angle of the link i-1, is oriented as a parallel line from the axis i-1 to the axis i about the common normal.
As shown in fig. 3, there is a joint axis between adjacent links, and accordingly, each joint axis has two common normal lines perpendicular to it, and the distance between the two common normal lines (links) is called the offset distance of the links, and is denoted as diRepresenting the offset distance of the connecting rod i relative to the connecting rod i-1; the angle between these two common normal lines (connecting rods) is called the joint angle, and is denoted as θiAnd represents the rotation angle of the link i about the axis i with respect to the link i-1.
As shown in fig. 4, in order to determine the relative movement and the pose relationship between the links of the robot, a coordinate system is fixed to each link. The coordinate system is called a base coordinate system fixed to the base (link 0), and the coordinate system is called a coordinate system i fixed to the link i.
For the intermediate coordinate system i, z is specifiediThe shaft and the joint axis i are collinear and point to any direction; x thereofiShaft and aiCollinear, pointing from joint i to i +1, when aiWhen equal to 0, take xi=±zi+1×zi(ii) a It y isiThe axes are determined according to the right hand rule; origin o of the coordinate systemiIs taken at xiAnd ziAt the intersection of (a) when z isi+1、ziAt the time of intersection, oiTaken at the intersection point, when zi+1、ziIn parallel, oiIs taken ati+1Where 0.
For the head and tail link coordinate systems, the z-axis of the coordinate system 0 is generally specified in the direction of the joint axis 1, and when the joint variable 1 is zero, the coordinate systems 0, 1 coincide. The end link coordinate system is specified similarly to coordinate system 0, with x being chosen for the revolute joint nnSuch that when thetanWhen equal to 0, xn、xn-1Coincidence, selection of origin of coordinate system n being such that d n0; for the mobile joint n, a coordinate system n is defined by θnIs equal to 0, and when dnWhen equal to 0, xn、xn-1And (4) overlapping.
Based on the above establishment method of the robot link coordinate system, the link coordinate system i can be regarded as the link coordinate system i-1 transformed by:
(a) around xi-1Rotation of the shaft alphai-1An angle; (b) along xi-1Axial movement ai-1(ii) a (c) Around ziAxis of rotation thetaiAn angle; (d) along ziAxial movement di。
According to the kinematics principle of the robot, the transformation matrix of the robot link coordinate system i relative to the link coordinate system i-1 can be obtained by the following formula:
wherein: a isi-1Is the length of the connecting rod i-1; alpha is alphai-1Is the torsion angle of the connecting rod i-1; diThe offset distance of the connecting rod i relative to the connecting rod i-1 is shown; thetaiThe rotation angle of the connecting rod i relative to the connecting rod i-1 around the axis i; rot (x, alpha)i-1) Representing the rotation angle alpha around the x-axis of the coordinate systemi-1The corresponding homogeneous transformation matrix is specifically as follows:
Trans(x,ai-1) Representing the x-axis translation distance a around the coordinate systemi-1The corresponding homogeneous transformation matrix is specifically as follows:
Rot(z,θi) Representing the angle of rotation theta around the z-axis of the coordinate systemiThe corresponding homogeneous transformation matrix is specifically
Trans(z,di) Representing a translation distance d around the z-axis of the coordinate systemiThe corresponding homogeneous transformation matrix is specifically as follows:
the method specifically comprises the following steps:
the modeling method is adopted to establish a kinematic model of the robot.
(2) Fundamental principle of differential transformation
The basic principle of the differential transformation method is shown in fig. 5, because the translation and rotation amplitude is small in the differential motion, the differential transformation is used for carrying out approximation processing on the angle operation, namely sin theta is approximately equal to theta, cos theta is approximately equal to 1, after the approximation processing, a homogeneous transformation matrix between a coordinate system before and after the differential motion can be further deduced, the composition of the homogeneous transformation matrix is observed, wherein the rotation matrix is an antisymmetric matrix corresponding to the differential rotation quantity, and the antisymmetric matrix is introduced to simplify the representation of the homogeneous transformation matrix. The basic principle of the differential transformation method is specifically described below with reference to the drawings.
As shown in fig. 6, it is assumed that coordinate system B initially coincides with coordinate system a, and then B sequentially undergoes differential rotational motion δ [ δ ] with respect to ax δy δz]TAnd translational motion d ═ dx dy dz]TTo B'. According to the kinematics principle of the robot, the rotation transformation matrix for rotating theta angles around the x axis, the y axis and the z axis sequentially comprises the following steps:
when θ is small, the following equation can be approximated:
sinθ=θ,cosθ=1 (10)
then δ is ═ δ for the differential rotational movement of B relative to ax δy δz]TThe differential rotation about each single axis can be transformed into:
the total transformation of the differential rotary motion can be regarded as the above three changesThe compound action is shown in formula (11). Wherein, the equivalent rotation axis k ═ kx ky kz]TEquivalent differential rotation angles delta theta and deltax,δy,δzThe relationship between them is:
δx=kxδθ,δy=kyδθ,δz=kzδθ (14)
multiplication of the differential rotation transformation matrix conforms to the commutative law, i.e. the operator Rot (x, δ)x)、Rot(y,δy)、Rot(z,δz) The order of (A) can be arbitrarily changed.
For the convenience of subsequent calculation, the differential rotation transformation matrix is expanded into a 4-order homogeneous transformation matrix as follows:
when B generates differential rotation motion relative to A, the B generates translational motion d ═ d relative to Ax dy dz]TThe transformation matrix corresponding to the translational motion is:
since B always performs a differential motion with respect to A (reference frame), the left-hand rule is used to calculate the overall transformation matrix, and the differential motion [ dT δT]TThe corresponding overall transformation matrix is:
in practical calculations, we tend to change δ to [ δ ═ δx δy δz]TToThe symmetric matrix is denoted as [ delta ]]It can be expressed as:
in the formula: delta is [ delta ]x δy δz]T,d=[dx dy dz]TAnd E is a 3-order identity matrix.
(3) Method for deducing space Jacobian matrix formula of robot by using virtual coordinate system method
In the embodiment of the invention, a space Jacobian matrix of the robot is constructed based on a virtual coordinate system method, as shown in FIG. 8, firstly, the error forms (position errors and attitude errors) of the robot joint coordinate system are analyzed, the generation of the errors is understood as the result of differential motion of the robot joint coordinate system, and the virtual coordinate system is introduced to show the pose errors of the joint coordinate system. Then, by utilizing the basic principle of a differential variation method, the homogeneous transformation relation between the virtual coordinate system and the original joint coordinate system (error-free theoretical coordinate system) is solved, the pose relation of the tail end coordinate system of the robot relative to the base coordinate system after the virtual coordinate system is introduced is further deduced and compared with the in-situ pose relation (error-free theoretical pose relation), the pose deviation of the tail end coordinate system of the robot is obtained, the composition of the pose deviation is observed, and the space Jacobian matrix of the robot can be constructed. The basic principle of constructing the robot space Jacobian matrix based on the virtual coordinate system method is specifically described below in conjunction with the accompanying drawing.
The robot kinematics defines that the velocity Jacobian matrix J (q) of the robot represents the velocity vector of the slave jointTo the operating velocity vectorLinear mapping of (2). Since the velocity can be regarded as a differential motion in a unit time, the velocity jacobian can be regarded as a conversion matrix between the differential motion dq of the joint space to the differential motion D of the operation space. The object Jacobian matrix of the robot is a conversion matrix of the motion amount error of the joint to the motion amount error of the tail end relative to the theoretical pose (relative to the coordinate system of a tail end tool); the space Jacobian matrix is a conversion matrix from the joint motion amount error to the motion amount error of the end relative to the base coordinate system (expressed relative to the base coordinate system). The object Jacobian matrix and the space Jacobian matrix of the robot can be mutually converted. Namely, it is
D=J(q)dq (21)
Further, J (q) may be expressed in blocks as
In the formula: j. the design is a squareliAnd JaiRespectively representing the amount of translation and the amount of rotation of the end effector due to the unit amount of joint motion of the joint i. End differential motion amount D ═ DT δT]TWhen expressed in the end tool coordinate system, the corresponding Jacobian matrix is noted asTJ (q), referred to as object Jacobian matrix; d ═ DT δT]TWhen expressed in the base coordinate system, the corresponding jacobian matrix is denoted as j (q), and is called a spatial jacobian matrix.
Here, assume D-H parameters a corresponding to the joint coordinate system ii-1,αi-1,diAnd thetaiA minute variation amount deltaa is generatedi-1,Δαi-1,ΔdiAnd Δ θiResulting in a differential rotation delta of the coordinate system i with respect to its theoretical poseiAnd a differential translation amount diI.e. producing a differential movement Di=[di T δi T]TThe differential motion causes the robot end coordinate system n to perform differential motion, so that the pose of the coordinate system n relative to the base coordinate system (coordinate system 0) changes.
As shown in FIG. 7, in the initial state, a transformation matrix of the robot end joint n with respect to the base coordinate system is represented asAccording to the kinematics principle of the robot, the following relations exist:
in the formula:respectively representing transformation matrices of the coordinate systems n, i and n relative to the coordinate systems o, o and i;respectively representThe rotation matrix of (1);0Pi0、iPn0、0Pn0respectively representIs determined.
Assume that coordinate system i has reached coordinate system i '(virtual coordinate system) after differential motion, and accordingly coordinate system n has moved to n'. In this case, the transformation matrix of the coordinate system n' with respect to the base coordinate system is denoted asThen:
because the pose of the coordinate system n relative to the coordinate system i is always kept unchanged in the process, the pose of the coordinate system n relative to the coordinate system i is always kept unchanged
Substituting formula (25) for formula (24) to obtain:
from the foregoing, it can be seen that the transformation matrix of the coordinate system i' with respect to the coordinate system iCan be obtained by differential transformation, knowing the magnitude of the differential motion as Di=[di T δi T]TAnd then:
substitution of equation (27) into (25) yields:
The equations (28) and (29) correspond to equal ones and are obtained:
so far, we only need to use that in formula (28)And in formula (23)Comparing to obtain differential motion D of joint coordinate system ii=[di T δi T]TResulting in a pose deviation of the end coordinate system n with respect to the base coordinate system0Dni=[0dni T 0δni T]TWherein0dniIn order to be a positional deviation,0δniis the attitude deviation.
For positional deviation0dniIn the calculation, we only need to use the position of the origin of the coordinate system n in the final state in the base coordinate system0Pno' subtracting the position of the origin of the coordinate system n in the initial state under the base coordinate system0PnoNamely, it can be obtained from formula (31):
for attitude deviation0δniThe calculation of (2) can be known from the analysis formula (30),byLeft rideThis is obtained by indicating that the terminal coordinate system n is differentially rotated with respect to the base coordinate system based on the initial attitude, and the differential rotation amount is known from the equation (20)0δniComprises the following steps:
the following equations (32), (33) are arranged in a matrix form:
comparing with the formula (22), it can be known that:
from this, the spatial jacobian matrix of the robot can be obtained by using the formula (22). It is worth mentioning that it is possible to show,0Dnisince the description is given under the robot base coordinate system, the space jacobian matrix of the robot is obtained according to the formula (22).
It will be understood by those skilled in the art that the foregoing is only a preferred embodiment of the present invention, and is not intended to limit the invention, and that any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the scope of the present invention.
Claims (9)
1. A space Jacobian matrix construction method for machine parameter identification is characterized by comprising the following steps:
s100, analyzing the influence of the rod length, the torsion angle, the offset and the joint angle in the D-H model of the robot on the relationship between the connecting rod and the joint of the robot, calculating a homogeneous transformation matrix of the adjacent joints of the robot by using translation and rotation operators, and constructing a robot kinematics model;
s200, analyzing differential motion characteristics of the robot joint based on a robot kinematic model, and establishing a homogeneous transformation matrix between coordinate systems under the condition of differential motion;
s300, assuming that a certain joint coordinate system generates differential motion, establishing a virtual coordinate system corresponding to the joint on the basis, establishing a transformation matrix between the two, further calculating the actual pose of the tail end of the robot relative to a base coordinate system, comparing the actual pose with a theory pose, obtaining the pose error of the tail end of the robot relative to the base coordinate system caused by the motion amount error of the joint coordinate system, and constructing a space Jacobian matrix of the robot;
s300 comprises the following specific steps:
s301: analyzing the error form of the robot joint coordinate system, and introducing a virtual coordinate system to indicate the pose error of the joint coordinate system;
s302: solving a homogeneous transformation relation between the virtual coordinate system and the original joint coordinate system by utilizing a basic principle of a differential variation method;
s303: solving the pose relation of the robot tail end coordinate system relative to the base coordinate system after the virtual coordinate system is introduced, and comparing the pose relation with the in-situ pose relation to obtain the pose deviation of the robot tail end coordinate system;
s304: and constructing a space Jacobian matrix of the robot according to the pose deviation of the terminal coordinate system of the robot.
2. The method for constructing space Jacobian matrix for machine-generated numerical identification as claimed in claim 1, wherein in step S200, the establishment of the homogeneous transformation matrix comprises the following specific steps:
s201: the amplitude of translation and rotation in differential motion is small, so that the angular operation of the robot is approximately processed in differential transformation, when the joint angle is small, sin theta is approximately equal to theta, and cos theta is approximately equal to 1;
s202: differential rotation motion delta from joint i-1 to joint i of robotx δy δz]TAnd translational motiond=[dx dy dz]TThe differential rotational movement δ ═ δx δy δz]TThe transformation matrix of (a) is:
wherein, the equivalent rotation axis k ═ kx ky kz]T,δx=kxδθ,δy=kyδθ,δz=kzδθ;
The translational movement d ═ dx dy dz]TThe corresponding transformation matrix is:
3. the method for constructing a spatial Jacobian matrix for robot parameter identification according to claim 2, wherein a total transformation matrix of differential motion between robot joint coordinate systems is constructed by differentiating rotational motion and translational motion as follows:
5. the method of claim 4, wherein the space Jacobian matrix J (q) of the robot in S304 is:
in the formula: j. the design is a squareliAnd JaiRespectively representing the translation and rotation of the end effector, dq, due to the unit joint motion amount of the joint iiRepresenting the spatial differential motion of joint i.
6. The method as claimed in claim 4, wherein in S301, the transformation matrix of the robot end joint n with respect to the base coordinate system is recorded as
7. The method of claim 4, wherein in step S302, if the coordinate system i reaches the virtual coordinate system i ' after differential motion, the coordinate system n moves to n ', and the transformation matrix of the coordinate system n ' relative to the base coordinate system is the same as the transformation matrix of the base coordinate system
8. The method of constructing a spatial Jacobian matrix for machine parameter identification as claimed in claim 4, wherein in S303, the pose deviation of the robot end coordinate system is:
0Dni=[0dni T0δni T]T
wherein,0dniis a positional deviation equal to the position of the origin of the coordinate system n in the final state under the base coordinate system0Pno' subtracting the position of the origin of the coordinate system n in the initial state under the base coordinate system0Pno;0δniIn order to be the attitude deviation, to representThe rotation matrix of (2).
9. The method of claim 1, wherein in S100, the robot kinematics model is a transformation matrix of a robot link coordinate system i relative to a link coordinate system i-1:
wherein: a isi-1Is the length of the connecting rod i-1; alpha is alphai-1Is the torsion angle of the connecting rod i-1; diThe offset distance of the connecting rod i relative to the connecting rod i-1 is shown; thetaiThe rotation angle of the connecting rod i relative to the connecting rod i-1 around the axis i; rot (x, alpha)i-1) Representing the rotation angle alpha around the x-axis of the coordinate systemi-1The corresponding homogeneous transformation matrix is specifically as follows:
Trans(x,ai-1) Representing the x-axis translation distance a around the coordinate systemi-1The corresponding homogeneous transformation matrix is specifically as follows:
Rot(z,θi) Representing the angle of rotation theta around the z-axis of the coordinate systemiThe corresponding homogeneous transformation matrix is specifically
Trans(z,di) Representing a translation distance d around the z-axis of the coordinate systemiThe corresponding homogeneous transformation matrix is specifically as follows:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911029194.7A CN110722562B (en) | 2019-10-28 | 2019-10-28 | Space Jacobian matrix construction method for machine ginseng number identification |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911029194.7A CN110722562B (en) | 2019-10-28 | 2019-10-28 | Space Jacobian matrix construction method for machine ginseng number identification |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110722562A CN110722562A (en) | 2020-01-24 |
CN110722562B true CN110722562B (en) | 2021-03-09 |
Family
ID=69222226
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911029194.7A Active CN110722562B (en) | 2019-10-28 | 2019-10-28 | Space Jacobian matrix construction method for machine ginseng number identification |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110722562B (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111360836B (en) * | 2020-04-02 | 2021-04-09 | 易思维(杭州)科技有限公司 | Robot calibration method for optimizing identification parameters |
CN113070880B (en) * | 2021-03-31 | 2022-09-09 | 深圳市优必选科技股份有限公司 | Motion control method and device, robot control equipment and readable storage medium |
CN113160334B (en) * | 2021-04-28 | 2023-04-25 | 北京邮电大学 | Dual-robot system calibration method based on hand-eye camera |
CN113752253B (en) * | 2021-08-16 | 2022-11-11 | 常州大学 | Parameter optimization method for continuum robot |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103085069A (en) * | 2012-12-17 | 2013-05-08 | 北京邮电大学 | Novel robot kinematics modeling method |
CN106097390A (en) * | 2016-06-13 | 2016-11-09 | 北京理工大学 | A kind of robot kinematics's parameter calibration method based on Kalman filtering |
WO2017129200A1 (en) * | 2016-01-28 | 2017-08-03 | MAX-PLANCK-Gesellschaft zur Förderung der Wissenschaften e.V. | A system for real-world continuous motion optimization and control |
CN107369167A (en) * | 2017-07-20 | 2017-11-21 | 江南大学 | A kind of robot self-calibrating method based on biplane constraint error model |
CN107443382A (en) * | 2017-09-12 | 2017-12-08 | 清华大学 | Industrial robot structure parameter error recognizes and compensation method |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7859540B2 (en) * | 2005-12-22 | 2010-12-28 | Honda Motor Co., Ltd. | Reconstruction, retargetting, tracking, and estimation of motion for articulated systems |
-
2019
- 2019-10-28 CN CN201911029194.7A patent/CN110722562B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103085069A (en) * | 2012-12-17 | 2013-05-08 | 北京邮电大学 | Novel robot kinematics modeling method |
WO2017129200A1 (en) * | 2016-01-28 | 2017-08-03 | MAX-PLANCK-Gesellschaft zur Förderung der Wissenschaften e.V. | A system for real-world continuous motion optimization and control |
CN106097390A (en) * | 2016-06-13 | 2016-11-09 | 北京理工大学 | A kind of robot kinematics's parameter calibration method based on Kalman filtering |
CN107369167A (en) * | 2017-07-20 | 2017-11-21 | 江南大学 | A kind of robot self-calibrating method based on biplane constraint error model |
CN107443382A (en) * | 2017-09-12 | 2017-12-08 | 清华大学 | Industrial robot structure parameter error recognizes and compensation method |
Non-Patent Citations (2)
Title |
---|
六自由度工业机器人定位误差参数辨识及补偿方法的研究;杜亮;《中国博士学位论文全文数据库》;中国学术期刊(光盘版)电子杂志;20170215(第2期);第104-105页 * |
工业机器人运动学标定及误差分析研究;夏天;《中国优秀硕士学位论文全文数据库》;中国学术期刊(光盘版)电子杂志社;20100415(第4期);第12-17,24-28,33-36页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110722562A (en) | 2020-01-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110722562B (en) | Space Jacobian matrix construction method for machine ginseng number identification | |
CN107589934B (en) | Solving method for inverse kinematics analytic solution of joint type mechanical arm | |
CN109895101B (en) | Unique solution method for inverse kinematics numerical value of joint type mechanical arm | |
CN110757454B (en) | Path planning method and device for cooperative rotation of double robots | |
CN110757450B (en) | Shoulder joint rehabilitation robot parameter calibration method | |
CN107995885B (en) | Coordinate system calibration method, system and device | |
CN107717993B (en) | Efficient and convenient simple robot calibration method | |
CN110281241A (en) | Mechanical arm kinematic calibration method is measured based on laser tracker | |
CN111055273B (en) | Two-step error compensation method for robot | |
WO2018188276A1 (en) | Error modeling method for tail-end space curve trajectory of six-degree-of-freedom robot | |
CN103942427B (en) | Quick and simple method for solving inverse kinematics of six-degree-of-freedom mechanical arm | |
CN110421566B (en) | Robot precision compensation method based on approximation degree weighted average interpolation method | |
CN107584474B (en) | Spherical joint double-arm robot coordinated movement method based on geometric projection | |
CN105773609A (en) | Robot kinematics calibration method based on vision measurement and distance error model | |
JPH0820894B2 (en) | Industrial robot operation control method | |
CN104408299B (en) | Robot location's error compensating method based on distance identification redundancy kinematics parameters | |
CN103481288B (en) | A kind of 5 articulated robot end-of-arm tooling posture control methods | |
CN113580148B (en) | Parallel robot kinematics calibration method based on equivalent kinematic chain | |
CN111844005B (en) | 2R-P-2R-P-2R mechanical arm motion planning method applied to tunnel wet spraying | |
CN114161425B (en) | Error compensation method for industrial robot | |
CN112643658A (en) | Calibration method for adaptive error modeling of series robot based on SIR dimension reduction DH model | |
CN111958602B (en) | Real-time inverse solution method for wrist offset type 6-axis robot | |
CN116330267A (en) | Control method based on industrial robot wrist singular point calculation | |
JP5378908B2 (en) | Robot accuracy adjustment method and robot | |
CN111283682A (en) | Geometric projection solution of forward kinematics of 4-UPU four-degree-of-freedom parallel robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |