A Method for Attitude-Related Frequency Response Prediction and Macro-Micro Coupling Error Compensation of a Mobile Hybrid Robot
By constructing a posture-related frequency response prediction and macro-micro coupling error compensation method, the trajectory deviation and vibration problems caused by chassis disturbance and mechanism deformation in dynamic processing of mobile hybrid robots are solved, achieving higher processing accuracy and stability.
Patent Information
- Application Number
- CN202611243789.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-08-17
- Publication Date
- 2026-11-17
AI Technical Summary
Existing robot machining error compensation methods are difficult to effectively handle the trajectory deviation and vibration amplification problems caused by chassis disturbance, mechanism posture-related elastic deformation and vibration errors during dynamic continuous processing of mobile hybrid robots, especially in the resonance sensitive area where real-time prediction and compensation are difficult to achieve.
By constructing a posture-related frequency response prediction and macro-micro coupling error compensation method for mobile hybrid robots, and combining low-frequency disturbances of the mobile chassis, elastic deformation of the hybrid mechanism and machining vibration errors, the target trajectory of the tool center point is generated, and the robot motion state is adjusted in real time to compensate for the error.
It improves the trajectory accuracy and processing stability of mobile hybrid robots during the process of moving and processing, reduces vibration errors, and improves the quality of the processed surface.
Smart Images

