Impedance control method of flexible joint manipulator based on connection and damping configuration
A flexible joint and impedance control technology, which is applied in the impedance control of flexible joint manipulators and the field of manipulator control, can solve problems such as inability to achieve stable control and large residual vibration, and improve the ability to suppress jitter, low hardware requirements, and design simplified effect
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
specific Embodiment approach 1
[0030] Embodiment 1: The impedance control method of a flexible joint manipulator based on connection and damping configuration described in this embodiment includes the following steps:
[0031] Step 1. Obtain the dynamics and kinematics parameters of the flexible joint manipulator through the CAD three-dimensional model, including geometric parameters, mass, and moment of inertia;
[0032] Step 2. Obtain the key parameters of the flexible joint through parameter identification, including joint stiffness matrix K, joint damping matrix D, and joint friction torque τ f ;
[0033] Step 3. Establish the dynamic equation of the flexible joint manipulator, and rewrite it as a port-controlled Hamiltonian (portcontrolHamiltonian, PCH) state equation;
[0034] Step 4. Based on the joint stiffness matrix K and joint damping matrix D obtained in step 2, a gravity and external force compensation algorithm based on the motor position is established;
[0035] Step 5. Calculation of the g...
specific Embodiment approach 2
[0039] Embodiment 2: The difference between this embodiment and Embodiment 1 is that the dynamic equation of the flexible joint manipulator described in step 3 is established, and it is rewritten as the Hamiltonian (portcontrolHamiltonian, PCH) state equation controlled by the port. The specific process is:
[0040] The dynamic equation of the flexible joint manipulator based on the spring damping model is:
[0041] M ( q ) q · · + C ( q , q · ) + g ...
specific Embodiment approach 3
[0077] Embodiment 3: The difference between this embodiment and Embodiment 1 or 2 is that in step 4, based on the joint stiffness matrix K and joint damping matrix D obtained in step 2, a gravity and external force compensation algorithm based on the motor position is established, The specific process is as follows:
[0078] F τ = F g ( x ) + Λ ( x ) x · · d + μ ( x , x · ) x · - Λ ( x ) Λ x - 1 ...
PUM
Abstract
Description
Claims
Application Information
- R&D Engineer
- R&D Manager
- IP Professional
- Industry Leading Data Capabilities
- Powerful AI technology
- Patent DNA Extraction
Browse by: Latest US Patents, China's latest patents, Technical Efficacy Thesaurus, Application Domain, Technology Topic, Popular Technical Reports.
© 2024 PatSnap. All rights reserved.Legal|Privacy policy|Modern Slavery Act Transparency Statement|Sitemap|About US| Contact US: help@patsnap.com