Friction compensation method and device, electronic equipment and storage medium
By calculating and compensating the real-time motion data of linear motion joints in real time, and using linear and nonlinear friction compensation models for friction compensation, the problem of poor friction compensation effect in surgical robots is solved, and the motion accuracy and stability are improved.
Patent Information
- Application Number
- CN202411189732.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-28
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2044-08-28
AI Technical Summary
The prior art is difficult to effectively compensate for the periodic friction of linearly moving joints that exhibit spike changes at specific positions, resulting in poor motion accuracy and stability of surgical robots.
By determining the real-time motion data of the linear motion joint, real-time calculation is performed using a friction compensation model including linear and nonlinear friction compensation sub-models to provide real-time compensation of friction moments to perform friction compensation until the end of the target motion.
Accurate compensation of friction during linear motion joint movement is achieved, the movement accuracy and positioning accuracy are improved, the stuck phenomenon caused by nonlinear friction is reduced, and the accuracy and stability of linear motion joints of surgical robots are improved.
Smart Images

Figure CN118897929A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of computer application technology, and in particular to a friction compensation method, device, electronic equipment and storage medium. Background Art
[0002] Linear motion joints play an important role in the application of surgical robots. Linear motion joints are usually composed of transmission structures such as gears or screws. During the movement of the joint, the friction caused by the transmission structure is one of the important factors affecting the accuracy and stability of the joint movement.
[0003] Traditional friction compensation methods usually construct linear models based on empirical formulas and implement friction compensation for linear motion joints based on the linear models. Such methods are difficult to compensate for the periodically changing friction caused by the transmission structure that presents spike changes at specific positions, resulting in poor friction compensation effects. Summary of the invention
[0004] The present invention provides a friction compensation method, device, electronic device and storage medium to solve the technical problem that the friction compensation effect of a linear motion joint in motion is currently poor, resulting in poor accuracy and stability of the linear motion joint of a surgical robot.
[0005] According to one aspect of the present invention, a friction compensation method is provided, wherein the method comprises:
[0006] Determine a linear motion joint for which friction compensation is to be performed, and determine real-time motion data of the linear motion joint during the process of the linear motion joint performing target motion, wherein the real-time motion data includes real-time motion position, real-time velocity and real-time acceleration;
[0007] The input real-time motion data is calculated in real time by a friction compensation model to determine the real-time compensation friction torque, wherein the friction compensation model includes a linear friction compensation sub-model and a nonlinear friction compensation sub-model;
[0008] The linear motion joint is subjected to real-time friction compensation based on the real-time compensation friction torque until the target motion of the linear motion joint is completed.
[0009] According to another aspect of the present invention, there is provided a friction compensation device, wherein the device comprises:
[0010] A data acquisition module, used for determining a linear motion joint to be subjected to friction compensation, and determining real-time motion data of the linear motion joint during the target motion of the linear motion joint, wherein the real-time motion data includes real-time motion position, real-time velocity and real-time acceleration;
[0011] A compensation torque calculation module, used for performing real-time calculation on the input real-time motion data through a friction compensation model to determine the real-time compensation friction torque, wherein the friction compensation model includes a linear friction compensation sub-model and a nonlinear friction compensation sub-model;
[0012] The friction compensation module is used to perform real-time friction compensation on the linear motion joint based on the real-time compensation friction torque until the target motion of the linear motion joint ends.
[0013] According to another aspect of the present invention, an electronic device is provided, the electronic device comprising:
[0014] at least one processor; and
[0015] a memory communicatively connected to the at least one processor; wherein,
[0016] The memory stores a computer program executable by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the friction compensation method described in any embodiment of the present invention.
[0017] According to another aspect of the present invention, a computer-readable storage medium is provided, wherein the computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the friction compensation method described in any embodiment of the present invention when executed.
[0018] The technical solution of the embodiment of the present invention is to determine the linear motion joint to be subjected to friction compensation, and determine the real-time motion data of the linear motion joint during the target motion of the linear motion joint, wherein the real-time motion data includes real-time motion position, real-time speed and real-time acceleration; perform real-time calculation on the input real-time motion data through the friction compensation model to determine the real-time compensation friction torque, wherein the friction compensation model includes a linear friction compensation sub-model and a nonlinear friction compensation sub-model; perform real-time friction compensation on the linear motion joint based on the real-time compensation friction torque until the target motion of the linear motion joint ends. The present invention can accurately compensate for the friction in the process of linear motion joint movement in real time, and improve the motion accuracy and positioning accuracy of the linear motion joint of the surgical robot; the present invention can simultaneously compensate for linear friction and nonlinear friction, thereby reducing the stuck phenomenon of the linear motion joint caused by nonlinear friction, and improving the accuracy and stability of controlling the linear motion joint of the surgical robot.
[0019] It should be understood that the contents described in this section are not intended to identify the key or important features of the embodiments of the present invention, nor are they intended to limit the scope of the present invention. Other features of the present invention will become easily understood through the following description. BRIEF DESCRIPTION OF THE DRAWINGS
[0020] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0021] Figure 1 is a flow chart of a friction compensation method provided according to Embodiment 1 of the present invention;
[0022] Figure 2 is a flow chart of a friction compensation method provided according to Embodiment 2 of the present invention;
[0023] Figure 3 is an overall flow chart of a friction compensation method provided according to an embodiment of the present invention;
[0024] Figure 4 is a structural schematic diagram of a friction compensation device provided according to Embodiment 3 of the present invention;
[0025] Figure 5 It is a structural schematic diagram of an electronic device for implementing the friction compensation method of an embodiment of the present invention. DETAILED DESCRIPTION
[0026] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.
[0027] It should be noted that the terms "first", "second", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0028] Before describing the embodiments, it is necessary to understand that the frictional forces that affect the motion accuracy and stability of the linear motion joint include linear frictional forces such as gravity, Coulomb frictional force and viscous frictional force, as well as nonlinear frictional forces caused by the transmission structure that present periodic changes with peaks at specific positions. It is difficult for common linear models to compensate for nonlinear frictional forces.
[0029] Embodiment 1
[0030] Figure 1 A flowchart of a friction compensation method is provided for the first embodiment of the present invention. This embodiment is applicable to the friction compensation of a linear motion joint in motion. The method can be performed by a friction compensation device. The friction compensation device can be implemented in the form of hardware and / or software. The friction compensation device can be configured in a computer. Figure 1 As shown, the method includes:
[0031] S110, determining a linear motion joint for which friction compensation is to be performed, and determining real-time motion data of the linear motion joint during target motion of the linear motion joint, wherein the real-time motion data includes real-time motion position, real-time velocity and real-time acceleration.
[0032] The linear motion joint can be understood as a linear motion joint in the structure of the surgical robot. The linear motion joint can be composed of a transmission structure such as a gear or a lead screw.
[0033] The target motion can be understood as the motion of the linear motion joint. Optionally, the target motion can be a linear motion.
[0034] In the embodiment of the present invention, the process of performing the target motion at the linear motion joint may be understood as the process of the linear motion joint being in a motion state.
[0035] The real-time motion data can be understood as real-time motion data. In the embodiment of the present invention, during the process of the linear motion joint performing the target motion, the motion data of the linear motion joint can change in real time.
[0036] The real-time motion position can be understood as the real-time motion position. Specifically, the real-time motion position of the linear motion joint can be obtained by a position encoder installed on the linear motion joint.
[0037] The real-time speed can be understood as the real-time movement speed. The real-time acceleration can be understood as the real-time movement acceleration.
[0038] S120, performing real-time calculation on the input real-time motion data through a friction compensation model to determine a real-time compensation friction torque, wherein the friction compensation model includes a linear friction compensation sub-model and a nonlinear friction compensation sub-model.
[0039] The friction compensation model can be used to calculate the real-time compensation friction torque of the linear motion joint during the motion process, so as to further compensate the friction of the linear motion joint. The input data of the friction compensation model is the real-time motion data, namely the real-time motion position, the real-time speed and the real-time acceleration. The output data of the friction compensation model is the calculated real-time compensation friction torque.
[0040] The real-time compensation friction torque can be understood as a real-time compensation friction torque. In an embodiment of the present invention, the real-time compensation friction torque can change in real time based on the real-time change of the real-time motion data of the linear motion joint.
[0041] Optionally, the real-time compensation friction torque may be the sum of the friction torque corresponding to the real-time compensated linear friction force and the friction torque corresponding to the real-time compensated nonlinear friction force.
[0042] The linear friction compensation submodel can be used to calculate the friction torque corresponding to the linear friction force compensated in real time during the motion of the linear motion joint. Correspondingly, the nonlinear friction compensation submodel can be used to calculate the friction torque corresponding to the nonlinear friction force compensated in real time during the motion of the linear motion joint.
[0043] S130 , performing real-time friction compensation on the linear motion joint based on the real-time compensation friction torque until the target motion of the linear motion joint is completed.
[0044] The technical solution of the embodiment of the present invention is to determine the linear motion joint to be subjected to friction compensation, and determine the real-time motion data of the linear motion joint during the target motion of the linear motion joint, wherein the real-time motion data includes real-time motion position, real-time speed and real-time acceleration; perform real-time calculation on the input real-time motion data through a friction compensation model to determine the real-time compensation friction torque, wherein the friction compensation model includes a linear friction compensation sub-model and a nonlinear friction compensation sub-model; perform real-time friction compensation on the linear motion joint based on the real-time compensation friction torque until the target motion of the linear motion joint ends. The present invention can accurately compensate for the friction in the process of linear motion joint movement in real time, and improve the motion accuracy and positioning accuracy of the linear motion joint of the surgical robot; the present invention can simultaneously compensate for linear friction and nonlinear friction, thereby reducing the stuck phenomenon of the linear motion joint caused by nonlinear friction, and improving the accuracy and stability of controlling the linear motion joint of the surgical robot.
[0045] Embodiment 2
[0046] Figure 2 This is a flow chart of a friction compensation method provided in the second embodiment of the present invention. This embodiment is an addition to the above-mentioned implementation of performing real-time calculation on the input real-time motion data through the friction compensation model. Figure 2 As shown, the method includes:
[0047] Figure 3 is an overall flow chart of a friction compensation method provided according to an embodiment of the present invention. Figure 3 As shown, the specific steps described below are also the overall process of the friction compensation method.
[0048] S210, controlling the linear motion joint to perform a simulated motion corresponding to the target motion, and recording the motion timing data of the linear motion joint during the simulated motion, wherein the motion timing data includes a plurality of recorded time points and a recorded friction torque corresponding to each of the recorded time points.
[0049] The simulated motion may be understood as a motion that simulates the target motion. Optionally, the simulated motion may be a reciprocating linear motion, or a reciprocating uniform linear motion.
[0050] The motion timing data can be understood as the recorded motion data of the linear motion joint during the simulated motion process.
[0051] The recording time point may be understood as the time point at which the motion data is recorded in the motion time series data.
[0052] The recorded friction torque can be understood as the recorded friction torque. It should be understood that, under normal circumstances, it is difficult to separately obtain the friction torque of the linear friction force or the friction torque of the nonlinear friction force of the linear motion joint during the movement. In an embodiment of the present invention, the recorded friction torque may be the total friction torque between the friction torque corresponding to the linear friction force and the friction torque corresponding to the nonlinear friction force. The present invention first obtains the recorded friction torque, that is, the total friction torque, and then performs friction decomposition on the recorded friction torque to obtain the friction torque corresponding to the separate linear friction force and the friction torque corresponding to the nonlinear friction force.
[0053] In an embodiment of the present invention, recording the motion timing data of the linear motion joint during the simulated motion process may include:
[0054] The original motion data of the linear motion joint during the simulated motion process is collected, and the original data is preprocessed to obtain motion timing data, wherein the original motion data may include at least one of position data, velocity data, acceleration data, torque data and current data.
[0055] The preprocessing method for the raw motion data can be preset according to the scene requirements and is not specifically limited here. Optionally, the data quality can be improved by filtering or denoising. For example, high-frequency noise signals can be suppressed by Kalman filtering, low-pass filtering, and Gaussian process regression.
[0056] In actual scenarios, the friction torque corresponding to linear friction force and the friction torque corresponding to nonlinear friction force are difficult to collect directly. Therefore, the present invention first collects the total friction torque, that is, the recorded friction torque, and then performs friction decomposition on the recorded friction torque to determine the friction torque corresponding to the nonlinear friction force, that is, the nonlinear friction torque, as shown below.
[0057] S220 . For each of the recorded time points, perform friction decomposition on the recorded friction torque to obtain a nonlinear friction torque corresponding to the recorded time point, and determine a nonlinear torque time sequence according to the multiple nonlinear friction torques.
[0058] The nonlinear friction torque may be understood as the friction torque corresponding to the nonlinear friction force.
[0059] The nonlinear torque time series may include the nonlinear friction torque corresponding to each of the recorded time points.
[0060] Optionally, the motion time series data further includes a recorded position, a recorded speed, and a recorded acceleration corresponding to each of the recorded time points;
[0061] The performing friction decomposition on the recorded friction torque to obtain the nonlinear friction torque corresponding to the recorded time point includes:
[0062] Determining the linear friction compensation sub-model;
[0063] For each of the recording time points, the input recording position, the recording speed and the recording acceleration are calculated by the linear friction compensation sub-model to obtain a linear friction torque corresponding to the recording time point;
[0064] A nonlinear friction torque is determined based on the linear friction torque and the recorded friction torque.
[0065] The recorded position can be understood as the recorded movement position, the recorded speed can be understood as the recorded movement speed, and the recorded acceleration can be understood as the recorded acceleration.
[0066] In the embodiment of the present invention, the recording positions, the recording speeds, and the recording accelerations corresponding to different recording time points may be the same or different.
[0067] The linear friction torque may be understood as the friction torque corresponding to the linear friction force.
[0068] Optionally, determining the linear friction compensation sub-model includes: constructing the linear friction compensation sub-model based on the following first formula:
[0069]
[0070] Among them, τ base represents the linear friction torque, θ represents the recording position, represents the recording speed, represents the recorded acceleration, M(θ) represents the mass matrix of the surgical arm, G(θ) represents the gravity vector, and F v represents the velocity-dependent viscous friction function, F c represents the Coulomb friction constant. The viscous friction function can be in the form of a first-order polynomial.
[0071] Optionally, the motion time series data may also include current data, etc. Specifically, based on the collected motion time series data, the first formula is parameter identified to determine G(θ), F c , and the parameters to be determined within each item of M(θ) to obtain the linear friction compensation sub-model; further, for each of the recorded time points, the recorded position, the recorded speed and the recorded acceleration are input into the constructed linear friction compensation sub-model to obtain the linear friction torque corresponding to the recorded time point; further, the difference between the linear friction torque and the recorded friction torque is used as the nonlinear friction torque.
[0072] The present invention realizes the separate identification and analysis of linear friction force and nonlinear friction force.
[0073] The present invention adopts a method of first separating the linear friction force from the motion time series data to obtain a nonlinear friction force with more obvious periodic variation characteristics, so as to further construct a nonlinear friction force compensation sub-model with higher accuracy.
[0074] S230, processing the nonlinear torque time series by using a Fourier transform algorithm to obtain the nonlinear friction force compensation sub-model.
[0075] The Fourier transform algorithm can be understood as a fast number theory transform algorithm. The Fourier transform algorithm can include a fast Fourier transform (FFT) algorithm.
[0076] Optionally, the nonlinear torque time series is processed by a Fourier transform algorithm to obtain the nonlinear friction compensation sub-model, including:
[0077] Processing the nonlinear torque time series by a Fourier transform algorithm to determine a plurality of target frequency points and complex data corresponding to each of the target frequency points, wherein the complex data includes a real value and an imaginary value;
[0078] For each of the target frequency points, determine the amplitude, phase and frequency corresponding to the target frequency point according to the complex data, and determine the cosine signal corresponding to the target frequency point according to the amplitude, the phase and the frequency;
[0079] The nonlinear friction compensation sub-model is determined based on a plurality of the cosine signals.
[0080] Optionally, before the nonlinear torque time series is processed by the Fourier transform algorithm, the method further includes:
[0081] Determine a Fourier transform algorithm, set algorithm parameters of the Fourier transform algorithm, and obtain the Fourier transform algorithm with parameter setting completed, wherein the algorithm parameters include sampling frequency, signal frequency, signal length, and number of sampling points;
[0082] The nonlinear torque time series is processed by a Fourier transform algorithm to determine a plurality of target frequency points, including:
[0083] The nonlinear moment time series is processed by the Fourier transform algorithm with parameter setting, the preliminary frequency points of the sampling points are determined, and the target frequency points among the preliminary frequency points are determined.
[0084] In the embodiment of the present invention, the sampling frequency, the signal frequency, the signal length, and the number of sampling points can be preset according to scene requirements, and are not specifically limited here.
[0085] Specifically, the sampling frequency Fs, signal frequency F, signal length L and sampling point number N are set; the nonlinear moment time series is used as the input of FFT; after FFT transformation, N preliminary frequency points and the complex data a+bi corresponding to each preliminary frequency point can be obtained; based on the periodic characteristics of the frequency, the first (1, N / 2+1) frequency points in the preliminary frequency points are used as target frequency points; for each target frequency point, the amplitude A corresponding to the complex data of the target frequency point is determined by the second formula n For each target frequency point, the phase P corresponding to the complex data of the target frequency point is determined by the third formula n For each target frequency point, the frequency F corresponding to the complex data of the target frequency point is determined by the fourth formula n ; For each target frequency point, the input amplitude, phase and frequency are calculated by the fifth formula to determine the cosine signal corresponding to the target frequency point; Based on the above steps, the effect of decomposing the signal of the nonlinear friction torque in the frequency domain is achieved.
[0086] Optionally, the second formula may be as follows:
[0087]
[0088] Among them, A n represents the amplitude, a represents the real value in the complex data, and b represents the imaginary value in the complex data.
[0089] Optionally, the third formula may be as follows:
[0090]
[0091] Among them, P nrepresents the phase, a represents the real value in the complex data, and b represents the imaginary value in the complex data.
[0092] Optionally, the fourth formula may be as follows:
[0093]
[0094] Among them, F n represents the frequency of the nth target frequency point, F s represents the sampling frequency, and N represents the number of sampling points.
[0095] Optionally, the fifth formula may be as follows:
[0096]
[0097] Among them, f n represents the cosine signal, A n represents the amplitude, P n represents the phase, F n represents the frequency of the nth target frequency point, N represents the number of sampling points, and t represents a time point.
[0098] Optionally, determining the nonlinear friction compensation sub-model based on the multiple cosine signals includes:
[0099] For each of the cosine signals, taking the cosine signal whose amplitude is greater than a preset amplitude threshold as a target signal;
[0100] The nonlinear friction compensation sub-model is determined based on a plurality of the target signals.
[0101] The preset amplitude threshold can be preset according to scene requirements and is not specifically limited here.
[0102] Specifically, k target signals whose amplitudes are greater than a set amplitude threshold are extracted from the cosine signal; and the nonlinear friction compensation sub-model is constructed based on the sum of the k target signals.
[0103] S240: Determine the friction compensation model based on the linear friction compensation sub-model and the nonlinear friction compensation sub-model.
[0104] Optionally, determining the friction compensation model based on the linear friction compensation sub-model and the nonlinear friction compensation sub-model includes:
[0105] The friction compensation model is obtained by aligning the time variable of the target signal of the nonlinear friction compensation sub-model and the position variable of the linear friction compensation sub-model.
[0106] Optionally, the friction compensation model constructed may be as follows:
[0107]
[0108] Wherein, τ represents the real-time compensation friction torque, θ represents the recording position, represents the recording speed, represents the recorded acceleration, M(θ) represents the mass matrix of the surgical arm, G(θ) represents the gravity vector, and F v represents the velocity-dependent viscous friction function, F c represents the Coulomb friction constant, k represents the number of the target signal; A n represents the amplitude, P n represents the phase, F n represents the frequency of the nth target frequency point, N represents the number of sampling points, d represents the constant term identification parameter, and t(θ) represents the alignment of time variable and position variable.
[0109] Among them, the constant term identification parameter can be used to correct the identification error of the linear friction force and the nonlinear friction force, and t(θ) represents aligning the real-time motion position of the linear motion joint to the time point.
[0110] S250, determining a linear motion joint for which friction compensation is to be performed, and determining real-time motion data of the linear motion joint during target motion of the linear motion joint, wherein the real-time motion data includes real-time motion position, real-time velocity and real-time acceleration.
[0111] In an embodiment of the present invention, a constructed friction compensation model can be introduced into the control system to read the real-time motion position, real-time speed and real-time acceleration of the linear motion joint in real time, calculate the friction compensation amount of the current linear motion joint in the target motion state, and use the calculated friction compensation amount as part of the control instruction and add it to the drive control of the linear motion joint to offset the influence of actual friction on the motion accuracy.
[0112] S260, performing real-time calculation on the input real-time motion data through a friction compensation model to determine a real-time compensation friction torque, wherein the friction compensation model includes a linear friction compensation sub-model and a nonlinear friction compensation sub-model.
[0113] S270: Perform real-time friction compensation on the linear motion joint based on the real-time compensation friction torque until the target motion of the linear motion joint is completed.
[0114] The technical solution of the embodiment of the present invention is to control the linear motion joint to perform a simulated motion corresponding to the target motion, record the motion timing data of the linear motion joint during the simulated motion, wherein the motion timing data includes a plurality of recorded time points and a recorded friction torque corresponding to each of the recorded time points; for each of the recorded time points, perform friction decomposition on the recorded friction torque to obtain a nonlinear friction torque corresponding to the recorded time point, and determine a nonlinear torque timing based on the plurality of nonlinear friction torques; process the nonlinear torque timing by a Fourier transform algorithm to obtain a nonlinear friction compensation submodel; and determine the friction compensation model based on the linear friction compensation submodel and the nonlinear friction compensation submodel. The present invention achieves the effect of constructing a high-precision friction compensation model.
[0115] Embodiment 3
[0116] Figure 4 This is a schematic diagram of the structure of a friction compensation device provided in Embodiment 3 of the present invention. Figure 4 As shown, the device includes: a data acquisition module 310 , a compensation torque calculation module 320 and a friction compensation module 330 .
[0117] Among them, the data acquisition module 310 is used to determine the linear motion joint to be friction compensated, and determine the real-time motion data of the linear motion joint during the target motion of the linear motion joint, wherein the real-time motion data includes real-time motion position, real-time speed and real-time acceleration; the compensation torque calculation module 320 is used to perform real-time calculation of the input real-time motion data through a friction compensation model to determine the real-time compensation friction torque, wherein the friction compensation model includes a linear friction compensation sub-model and a nonlinear friction compensation sub-model; the friction compensation module 330 is used to perform real-time friction compensation on the linear motion joint based on the real-time compensation friction torque until the target motion of the linear motion joint is completed.
[0118] The technical solution of the embodiment of the present invention is to determine the linear motion joint to be subjected to friction compensation, and determine the real-time motion data of the linear motion joint during the target motion of the linear motion joint, wherein the real-time motion data includes real-time motion position, real-time speed and real-time acceleration; perform real-time calculation on the input real-time motion data through a friction compensation model to determine the real-time compensation friction torque, wherein the friction compensation model includes a linear friction compensation sub-model and a nonlinear friction compensation sub-model; perform real-time friction compensation on the linear motion joint based on the real-time compensation friction torque until the target motion of the linear motion joint ends. The present invention can accurately compensate for the friction in the process of linear motion joint movement in real time, and improve the motion accuracy and positioning accuracy of the linear motion joint of the surgical robot; the present invention can simultaneously compensate for linear friction and nonlinear friction, thereby reducing the stuck phenomenon of the linear motion joint caused by nonlinear friction, and improving the accuracy and stability of controlling the linear motion joint of the surgical robot.
[0119] Optionally, the friction compensation device further includes: a motion simulation module, a friction decomposition module, a Fourier transform module and a compensation model construction module;
[0120] The simulation motion module is used to control the linear motion joint to perform a simulation motion corresponding to the target motion before the real-time motion data input is calculated in real time by the friction compensation model, and record the motion timing data of the linear motion joint during the simulation motion, wherein the motion timing data includes a plurality of recording time points and a recorded friction torque corresponding to each of the recording time points;
[0121] The friction decomposition module is used to perform friction decomposition on the recorded friction torque for each recorded time point to obtain the nonlinear friction torque corresponding to the recorded time point, and determine the nonlinear torque time series according to the multiple nonlinear friction torques;
[0122] The Fourier transform module is used to process the nonlinear torque time series by using a Fourier transform algorithm to obtain the nonlinear friction force compensation sub-model;
[0123] The compensation model building module is used to determine the friction compensation model based on the linear friction compensation sub-model and the nonlinear friction compensation sub-model.
[0124] Optionally, the motion time series data further includes a recorded position, a recorded speed, and a recorded acceleration corresponding to each recorded time point; the friction force decomposition module is specifically used to:
[0125] Determining the linear friction compensation sub-model;
[0126] For each of the recording time points, the input recording position, the recording speed and the recording acceleration are calculated by the linear friction compensation sub-model to obtain a linear friction torque corresponding to the recording time point;
[0127] A nonlinear friction torque is determined based on the linear friction torque and the recorded friction torque.
[0128] Optionally, the Fourier transform module includes: a Fourier transform unit, a cosine signal determination unit and a nonlinear model determination unit;
[0129] The Fourier transform unit is used to process the nonlinear torque time series by a Fourier transform algorithm to determine a plurality of target frequency points and complex data corresponding to each of the target frequency points, wherein the complex data includes a real value and an imaginary value;
[0130] The cosine signal determination unit is used to determine, for each of the target frequency points, an amplitude, a phase and a frequency corresponding to the target frequency point according to the complex data, and determine a cosine signal corresponding to the target frequency point according to the amplitude, the phase and the frequency;
[0131] The nonlinear model determination unit is used to determine the nonlinear friction compensation sub-model based on the multiple cosine signals.
[0132] Optionally, the nonlinear model determination unit is specifically used to:
[0133] For each of the cosine signals, taking the cosine signal whose amplitude is greater than a preset amplitude threshold as a target signal;
[0134] The nonlinear friction compensation sub-model is determined based on a plurality of the target signals.
[0135] Optionally, the Fourier transform module further includes: an algorithm parameter setting unit, which is used to determine a Fourier transform algorithm and set algorithm parameters of the Fourier transform algorithm before processing the nonlinear torque time series by the Fourier transform algorithm, so as to obtain the Fourier transform algorithm with parameter setting completed, wherein the algorithm parameters include sampling frequency, signal frequency, signal length and number of sampling points;
[0136] The Fourier transform unit is specifically used for:
[0137] The nonlinear moment time series is processed by the Fourier transform algorithm with parameter setting, the preliminary frequency points of the sampling points are determined, and the target frequency points among the preliminary frequency points are determined.
[0138] Optional, compensation model building module, specifically for:
[0139] The friction compensation model is obtained by aligning the time variable of the target signal of the nonlinear friction compensation sub-model and the position variable of the linear friction compensation sub-model.
[0140] The friction compensation device provided in the embodiment of the present invention can execute the friction compensation method provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.
[0141] Embodiment 4
[0142] Figure 5 A schematic diagram of the structure of an electronic device 10 that can be used to implement an embodiment of the present invention is shown. The electronic device is intended to represent various forms of digital computers, such as laptop computers, desktop computers, workstations, personal digital assistants, servers, blade servers, mainframe computers, and other suitable computers. The electronic device can also represent various forms of mobile devices, such as personal digital processing, cellular phones, smart phones, wearable devices (such as helmets, glasses, watches, etc.) and other similar computing devices. The components shown herein, their connections and relationships, and their functions are merely examples and are not intended to limit the implementation of the present invention described and / or required herein.
[0143] like Figure 5 As shown, the electronic device 10 includes at least one processor 11, and a memory connected to the at least one processor 11, such as a read-only memory (ROM) 12, a random access memory (RAM) 13, etc., wherein the memory stores a computer program that can be executed by at least one processor, and the processor 11 can perform various appropriate actions and processes according to the computer program stored in the read-only memory (ROM) 12 or the computer program loaded from the storage unit 18 to the random access memory (RAM) 13. In the RAM 13, various programs and data required for the operation of the electronic device 10 can also be stored. The processor 11, the ROM 12, and the RAM 13 are connected to each other through a bus 14. An input / output (I / O) interface 15 is also connected to the bus 14.
[0144] A number of components in the electronic device 10 are connected to the I / O interface 15, including: an input unit 16, such as a keyboard, a mouse, etc.; an output unit 17, such as various types of displays, speakers, etc.; a storage unit 18, such as a disk, an optical disk, etc.; and a communication unit 19, such as a network card, a modem, a wireless communication transceiver, etc. The communication unit 19 allows the electronic device 10 to exchange information / data with other devices through a computer network such as the Internet and / or various telecommunication networks.
[0145] The processor 11 may be a variety of general and / or dedicated processing components with processing and computing capabilities. Some examples of the processor 11 include, but are not limited to, a central processing unit (CPU), a graphics processing unit (GPU), various dedicated artificial intelligence (AI) computing chips, various processors running machine learning model algorithms, a digital signal processor (DSP), and any appropriate processor, controller, microcontroller, etc. The processor 11 executes the various methods and processes described above, such as the friction compensation method.
[0146] In some embodiments, the friction compensation method may be implemented as a computer program, which is tangibly contained in a computer-readable storage medium, such as a storage unit 18. In some embodiments, part or all of the computer program may be loaded and / or installed on the electronic device 10 via the ROM 12 and / or the communication unit 19. When the computer program is loaded into the RAM 13 and executed by the processor 11, one or more steps of the friction compensation method described above may be performed. Alternatively, in other embodiments, the processor 11 may be configured to perform the friction compensation method in any other appropriate manner (e.g., by means of firmware).
[0147] Various implementations of the systems and techniques described above herein can be implemented in digital electronic circuit systems, integrated circuit systems, field programmable gate arrays (FPGAs), application specific integrated circuits (ASICs), application specific standard products (ASSPs), systems on chips (SOCs), load programmable logic devices (CPLDs), computer hardware, firmware, software, and / or combinations thereof. These various implementations can include: being implemented in one or more computer programs that can be executed and / or interpreted on a programmable system including at least one programmable processor, which can be a special purpose or general purpose programmable processor that can receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
[0148] Computer programs for implementing the methods of the present invention may be written in any combination of one or more programming languages. These computer programs may be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, so that when the computer program is executed by the processor, the functions / operations specified in the flow chart and / or block diagram are implemented. The computer program may be executed entirely on the machine, partially on the machine, partially on the machine and partially on a remote machine as a stand-alone software package, or entirely on a remote machine or server.
[0149] In the context of the present invention, a computer-readable storage medium may be a tangible medium that may contain or store a computer program for use by or in combination with an instruction execution system, device or equipment. A computer-readable storage medium may include, but is not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices or equipment, or any suitable combination of the foregoing. Alternatively, a computer-readable storage medium may be a machine-readable signal medium. A more specific example of a machine-readable storage medium may include an electrical connection based on one or more lines, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.
[0150] To provide interaction with a user, the systems and techniques described herein may be implemented on an electronic device having: a display device (e.g., a CRT (cathode ray tube) or LCD (liquid crystal display) monitor) for displaying information to the user; and a keyboard and a pointing device (e.g., a mouse or trackball) through which the user can provide input to the electronic device. Other types of devices may also be used to provide interaction with the user; for example, the feedback provided to the user may be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and input from the user may be received in any form (including acoustic input, voice input, or tactile input).
[0151] The systems and techniques described herein may be implemented in a computing system that includes backend components (e.g., as a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes frontend components (e.g., a user computer with a graphical user interface or a web browser through which a user can interact with implementations of the systems and techniques described herein), or a computing system that includes any combination of such backend components, middleware components, or frontend components. The components of the system may be interconnected by any form or medium of digital data communication (e.g., a communication network). Examples of communication networks include: a local area network (LAN), a wide area network (WAN), a blockchain network, and the Internet.
[0152] A computing system may include a client and a server. The client and the server are generally remote from each other and usually interact through a communication network. The client and server relationship is generated by computer programs running on the corresponding computers and having a client-server relationship with each other. The server may be a cloud server, also known as a cloud computing server or cloud host, which is a host product in the cloud computing service system to solve the defects of difficult management and weak business scalability in traditional physical hosts and VPS services.
[0153] It should be understood that the various forms of processes shown above can be used to reorder, add or delete steps. For example, the steps described in the present invention can be executed in parallel, sequentially or in different orders, as long as the desired results of the technical solution of the present invention can be achieved, and this document does not limit this.
[0154] The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims
1. A friction compensation method, characterized in that: include: Determine a linear motion joint for which friction compensation is to be performed, and determine real-time motion data of the linear motion joint during the process of the linear motion joint performing target motion, wherein the real-time motion data includes real-time motion position, real-time velocity and real-time acceleration; The input real-time motion data is calculated in real time by a friction compensation model to determine the real-time compensation friction torque, wherein the friction compensation model includes a linear friction compensation sub-model and a nonlinear friction compensation sub-model; The linear motion joint is subjected to real-time friction compensation based on the real-time compensation friction torque until the target motion of the linear motion joint is completed.
2. The method according to claim 1, characterized in that Before the real-time calculation of the input real-time motion data by the friction compensation model, the method further includes: Controlling the linear motion joint to perform a simulated motion corresponding to the target motion, and recording the motion timing data of the linear motion joint during the simulated motion, wherein the motion timing data includes a plurality of recorded time points and a recorded friction torque corresponding to each of the recorded time points; For each of the recorded time points, performing friction decomposition on the recorded friction torque to obtain a nonlinear friction torque corresponding to the recorded time point, and determining a nonlinear torque time sequence according to the multiple nonlinear friction torques; Processing the nonlinear torque time series by Fourier transform algorithm to obtain the nonlinear friction force compensation sub-model; The friction compensation model is determined based on the linear friction compensation sub-model and the nonlinear friction compensation sub-model.
3. The method according to claim 2, characterized in that The motion time series data also includes a recording position, a recording speed and a recording acceleration corresponding to each recording time point; The performing friction decomposition on the recorded friction torque to obtain the nonlinear friction torque corresponding to the recorded time point includes: Determining the linear friction compensation sub-model; For each of the recording time points, the input recording position, the recording speed and the recording acceleration are calculated by the linear friction compensation sub-model to obtain a linear friction torque corresponding to the recording time point; A nonlinear friction torque is determined based on the linear friction torque and the recorded friction torque.
4. The method according to claim 2, characterized in that: The nonlinear torque time series is processed by Fourier transform algorithm to obtain the nonlinear friction force compensation sub-model, including: Processing the nonlinear torque time series by a Fourier transform algorithm to determine a plurality of target frequency points and complex data corresponding to each of the target frequency points, wherein the complex data includes a real value and an imaginary value; For each of the target frequency points, determine the amplitude, phase and frequency corresponding to the target frequency point according to the complex data, and determine the cosine signal corresponding to the target frequency point according to the amplitude, the phase and the frequency; The nonlinear friction compensation sub-model is determined based on a plurality of the cosine signals.
5. The method according to claim 4, characterized in that The determining the nonlinear friction force compensation sub-model based on the plurality of cosine signals comprises: For each of the cosine signals, taking the cosine signal whose amplitude is greater than a preset amplitude threshold as a target signal; The nonlinear friction compensation sub-model is determined based on a plurality of the target signals.
6. The method according to claim 4, characterized in that Before the nonlinear torque time series is processed by the Fourier transform algorithm, the method further includes: Determine a Fourier transform algorithm, set algorithm parameters of the Fourier transform algorithm, and obtain the Fourier transform algorithm with parameter setting completed, wherein the algorithm parameters include sampling frequency, signal frequency, signal length, and number of sampling points; The nonlinear torque time series is processed by a Fourier transform algorithm to determine a plurality of target frequency points, including: The nonlinear moment time series is processed by the Fourier transform algorithm with parameter setting, the preliminary frequency points of the sampling points are determined, and the target frequency points among the preliminary frequency points are determined.
7. The method according to claims 3 and 5, characterized in that The determining the friction compensation model based on the linear friction compensation sub-model and the nonlinear friction compensation sub-model comprises: The friction compensation model is obtained by aligning the time variable of the target signal of the nonlinear friction compensation sub-model and the position variable of the linear friction compensation sub-model.
8. A friction compensation device, characterized in that: include: A data acquisition module, used for determining a linear motion joint to be subjected to friction compensation, and determining real-time motion data of the linear motion joint during the target motion of the linear motion joint, wherein the real-time motion data includes real-time motion position, real-time velocity and real-time acceleration; A compensation torque calculation module, used for performing real-time calculation on the input real-time motion data through a friction compensation model to determine the real-time compensation friction torque, wherein the friction compensation model includes a linear friction compensation sub-model and a nonlinear friction compensation sub-model; The friction compensation module is used to perform real-time friction compensation on the linear motion joint based on the real-time compensation friction torque until the target motion of the linear motion joint ends.
9. An electronic device, characterized in that: The electronic device comprises: at least one processor; and a memory communicatively connected to the at least one processor; wherein, The memory stores a computer program executable by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can perform the friction compensation method according to any one of claims 1 to 7.
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the friction compensation method according to any one of claims 1 to 7 when executed.
Citation Information
Patent Citations
Robot joint friction force compensation method
CN112677156A
Robot low-speed motion nonlinear dynamic characteristic analysis and modeling method
CN113276118A
Nonlinear friction force compensation method and device, electronic equipment and storage medium
CN117400268A
Friction parameter identification method, compensation method, related equipment, system and medium
CN118081731A
Robot control method, apparatus and device based on frictional force
WO2023010811A1
Cited By
Mechanical arm joint friction force estimation method and device, electronic equipment and storage medium
CN119077753A
Compensation method for friction force error of robot arm
CN119839872A
