A method for estimating external force of teleoperation master hand based on first-order low-pass filtering
Through first-order low-pass filtering technology, the dynamic model of the remote operation master is simplified, and the external force estimator is designed, which solves the complex and expensive external force estimation problems in the existing technology, realizes fast and accurate external force estimation, and improves the application Convenience.
Patent Information
- Application Number
- CN202311594152.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-11-27
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2043-11-27
AI Technical Summary
The existing remote operation main hand external force estimation methods are complex, difficult to adjust parameters, and require expensive inverse operations, making it difficult to achieve simple, fast and accurate external force estimation.
The first-order low-pass filtering technology is used to establish a dynamic model through the Euler-Lagrangian method, and transform it into a form without obvious acceleration signal. The remote operation main hand external force estimator is designed, and the external force estimation is achieved by using filtering operations, which requires only one Parameter setting.
Fast and accurate external force estimation is achieved, the algorithm is simplified, inverse operations is avoided, and the feasibility and application convenience of the method are improved.
Smart Images

Figure CN117631835B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a teleoperation master hand external force estimation method based on first-order low-pass filtering, and belongs to the field of teleoperation master hand external force estimation. Background Art
[0002] The teleoperation master is the main operating device in the teleoperation system. The operator manually controls the teleoperation master to control the remote teleoperation slave to perform the corresponding task, so as to achieve the purpose of precise control of the teleoperation slave in a safe environment. Based on the above characteristics, the teleoperation master is widely used in remote surgery, remote nuclear waste disposal, space exploration, underwater exploration and other scenarios.
[0003] In order to achieve accurate force feedback, it is necessary to obtain the operating force information of the teleoperator's main hand. The usual solution is to install a force sensor, but this will increase the hardware cost and assembly complexity. Therefore, the external force estimation method without force sensors is more economical and practical.
[0004] Among the existing external force estimation methods, nonlinear disturbance observers and extended state observers are widely used. However, these methods require the construction of an observer-like structure to provide observation errors to construct the estimator, which makes the algorithm implementation complex and parameter adjustment difficult, and the convergence speed mainly depends on the observer gain. In addition, the design of the nonlinear disturbance observer also requires the inversion of the inertia matrix of the teleoperation master hand, which increases the computational burden of the computer. Therefore, how to construct a simple, easy-to-adjust, and accurate teleoperation master hand external force estimator is of great significance for the realization of teleoperation. Summary of the invention
[0005] The present invention provides a teleoperation master hand external force estimation method based on first-order low-pass filtering, aiming to solve at least one of the technical defects.
[0006] The technical solution of the present invention is: a method for estimating the external force of a teleoperation master hand based on a first-order low-pass filter, comprising the following steps:
[0007] Step S1, establishing a dynamic model of an n-degree-of-freedom teleoperation master hand according to the Euler-Lagrange method;
[0008] Step S2, obtaining a dynamic model in a form that does not explicitly contain acceleration signals according to the dynamic model of the teleoperation master hand;
[0009] Step S3, obtaining a dynamic model that does not use the acceleration signal according to the dynamic model that does not explicitly contain the acceleration signal;
[0010] Step S4, designing a teleoperation master hand external force estimator according to the dynamic model that does not use the acceleration signal.
[0011] The dynamic model of the teleoperation master hand is:
[0012]
[0013] in, are the joint positions, velocities and acceleration vectors of the teleoperator’s master hand, respectively; represents the control torque vector of the teleoperated master controller, The operating torque vector for the operator to push the teleoperator's master hand; Indicates the dimension is n, They represent the inertia matrix, Coriolis force matrix and gravity vector of the teleoperator respectively.
[0014] The dynamic model in the form of non-explicit acceleration signal is obtained based on the dynamic model of the teleoperation master hand, specifically:
[0015] Define auxiliary vectors separately and for:
[0016]
[0017] Based on the auxiliary vector and The dynamics model of the teleoperation master hand is preprocessed to convert the dynamics model of the teleoperation master hand into a dynamics model in a form that does not explicitly contain acceleration signals:
[0018]
[0019] in, is the derivative of the inertia matrix M(q) of the teleoperator master, is the auxiliary vector The derivative of .
[0020] The dynamic model without using the acceleration signal is obtained based on the dynamic model without explicitly including the acceleration signal, specifically:
[0021] The first-order low-pass filtering operation is performed on both sides of the equal sign of the dynamic model that does not contain the acceleration signal, and the filtered model is:
[0022]
[0023] Among them, the vector τ f They are The variable after τ filtering satisfies:
[0024]
[0025] According to the first line of formula (5), we can know that:
[0026]
[0027] Therefore, the filtered model (4) is expressed as a dynamic model without using the acceleration signal:
[0028]
[0029] in, They are τ f The derivative of , where the parameter k is a scalar greater than 0 and less than 1.
[0030] The design of the teleoperation master hand external force estimator based on the dynamic model without using the acceleration signal is specifically as follows:
[0031] When the parameter k approaches 0, τ f Approaching the true value τ, determine the teleoperation master hand external force estimator The external force exerted by the operator on the teleoperator's main hand can be accurately estimated. At this time:
[0032]
[0033] The beneficial effects of the present invention are as follows: the present invention can realize fast and accurate external force estimation only through filtering operation, the method is simple, no inversion is required and only one parameter needs to be adjusted, which improves the feasibility and convenience of the method in practical applications. BRIEF DESCRIPTION OF THE DRAWINGS
[0034] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0035] Figure 1 Flow chart of a teleoperation master hand external force estimation method based on first-order low-pass filtering according to an embodiment of the present invention;
[0036] Figure 2 This is a schematic diagram of the remote control master hand structure;
[0037] Figure 3 This is a schematic diagram of the structure of a 2-DOF teleoperation master hand according to an embodiment of the present invention;
[0038] Figure 4 This is a graph showing the experimental results of comparing the estimated value of the external force of joint 1 obtained by the teleoperation master hand external force estimation method based on first-order low-pass filtering according to an embodiment of the present invention with the true value;
[0039] Figure 5 This is a graph showing experimental results of comparing the estimated value of the external force of joint 2 obtained by the teleoperation master hand external force estimation method based on first-order low-pass filtering according to an embodiment of the present invention with the true value. DETAILED DESCRIPTION
[0040] The invention will be further described below in conjunction with the accompanying drawings and embodiments, but the content of the present invention is not limited to the scope of the embodiments.
[0041] Example 1: Figure 1-5 As shown, a teleoperation master hand external force estimation method based on first-order low-pass filtering includes the following steps: step S1, establishing an n-degree-of-freedom teleoperation master hand dynamics model according to the Euler-Lagrange method; step S2, obtaining a dynamics model in a form that does not explicitly contain acceleration signals based on the teleoperation master hand dynamics model; step S3, obtaining a dynamics model that does not use acceleration signals based on the dynamics model that does not explicitly contain acceleration signals; step S4, designing a teleoperation master hand external force estimator based on the dynamics model that does not use acceleration signals.
[0042] In some embodiments, n degrees of freedom include 1 or more degrees of freedom, for example, 3 degrees of freedom or 4 degrees of freedom. Figure 2 Shown is a teleoperated master hand structure with 3 degrees of freedom.
[0043] Furthermore, the dynamic model of the teleoperation master hand is:
[0044]
[0045] in, are the joint positions, velocities and acceleration vectors of the teleoperator’s master hand, respectively; represents the control torque vector of the teleoperated master controller, The operating torque vector of the operator pushing the teleoperator master hand, which is the external force to be estimated by this method; Indicates the dimension is n, They represent the inertia matrix, the Coriolis force (centripetal force) matrix and the gravity vector of the teleoperator respectively.
[0046] Furthermore, the dynamic model without explicit acceleration signal form is obtained based on the dynamic model of the teleoperation master hand, specifically:
[0047] Define auxiliary vectors separately and for:
[0048]
[0049] Based on the auxiliary vector and The dynamics model of the teleoperation master hand is preprocessed to convert the dynamics model of the teleoperation master hand into a dynamics model in a form that does not explicitly contain acceleration signals:
[0050]
[0051] in, is the derivative of the inertia matrix M(q) of the teleoperator master, is the auxiliary vector The derivative of .
[0052] Furthermore, the dynamic model without using the acceleration signal is obtained based on the dynamic model without explicitly including the acceleration signal, specifically:
[0053] The first-order low-pass filtering operation is performed on both sides of the equal sign of the dynamic model that does not contain the acceleration signal, and the filtered model is:
[0054]
[0055] Among them, the vector τ f They are The variable after τ filtering satisfies:
[0056]
[0057] According to the first line of formula (5), we can know that:
[0058]
[0059] Therefore, the filtered model (4) is expressed as a dynamic model without using the acceleration signal:
[0060]
[0061] in, They are τ f The derivative of , where the parameter k is a scalar greater than 0 and less than 1.
[0062] Furthermore, the teleoperation master hand external force estimator is designed based on the dynamic model that does not use the acceleration signal, specifically:
[0063] When the parameter k approaches 0, τ f Approaching the true value τ, determine the teleoperation master hand external force estimator The external force exerted by the operator on the teleoperator's main hand can be accurately estimated. At this time:
[0064]
[0065] Specifically, after rigorous theoretical derivation, it can be proved that when k approaches 0, τ f Approaching the true value τ, we design the external force estimator The external force of the operator pushing the teleoperation master hand can be accurately estimated. Here, k approaches 0 and can be taken as k=0.01 or k=0.001. This is just an example and is not a specific limitation on the k value approaching 0. In actual applications, the k value can be set according to the actual debugging needs of the teleoperation master hand.
[0066] Further, the optional specific implementation modes of the present invention are described as follows:
[0067] Using the proposed external force estimation method, an external force estimation experiment was carried out on a 2-DOF teleoperation master hand.
[0068] Consider Figure 3 The 2-DOF teleoperation master hand shown, when under teleoperation control, uses the teleoperation master hand external force estimation method based on first-order low-pass filtering proposed in the present invention to estimate the control force of the operator.
[0069] According to step S1, the kinetic model variables in formula (1) can be deduced as follows:
[0070]
[0071]
[0072]
[0073] Where q1, q2 represent the first and second elements of the joint position vector q, i.e., the first and second joint angles of the 2-DOF teleoperation master hand. α, β, δ represent the physical parameters of the 2-DOF teleoperation master hand (such as the mass of the connecting rod m1, m2, the position of the center of mass of the connecting rod l1, l2), and g is the gravitational acceleration constant.
[0074] According to step S2, the auxiliary vector is calculated by combining the dynamic model variables obtained above. and
[0075]
[0076] Among them, u is the control torque output by the controller, which can be read in real time by the motor driver.
[0077] According to step S3, the auxiliary variables and Perform a first-order low-pass filtering operation to obtain the filtered variable and
[0078]
[0079] In this experiment, k=0.001.
[0080] According to step S4, the external force estimator is designed as:
[0081]
[0082] This is the value estimated by the external force estimation method based on first-order low-pass filtering proposed in the present invention. Finally, the estimated value is compared with the measured value of the force sensor installed on the teleoperator master hand, and the experimental results are as follows: Figure 4-5 shown.
[0083] Since force sensors are usually very sensitive to noise, the external force signals measured by the force sensors are often mixed with a lot of noise, resulting in a low signal-to-noise ratio. Figure 4-5 It is very obvious in the figure, which is manifested as large fluctuations in the measured values; correspondingly, the estimated value of the external force by the remote operation external force estimation method based on first-order low-pass filtering proposed in the present invention is relatively smooth, and the overall trend is consistent with the measured value, indicating that the method proposed in this patent can not only effectively estimate the external force, but also avoid the defect of the force sensor being sensitive to signal noise.
[0084] By applying the above technical solution, it can be known that the external force estimation method for the teleoperation master hand of the embodiment of the present invention solves the problem of external force estimation of the teleoperation master hand without torque sensor. In particular, when the operator manually controls the teleoperation master hand, the method proposed in the present invention can quickly and accurately estimate the operator's control force on the teleoperation master hand through the information collected by the teleoperation master hand itself under the condition of no torque sensor, so that the estimated external force can be further applied to the control algorithm.
[0085] The advantages of the present invention are that fast and accurate external force estimation can be achieved only through filtering operation, the structure is simple, no inversion is required, and only one parameter needs to be adjusted, which improves the feasibility and convenience of the method in practical applications.
[0086] The specific implementation modes of the present invention are described in detail above in conjunction with the accompanying drawings, but the present invention is not limited to the above implementation modes, and various changes can be made within the knowledge scope of ordinary technicians in this field without departing from the purpose of the present invention.
Claims
1. A teleoperation master hand external force estimation method based on first-order low-pass filtering, characterized in that: The following steps are involved: Step S1, establishing a dynamic model of an n-degree-of-freedom teleoperation master hand according to the Euler-Lagrange method; Step S2, obtaining a dynamic model in a form that does not explicitly contain acceleration signals according to the dynamic model of the teleoperation master hand; Step S3, obtaining a dynamic model that does not use the acceleration signal according to the dynamic model that does not explicitly contain the acceleration signal; Step S4, designing a teleoperation master hand external force estimator according to the dynamic model that does not use the acceleration signal; The dynamic model of the teleoperation master hand is: in, are the joint positions, velocities and acceleration vectors of the teleoperator’s master hand, respectively; represents the control torque vector of the teleoperated master controller, The operating torque vector for the operator to push the teleoperator's master hand; Represents dimension n, M(q), G(q) represents the inertia matrix, Coriolis force matrix and gravity vector of the teleoperator hand respectively; The dynamic model in the form of non-explicit acceleration signal is obtained based on the dynamic model of the teleoperation master hand, specifically: Define auxiliary vectors separately and for: Based on the auxiliary vector and The dynamics model of the teleoperation master hand is preprocessed to convert the dynamics model of the teleoperation master hand into a dynamics model in a form that does not explicitly contain acceleration signals: in, is the derivative of the inertia matrix M(q) of the teleoperator master, is the auxiliary vector The derivative of The dynamic model without using the acceleration signal is obtained based on the dynamic model without explicitly including the acceleration signal, specifically: The first-order low-pass filtering operation is performed on both sides of the equal sign of the dynamic model that does not contain the acceleration signal, and the filtered model is: Among them, the vector τ f They are The variable after τ filtering satisfies: According to the first line of formula (5), we can know that: Therefore, the filtered model (4) is expressed as a dynamic model without using the acceleration signal: in, They are τ f The derivative of , the parameter k is a scalar greater than 0 and less than 1; The design of the teleoperation master hand external force estimator based on the dynamic model without using the acceleration signal is specifically as follows: When the parameter k approaches 0, τ f Approaching the true value τ, determine the teleoperation master hand external force estimator The external force applied by the operator to push the teleoperation master hand can be accurately estimated.
