CN112276959A - Geometric parameter and joint zero position self-calibration method and device, electronic equipment and medium - Google Patents
Geometric parameter and joint zero position self-calibration method and device, electronic equipment and medium Download PDFInfo
- Publication number
- CN112276959A CN112276959A CN202011560013.6A CN202011560013A CN112276959A CN 112276959 A CN112276959 A CN 112276959A CN 202011560013 A CN202011560013 A CN 202011560013A CN 112276959 A CN112276959 A CN 112276959A
- Authority
- CN
- China
- Prior art keywords
- joint
- foot
- robot
- error
- posture
- 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
- 238000000034 method Methods 0.000 title claims abstract description 41
- 230000036544 posture Effects 0.000 claims description 82
- 238000012546 transfer Methods 0.000 claims description 26
- 238000004364 calculation method Methods 0.000 claims description 16
- 230000033001 locomotion Effects 0.000 claims description 16
- 238000003860 storage Methods 0.000 claims description 5
- 230000005540 biological transmission Effects 0.000 claims description 3
- 238000005457 optimization Methods 0.000 claims description 3
- 238000004590 computer program Methods 0.000 claims description 2
- 238000005259 measurement Methods 0.000 abstract description 4
- 210000002683 foot Anatomy 0.000 description 116
- 210000002414 leg Anatomy 0.000 description 23
- 239000011159 matrix material Substances 0.000 description 20
- 239000013598 vector Substances 0.000 description 20
- 210000001503 joint Anatomy 0.000 description 12
- 230000009466 transformation Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 5
- 238000013461 design Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 241000238631 Hexapoda Species 0.000 description 3
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000011156 evaluation Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000013519 translation Methods 0.000 description 2
- 210000000544 articulatio talocruralis Anatomy 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012512 characterization method Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 210000004394 hip joint Anatomy 0.000 description 1
- 210000000629 knee joint Anatomy 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000000844 transformation 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/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
-
- 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
-
- 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/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
Abstract
The invention discloses a method, a device, electronic equipment and a medium for self-calibrating geometric parameters and a zero position of a joint, which can be particularly used for calibrating the size parameters of each component of a foot type robot and the zero position of a driving joint, and improving the positioning and control precision of the robot. The method comprises the steps of fixing the feet of the robot on a calibration plate with definite size parameters, adjusting the joint position of the robot, and calibrating the structure size parameters and the joint zero position of the robot on the basis of establishing a robot calibration model by using an inertia measurement unit and joint readings which are placed on the body of the robot. The invention has the advantages of low cost, simple and convenient operation and the like, and is suitable for calibrating the parameters of robots with different configurations and different leg and foot numbers.
Description
Technical Field
The invention relates to the field of robots and parameter identification, in particular to a method and a device for self-calibrating a geometric parameter and a joint zero position, electronic equipment and a medium.
Background
Among mobile robots, a legged robot has significant advantages in terrain adaptability, has the capabilities of walking on a complex ground, avoiding obstacles and the like, but has the problems of high control difficulty, poor motion stability and the like. The high-precision control of the foot robot is a key problem for realizing the stable motion of the foot robot. However, due to the influence of errors in machining, assembly and the like, geometric parameters, zero positions of kinematic joints and design values of the foot robot have deviations, and the robot is subjected to motion calculation on the basis, so that the pose deviation of the foot is inevitably caused. Therefore, the geometric parameters and the joint zero position of the foot type robot need to be calibrated, the positioning accuracy of the foot is improved, and a foundation is laid for the stable control of the robot.
The search of the prior art shows that the prior art has fewer calibrating means for the geometric parameters and the zero position of the joint of the foot type robot, and a few technical means in the aspect are mostly used for calibrating the driving joint in the robot, so that the overall consideration is lacked, and the positioning error caused by the size parameters of the component is difficult to compensate by a control system. For example, chinese patent application publication No. CN110374961A discloses a self-calibration device and a calibration method for a foot-type robot hydraulic actuator, which are used to calibrate a driving system of a robot individually; chinese patent application publication No. CN107065558A discloses a hexapod robot joint angle calibration method based on body attitude angle correction, which is used for calibrating joint angle deviation of a hexapod robot.
Disclosure of Invention
The embodiment of the invention aims to provide a geometric parameter and joint zero position self-calibration method, a device, electronic equipment and a medium, so as to at least solve the problems of incomplete calibration parameter consideration and poor calibration method universality in the related technology.
In order to achieve the above purpose, the technical solution adopted by the embodiment of the present invention is as follows:
according to a first aspect of the embodiments of the present invention, there is provided a geometric parameter and joint zero position self-calibration method for a foot robot, the method including: acquiring posture and joint position data of the body of the legged robot, wherein the feet of the legged robot are fixed on a calibration plate; respectively constructing a kinematic forward solution model between the body and the foot of the foot type robot, a first posture error model between the body and the foot of the foot type robot and a second posture error model between the feet of the foot type robot according to the posture and the joint position data, wherein the kinematic forward solution model is used for solving the corresponding foot posture according to the posture and the joint position data, and the first posture error model is used for describing the transmission relation between the corresponding leg connecting rod size error and the zero position error of the moving joint to the foot posture error; the second pose error model is used for describing pose error relations among different feet, which are influenced by geometric parameter deviations of corresponding legs and zero deviations of joints; and identifying and calculating the geometric parameters and the zero positions of the joints of the foot type robot by using the postures and joint position data of the foot type robot under multiple groups of postures based on the kinematics positive solution model, the first posture error model and the second posture error model until the residual error converges to a given threshold value or the iterative calculation converges, and finally obtaining the zero positions and the geometric parameters of the joints.
According to a second aspect of the embodiments of the present invention, there is provided a geometric parameter and joint zero position self-calibration apparatus for a legged robot, including: an acquisition unit for acquiring posture and joint position data of a body of a legged robot mounted on a calibration board; the model building unit is used for respectively building a kinematic positive solution model between the body and the foot of the foot type robot, a first position error model between the body and the foot of the foot type robot and a second position error model between the feet of the foot type robot according to the posture and the joint position data, wherein the kinematic positive solution model is used for solving the corresponding foot position and posture according to the posture of the body and the joint position data, and the first position error model is used for describing the transfer relationship from the corresponding leg connecting rod size error and the zero position error of the moving joint to the foot position and posture error; the second pose error model is used for describing pose error relations among different feet, which are influenced by geometric parameter deviations of corresponding legs and zero deviations of joints; and the calculation unit is used for identifying and calculating the geometric parameters and the joint zero position of the foot type robot by utilizing the postures and the joint position data of the foot type robot under multiple groups of posture shapes based on the kinematics positive solution model, the first posture error model and the second posture error model until the residual error converges to a given threshold value, and finally obtaining the joint zero position and the geometric parameters.
According to a third aspect of embodiments of the present invention, there is provided an electronic apparatus, including: one or more processors; a memory for storing one or more programs; when executed by the one or more processors, cause the one or more processors to implement a method as described in the first aspect.
According to a fourth aspect of embodiments of the present invention, there is provided a computer-readable storage medium having stored thereon a computer program which, when executed by a processor, implements the method according to the first aspect.
According to the technical scheme, the embodiment of the invention has the following beneficial effects: under the condition of only depending on one calibration plate, the established transfer relation model of the zero position error of the geometry and the joint and the pose error can simultaneously consider the influence of the geometric dimension error of a robot member and the zero position error of a driving joint on the positioning precision of the robot, under the condition of acquiring body postures and joint position information of the robot under a plurality of configurations, the geometric parameters of the robot member and the zero position self-calibration of the driving joint can be synchronously completed, and the positioning precision of the feet of the robot can be improved and the motion control effect of the robot can be improved by compensating the calibrated result into a control system.
Drawings
The accompanying drawings, which are included to provide a further understanding of the invention and are incorporated in and constitute a part of this specification, illustrate embodiments of the invention and together with the description serve to explain the invention and not to limit the invention. In the drawings:
FIG. 1 is a flow chart illustrating a method for geometric parameter and joint null self-calibration in accordance with an exemplary embodiment.
Fig. 2 is a schematic diagram of a biped robot configuration shown in accordance with an exemplary embodiment.
FIG. 3 is a schematic diagram of a calibration plate shown in accordance with an exemplary embodiment.
Fig. 4 is a schematic diagram of a biped robot configuration shown in accordance with an exemplary embodiment.
FIG. 5 is a flow chart illustrating the calculation of the geometry and joint null identification according to an exemplary embodiment.
FIG. 6 is a block diagram illustrating a geometry and joint null self-calibration arrangement in accordance with an exemplary embodiment.
Detailed Description
The present invention will be described in detail below with reference to the accompanying drawings and preferred embodiments, and the objects and effects of the present invention will become more apparent, and the present invention will be further described in 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.
Example 1:
fig. 1 is a flowchart illustrating a geometric parameter and joint zero position self-calibration method according to an exemplary embodiment, and referring to fig. 1, the present embodiment provides a geometric parameter and joint zero position self-calibration method for a foot robot, which is used for geometric parameter and joint zero position self-calibration, and includes the following steps:
step S101, acquiring body posture and joint position data of a legged robot, wherein the legged robot is installed on a calibration plate 2;
specifically, fig. 2 is a schematic view showing a biped robot structure according to an exemplary embodiment, fig. 3 is a schematic view showing a calibration plate according to an exemplary embodiment, and fig. 4 is a schematic view showing a biped robot structure according to an exemplary embodiment. The calibration plate is provided with the foot type machineThe positioning parts with the same number of human feet are used for connecting the feet of the legged robot and calibrating the position relation of the feet. The foot type robot forms include, but are not limited to, biped, quadruped, hexapod and other configurations, and the foot and the body are connected in sequence through a kinematic joint and a connecting rod; taking a biped robot as an example, as shown in fig. 1-3, a body 7 of the biped robot is respectively connected with a left foot part 14 and a right foot part 16 through a first kinematic joint 8, a second kinematic joint 9, a third kinematic joint 10, a first connecting rod 11, a fourth kinematic joint 12, a second connecting rod 13 and a fifth kinematic joint 15 in sequence, wherein the first kinematic joint 8, the second kinematic joint 9 and the third kinematic joint 10 integrally form a hip joint of the biped robot, the fourth kinematic joint 12 is a knee joint, and the fifth kinematic joint 15 is an ankle joint; the calibration plate is provided with a first positioning part 3 and a second positioning part 5 which are processed with high precision and are used for connecting the robot feet, the number of the first positioning part 3 and the second positioning part 5 is the same as that of the robot feet, a left foot coordinate system 4 and a right foot coordinate system 6 are respectively established on the calibration plate, the first positioning part 3 and the second positioning part 5 have accurate position relation, and the calibration plate is rigidly connected with the robot left foot part 14 and the robot right foot part 16 through a connection mode including but not limited to bolts. And defining a coordinate system
Relative to
Has accurate pose relation
。
Before acquiring the posture and joint position data of the body of the legged robot, the feet of the legged robot need to be installed on the calibration board, wherein the step of acquiring the posture data of the body of the legged robot comprises the following steps:
reading body posture information of the legged robot through a sensor, wherein the sensor comprises but is not limited to an inertial measurement unit; defining coordinates of body gestures read by a sensor relative to a global coordinate system
Comprises the following steps:
wherein,
respectively representing the rotation RPY Euler angles of the body coordinate system of the legged robot relative to the global coordinate system, and then representing the attitude matrix of the body coordinate system relative to the global coordinate system
Expressed as:
wherein,
indicating edgexRotation of the shaft
The attitude matrix of the angle is then used,
indicating edgezRotation of the shaft
The attitude matrix of the angle is then used,
indicating edgeyRotation of the shaft
An attitude matrix of angles;
，
，
，
，
，
respectively represent
，
Abbreviations of (a);
defining a position vector of a robot body coordinate system relative to a global coordinate system
Comprises the following steps:
wherein,x、y、zrespectively representing the body coordinate system of the robot relative to the global coordinate systemx、y、zPosition coordinates in the axial direction.
The method comprises the following steps of acquiring joint position data of a body of the legged robot, wherein the steps comprise:
reading of foot robot by sensors mounted on kinematic jointsiKinematic joint position information for a bar leg, including but not limited to encoders, grating scales, etc.; and the position information of the moving joint in each leg
Merge and write into vector form:
wherein
Is shown asiThe leg is firstnIndividual kinematic joint position information.
Step S102, respectively constructing a kinematic forward solution model between the body and the foot of the foot type robot, a first posture error model between the body and the foot of the foot type robot and a second posture error model between the feet of the foot type robot according to the posture and the joint position data, wherein the kinematic forward solution model is used for solving the corresponding foot posture according to the body posture and the joint position data, and the first posture error model is used for describing the transfer relationship between the corresponding leg connecting rod size error and the zero position error of the moving joint to the foot posture error; the second pose error model is used for describing pose error relations among different feet, which are influenced by geometric parameter deviations of corresponding legs and zero deviations of joints;
specifically, a step of constructing a kinematics forward solution model between the body and the foot of the legged robot, where the modeling method of the kinematics forward solution model includes, but is not limited to, a closed-loop vector method, a D-H parameter method, and an exponential product method, and the following methods are taken as examples in this example, and include:
and for each leg, deducing the position and posture information of the corresponding foot relative to a coordinate system of the body of the robot according to the geometric dimension parameters of the leg component of the robot and the position information of the motion joint.
For the firstiThe kinematics forward model between the body and the foot of the legged robot is expressed as:
wherein,
representing a positive kinematics solution function between the body and the foot of the legged robot;
is shown asiThe pose vector of an individual foot with respect to the global coordinate system is made up of position and pose vectors, i.e.
Wherein
And
respectively representiThe position and attitude vectors of the individual foot relative to the global coordinate system,
the position component is represented by a representation of,
representing the euler angles describing the pose;
is shown asiA vector formed by geometric parameters of each member in the strip leg;
and representing the pose vector of the body coordinate system of the foot type robot relative to the global coordinate system.
The method comprises the following steps of constructing a first posture error model between the body and the foot of the foot type robot, wherein the step comprises the following steps:
for each leg, according to the geometric dimension parameters of the leg component of the robot and the position information of the motion joint, constructing a transfer relation between the geometric dimension error of the leg component and the zero offset of the motion joint to the corresponding attitude offset of the foot, wherein the transfer relation is a first attitude error model.
Specifically, the attitude error model between the body and the foot of the legged robot is expressed as:
wherein,
representing the deviation between the theoretical and actual pose of the foot,
to represent
The corresponding error parameter is set to be,
is as followsiZero offset of the joints in the leg,
respectively represent
A transfer relation matrix of the foot pose deviation;
the first attitude error model, which is finally used for calibration, except for the parameters related to the position error, is represented as:
wherein,
representing the attitude vector of the foot positioning device on the calibration board under the global coordinate system,
the pose vector of the foot with respect to the global coordinate system obtained by the kinematic calculation,
respectively representing a 3-dimensional identity matrix and a three-dimensional zero matrix.
The step of constructing a second attitude error model between the feet of the foot robot comprises the following steps:
the method comprises the steps of obtaining a preset real pose relation of two feet through a calibration plate, obtaining a theoretical pose relation of the corresponding feet by utilizing a kinematics forward model of legs corresponding to the two feet, and constructing a transfer relation from a geometric parameter error of the corresponding legs and a zero position error of a joint to a pose error of the feet by taking the minimum difference value of the real pose and the theoretical pose of the two feet as an optimization target, wherein the transfer relation is a second pose error model.
Specifically, the pose error model between the feet is expressed as:
wherein,
a homogeneous transformation matrix representing the body relative to a world coordinate system,
is shown asiA homogeneous transformation matrix of the position and posture of each foot relative to a body coordinate system,
in the second attitude error model, function
Representing homogeneous transformation matrices
The accompanying characterization of (a) and (b),
wherein,
as a position vector
Is characterized by the antisymmetric matrix written as:
x、y、zrespectively representing three-dimensional vectors
Of (1). In the second attitude error model
Respectively represent
A transfer relation matrix of the foot pose deviation,
to represent
The corresponding error parameter is set to be,
is composed of
Corresponding zero offset.
Furthermore, to ensure linear independence of the error transfer matrix in the attitude error model, it is common toi、jSelection of adjacent legs, i.e. assuming roboticsnFoot, then existn-1 interfoot pose error model; different from the foot error model, the calibration board has high-precision pose relationship among the feet, and
the error model of (1) describes the pose relationship between two feet, and actually does not contain the position and posture information of the body of the legged robot, so that the position and posture information of the legged robot is not included in the error model
The six-dimensional pose error parameters are all available. Writing first attitude error models and second attitude error models corresponding to all legs in the foot robot into a matrix form to obtain an error model for self-calibration of geometric parameters and joint zero positions of the foot robot, and finally writing the following form:
wherein,
by
And
the structure of the utility model is that the material,
and
to correspond to
And
combinations of (a) and (b).
The step S103 will be described in further detail below by taking a bipedal robot as an example.
In the embodiment, the kinematics forward solution model of the legged robot is constructed by a D-H parameter method. Considering the fact that the traditional D-H parameters are singular when the pose error model is constructed and when the axes of adjacent joints are parallel, an improved D-H method (used when the axes of adjacent joints are not parallel) and a Hayati model (used when the axes of adjacent joints are parallel) are respectively constructed, and finally, the kinematics positive solution model in the embodiment totally comprises 3 types of pose transfer models for describing the states of adjacent members, namely:
wherein,
and
representing translation and rotation transformations, respectively, the first variable in brackets representing the reference axis of motion and the second variable representing the specific amount of motion;
representing the pose transfer relationship of the body coordinate system to the first kinematic joint 8,a、b、cindicating the amount of translation along the corresponding axis,
indicating the amount of rotation along the corresponding axis,
represents the amount of movement of the kinematic joint 8;
representing the posture transformation relation between coordinate systems described by the improved D-H method,
、 a、 
、
represents the corresponding D-H parameter;
representing the posture transformation relation among coordinate systems described by the Hayati model,
represents the corresponding D-H parameter; according to the geometrical relationship of the adjacent joints of the legged robot in the embodiment, the forward kinematic model of the legged robot can be obtained as follows:
wherein the function
Representing a homogeneous transformation matrix
Converting into a function of corresponding Euler angles and position coordinates; the corresponding D-H parameters are defined as shown in Table 1. It can be seen that each leg of the robot contains 21 geometric parameters and 5 joint zero-position parameters, so that the total number of parameters to be calibrated is 52, that is, at least 6 positions are required to realize calibration calculation of the robot. However, in general, to ensure a sufficiently good calibration effect, the number of patterns used for calibration is preferably much larger than the minimum number required, and covers the entire working space of the robot as much as possible.
Table 1: D-H parameters for kinematic positive solutions in the examples
Wherein,
respectively representiThe lower corner mark letter represents the position and posture transfer relation matrix of the body in the leg to the joint 8, the joint 8 to the joint 9, the joint 9 to the joint 10, the joint 10 to the joint 12 and the joint 12 to the joint 15The subsequent parameters of the adopted specific D-H modeling method are parameters in the corresponding method, and specifically comprise geometric parameters, joint zero position parameters and joint motion parameters.
The first and second attitude error models of the robot are constructed based on the error transfer relationship between adjacent members or motion joint coordinate systems
The pose error model corresponding to the pose error model can be written as:
wherein,
which is indicative of the error of the corresponding geometric parameter,
indicating a joint null. The concrete expression of the transmission relation between the geometric and joint zero offset and the pose error can be obtained by the following formula
On the basis, the first attitude error model of the foot robot can be written as follows:
wherein,
in the above formula, a 6-dimensional unit matrix,
the matrix in (1) can be obtained according to the corresponding geometric, joint zero offset and pose error transfer relationship matrix.
From the above results, a second posture error transfer model between foot 14 and foot 16 can be obtained as:
and combining the two error models to obtain an error model for self-calibration of the geometric parameters and the zero position of the joint of the foot robot:
wherein, each part in the error model can be written as:
and step S103, identifying and calculating geometric parameters and joint zero positions of the foot type robot by using the postures and joint position data of the foot type robot under multiple sets of posture forms based on the kinematics positive solution model, the first posture error model and the second posture error model until the residual error converges to a given threshold value or converges, wherein the finally obtained joint zero position and geometric parameters are calibration results. FIG. 5 is a flow chart illustrating the calculation of the geometry and joint null identification according to an exemplary embodiment. The specific process can be seen with reference to fig. 5 and described below:
(1) beginning: completing preparation work, including 1) establishing a kinematics positive solution model of the robot, a first position and posture error model and a second position and posture error model; 2) respectively fixing the left foot part and the right foot part of the robot on a first positioning part 3 and a second positioning part 5 of a calibration plate, and ensuring that the calibration plate is in a static state relative to a global coordinate system; 3) foot measurement using inertial measurement unitAttitude vector of part fixing device
And obtaining the pose vector of the foot fixing device 2 on the calibration plate relative to the position vector 1 through a design drawing
；
(2) Nominal geometry and joint zero position parameter definition of the robot: determining theoretical (nominal) geometry and joint zero position parameters of the robot, wherein the values are initial values of parameter identification calculation when the robot performs calibration;
(3) obtaining calibration experiment data: controlling the foot robot to move to different configurations, and measuring the joint position information after the foot robot is stationary
And body posture
(ii) a According to the first and second attitude error models in the invention, each attitude can be obtained
The basic requirement of calibration is that the number of the constraint equations is not less than the number of geometric and joint zero parameters to be calibrated;
(4) and (3) calculating a calibration model under the current parameters: calculated through a kinematics positive solution model of the robotmPose vectors of two feet under the configuration relative to a world coordinate system
(ii) a On the basis, according to the first and second attitude error models, a model for calibrating iterative computation can be obtained, namely:
wherein, the lower corner markkIndicating that the model is in the second placekIn the secondary iterative calculation process, the geometric and joint zero position parameters in the model are the design values of the robot during the first iteration.
(5) Deviation evaluation: judging whether the actual precision requirement is met or not according to the calculated deviation value, and finishing calibration if the actual precision requirement is met; if not, performing parameter identification calculation;
(6) and (3) parameter identification and calculation:
(7) updating geometric and joint zero parameters:
(8) calculating the positive solution of the robot kinematics under the current parameters: after the geometric and joint zero position parameters of the robot are updated, the pose vectors of the two feet relative to the world coordinate system under all the calibration poses are recalculated
；
(9) And (5) repeating the processes (4) to (8) until the deviation evaluation requirement is met or the iterative calculation is converged, namely completing the whole calibration process, and finally obtaining the geometric and joint zero position parameters which are the calibration result.
Corresponding to the embodiment of the geometric parameter and joint zero position self-calibration method, the application also provides an embodiment of a geometric parameter and joint zero position self-calibration device. FIG. 6 is a block diagram illustrating a geometry and joint null self-calibration apparatus for a legged robot, according to an exemplary embodiment, comprising:
an acquisition unit 21 for said acquiring posture and joint position data of a body of a legged robot mounted on a calibration board;
the model building unit 22 is configured to respectively build a kinematic forward solution model between the body and the foot of the foot robot, a first posture error model between the body and the foot of the foot robot, and a second posture error model between the feet of the foot robot according to the posture and the joint position data, where the kinematic forward solution model is configured to solve the corresponding foot posture according to the posture of the body and the joint position data, and the first posture error model is configured to describe a transfer relationship between the corresponding leg link size error and the zero position error of the moving joint to the foot posture error; the second pose error model is used for describing pose error relations among different feet, which are influenced by geometric parameter deviations of corresponding legs and zero deviations of joints;
and the calculating unit 23 is configured to perform identification calculation on the geometric parameters and the joint zero position of the foot robot by using the postures and joint position data of the foot robot under multiple sets of posture shapes based on the kinematic positive solution model, the first posture error model and the second posture error model until a residual error converges to a given threshold value, and finally obtain the joint zero position and the geometric parameters.
The above-mentioned serial numbers of the embodiments of the present invention are merely for description and do not represent the merits of the embodiments.
In the above embodiments of the present invention, the descriptions of the respective embodiments have respective emphasis, and for parts that are not described in detail in a certain embodiment, reference may be made to related descriptions of other embodiments.
In the embodiments provided in the present application, it should be understood that the disclosed technology can be implemented in other ways. The above-described device embodiments are merely illustrative, and for example, the division of the units may be a logical division, and in actual implementation, there may be another division, for example, multiple units or components may be combined or integrated into another system, or some features may be omitted, or not executed. In addition, the shown or discussed mutual coupling or direct coupling or communication connection may be an indirect coupling or communication connection through some interfaces, units or modules, and may be in an electrical or other form.
The units described as separate parts may or may not be physically separate, and parts displayed as units may or may not be physical units, may be located in one place, or may be distributed on a plurality of units. Some or all of the units can be selected according to actual needs to achieve the purpose of the solution of the embodiment.
In addition, functional units in the embodiments of the present invention may be integrated into one processing unit, or each unit may exist alone physically, or two or more units are integrated into one unit. The integrated unit can be realized in a form of hardware, and can also be realized in a form of a software functional unit.
The integrated unit, if implemented in the form of a software functional unit and sold or used as a stand-alone product, may be stored in a computer readable storage medium. Based on such understanding, the technical solution of the present invention may be embodied in the form of a software product, which is stored in a storage medium and includes instructions for causing a computer device (which may be a personal computer, a server, or a network device) to execute all or part of the steps of the method according to the embodiments of the present invention. And the aforementioned storage medium includes: a U-disk, a Read-Only Memory (ROM), a Random Access Memory (RAM), a removable hard disk, a magnetic or optical disk, and other various media capable of storing program codes.
The above description is only for the purpose of illustrating the preferred embodiments of the present invention and is not to be construed as limiting the invention, and any modifications, equivalents, improvements and the like that fall within the spirit and principle of the present invention are intended to be included therein.
Claims (10)
1. A geometric parameter and joint zero position self-calibration method is used for geometric parameter and joint zero position self-calibration of a foot robot, and is characterized by comprising the following steps:
acquiring posture and joint position data of the body of the legged robot, wherein the feet of the legged robot are fixed on a calibration plate;
respectively constructing a kinematic forward solution model between the body and the foot of the foot type robot, a first posture error model between the body and the foot of the foot type robot and a second posture error model between the feet of the foot type robot according to the posture and the joint position data, wherein the kinematic forward solution model is used for solving the corresponding foot posture according to the posture and the joint position data, and the first posture error model is used for describing the transmission relation between the corresponding leg connecting rod size error and the zero position error of the moving joint to the foot posture error; the second pose error model is used for describing pose error relations among different feet, which are influenced by geometric parameter deviations of corresponding legs and zero deviations of joints;
and identifying and calculating the geometric parameters and the zero positions of the joints of the foot type robot by using the postures and joint position data of the foot type robot under multiple groups of postures based on the kinematics positive solution model, the first posture error model and the second posture error model until the residual error converges to a given threshold value or the iterative calculation converges, and finally obtaining the zero positions and the geometric parameters of the joints.
2. The method for self-calibration of geometric parameters and zero positions of joints according to claim 1, wherein the calibration plate is provided with positioning parts, the number of which is the same as that of the feet of the legged robot, for connecting the feet of the legged robot and calibrating the position relation of the feet.
3. The method for zero position self-calibration of geometric parameters and joints according to claim 1, wherein the step of constructing the first position error model from the body to the foot of the legged robot comprises:
for each leg, according to the geometric dimension parameters of the leg component of the robot and the position information of the motion joint, constructing a transfer relation between the geometric dimension error of the leg component and the zero offset of the motion joint to the corresponding attitude offset of the foot, wherein the transfer relation is a first attitude error model.
4. The method for zero position self-calibration of geometric parameters and joints according to claim 1, wherein the step of constructing a second attitude error model between the feet of the legged robot comprises:
and obtaining the real pose relations of two preset feet through a calibration plate, simultaneously obtaining the theoretical pose relations of the two feet by utilizing the kinematics forward solution model, and constructing a transfer relation from the corresponding leg geometric parameter errors and the joint zero position errors to the foot pose errors by taking the minimum difference between the real pose and the theoretical pose of the two feet as an optimization target, wherein the transfer relation is a second pose error model.
5. A geometrical parameter and joint zero position self-calibration device, which is used for a foot type robot, is characterized by comprising:
an acquisition unit for acquiring posture and joint position data of a body of a legged robot mounted on a calibration board;
the model building unit is used for respectively building a kinematic positive solution model between the body and the foot of the foot type robot, a first position error model between the body and the foot of the foot type robot and a second position error model between the feet of the foot type robot according to the posture and the joint position data, wherein the kinematic positive solution model is used for solving the corresponding foot position and posture according to the posture of the body and the joint position data, and the first position error model is used for describing the transfer relationship from the corresponding leg connecting rod size error and the zero position error of the moving joint to the foot position and posture error; the second pose error model is used for describing pose error relations among different feet, which are influenced by geometric parameter deviations of corresponding legs and zero deviations of joints;
and the calculation unit is used for identifying and calculating the geometric parameters and the joint zero position of the foot type robot by utilizing the postures and the joint position data of the foot type robot under multiple groups of posture shapes based on the kinematics positive solution model, the first posture error model and the second posture error model until the residual error converges to a given threshold value, and finally obtaining the joint zero position and the geometric parameters.
6. The device for automatically calibrating geometric parameters and zero positions of joints according to claim 5, wherein the calibration plate is provided with positioning parts which are as many as the feet of the legged robot, are used for connecting the feet of the legged robot, and calibrate the position relation of the feet.
7. The device for self-calibration of geometric parameters and zero position of joints according to claim 5, wherein constructing a first position error model between the body and the foot of the legged robot comprises:
for each leg, according to the geometric dimension parameters of the leg component of the robot and the position information of the motion joint, constructing a transfer relation between the geometric dimension error of the leg component and the zero offset of the motion joint to the corresponding attitude offset of the foot, wherein the transfer relation is a first attitude error model.
8. The device for self-calibration of geometric parameters and zero position of joints according to claim 5, wherein constructing a second model of attitude errors between feet of the legged robot comprises:
and obtaining the real pose relations of two preset feet through a calibration plate, simultaneously obtaining the theoretical pose relations of the two feet by utilizing the kinematics forward solution model, and constructing a transfer relation from the corresponding leg geometric parameter errors and the joint zero position errors to the foot pose errors by taking the minimum difference between the real pose and the theoretical pose of the two feet as an optimization target, wherein the transfer relation is a second pose error model.
9. An electronic device, comprising:
one or more processors;
a memory for storing one or more programs;
when executed by the one or more processors, cause the one or more processors to implement the method of any one of claims 1-4.
10. A computer-readable storage medium, on which a computer program is stored which, when being executed by a processor, carries out the method according to any one of claims 1-4.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011560013.6A CN112276959B (en) | 2020-12-25 | 2020-12-25 | Geometric parameter and joint zero position self-calibration method and device, electronic equipment and medium |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011560013.6A CN112276959B (en) | 2020-12-25 | 2020-12-25 | Geometric parameter and joint zero position self-calibration method and device, electronic equipment and medium |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112276959A true CN112276959A (en) | 2021-01-29 |
| CN112276959B CN112276959B (en) | 2021-03-30 |
Family
ID=74426287
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011560013.6A Active CN112276959B (en) | 2020-12-25 | 2020-12-25 | Geometric parameter and joint zero position self-calibration method and device, electronic equipment and medium |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112276959B (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113345030A (en) * | 2021-06-17 | 2021-09-03 | 三一重机有限公司 | Calibration method and device for sensor of working machine, working machine and electronic equipment |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101763118A (en) * | 2002-03-18 | 2010-06-30 | 索尼株式会社 | Robot device, device and method for controlling operation of legged locomotion robot, sensor system for legged locomotion robot, and moving body device |
| US20130131865A1 (en) * | 2011-11-22 | 2013-05-23 | Disney Enterprises, Inc. | Kinematic and Dynamic Calibration Methods for Legged Robots with Force-Controlled Joints |
| CN105808882A (en) * | 2016-03-29 | 2016-07-27 | 郑州轻工业学院 | Calibration method and device for movement parameters of reptile-imitated four-foot walking robot |
| US9778132B1 (en) * | 2015-12-16 | 2017-10-03 | X Development Llc | Methods and systems for force sensor calibration |
| CN208898448U (en) * | 2018-09-29 | 2019-05-24 | 浙江迈睿机器人有限公司 | A kind of calibrating device suitable for two-wheel differential fork truck |
| US20200189110A1 (en) * | 2017-06-29 | 2020-06-18 | Sony Interactive Entertainment Inc. | Robot control apparatus, control method and control program |
-
2020
- 2020-12-25 CN CN202011560013.6A patent/CN112276959B/en active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101763118A (en) * | 2002-03-18 | 2010-06-30 | 索尼株式会社 | Robot device, device and method for controlling operation of legged locomotion robot, sensor system for legged locomotion robot, and moving body device |
| US20130131865A1 (en) * | 2011-11-22 | 2013-05-23 | Disney Enterprises, Inc. | Kinematic and Dynamic Calibration Methods for Legged Robots with Force-Controlled Joints |
| US9778132B1 (en) * | 2015-12-16 | 2017-10-03 | X Development Llc | Methods and systems for force sensor calibration |
| CN105808882A (en) * | 2016-03-29 | 2016-07-27 | 郑州轻工业学院 | Calibration method and device for movement parameters of reptile-imitated four-foot walking robot |
| US20200189110A1 (en) * | 2017-06-29 | 2020-06-18 | Sony Interactive Entertainment Inc. | Robot control apparatus, control method and control program |
| CN208898448U (en) * | 2018-09-29 | 2019-05-24 | 浙江迈睿机器人有限公司 | A kind of calibrating device suitable for two-wheel differential fork truck |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113345030A (en) * | 2021-06-17 | 2021-09-03 | 三一重机有限公司 | Calibration method and device for sensor of working machine, working machine and electronic equipment |
| CN113345030B (en) * | 2021-06-17 | 2024-01-02 | 三一重机有限公司 | Calibration method and device for working machine sensor, working machine and electronic equipment |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112276959B (en) | 2021-03-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109153125B (en) | Method for orienting an industrial robot and industrial robot | |
| CN110193829B (en) | Robot precision control method for coupling kinematics and rigidity parameter identification | |
| CN107042528B (en) | A kind of Kinematic Calibration system and method for industrial robot | |
| Zhuang | Self-calibration of parallel mechanisms with a case study on Stewart platforms | |
| KR102050895B1 (en) | Calibration and programming of robots | |
| CN111168719B (en) | Robot calibration method and system based on positioning tool | |
| CN112105484B (en) | Robot kinematics parameter self-calibration method, system and storage device | |
| CN104608129B (en) | Based on the robot calibration method of plane restriction | |
| CN110815206B (en) | Kinematics calibration method for Stewart parallel robot | |
| CN106457562B (en) | Method and robot system for calibration machine people | |
| CN106777656B (en) | Industrial robot absolute accuracy calibration method based on PMPSD | |
| CN111055273A (en) | Two-step error compensation method for robot | |
| CN106338990A (en) | Industrial robot DH parameter calibration and zero position calibration method based on laser tracker | |
| CN109176531A (en) | A kind of tandem type robot kinematics calibration method and system | |
| CN113160334B (en) | Dual-robot system calibration method based on hand-eye camera | |
| CN105444672A (en) | Orthogonal plane calibrating method and orthogonal plane calibrating system of relation between laser distance measuring device and end of mechanical arm | |
| CN112767493B (en) | Machine vision calibration method for kinematic parameters of Stewart platform | |
| Boby | Identification of elasto-static parameters of an industrial robot using monocular camera | |
| Santolaria et al. | Self-alignment of on-board measurement sensors for robot kinematic calibration | |
| Xiao et al. | A new fixed axis-invariant based calibration approach to improve absolute positioning accuracy of manipulators | |
| Liska et al. | Hand-eye calibration of a laser profile scanner in robotic welding | |
| CN112276959B (en) | Geometric parameter and joint zero position self-calibration method and device, electronic equipment and medium | |
| CN114654466B (en) | Automatic calibration method, device, system, electronic equipment and storage medium | |
| CN114161411B (en) | Visual-based multi-legged robot kinematics parameter calibration method | |
| Shen et al. | Automatic camera calibration for a multiple-sensor integrated coordinate measurement system |
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 |