A master-slave underwater manipulator delay control method
A technology of underwater machinery and delay control, applied in the field of robotics, can solve the problems of increasing difficulty for operators to operate, affecting the judgment of surface operators, and long transmission delay time.
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
Embodiment 1
[0078] Embodiment 1, in conjunction with attached figure 1 , the method of the present invention comprises the steps:
[0079] Step 1: Given the structural parameters of the underwater manipulator, establish the kinematics model of the manipulator, and calculate the communication delay time from the master hand to the slave hand.
[0080] Step 2: Considering hydrodynamic factors, establish a dynamic model of the underwater manipulator to verify whether the performance of the manipulator meets the model requirements and can be applied to actual control operations.
[0081] Step 3: Delay the action signal of the master hand, cache the joint control signal at the first n times in the underwater controller, and then calculate the ideal joint motion of the slave hand at n+1 time based on the multi-power curve fitting method Location.
[0082] Step 4: Analyze whether the main hand of the manipulator has emergency operations such as emergency stop and change direction, and whether ...
Embodiment 2
[0084] Embodiment 2, in conjunction with attached figure 2 , to establish the dynamic model of the underwater manipulator. Firstly, without considering the hydrodynamic factors, the Newton-Euler equation is used to model the dynamics of the manipulator.
[0085] At any moment of movement of the underwater manipulator, the angle variable q of each joint of the manipulator i , speed variable acceleration variable i=1,...n as known conditions, solve the moment variable Q of each joint i , i=1,...n. According to the Newton-Euler method, the velocity and acceleration of each connecting rod of the manipulator are calculated forward iteratively. Assuming that the initial motion state of the base is determined, if the base is fixed, then 0 ω 0 = 0, Then, the force and moment of each joint of the manipulator is iteratively calculated backwards according to the Newton-Euler method. The initial condition is Assuming that the end point of the underwater manipulator can mo...
Embodiment 3
[0129] Embodiment 3, in conjunction with attached image 3 , the curve fitting is to obtain finite pairs of test data (x i ,y i ), use these data to find the approximate function y=f(x). In the formula, x is the output quantity, and y is the measured physical quantity. In delay control, the time is the output quantity, and the joint angle is the measured physical quantity.
[0130] The curve fitting method is applied to the delay control of the master-slave underwater manipulator, and the delay link time is set to two parameter cycles, which is called a two-cycle delay. In addition to the signal delay caused by the 485 bus transmission, the slave hand lags behind the main hand for three periods of movement. Process analysis: at the time i+3 of the main hand movement, due to the delay of the 485 communication signal, the underwater control at time i+3 The controller has just received the position of the master hand at time i+2, so the controller knows the position points at...
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