Robot control method, device and equipment
By constructing a static stiffness model and using a quantum particle swarm optimization algorithm, the position of the drilling and riveting robot is optimized, and the problem of insufficient rigidity of the robot structure is solved and the quality and efficiency of drilling and riveting operation is improved.
Patent Information
- Application Number
- CN202411194330.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-28
- Publication Date
- 2024-11-26
AI Technical Summary
The structural stiffness of the multi-joint tandem robot is insufficient, which affects its drilling and riveting operation quality in aviation manufacturing.
By constructing the static stiffness model of the drilling and riveting robot, the relationship between its stiffness index and joint angle in the processing plane is determined, and combined with the Jacobian matrix and punishment factor, an evaluation function is constructed, and the quantum particle swarm optimization algorithm is used to search for the optimal position. Optimize the stiffness performance of the robot.
It improves the stiffness performance and machining accuracy of the robot in drilling and riveting operations, enhances robustness and adaptability, reduces calculation time, and improves work efficiency.
Smart Images

Figure CN119017413A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of robotics technology, and in particular to a robot control method, device and equipment. Background Art
[0002] Due to the significant increase in the demand for large aircraft, the demand for automated production in the aviation manufacturing field has also gradually increased. Industrial robots are increasingly used in aviation manufacturing due to their advantages such as strong operational flexibility, high intelligence and low space requirements. The connection of aircraft fuselages is largely in the form of riveting, so drilling and riveting robots can be used to perform drilling and riveting operations on structural parts.
[0003] However, since the robot is a multi-joint serial robot, its structural stiffness has obvious disadvantages, which seriously affects its processing quality. Therefore, how to improve the stiffness performance of the robot and improve its application value in high-end assembly manufacturing has become the focus of current research. Summary of the invention
[0004] In view of this, the present application provides a robot control method, device and equipment to improve the stiffness performance of the robot during drilling and riveting operations, so as to improve the processing quality of the drilling and riveting operations.
[0005] Specifically, the present application is implemented through the following technical solutions: In a first aspect, the present application provides a robot control method, which is used to control a drilling and riveting robot so that the drilling and riveting robot performs drilling and riveting operations on a structural member; the robot control method comprises: Constructing a static stiffness model of the drilling and riveting robot; wherein the static stiffness model is used to characterize the relationship between the force vector of the end effector and the deformation and joint stiffness matrix of the end effector; Determining a first correspondence between a stiffness index of the drilling and riveting robot and a rotation angle of each joint in a processing plane according to a static stiffness model of the drilling and riveting robot; Determine a second correspondence between the operability value of the drilling and riveting robot and each joint angle according to the Jacobian matrix of the drilling and riveting robot, the inverse matrix of the Jacobian matrix, and the penalty factor of the drilling and riveting robot; Constructing an evaluation function according to the first corresponding relationship and the second corresponding relationship; wherein the evaluation function takes into account the stiffness index of the drilling and riveting robot in the processing plane and the operability of the drilling and riveting robot; Under the limit constraints and state constraints of the drilling and riveting robot, the angles of the joints of the drilling and riveting robot are used as optimization variables, the evaluation function is used as the objective function, and the optimal posture of the drilling and riveting robot is searched by using a quantum particle swarm optimization algorithm, and the drilling and riveting robot is controlled according to the optimal posture; wherein the optimal posture includes the optimal angles of the joints of the drilling and riveting robot when machining the target hole position corresponding to the state constraint.
[0006] A second aspect of the present application provides a robot control device, which is used to control a drilling and riveting robot so that the drilling and riveting robot performs drilling and riveting operations on structural parts; the robot control device includes a construction module, a determination module and a processing module; wherein, The construction module is used to construct a static stiffness model of the drilling and riveting robot; wherein the static stiffness model is used to characterize the relationship between the force vector of the end effector and the deformation and joint stiffness matrix of the end effector; The determination module is used to determine a first correspondence between a stiffness index of the drilling and riveting robot and each joint angle in a processing plane according to a static stiffness model of the drilling and riveting robot; The determination module is used to determine a second correspondence between the operability value of the drilling and riveting robot and each joint angle according to the Jacobian matrix of the drilling and riveting robot, the inverse matrix of the Jacobian matrix, and the penalty factor of the drilling and riveting robot; The construction module is used to construct an evaluation function according to the first corresponding relationship and the second corresponding relationship; wherein the evaluation function takes into account the stiffness index of the drilling and riveting robot in the processing plane and the operability of the drilling and riveting robot; The processing module is used to use the angle of each joint of the drilling and riveting robot as the optimization variable and the evaluation function as the objective function under the limit constraints and state constraints of the drilling and riveting robot, search for the optimal posture of the drilling and riveting robot by using the quantum particle swarm optimization algorithm, and control the drilling and riveting robot according to the optimal posture; wherein the optimal posture includes the optimal angle of each joint of the drilling and riveting robot when processing the target hole position corresponding to the state constraint.
[0007] A third aspect of the present application provides a robot control device, which is used to control a drilling and riveting robot so that the drilling and riveting robot performs drilling and riveting operations on structural parts; the robot control device includes a memory, a processor, and a computer program stored in the memory and executable on the processor, and when the processor executes the program, the steps of any one of the methods provided in the first aspect of the present application are implemented.
[0008] The fourth aspect of the present application provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the steps of any one of the methods provided in the first aspect of the present application.
[0009] The robot control method, device and equipment provided by the present application, in the first aspect, constructs a static stiffness model of the drilling and riveting robot, and determines the first correspondence between the stiffness index of the drilling and riveting robot in the processing plane and the rotation angles of each joint according to the static stiffness model of the drilling and riveting robot, and determines the second correspondence between the operability value of the drilling and riveting robot and the rotation angles of each joint according to the Jacobian matrix of the drilling and riveting robot, the inverse matrix of the Jacobian matrix, and the penalty factor of the drilling and riveting robot, and then constructs an evaluation function according to the first correspondence and the second correspondence. In this way, on the one hand, the evaluation function can cope with changes under different working conditions and can enhance robustness and adaptability. On the other hand, the stiffness index and operability can be comprehensively considered in the evaluation function. Operability, so that the robot can maintain the best stiffness and operability in different processing positions and postures, which can improve the stiffness performance of the robot in drilling and riveting operations and improve processing accuracy; secondly, when determining the first correspondence between the stiffness index of the drilling and riveting robot in the processing plane and the rotation angle of each joint, the static stiffness model is used to characterize the relationship between the force vector of the end effector and the deformation of the end effector and the joint stiffness matrix, which can accurately predict and compensate for the displacement of the robot end caused by the force, ensuring the high precision of the drilling and riveting operation; thirdly, when determining the second correspondence between the operability value of the drilling and riveting robot and the rotation angle of each joint, by introducing a penalty factor, the operability of the robot at different joint angles can be accurately determined, and the overall performance of the robot can be optimized. Fourthly, when searching for the optimal posture, the search is based on the quantum particle swarm optimization algorithm, which can quickly find the optimal posture, reduce the calculation time, and improve work efficiency. BRIEF DESCRIPTION OF THE DRAWINGS
[0010] Figure 1 A flowchart of a first embodiment of a robot control method provided in this application; Figure 2 A flowchart of a second embodiment of the robot control method provided in this application; Figure 3 A schematic diagram of a rigidity ellipsoid in three-dimensional space shown as an exemplary embodiment of the present application; Figure 4 A schematic diagram of a property constraint shown in an exemplary embodiment of the present application; Figure 5 A flowchart of a third embodiment of the robot control method provided in this application; Figure 6 A hardware structure diagram of the robot control device of the present application; Figure 7 This is a schematic structural diagram of the first embodiment of the robot control device provided in this application. DETAILED DESCRIPTION
[0011] Here, exemplary embodiments are described in detail, and examples thereof are shown in the accompanying drawings. When the following description refers to the drawings, unless otherwise indicated, the same numbers in different drawings represent the same or similar elements. The implementations described in the following exemplary embodiments do not represent all implementations consistent with the present application.
[0012] The terms used in this application are only for the purpose of describing specific embodiments and are not intended to limit this application. The singular forms of "a", "said" and "the" used in this application are also intended to include plural forms, unless the context clearly indicates other meanings. It should also be understood that the term "and / or" used in this article refers to and includes any or all possible combinations of one or more associated listed items.
[0013] It should be understood that although the terms first, second, third, etc. may be used in the present application to describe various information, these information should not be limited to these terms. These terms are only used to distinguish the same type of information from each other. For example, without departing from the scope of the present application, the first information may also be referred to as the second information, and similarly, the second information may also be referred to as the first information. Depending on the context, the word "if" as used herein may be interpreted as "at the time of" or "when" or "in response to determining".
[0014] The present application provides a robot control method, device and equipment for improving the stiffness performance of the robot during drilling and riveting operations, so as to improve the processing quality of the drilling and riveting operations.
[0015] It should be noted that the stiffness of a drilling and riveting robot mainly depends on three aspects: (1) the geometric shape of the connecting rod structure and the properties of the materials used, which affect the stiffness of the connecting rod structure and thus the stiffness of the robot; (2) the stiffness of the drive mechanism and the reduction mechanism. For industrial robots, this is the stiffness of the angular joint, which is mainly affected by the torque output by the drive system and the combined effect of the reducer; (3) the geometric configuration of the robot, that is, the working posture of the robot (i.e. the position of the robot when working).
[0016] The first two methods are often used in the design stage of the robot. For mature robots used for drilling and riveting operations, it is unrealistic to change the connecting rod structure. Therefore, the only way to improve the stiffness is to optimize the robot's posture.
[0017] Furthermore, for drilling and riveting operations, the processing equipment needs to have the freedom of movement in the three directions of X, Y, and Z and the two degrees of rotation in the normal directions A and B of the surface to be processed. The processing task can be completed by meeting these five degrees of freedom requirements. Industrial robots usually have 6 degrees of freedom, and there is a redundant degree of freedom of one-dimensional rotation around the tool axis relative to the processing task. Therefore, the redundant degrees of freedom can be used to carry out posture optimization to improve its stiffness performance in drilling and riveting operations, thereby improving the processing quality.
[0018] Specific embodiments are given below to introduce the technical solution of the present application in detail.
[0019] Figure 1 This is a flow chart of the first embodiment of the robot control method provided by this application. Please refer to Figure 1 The robot control method provided in this embodiment is used to control a drilling and riveting robot so that the drilling and riveting robot performs drilling and riveting operations on structural parts; the robot control method includes: S101, constructing a static stiffness model of the drilling and riveting robot.
[0020] It should be noted that the robot control method and apparatus provided in the present application are applied to a robot control device, which may be integrated on the robot or may be a control device independent of the robot, and the present application does not limit it.
[0021] Specifically, the stiffness of the robot is the ability of the robot body structure to resist deformation when the robot is subjected to external forces. Furthermore, for the drilling and riveting robot used for hole making and riveting, the robot always remains stationary during operation, and the static stiffness has a great influence on the quality of the processing results. The end effector and connecting rod of the drilling and riveting robot are in a rigid state during operation. Therefore, in this embodiment, the static stiffness model of the drilling and riveting robot is constructed only at the joint position.
[0022] Referring to the above description, it can be understood that the static stiffness model is used to characterize the relationship between the force vector of the end effector and the deformation and joint stiffness matrix of the end effector; Further, optional, Figure 2 Please refer to the flowchart of the second embodiment of the robot control method provided in this application. Figure 2 Based on the above embodiment, the process of constructing the static stiffness model of the drilling and riveting robot may include: S201. According to a preset stiffness condition and a preset virtual work condition, a first functional relationship corresponding to the virtual work condition is determined by using the virtual work principle; wherein the virtual work condition includes a force vector of an end effector of the drilling and riveting robot, a virtual displacement of the end effector under the action of the force vector, and a force vector of each joint of the drilling and riveting robot, and a virtual displacement of each joint under the action of the force vector.
[0023] In this embodiment, the preset stiffness condition is that the end effector and connecting rod of the drilling and riveting robot are in a rigid state during operation, and only the joint is deformed. Furthermore, the preset virtual work condition is that the force vector of the end effector of the drilling and riveting robot is F, and the virtual displacement of the end effector under the action of the force vector is , Force vectors of each joint of the drilling and riveting robot , and the virtual displacement of each joint under the action of the force vector is .
[0024] At this time, according to the principle of virtual work, the first functional relationship corresponding to the virtual work condition is determined as: ; (1) in, Virtual work done by the drilling and riveting robot; is the force vector of the end effector of the drilling and riveting robot; is the force vector of each joint of the drilling and riveting robot; is the virtual displacement of the end effector under the action of the force vector; is the virtual displacement of each joint under the action of force vector.
[0025] S202: Determine a second functional relationship between the virtual displacement of the end effector and the virtual displacement of each joint.
[0026] Specifically, according to the Jacobian matrix and differential motion of the robot, the second functional relationship between the virtual displacement of the end effector and the virtual displacement of each joint can be further determined, and the second functional relationship is as follows: ; (2) in, is the virtual displacement of the end effector under the action of the force vector, is the virtual displacement of each joint under the action of the force vector, is the Jacobian matrix of the drilling and riveting robot.
[0027] Specifically, the Jacobian matrix is used to describe the relationship between the position change of the end effector and the change of each joint angle. For example, when the robot system is in a certain posture, the Jacobian matrix can be used to calculate the expected change of the end effector position under a given joint angle change.
[0028] S203. Determine a third functional relationship between the force vector of each joint and the force vector of the end effector according to the first functional relationship and the second functional relationship.
[0029] Specifically, by combining the first functional relationship and the second functional relationship, that is, combining formula (1) and formula (2), a third functional relationship between the force vector of each joint and the force vector of the end effector can be further determined. The third functional relationship is as follows: ; (3) in, is the force vector of each joint of the drilling and riveting robot, is the Jacobian matrix, is the force vector of the end effector of the drilling and riveting robot.
[0030] S204. Determine the seventh functional relationship between the stiffness matrix of the end effector and the joint stiffness matrix based on the fourth functional relationship between the force vector of the end effector and the deformation of the end effector, the fifth functional relationship between the force vector of each joint and the deformation of each joint, the sixth functional relationship between the deformation of the end effector and the deformation of each joint, and the third functional relationship.
[0031] Specifically, according to the elastic deformation and small deformation principle in material mechanics, it can be known that the fourth functional relationship between the force vector of the end effector and the deformation of the end effector is as follows: ; (4) in, is the force vector of the end effector of the drilling and riveting robot, is the stiffness matrix of the end effector, is the deformation of the end effector, which can be characterized by generalized displacement.
[0032] Specifically, when the robot end effector is subjected to external force, each joint of the robot will also be subjected to force and produce some deformation. The fifth functional relationship between the force vector of each joint and the deformation of each joint is as follows: ; (5) in, is the force vector of each joint of the robot, is the deformation of each joint of the robot, which can be represented by generalized displacement, is the joint stiffness matrix.
[0033] Specifically, according to the Jacobian matrix and differential transformation, it can be known that the sixth functional relationship between the deformation of the robot end effector and the deformation of each joint of the robot is as follows: ; (6) in, is the deformation of the robot end effector, is the Jacobian matrix, is the deformation of each joint of the robot.
[0034] Further, after obtaining the fourth functional relationship between the force vector of the end effector and the deformation of the end effector, the fifth functional relationship between the force vector of each joint and the deformation of each joint, and the sixth functional relationship between the deformation of the end effector and the deformation of each joint, combined with the third functional relationship, the seventh functional relationship between the stiffness matrix of the end effector and the joint stiffness matrix can be determined; wherein, the seventh functional relationship between the stiffness matrix of the end effector and the joint stiffness matrix is as follows: ; (7) in, is the stiffness matrix of the end effector, is the pseudo-inverse transpose matrix of the Jacobian matrix, is the joint stiffness matrix, is the inverse of the Jacobian matrix.
[0035] It should be noted that the seventh functional relationship between the stiffness matrix of the end effector and the joint stiffness matrix can map the deformation of each joint of the robot to the deformation of the end effector of the robot. Linking the two can help analyze the complex relationship between the stiffness of the end effector and the joint stiffness in the robot.
[0036] S205. Determine a static stiffness model of the drilling and riveting robot according to the fourth functional relationship and the seventh functional relationship.
[0037] Specifically, the fourth functional relationship and the seventh functional relationship are combined, the seventh functional relationship is substituted into the fourth functional relationship, and further simplified operations are performed to obtain the static stiffness model of the drilling and riveting robot. The static stiffness model of the drilling and riveting robot is as follows: ; (8) in, is the force vector of the end effector of the drilling and riveting robot, is the pseudo-inverse transpose matrix of the Jacobian matrix, is the joint stiffness matrix, is the inverse matrix of the Jacobian matrix, is the deformation of the robot end effector.
[0038] It can be understood that, by combining the relationship between the force vector of the robot's end effector and the deformation of the end effector, as well as the relationship between the stiffness matrix of the end effector and the joint stiffness matrix, the relationship between the force vector of the robot's end effector and the deformation of the end effector and the joint stiffness matrix can be obtained, which is used as the static stiffness model of the drilling and riveting robot.
[0039] The method provided in this embodiment gives a method of static stiffness model. Through this method, the static stiffness model of the robot can be accurately established, so as to analyze the stress and deformation of each joint and end effector under different working conditions through the static stiffness model, so as to perform posture optimization based on this and improve the stiffness performance of the robot.
[0040] S102: Determine a first corresponding relationship between a stiffness index of the drilling and riveting robot and each joint angle in a processing plane according to a static stiffness model of the drilling and riveting robot.
[0041] Specifically, in a possible implementation manner, the specific implementation process of this step may include: S1021. Obtain a third corresponding relationship between each joint angle and the cutting force applied to the end effector.
[0042] Specifically, according to the different dimensions of each element in the static stiffness model of the drilling and riveting robot, the relationship between the force and deformation of the robot can be expressed as: ; (9) in, is the cutting force on the end effector, is the torque matrix of the end effector under the cutting force, is the translation matrix of the end effector, is the rotation matrix of the end effector under the cutting force, is the force-translation stiffness submatrix, is the force-rotation stiffness submatrix, is the torque-translation stiffness submatrix, is the torque-rotation stiffness submatrix.
[0043] It needs to be explained that the force-translation stiffness submatrix is used to describe the displacement change of the robot in the displacement direction under the action of unit force; the force-rotational stiffness submatrix is used to describe the posture change of the robot in the rotation direction under the action of unit force; the torque-translation stiffness submatrix is used to describe the displacement change of the robot in the displacement direction under the action of unit torque; the torque-rotational stiffness submatrix is used to describe the posture change of the robot in the rotation direction under the action of unit torque.
[0044] S1022. Obtain a simplified relationship between the cutting force exerted on the end effector and the end linear displacement according to the static stiffness model.
[0045] Specifically, in the actual operation of the drilling and riveting robot, the torque on the end effector of the robot is much smaller than the cutting force on the end effector, and in the angular displacement and linear displacement of the end effector, the linear displacement of the end effector has a greater impact on the operation accuracy than the angular displacement of the end effector. Therefore, according to the static stiffness model of the robot, the third corresponding relationship can be simplified to obtain the simplified relationship between the cutting force on the end effector and the end linear displacement. The simplified relationship is as follows: ; (10) in, is the cutting force on the end effector, is the linear displacement of the end effector, is the force-translation stiffness submatrix.
[0046] S1023. According to the simplified relationship, and according to the conditions satisfied by the linear displacement generated by the cutting force acting on the end effector, a stiffness ellipsoid equation corresponding to the cutting force is constructed; wherein the stiffness ellipsoid equation describes the stiffness characteristics of the end effector in different directions.
[0047] Specifically, if the cutting force on the end effector is F, when F is the unit matrix, the linear displacement generated by the cutting force acting on the end effector satisfies the following condition: .
[0048] At this time, according to the simplified relationship between the cutting force on the end effector and the end linear displacement, the following formula can be obtained: ; (11) in, is the cutting force modulus of the end effector, is the cutting force on the end effector, is the linear displacement of the end effector, is the force-translation stiffness submatrix.
[0049] In three-dimensional space, , represents an ellipsoid. Furthermore, the direction of the main axis of this ellipsoid is The eigenvectors of are λ1, λ2 and λ3, which represent the squares of the stiffness exponents in the three directions.
[0050] It can be understood that, as shown in the above formula, for any action on the robot end effector that can produce a linear displacement Cutting force , both have Furthermore, by mapping the above relationship into three-dimensional space, the stiffness ellipsoid equation corresponding to the cutting force on the end effector can be obtained. The stiffness ellipsoid equation can be expressed as follows: ; (12) in, is the semi-axis length of the ellipsoid in the x-axis direction, is the semi-axis length of the ellipsoid in the y-axis direction, is the semi-axis length of the ellipsoid in the z-axis direction.
[0051] Figure 3 This is a schematic diagram of a rigid ellipsoid in three-dimensional space according to an exemplary embodiment of the present application. Figure 3 It should be noted that the ellipsoid is a three-dimensional geometric shape, and its quadratic equation is expressed as ,in, It is a symmetric positive definite matrix. As the stiffness matrix of the ellipsoid, by mapping it into three-dimensional space, we can get the stiffness ellipsoid matrix.
[0052] Furthermore, the force-translation stiffness submatrix is the matrix describing the stiffness of the robot end, calculated by The eigenvalues λ1, λ2, λ3 can be used to obtain the square of the stiffness index in each direction. Furthermore, the eigenvectors v1, v2, v3 correspond to the eigenvalues λ1, λ2, λ3, which determine the direction of the main axis of the ellipsoid. The main axis direction indicates the stiffness characteristics of the robot end in different directions of deformation in three-dimensional space. Furthermore, the semi-axis length of the ellipsoid is inversely proportional to the square root of the eigenvalue. Specifically, the semi-axis lengths of the ellipsoid in the main axis direction are , which means that the direction with greater stiffness has smaller deformation, and vice versa.
[0053] It should be noted that, referring to the previous description, different cutting forces correspond to different stiffness ellipsoid equations.
[0054] S1024. Determine a fourth corresponding relationship between the coordinates of the intersection point of the unit vector in the processing plane and the stiffness ellipsoid equation and the stiffness ellipsoid equation.
[0055] For details, please continue to refer to Figure 3 , any unit vector in the processing plane is recorded as , It can be expressed as , the straight line where the unit vector lies can be expressed as: ; (13) Furthermore, by combining the equation of the line where the unit vector is located with the equation of the rigidity ellipsoid, the fourth corresponding relationship between the coordinates of the intersection of the unit vector and the equation of the rigidity ellipsoid and the equation of the rigidity ellipsoid can be determined, wherein the fourth corresponding relationship is as follows: ; (14) S1025. Determine a fifth corresponding relationship between the stiffness index in the direction indicated by the unit vector and the coordinates of the intersection point.
[0056] Specifically, according to the fourth corresponding relationship obtained above, the unit vector can be calculated The modulus length is The modulus length can be expressed as follows: ; (15) in, is a unit vector The mold length.
[0057] Furthermore, we can use the unit vector The modulus length determines the fifth correspondence between the stiffness index in the direction indicated by the unit vector and the coordinates of the intersection point, and the fifth correspondence is as follows: ; (16) in, is the stiffness index in the direction indicated by the unit vector, is a unit vector The mold length.
[0058] It should be explained that the stiffness index in the direction indicated by the unit vector is used to describe the stiffness of the drilling and riveting robot in the direction indicated by a unit vector, and can evaluate the stability and response ability of the system in this direction. For example, the above stiffness index Used to describe the system in terms of unit vector Stiffness in the indicated direction.
[0059] S1026. Determine a sixth corresponding relationship between a stiffness index in the machining plane and a plurality of stiffness indices in directions indicated by a plurality of unit vectors in the machining plane.
[0060] Specifically, after obtaining the fifth correspondence between the stiffness index in the direction indicated by a unit vector and the coordinates of the intersection point, similarly, for multiple unit vectors, multiple correspondences between the stiffness index in the directions indicated by multiple unit vectors and the coordinates of the intersection point can be obtained.
[0061] For example, for a unit vector on the Y axis and the unit vector in the Z-axis direction ,in, It can be expressed as , It can be expressed as , at this time, the unit vector The correspondence between the stiffness index in the indicated direction and the coordinates of the intersection point, as well as the unit vector The stiffness index in the indicated direction corresponds to the coordinates of the intersection point as follows: ; (17) ; (18) in, is a unit vector The stiffness index in the indicated direction (Y-axis direction), is a unit vector The stiffness exponent in the indicated direction (Z-axis direction).
[0062] It is understandable that the unit vector The stiffness index in the indicated direction is the stiffness index in the Y-axis direction, and the unit vector The stiffness index in the indicated direction is the stiffness index in the Z-axis direction.
[0063] Referring to the above description, it can be known that the stiffness index in the processing plane can be determined by the multiple stiffness indices in the directions indicated by the multiple unit vectors in the processing plane, so as to obtain the sixth corresponding relationship between the stiffness index in the processing plane and the multiple stiffness indices in the directions indicated by the multiple unit vectors in the processing plane. For example, in a possible implementation, the processing plane is a YOZ plane. At this time, according to the unit vectors in the processing plane and The stiffness index in the indicated direction can be calculated according to the following formula to calculate the stiffness index in the processing plane: ; (19) in, is the stiffness index of the drilling and riveting robot in the processing plane, is a unit vector The stiffness index in the indicated direction, is a unit vector Stiffness exponent in the indicated direction.
[0064] S1027. Determine a first correspondence between the stiffness index of the drilling and riveting robot in a processing plane and each joint angle according to the third correspondence, the simplified relationship, the stiffness ellipsoid equation, the fourth correspondence, the fifth correspondence, and the sixth correspondence.
[0065] Specifically, referring to the previous description, it can be understood that the third corresponding relationship describes the relationship between each joint angle and the cutting force received by the end effector, the simplified relationship describes the relationship between the cutting force received by the end effector and the end linear displacement, the stiffness ellipsoid equation describes the corresponding relationship between the cutting force and the stiffness ellipsoid, the fourth corresponding relationship describes the relationship between the coordinates of the intersection of the unit vector in the processing plane and the stiffness ellipsoid equation and the stiffness ellipsoid equation, the fifth corresponding relationship describes the stiffness index in the direction indicated by the unit vector and the coordinates of the intersection, the sixth relationship describes the relationship between the stiffness index in the processing plane and multiple stiffness indices in the directions indicated by multiple unit vectors in the processing plane, and by combining these relationships, the first corresponding relationship between the stiffness index of the drilling and riveting robot in the processing plane and each joint angle can be obtained.
[0066] It should be noted that the first corresponding relationship is relatively complex, and in this embodiment, the explicit expression of the first corresponding relationship is not described. Further, referring to the previous description, it can be seen that the stiffness index of the drilling and riveting robot in the processing plane is related to the rotation angle of each joint. Therefore, the first corresponding relationship represents the correlation between the stiffness index of the drilling and riveting robot in the processing plane and the rotation angle of each joint.
[0067] The method provided in this embodiment provides a method for constructing a first correspondence between the stiffness index of the drilling and riveting robot in the processing plane and the rotation angles of each joint. Through this method, the correspondence between the stiffness index of the drilling and riveting robot in the processing plane and the rotation angles of each joint can be accurately obtained. Furthermore, through this correspondence, the relationship between the rotation angles of each joint and the stiffness of the end effector can be understood. During the processing, the optimal posture can be searched to ensure that the stiffness of the end effector in each direction meets the processing requirements, thereby improving the processing accuracy.
[0068] S103: Determine a second corresponding relationship between the operability value of the drilling and riveting robot and each joint angle according to the Jacobian matrix of the drilling and riveting robot, the inverse matrix of the Jacobian matrix, and the penalty factor of the drilling and riveting robot.
[0069] Specifically, in order to consider the joint restrictions of multiple conditions and scale the operability of the drilling and riveting robot, a penalty factor of the drilling and riveting robot is introduced. At the same time, according to the Jacobian matrix of the drilling and riveting robot, the transposed matrix of the Jacobian matrix and the introduced penalty factor, the second functional relationship between the operability value of the drilling and riveting robot and the rotation angle of each joint is determined.
[0070] Specifically, in a possible implementation, the second functional relationship between the operability value of the drilling and riveting robot and the rotation angle of each joint is as follows: ; (20) in, is the operability value, is the penalty factor of the drilling and riveting robot, is the joint angle of the drilling and riveting robot, is the Jacobian matrix of the drilling and riveting robot, which is related to the joint angle Related.
[0071] Specifically, in a possible implementation, the calculation process of the penalty factor includes: Step 1: For each joint of the robot, a sub-penalty factor of the joint is calculated according to the current position of the joint, the upper limit position of the joint, the lower limit position of the joint, and the scaling factor corresponding to the joint.
[0072] Specifically, for each joint of the robot, the sub-penalty factor of the joint can be calculated according to the following formula: ; (twenty one) in, For joints The sub-penalty factor of , a is the scaling factor corresponding to the joint, which is used to adjust the behavior of the joint near the limit, For joints Current location, For joints The upper limit position of For joints The lower limit position.
[0073] Step 2: Taking the minimum value of each sub-penalty factor as the penalty factor of the robot.
[0074] Specifically, after calculating the sub-penalty factors of each joint of the robot, the minimum value of each sub-penalty factor is used as the penalty factor of the drilling and riveting robot, that is, the penalty factor of the drilling and riveting robot is determined according to the following formula: ; (twenty two) in, is the penalty factor of the drilling and riveting robot, For joints The sub-penalty factor of .
[0075] The method provided in this embodiment can achieve precise control of the robot by combining the position, range of motion and scaling factor of the joint, thereby improving safety, efficiency and overall performance. First, by calculating the penalty factor based on the relationship between the current position of the joint and the upper and lower limit positions, the joint can be prevented from exceeding its physical limits, thereby avoiding damage to the robot or its environment; secondly, by introducing the penalty factor, the movement of the robot within an unnecessary range can be reduced, thereby improving movement efficiency and energy utilization; finally, by using the minimum value of each sub-penalty factor as the total penalty factor, the overall control problem of the multi-joint robot is simplified, mutual interference between the joints in the multi-joint system can be avoided, and the overall performance degradation caused by the local optimal solution can be prevented.
[0076] S104. Constructing an evaluation function according to the first corresponding relationship and the second corresponding relationship; wherein the evaluation function takes into account the stiffness index of the drilling and riveting robot in the processing plane and the operability of the drilling and riveting robot.
[0077] Specifically, when constructing an evaluation function based on the first corresponding relationship and the second corresponding relationship, the stiffness index of the drilling and riveting robot in the processing plane and the operability value of the drilling and riveting robot can be introduced into the evaluation function as evaluation factors to comprehensively evaluate the performance of the drilling and riveting robot.
[0078] Optionally, in a possible implementation manner, the specific implementation process of this step may include: S1041, traversing any posture in the working space of the drilling and riveting robot, and for a currently traversed target posture, calculating the stiffness index of the drilling and riveting robot corresponding to the target posture according to the first corresponding relationship.
[0079] Specifically, the workspace of the drilling and riveting robot is a set of all positions and postures that the robot end effector can reach. Any posture of the drilling and riveting robot in the workspace is traversed, and according to the first correspondence, the stiffness index of the drilling and riveting robot corresponding to the currently traversed target posture is calculated to obtain the stiffness index of the drilling and riveting robot corresponding to all postures that the end effector can reach. In specific implementation, the posture is substituted into the first correspondence to obtain the stiffness index of the robot corresponding to the posture.
[0080] S1042: Find a maximum stiffness index and a minimum stiffness index from the stiffness indexes of the drilling and riveting robot corresponding to all positions.
[0081] Specifically, the maximum stiffness index is found from all stiffness indexes corresponding to all positions of the drilling and riveting robot. and the minimum value of stiffness index .
[0082] S1043: Construct a first sub-evaluation function according to the first corresponding relationship, the maximum value of the stiffness index, and the minimum value of the stiffness index.
[0083] Specifically, according to the maximum value and the minimum value of the stiffness index, the stiffness index of the drilling and riveting robot in the processing plane is normalized, and a first sub-evaluation function is constructed with the stiffness index of the drilling and riveting robot in the processing plane as an evaluation factor. The first sub-evaluation function is as follows: ;(twenty three) in, Indicates that the joint angle is When , the normalized value of the stiffness index in the machining plane is, Represents the first correspondence, which is used to represent the joint angle When the drilling and riveting robot has a stiffness index in the processing plane, is the minimum stiffness index of the drilling and riveting robot in the processing plane, It is the maximum value of the stiffness index of the drilling and riveting robot in the processing plane.
[0084] Further, it can be understood that the first sub-evaluation function is used to characterize the relationship between a set of joint angles and the normalized values of the stiffness index within the processing plane.
[0085] S1044, traversing any posture in the workspace of the drilling and riveting robot, and for the currently traversed target posture, calculating the operability value of the drilling and riveting robot corresponding to the target posture according to the second corresponding relationship.
[0086] Specifically, any posture of the drilling and riveting robot in the workspace is traversed, and according to the second corresponding relationship, the operability value of the drilling and riveting robot corresponding to the currently traversed target posture is calculated to obtain the operability value of the drilling and riveting robot corresponding to all postures that the end effector can reach. In specific implementation, the posture is substituted into the second corresponding relationship, and the operability value of the robot corresponding to the posture can be obtained based on this.
[0087] S1045. Find a maximum operability value and a minimum operability value from the operability values of the drilling and riveting robot corresponding to all positions and postures.
[0088] Specifically, the maximum operability value is found from the operability values of the drilling and riveting robot corresponding to all positions. and minimum operability value .
[0089] S1046: Construct a second sub-evaluation function according to the second corresponding relationship, the maximum operability value, and the minimum operability value.
[0090] Specifically, according to the maximum operability value and the minimum operability value, the operability value of the drilling and riveting robot is normalized, and a second sub-evaluation function with the operability value of the drilling and riveting robot as an evaluation factor is constructed. The second sub-evaluation function is as follows: ; (twenty four) in, For the joint angle (a set of joint angles), the normalized value of the maneuverability value; The second corresponding relationship is shown, which means that when the joint angle is When the operability value of the drilling and riveting robot is is the minimum operability value of the drilling and riveting robot, It is the maximum operability value of the drilling and riveting robot.
[0091] Further, it can be understood that the first sub-evaluation function is used to characterize the relationship between a set of joint angles and the normalized values of the stiffness index within the processing plane.
[0092] S1047: Fuse the first sub-evaluation function and the second sub-evaluation function to obtain the evaluation function.
[0093] Specifically, the first sub-evaluation function and the second sub-evaluation function are integrated to obtain an evaluation function using the stiffness index of the drilling and riveting robot in the processing plane and the operability of the drilling and riveting robot as evaluation factors. The evaluation function is as follows: ; (25) in, is the evaluation function.
[0094] Referring to the previous description, we can see that and All of them change with the joint angle, so the evaluation function changes with the robot posture, that is, with the robot joint angle Changes, that is, the evaluation function is related to a set of joint angles; further, the larger the value of the evaluation index, the better the stiffness and motion performance of the robot.
[0095] The method provided in this embodiment provides a method for constructing an evaluation function. Through this method, an evaluation function that comprehensively considers the stiffness index of the drilling and riveting robot in the processing plane and the operability of the drilling and riveting robot can be constructed. The evaluation function is subsequently used to perform posture optimization, so that the robot can maintain optimal stiffness and operability in different processing positions and postures, thereby improving the processing accuracy.
[0096] S105. Under the limit constraints and state constraints of the drilling and riveting robot, take the angles of the joints of the drilling and riveting robot as optimization variables, take the evaluation function as the objective function, use the quantum particle swarm optimization algorithm to search for the optimal posture of the drilling and riveting robot, and control the drilling and riveting robot according to the optimal posture; wherein the optimal posture includes the optimal angles of the joints of the drilling and riveting robot when machining the target hole position corresponding to the state constraint.
[0097] Specifically, in this application, the drilling and riveting robot is a six-degree-of-freedom serial robot, and its posture change is achieved by adjusting the rotation angles of each joint of the robot. Therefore, in this application, the optimization variable is the angle variable θ composed of the angles of each joint of the robot (i.e., the rotation angles of each joint), that is, the optimization variable is: ; (26) Furthermore, the objective function of optimization is the above-mentioned evaluation function, and the quantum particle swarm optimization algorithm is used to search for the optimal posture of the drilling and riveting robot.
[0098] Specifically, the process of searching using quantum particle swarms may include: 1. Initialization First, the initial position of each particle is randomly initialized in the search space; further, the initial position of each particle is set to its personal best position, and at the same time, the global best position is initialized as the best particle position in the group; 2. Iteration process For each generation, the following steps are repeated until a termination condition is met (such as reaching a maximum number of iterations or a convergence criterion): a. Calculate the average best position; b. Update the particle position; c. Calculate the local attraction factor; d. Calculate the fitness value; e. Update the personal best position and the global best position; 3. Determine whether the termination conditions are met.
[0099] Specifically, the specific implementation principle and implementation process of the iterative process are described in the following embodiments and will not be repeated here.
[0100] Furthermore, in this application, during the search process, the constraints that need to be met are as follows: (1) Boundary constraints The limit constraints are the upper and lower limits of the optimization variables. In this application, the optimization variable is the robot's angular variable θ. In one possible implementation, the limit constraints are shown in Table 1: Table 1 Boundary constraints
[0101] Furthermore, the limit constraints in the above table can be expressed in the following form: ; (27) in, For the The upper limit of the optimization variable, For the The lower bound of the optimization variable.
[0102] (2) Property constraints The property constraint refers to the system achieving a certain function according to a constraint of a certain nature. In this application, in the optimization of stiffness performance, the property constraint is the position and posture constraint conditions that the robot must meet during the drilling and riveting operation.
[0103] Figure 4 This is a schematic diagram of a property constraint shown in an exemplary embodiment of the present application, please refer to Figure 4 ,During the machining process, the end effector should reach the given target hole position, i.e. Need to meet the following formula: ; (28) in, is the position vector of the end effector during the machining process, is the position vector corresponding to the target hole to be processed. That is, the end effector needs to reach the target hole to be processed during the processing.
[0104] Furthermore, the tool feed direction must be perpendicular to the machining plane, and in the field of aviation manufacturing, the tolerance is usually set to 0.3°, that is, Need to meet the following formula: ; (29) in, is the direction vector corresponding to the feed direction of the tool held by the end effector, is a vector perpendicular to the machining plane. That is, during the machining process, the feed direction of the tool held by the end effector needs to be perpendicular to the machining plane.
[0105] The method provided in this embodiment, in a first aspect, constructs a static stiffness model of the drilling and riveting robot, and determines a first correspondence between the stiffness index of the drilling and riveting robot in a processing plane and each joint angle according to the static stiffness model of the drilling and riveting robot, and determines a second correspondence between the operability value of the drilling and riveting robot and each joint angle according to the Jacobian matrix of the drilling and riveting robot, the inverse matrix of the Jacobian matrix, and the penalty factor of the drilling and riveting robot, and then constructs an evaluation function according to the first correspondence and the second correspondence. In this way, on the one hand, the evaluation function can cope with changes under different working conditions and enhance robustness and adaptability. On the other hand, the stiffness index and operability can be comprehensively considered in the evaluation function to make The robot can maintain the best stiffness and operating performance under different processing positions and postures, which can improve the stiffness performance of the robot in drilling and riveting operations and improve processing accuracy; secondly, when determining the first correspondence between the stiffness index of the drilling and riveting robot in the processing plane and the rotation angle of each joint, the static stiffness model is used to characterize the relationship between the force vector of the end effector and the deformation and joint stiffness matrix of the end effector, which can accurately predict and compensate for the displacement of the robot end caused by the force, ensuring the high precision of the drilling and riveting operation; thirdly, when determining the second correspondence between the operability value of the drilling and riveting robot and the rotation angle of each joint, by introducing a penalty factor, the operability of the robot at different joint angles can be accurately determined, optimizing the overall performance of the robot. Fourthly, when searching for the optimal posture, the search based on the quantum particle swarm optimization algorithm can quickly find the optimal posture, which can reduce the calculation time and improve work efficiency.
[0106] Figure 5 This is a flowchart of the third embodiment of the robot control method provided by this application. Please refer to Figure 5 On the basis of the above embodiment, in the process of searching for the optimal posture of the drilling and riveting robot using the quantum particle swarm optimization algorithm, in each iteration, the process of updating the position of each particle includes: S501. Calculate the average value of the current best positions of all particles.
[0107] Specifically, the average value of the current best positions of all particles can be calculated as shown in the following formula: ; (30) in, is the average value of the current best position of all particles, is the number of all particles, For the Particles until The best position of the iteration, that is, The current best position of a particle.
[0108] S502: Generate a first random number, a second random number, and a third random number for each particle.
[0109] Specifically, in order to help the particle escape from the local optimal solution and reach the global optimal solution as much as possible, the first random number u, the second random number k and the third random number are generated. .
[0110] Among them, the first random number u, the second random number k and the third random number The value range of is [0,1], and the values are evenly distributed in the value range.
[0111] S503: Calculate a position update amount according to the average value, the current position of the particle, the first random number and a preset shrinkage and expansion coefficient.
[0112] Specifically, the position update amount can be calculated according to the following formula: ; (31) in, is the position update amount; is the preset shrinkage and expansion coefficient; is the average value of the current best position of all particles; For the The current position of a particle; is the first random number.
[0113] S504: Calculate the local attraction factor of the particle according to the current global optimal position, the current optimal position of the particle, and the third random number.
[0114] Specifically, the local attraction factor can be calculated according to the following formula: ; (32) in, For the The local attraction factor of a particle, For the Particles until The best position of the iteration, that is, The current best position of a particle, For the The global best position of all particles before the generation, that is, the current global best position, is the third random number.
[0115] S505. When the second random number is greater than or equal to a preset threshold, the sum of the local attraction factor and the position update amount is determined as the updated position of the particle; when the second random number is less than the preset threshold, the difference between the local attraction factor and the position update amount is determined as the updated position of the particle.
[0116] Specifically, when the second random number is greater than or equal to the preset threshold, the sum of the local attraction factor and the position update amount is determined as the updated position of the particle, as shown below: ; (35) When the second random number is less than the preset threshold, the difference between the local attraction factor and the position update amount is determined as the updated position of the particle, as shown below: ; (34) in, is the updated position of the particle; is the local attraction factor of the particle, is the shrinkage expansion coefficient; is the average value of the current best position of all particles; is the current position of the particle; is the first random number.
[0117] It should be noted that the preset threshold is set according to actual needs and is not limited in this embodiment. For example, in one embodiment, the preset threshold can be set to 0.5.
[0118] The method provided in this embodiment, in the process of searching for the optimal posture using the quantum particle swarm optimization algorithm, when updating the position of the particle, firstly, by calculating the average value of the current optimal position of all particles and introducing the first random number, the second random number and the third random number, not only can the distribution information of the entire particle swarm be used to guide the search, but also randomness is introduced in the search process, so that the diversity of the algorithm's exploration in the search space can be increased, which helps to avoid falling into the local optimum and increase the global search capability. Secondly, by calculating the local attraction factor based on the global optimal position and the current optimal position of the particle, and determining the updated position by comparing the second random number with the preset threshold, the particle can adjust its position more finely when it is close to the global optimal position, which can enhance the flexibility and accuracy of the local search.
[0119] Corresponding to the aforementioned embodiment of a robot control method, the present application also provides an embodiment of a robot control device.
[0120] The present application provides an embodiment of a robot control device that can be applied to a robot control device. The device embodiment can be implemented by software, or by hardware, or by a combination of software and hardware. Taking software implementation as an example, as a device in a logical sense, the processor of the robot control device in which it is located reads the corresponding computer program instructions in the non-volatile memory into the memory and runs them. From the hardware level, if Figure 6 As shown, it is a hardware structure diagram of the robot control device where the robot control device of this application is located. Figure 6 In addition to the processor, memory, network interface, and non-volatile memory shown, the robot control device in which the device is located in the embodiment may also include other hardware according to the actual function of the robot control device, which will not be described in detail.
[0121] Figure 7 This is a schematic diagram of the structure of the first embodiment of the robot control device provided in this application. Figure 7 The device provided in this embodiment includes a construction module 710, a determination module 720 and a processing module 730; wherein, The construction module 710 is used to construct a static stiffness model of the drilling and riveting robot; The determination module 720 is used to determine a first correspondence between a stiffness index of the drilling and riveting robot and each joint angle in a processing plane according to a static stiffness model of the drilling and riveting robot; The determination module 720 is used to determine a second correspondence between the operability value of the drilling and riveting robot and each joint angle according to the Jacobian matrix of the drilling and riveting robot, the inverse matrix of the Jacobian matrix, and the penalty factor of the robot; The construction module 710 is used to construct an evaluation function according to the first corresponding relationship and the second corresponding relationship; wherein the evaluation function takes into account the stiffness index of the drilling and riveting robot in the processing plane and the operability of the drilling and riveting robot; The processing module 730 is used to search for the optimal posture of the drilling and riveting robot by using the quantum particle swarm optimization algorithm under the limit constraints and state constraints of the drilling and riveting robot, taking the angles of each joint of the drilling and riveting robot as optimization variables and the evaluation function as the objective function; the optimal posture includes the optimal angles of each joint when processing the target hole position corresponding to the state constraint.
[0122] The device of this embodiment can be used to perform Figure 1 The steps, specific implementation principles and implementation processes of the method embodiment shown are similar and will not be repeated here.
[0123] Please continue to refer to Figure 6The present application also provides a robot control device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein when the processor executes the program, the steps of any one of the methods provided in the first aspect of the present application are implemented.
[0124] The present application also provides a computer-readable storage medium having a computer program stored thereon, and when the program is executed by a processor, the steps of any one of the methods provided in the present application are implemented.
[0125] The implementation process of the functions and effects of each unit in the above-mentioned device is specifically described in the implementation process of the corresponding steps in the above-mentioned method, and will not be repeated here.
[0126] For the device embodiment, since it basically corresponds to the method embodiment, the relevant parts can refer to the partial description of the method embodiment. The device embodiment described above is only schematic, wherein the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the present application scheme. A person of ordinary skill in the art can understand and implement it without paying any creative work.
[0127] The above description is only a preferred embodiment of the present application and is not intended to limit the present application. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present application shall be included in the scope of protection of the present application.
Claims
1. A robot control method, It is characterized in that The robot control method is used to control a drilling and riveting robot so that the drilling and riveting robot performs drilling and riveting operations on structural parts; the robot control method includes: Constructing a static stiffness model of the drilling and riveting robot; wherein the static stiffness model is used to characterize the relationship between the force vector of the end effector and the deformation and joint stiffness matrix of the end effector; Determining a first correspondence between a stiffness index of the drilling and riveting robot and a rotation angle of each joint in a processing plane according to a static stiffness model of the drilling and riveting robot; Determine a second correspondence between the operability value of the drilling and riveting robot and each joint angle according to the Jacobian matrix of the drilling and riveting robot, the inverse matrix of the Jacobian matrix, and the penalty factor of the drilling and riveting robot; Constructing an evaluation function according to the first corresponding relationship and the second corresponding relationship; wherein the evaluation function takes into account the stiffness index of the drilling and riveting robot in the processing plane and the operability of the drilling and riveting robot; Under the limit constraints and state constraints of the drilling and riveting robot, the angles of the joints of the drilling and riveting robot are used as optimization variables, the evaluation function is used as the objective function, and the optimal posture of the drilling and riveting robot is searched by using a quantum particle swarm optimization algorithm, and the drilling and riveting robot is controlled according to the optimal posture; wherein the optimal posture includes the optimal angles of the joints of the drilling and riveting robot when machining the target hole position corresponding to the state constraint.
2. The method according to claim 1, It is characterized in that The constructing an evaluation function according to the first corresponding relationship and the second corresponding relationship includes: Traversing any posture in the working space of the drilling and riveting robot, and for the currently traversed target posture, calculating the stiffness index of the drilling and riveting robot corresponding to the target posture according to the first corresponding relationship; Finding a maximum stiffness index and a minimum stiffness index from the stiffness indexes of the drilling and riveting robot corresponding to all positions; Constructing a first sub-evaluation function according to the first corresponding relationship, the maximum value of the stiffness index and the minimum value of the stiffness index; Traversing any posture in the working space of the drilling and riveting robot, and for the currently traversed target posture, calculating the operability value of the drilling and riveting robot corresponding to the target posture according to the second corresponding relationship; Finding a maximum operability value and a minimum operability value from the operability values of the drilling and riveting robot corresponding to all postures; Constructing a second sub-evaluation function according to the second corresponding relationship, the maximum operability value and the minimum operability value; The first sub-evaluation function and the second sub-evaluation function are integrated to obtain the evaluation function.
3. The method according to claim 1, It is characterized in that Determining a first correspondence between a stiffness index of the drilling and riveting robot and a rotation angle of each joint in a processing plane according to a static stiffness model of the drilling and riveting robot includes: Obtaining a third corresponding relationship between each joint angle and the cutting force exerted on the end effector; According to the static stiffness model, a simplified relationship between the cutting force on the end effector and the end linear displacement is obtained; According to the simplified relationship and the conditions satisfied by the linear displacement generated by the cutting force acting on the end effector, a stiffness ellipsoid equation corresponding to the cutting force is constructed; wherein the stiffness ellipsoid equation describes the stiffness characteristics of the end effector in different directions; Determining a fourth corresponding relationship between the coordinates of the intersection point of the unit vector in the processing plane and the stiffness ellipsoid equation and the stiffness ellipsoid equation; determining a fifth corresponding relationship between a stiffness index in the direction indicated by the unit vector and the coordinates of the intersection point; Determining a sixth correspondence between a stiffness index in a machining plane and a plurality of stiffness indices in directions indicated by a plurality of unit vectors in the machining plane; According to the third corresponding relationship, the simplified relationship, the stiffness ellipsoid equation, the fourth corresponding relationship, the fifth corresponding relationship and the sixth corresponding relationship, a first corresponding relationship between the stiffness index of the drilling and riveting robot in a processing plane and the rotation angles of each joint is determined.
4. The method according to claim 1, It is characterized in that The construction of the static stiffness model of the drilling and riveting robot includes: According to the preset stiffness condition and the preset virtual work condition, the first functional relationship corresponding to the virtual work condition is determined by using the virtual work principle; wherein the virtual work condition includes the force vector of the end effector of the drilling and riveting robot, the virtual displacement of the end effector under the action of the force vector, and the force vector of each joint of the drilling and riveting robot, and the virtual displacement of each joint under the action of the force vector; determining a second functional relationship between the virtual displacement of the end effector and the virtual displacement of each joint; Determining a third functional relationship between the force vector of each joint and the force vector of the end effector according to the first functional relationship and the second functional relationship; Determine a seventh functional relationship between the stiffness matrix of the end effector and the joint stiffness matrix according to a fourth functional relationship between the force vector of the end effector and the deformation of the end effector, a fifth functional relationship between the force vector of each joint and the deformation of each joint, a sixth functional relationship between the deformation of the end effector and the deformation of each joint, and the third functional relationship; According to the fourth functional relationship and the seventh functional relationship, a static stiffness model of the drilling and riveting robot is determined.
5. The method according to claim 1, It is characterized in that The process of determining the penalty factor includes: For each joint of the robot, a sub-penalty factor of the joint is calculated according to the current position of the joint, the upper limit position of the joint, the lower limit position of the joint, and the scaling factor corresponding to the joint; The minimum value among the sub-penalty factors is used as the penalty factor of the robot.
6. The robot control method according to claim 5, It is characterized in that The sub-penalty factor of the joint is calculated according to the current position of the joint, the upper limit position of the joint, the lower limit position of the joint, and the scaling factor corresponding to the joint, including: Calculate the sub-penalty factor of the joint according to the following formula; ; Among them, the For joints The sub-penalty factor of is the scaling factor corresponding to the joint, which is used to adjust the behavior of the joint near the limit. For joints The current location of For joints The upper limit position of joint lower limit position.
7. The method according to claim 1, It is characterized in that In the process of searching for the optimal posture of the drilling and riveting robot using the quantum particle swarm optimization algorithm, in each iteration, the updating process of the position of each particle includes: Calculate the average of the current best positions of all particles; For each particle, generate a first random number, a second random number and a third random number; Calculate a position update amount according to the average value, the current position of the particle, the first random number and a preset shrinkage and expansion coefficient; Calculating a local attraction factor of the particle according to the current global best position, the current best position of the particle, and the third random number; When the second random number is greater than or equal to a preset threshold, the sum of the local attraction factor and the position update amount is determined as the updated position of the particle; when the second random number is less than the preset threshold, the difference between the local attraction factor and the position update amount is determined as the updated position of the particle.
8. A robot control device, It is characterized in that The robot control device is used to control the drilling and riveting robot so that the drilling and riveting robot performs drilling and riveting operations on structural parts; the device includes a construction module, a determination module and a processing module; wherein, The construction module is used to construct a static stiffness model of the drilling and riveting robot; wherein the static stiffness model is used to characterize the relationship between the force vector of the end effector and the deformation and joint stiffness matrix of the end effector; The determination module is used to determine a first correspondence between a stiffness index of the drilling and riveting robot and each joint angle in a processing plane according to a static stiffness model of the drilling and riveting robot; The determination module is used to determine a second correspondence between the operability value of the drilling and riveting robot and each joint angle according to the Jacobian matrix of the drilling and riveting robot, the inverse matrix of the Jacobian matrix, and the penalty factor of the drilling and riveting robot; The construction module is used to construct an evaluation function according to the first corresponding relationship and the second corresponding relationship; wherein the evaluation function takes into account the stiffness index of the drilling and riveting robot in the processing plane and the operability of the drilling and riveting robot; The processing module is used to use the angle of each joint of the drilling and riveting robot as the optimization variable and the evaluation function as the objective function under the limit constraints and state constraints of the drilling and riveting robot, search for the optimal posture of the drilling and riveting robot by using the quantum particle swarm optimization algorithm, and control the drilling and riveting robot according to the optimal posture; wherein the optimal posture includes the optimal angle of each joint of the drilling and riveting robot when processing the target hole position corresponding to the state constraint.
9. A robot control device, It is characterized in that The robot control device is used to control the drilling and riveting robot so that the drilling and riveting robot performs drilling and riveting operations on structural parts; the robot control device includes a memory, a processor, and a computer program stored in the memory and executable on the processor, and the processor implements the steps of any one of claims 1 to 7 when executing the program.
10. A computer-readable storage medium having a computer program stored thereon, It is characterized in that When the program is executed by a processor, the steps of the method according to any one of claims 1 to 7 are implemented.
Citation Information
Patent Citations
Enhanced active power filtering method based on echo state network
CN118412866A
Method for determining the manipulability of a handling device and method for determining the load-bearing capacity of a handling device and handling device
DE102020116900B3