Figure CN123103588A_ABST
Abstract
Description
Technical Field
[0001] This application belongs to the field of robot processing and intelligent manufacturing technology, and in particular relates to a method for attitude-related frequency response prediction and macro-micro coupling error compensation of a mobile hybrid robot. Background Technology
[0002] With the increasing demand for on-site machining of large and complex components in aerospace, large equipment manufacturing, shipbuilding, and rail transportation, robotic machining systems are gradually being applied to milling, drilling, finishing, and grinding of large structural parts. Compared with traditional machine tools, robotic machining systems have advantages such as large workspace, high flexibility, convenient deployment, and adaptability to complex machining environments. Hybrid robots combine the high rigidity and strong load-bearing capacity of parallel mechanisms with the large workspace and flexible posture adjustment of serial mechanisms, making them suitable for machining complex curved surfaces and large-sized components.
[0003] However, during the dynamic continuous machining process of a mobile hybrid robot, the actual motion trajectory of the tool center point is easily affected by various error sources. On the one hand, the mobile chassis will generate low-frequency displacement disturbances, posture yaws, and positioning errors during walking or positioning. On the other hand, the stiffness, damping, mass distribution, and frequency response characteristics of the hybrid robot body will change under different machining postures. Under the action of cutting forces, inertial forces, and periodic machining loads, the robot end effector will generate posture-related elastic deformation.
[0004] Existing robot machining error compensation methods are mostly designed for fixed industrial robots or single mechanism errors, such as considering only geometric errors, static stiffness errors, or end-effector deformation under a single load. For mobile hybrid robots that are machining while moving, the disturbance of the moving chassis, the elastic deformation related to the posture of the hybrid mechanism, and the vibration error caused by machining excitation often coexist and act together on the tool center point, causing the actual machining trajectory to deviate from the ideal trajectory.
[0005] Furthermore, when the tooth passing frequency, cutting excitation frequency, or other machining excitation frequency corresponding to the spindle speed approaches the robot's natural frequency under its current posture, the system may experience vibration amplification or resonance, leading to surface chatter marks, increased dimensional errors, and decreased machining stability. Existing methods typically struggle to predict frequency response characteristics based on the robot's real-time posture, and also find it difficult to simultaneously perform chassis disturbance compensation, mechanism elastic deformation compensation, and resonance-sensitive parameter avoidance during machining. Summary of the Invention
[0006] In view of this, the purpose of this application is to provide a method for attitude-related frequency response prediction and macro-micro coupling error compensation of a mobile hybrid robot, which maps the low-frequency disturbance of the mobile chassis, the attitude-related elastic deformation of the hybrid mechanism, and the machining vibration error to the tool center point trajectory, thereby improving the trajectory accuracy, machining stability and surface finish of the mobile hybrid robot during the process of moving and machining.
[0007] This application provides a method for attitude-related frequency response prediction and macro-micro coupling error compensation of a mobile hybrid robot, applied to the dynamic continuous machining process of the mobile hybrid robot. The mobile hybrid robot consists of a mobile chassis, a parallel mechanism, a serial wrist, and an end effector. The method includes: Based on the pose error of the mobile chassis during dynamic continuous processing, the low-frequency disturbance error of the mobile chassis is calculated, and an elastic dynamic model related to the posture of the mobile hybrid robot is constructed. Based on the mass matrix, damping matrix and stiffness matrix of the mobile hybrid robot in its current posture, the elastic deformation error at the tool center point induced by the current machining load is calculated, and the machining vibration error compensation amount caused by the machining excitation frequency being close to the natural frequency of the mobile hybrid robot in its current posture is obtained. The ideal trajectory of the tool center point is obtained, and then combined with the low-frequency disturbance error of the moving chassis, the elastic deformation error at the tool center point, and the machining vibration error compensation amount, the target trajectory of the compensated tool center point is generated. Adjust the motion state of the moving chassis, the length of the parallel mechanism branch chain, and the angle of the series wrist joint based on the target trajectory of the compensated tool center point.
[0008] The attitude-related frequency response prediction and macro-micro coupling error compensation method for mobile hybrid robots provided in this application has the following beneficial effects: 1) It considers the low-frequency disturbance error generated by the mobile chassis during dynamic continuous machining and the vibration error caused by machining excitation, which can more comprehensively describe the comprehensive error sources in the process of mobile hybrid robots moving and machining simultaneously; 2) It predicts the end frequency response function and natural frequency based on the mass matrix, damping matrix and stiffness matrix under the current attitude, thereby realizing dynamic updating of frequency response characteristics according to changes in machining attitude; 3) When the current machining parameters are in the resonance sensitive area, it can reduce vibration and improve machining stability by adjusting the machining vibration damping parameters; 4) It maps multiple errors to the tool center point trajectory in a unified manner, which helps to improve the trajectory tracking accuracy and machining dimensional accuracy in the dynamic continuous machining process of mobile hybrid robots. Attached Figure Description
[0009] Figure 1 A flowchart of the attitude-related frequency response prediction and macro-micro coupling error compensation method for mobile hybrid robots provided in this application embodiment is shown. Detailed Implementation
[0010] To make the objectives, technical solutions, and advantages of this technical solution clearer, the following detailed description, in conjunction with specific embodiments, further illustrates this technical solution. It should be understood that these descriptions are merely exemplary and not intended to limit the scope of this technical solution.
[0011] Example 1: First, let me introduce the application scenarios of this application. This application is applicable to application scenarios such as on-site processing of large structural parts, long-distance continuous processing, aircraft skin processing, robotic milling, robotic drilling, and high-precision trajectory tracking control.
[0012] The method is applied to the dynamic continuous machining process of a mobile hybrid robot, which consists of a mobile chassis, a parallel mechanism, a series wrist, and an end effector. The mobile chassis enables large-scale movement of the robot as a whole, the parallel mechanism provides position adjustment and load-bearing capacity for the tool center point, the series wrist adjusts the posture of the end effector, and the end effector mounts milling cutters, drilling cutters, grinding tools, or other machining tools.
[0013] Please see as follows Figure 1 The flowchart illustrates a method for attitude-related frequency response prediction and macro-micro coupling error compensation for a mobile hybrid robot. The method includes: S101. Based on the pose error of the mobile chassis during dynamic continuous processing, the low-frequency disturbance error of the mobile chassis is calculated, and an elastic dynamic model related to the posture of the mobile hybrid robot is constructed.
[0014] In practical implementation, the low-frequency disturbance error of the mobile chassis is calculated using the following formula: (1) In the formula, This indicates the equivalent error of the tool center point caused by the movement of the mobile chassis, positioning errors, low-frequency vibrations, or attitude deviations. This represents the mapping matrix from the moving chassis pose error to the tool center point error. The positional error of the moving chassis is represented by the following formula: (2) In the formula, This indicates the actual position and orientation of the mobile chassis. This indicates the ideal position of the moving chassis.
[0015] Here, the actual position and orientation of the mobile chassis during dynamic continuous processing can be obtained based on the mobile chassis encoder, inertial measurement unit, visual positioning device, laser displacement sensor, laser tracker or other pose measurement device.
[0016] In addition, the ideal machining trajectory and current state parameters of the mobile hybrid robot can be obtained in advance for subsequent calculations. The ideal machining trajectory includes the position and attitude of the tool center point, feed rate, spindle speed and machining time sequence. The current state parameters include the mobile chassis pose, the length of the parallel mechanism branch, the angle of the serial wrist joint, the end-effector machining load and chassis vibration or displacement information.
[0017] S102. Based on the mass matrix, damping matrix, and stiffness matrix of the mobile hybrid robot in its current posture, calculate the elastic deformation error at the tool center point induced by the current machining load, and obtain the machining vibration error compensation amount caused by the machining excitation frequency being close to the natural frequency of the mobile hybrid robot in its current posture.
[0018] In practical implementation, the mass matrix, damping matrix, and stiffness matrix of the mobile hybrid robot in its current posture are obtained through the following methods: Step 1021: Determine the current processing posture of the mobile hybrid robot based on the pose of the mobile chassis, the length of the parallel mechanism branch chain, and the angle of the serial wrist joint.
[0019] In this step, the current processing posture of the mobile hybrid robot is represented as: (3) In the formula, This indicates the current processing posture parameters of the mobile hybrid robot. This represents the pose vector of the moving chassis. This represents the branch state vector of a parallel mechanism. This represents the series wrist joint angle vector.
[0020] Step 1022: Equivalently represent the parallel mechanism branches as spatial flexible beam elements, and establish the attitude-related elastic dynamics model of the mobile hybrid robot based on the branch structure parameters, material parameters, branch extension and contraction states, and serial wrist parameters.
[0021] In this step, the attitude-related elastic dynamics model is based on the current processing attitude of the mobile hybrid robot. Updated in real time or near real time.
[0022] Step 1023: Based on the attitude-related elastic dynamics model, obtain the mass matrix, damping matrix, and stiffness matrix under the current attitude.
[0023] In practical implementation, the elastic deformation error is calculated using the following formula: (4) In the formula, This represents the elastic deformation error of the mobile hybrid robot under its current posture and processing load. The current machining load is represented by the following dynamic equation, which is used to calculate the dynamic elastic response at the tool center point when the load changes significantly over time: (5) In the formula, This represents the elastic response displacement at the center point of the tool. Indicates the elastic response speed. Indicates elastic response acceleration. Represents the attitude-related mass matrix. This represents the attitude-related damping matrix. Let represent the attitude-dependent stiffness matrix, where This indicates the current attitude parameters of the mobile hybrid robot.
[0024] Here, end-processing load It is directly measured by a force sensor mounted on the end effector, or estimated based on spindle power, depth of cut, feed rate, tool parameters, and workpiece material parameters.
[0025] In practical implementation, the machining vibration error compensation amount is obtained through the following methods: Step 201: Obtain the machining excitation frequency of the teeth corresponding to the spindle speed, and calculate the difference between it and the natural frequency of the end effector of the mobile hybrid robot in the current posture.
[0026] In practical implementation, the natural frequency of the end effector of the mobile hybrid robot in the current posture is calculated using the following formula: (6) In the formula, Indicates the corresponding first The first natural angular frequency is obtained through the following equation: (7) Step 202: When the absolute value of the difference between the two is less than the preset threshold, it is determined that the current machining parameters are in the resonance sensitive area. Then, the machining vibration error compensation amount is determined according to the attitude-related frequency response function of the end of the mobile hybrid robot. At the same time, vibration damping machining parameters are generated by adjusting one or more of the spindle speed, feed rate, cutting depth, local tool path parameters, and machining posture.
[0027] In practical implementation, the processing vibration error compensation amount is determined based on the attitude-related frequency response function of the mobile hybrid robot's end effector, including: Step 2021: Based on the mass matrix, damping matrix, and stiffness matrix under the current attitude, calculate the attitude-related frequency response function of the end effector of the mobile hybrid robot: (8) In the formula, Indicates the angular frequency of the machining excitation. Represents the imaginary unit, satisfying .
[0028] In this step, the attitude-related frequency response function It is obtained through one or more of the following methods: theoretical model calculation, experimental modal testing, impact hammer testing, online excitation identification, or digital twin model correction.
[0029] Step 2022: Based on the attitude-related frequency response function and the processing excitation frequency, calculate the vibration response amplitude under the current attitude, and then obtain the processing vibration error compensation amount caused by the processing excitation frequency being close to the natural frequency of the mobile hybrid robot under the current attitude: (9) In the formula, Indicates the inverse Fourier transform. It represents the processing excitation frequency, and the force vector in the frequency domain.
[0030] Step 203: When the absolute value of the difference between the two is not less than the preset threshold, it is determined that the current processing parameters are not in the resonance sensitive area, and the processing vibration error compensation amount is set to 0.
[0031] S103. Obtain the ideal trajectory of the tool center point, and then combine the low-frequency disturbance error of the moving chassis, the elastic deformation error at the tool center point, and the machining vibration error compensation amount to generate the target trajectory of the compensated tool center point.
[0032] In this step, the compensated target trajectory of the tool center point is represented as follows: (10) In the formula, The ideal trajectory representing the center point of the cutting tool.
[0033] The compensated tool center point target trajectory is used for robotic milling, robotic drilling, robotic grinding, robotic trimming, robotic polishing, or on-site machining tasks of large structural parts.
[0034] S104. Adjust the motion state of the moving chassis, the length of the parallel mechanism branch chain, and the angle of the series wrist joint according to the target trajectory of the compensated tool center point.
[0035] In this step, the target trajectory of the compensated tool center point is sent to the mobile chassis controller and the hybrid robot controller. The mobile chassis controller adjusts the chassis motion state according to the compensated tool center point target trajectory, and the hybrid robot controller adjusts the branch length of the parallel mechanism and the angle of the serial wrist joint according to the compensated tool center point target trajectory, so that the tool center point moves along the compensated target trajectory.
[0036] This enables compensation for disturbances to the mobile chassis, compensation for elastic deformation of the hybrid mechanism, and avoidance of processing vibrations during the dynamic continuous processing of the mobile hybrid robot.
[0037] Example 2: Error compensation method for mobile hybrid robot while processing.
[0038] The mobile hybrid robot in this embodiment includes a mobile chassis, a parallel mechanism, a serial wrist, an end effector, a machining tool, a sensor system, and a control system.
[0039] The mobile chassis is used to move the robot along the surface of large components or the machining path; the parallel mechanism is used to provide the main load-bearing capacity and position adjustment capability; the serial wrist is used to adjust the attitude of the end effector; the end effector is used to mount milling cutters, drilling cutters or grinding tools; the sensor system is used to collect chassis attitude, chassis vibration, parallel chain length, serial wrist angle and machining load; the control system is used to perform attitude-related frequency response prediction, error compensation calculation and compensation trajectory output.
[0040] Before machining begins, an ideal machining trajectory is first generated by an offline programming system or CAM system. The ideal machining trajectory includes the position and orientation of the tool center point, the spindle speed, the feed rate, and the machining time sequence.
[0041] During the manufacturing process, the control system acquires the actual position and orientation of the mobile chassis in real time and compares it with the ideal position and orientation to obtain the low-frequency disturbance error of the mobile chassis. This error includes positioning deviation, low-frequency vibration error, and attitude yaw error generated during the movement of the mobile chassis.
[0042] Simultaneously, the control system determines the current posture of the mobile hybrid robot based on the branch length of the parallel mechanism, the angle of the serial wrist joint, and the pose of the mobile chassis. Then, an attitude-related elastic dynamics model is established under the current attitude to obtain the mass matrix. Damping matrix and stiffness matrix .
[0043] In this embodiment, the processing load The force is measured by a force sensor mounted on the end effector, or estimated based on spindle power, depth of cut, feed rate, tool parameters, and workpiece material parameters. This is based on the current machining load. and the stiffness matrix under the current attitude Calculate the elastic deformation error at the center point of the tool. .
[0044] When the machining load changes significantly with time, the control system adopts the dynamic equation. Calculate the dynamic elastic response at the tool center point to obtain the end-effector elastic deformation under the current posture and machining load. .
[0045] Next, the control system determines the mass matrix based on the current attitude. Damping matrix and stiffness matrix Calculate the attitude-related frequency response function And obtain the natural frequency under the current attitude. .
[0046] Then, the tooth passing frequency, cutting excitation frequency, or other machining excitation frequency corresponding to the spindle speed are used. Natural frequency at the current attitude Compare. When satisfied... When the control system determines that the current machining parameters are in the resonance sensitive area, it automatically adjusts the spindle speed, feed rate, depth of cut, local tool path parameters or machining posture to avoid the resonance area.
[0047] At the same time, the control system uses the attitude-related frequency response function and processing excitation frequency Calculate the machining vibration error compensation amount .
[0048] When the current processing parameters are not in the resonance sensitive region It can be set to zero or take a preset small value; when the current processing parameters are in the resonance sensitive area, the control system calculates the vibration response amplitude according to the frequency response function and uses it as part of the trajectory compensation.
[0049] Finally, the control system generates the compensated target trajectory of the tool center point based on the compensation amounts for the low-frequency disturbance error of the mobile chassis, the elastic deformation error of the mechanism, and the machining vibration error. .
[0050] The control system sends the compensated target trajectory of the tool center point to the mobile chassis controller and the hybrid robot controller. The mobile chassis controller adjusts the chassis motion state according to the compensated trajectory, and the hybrid robot controller adjusts the branch length of the parallel mechanism and the angle of the serial wrist joint according to the compensated trajectory, so that the tool center point moves along the compensated target trajectory.
[0051] Through the above methods, this embodiment can simultaneously compensate for low-frequency disturbances of the mobile chassis, elastic deformation of the hybrid mechanism, and machining vibration errors during the process of the mobile hybrid robot moving and machining, thereby improving the accuracy of tool center point trajectory tracking, machining stability, and surface machining quality.
[0052] The above content is only a preferred embodiment of the present invention. For those skilled in the art, many changes can be made in the specific implementation and application scope based on the ideas of the present invention. As long as these changes do not depart from the concept of the present invention, they all fall within the protection scope of the present invention.
Claims
1. A method for attitude-related frequency response prediction and macro-micro coupling error compensation of a mobile hybrid robot, characterized in that, This method, applied to dynamic continuous processing of a mobile hybrid robot, which consists of a mobile chassis, a parallel mechanism, a serial wrist, and an end effector, includes: Based on the pose error of the mobile chassis during dynamic continuous processing, the low-frequency disturbance error of the mobile chassis is calculated, and an elastic dynamic model related to the posture of the mobile hybrid robot is constructed. Based on the mass matrix, damping matrix and stiffness matrix of the mobile hybrid robot in its current posture, the elastic deformation error at the tool center point induced by the current machining load is calculated, and the machining vibration error compensation amount caused by the machining excitation frequency being close to the natural frequency of the mobile hybrid robot in its current posture is obtained. The ideal trajectory of the tool center point is obtained, and then combined with the low-frequency disturbance error of the moving chassis, the elastic deformation error at the tool center point, and the machining vibration error compensation amount, the target trajectory of the compensated tool center point is generated. Adjust the motion state of the moving chassis, the length of the parallel mechanism branch chain, and the angle of the series wrist joint based on the target trajectory of the compensated tool center point.
2. The method as described in claim 1, characterized in that, The low-frequency disturbance error of the mobile chassis is calculated using the following formula: ; In the formula, This indicates the equivalent error of the tool center point caused by the movement of the mobile chassis, positioning errors, low-frequency vibrations, or attitude deviations. This represents the mapping matrix from the moving chassis pose error to the tool center point error. The positional error of the moving chassis is represented by the following formula: ; In the formula, This indicates the actual position and orientation of the mobile chassis. This indicates the ideal position of the moving chassis.
3. The method as described in claim 1, characterized in that, The mass matrix, damping matrix, and stiffness matrix of the mobile hybrid robot in its current posture are obtained through the following methods: Based on the pose of the mobile chassis, the length of the parallel mechanism branches, and the angle of the serial wrist joints, the current processing posture of the mobile hybrid robot is determined. The parallel mechanism branches are equivalent to spatial flexible beam elements, and an attitude-related elastic dynamics model of the mobile hybrid robot is established based on the branch structure parameters, material parameters, branch extension and contraction states, and serial wrist parameters. Based on the attitude-related elastic dynamics model, the mass matrix, damping matrix, and stiffness matrix under the current attitude are obtained.
4. The method as described in claim 1, characterized in that, The elastic deformation error is calculated using the following formula: ; In the formula, This represents the elastic deformation error of the mobile hybrid robot under its current posture and processing load. The current machining load is represented by the following dynamic equation, which is used to calculate the dynamic elastic response at the tool center point when the load changes significantly over time: ; In the formula, This represents the elastic response displacement at the center point of the tool. Indicates the elastic response speed. Indicates elastic response acceleration. Represents the attitude-related mass matrix. This represents the attitude-related damping matrix. Let represent the attitude-dependent stiffness matrix, where This indicates the current attitude parameters of the mobile hybrid robot.
5. The method as described in claim 1, characterized in that, The machining vibration error compensation amount is obtained through the following methods: Obtain the machining excitation frequency of the teeth corresponding to the spindle speed, and calculate the difference between it and the natural frequency of the end effector of the mobile hybrid robot in the current posture; When the absolute value of the difference between the two is less than the preset threshold, it is determined that the current machining parameters are in the resonance sensitive area. Then, based on the attitude-related frequency response function of the end of the mobile hybrid robot, the machining vibration error compensation amount is determined. At the same time, vibration damping machining parameters are generated by adjusting one or more of the spindle speed, feed rate, cutting depth, local tool path parameters, and machining attitude. When the absolute value of the difference between the two is not less than the preset threshold, it is determined that the current processing parameters are not in the resonance sensitive area, and the processing vibration error compensation amount is set to 0.
6. The method as described in claim 5, characterized in that, The natural frequency of the end effector of the mobile hybrid robot in its current posture is calculated using the following formula: ; In the formula, Indicates the corresponding first The first natural angular frequency is obtained through the following equation: 。 7. The method as described in claim 5, characterized in that, The step of determining the processing vibration error compensation amount based on the attitude-related frequency response function of the mobile hybrid robot end effector includes: Based on the mass matrix, damping matrix, and stiffness matrix under the current posture, calculate the attitude-related frequency response function of the end effector of the mobile hybrid robot: ; In the formula, Indicates the angular frequency of the machining excitation. Represents the imaginary unit, satisfying ; Based on the attitude-related frequency response function and the processing excitation frequency, the vibration response amplitude under the current attitude is calculated, and then the processing vibration error compensation amount caused by the processing excitation frequency being close to the natural frequency of the mobile hybrid robot under the current attitude is obtained: ; In the formula, Indicates the inverse Fourier transform. It represents the processing excitation frequency, and the force vector in the frequency domain.
