A multi-finger spatial collaborative control manipulator in a high-risk pollution environment

By integrating bionic robots and wearable perception gloves in robotic hands, using dynamic models and PID control algorithms, combined with electromyography signal processing technology, multi-finger space coordinated control in high-risk environments is achieved, and the problem of insufficient coordinated control between fingers is solved. Improves operational safety and precision.

CN114227645BActive Publication Date: 2024-12-06AGRICULTURAL EQUIPMENT INSTITUTE OF HUNAN +2
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202111631078.X
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-12-28
Publication Date
2024-12-06
Estimated Expiration
2041-12-28

AI Technical Summary

Technical Problem

Existing robots have insufficient coordinated control between fingers in high-risk polluted environments, unable to complete fine operations, and lack effective algorithm unity, resulting in improper operation in dangerous environments that may cause harm to the human body.

Method used

A robot with coordinated control of multi-finger space in high-risk pollution environments was designed. Combined with bionic robot and wearable perception gloves, the Arduino control development board, Bluetooth reception sensor and STM32 data processing microcontroller was used to realize fingers through dynamic model and PID control algorithm. Movement trajectory planning and collaborative control, muscle bioelectric field sensor and wavelet analysis technology are used to extract electromyography signals, and multi-source signal fusion is performed in combination with Bayesian estimation to achieve remote bionic motion control.

Benefits of technology

Realizes remote bionic motion control with flexible fingers and accurate positioning in high-risk environments, reduces harm to the human body, improves operational safety and ease of operation, and can be grasped and moved in high-radiation, low temperature and air pollution environments. and rotation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114227645B_ABST
    Figure CN114227645B_ABST
Patent Text Reader

Abstract

The present invention provides an intelligent bionic gripper in a high-risk environment, including a bionic manipulator and a wearable sensing glove, wherein the bionic manipulator includes a gripper support platform, a mobile control system and a manipulator gripper. The mobile control system includes an Arduino control development board, a Bluetooth receiving sensor and an STM32 data processing single-chip microcomputer, and the manipulator gripper part includes fingers, palms and a rotating support, and the fingers are composed of finger heels, finger joints and fingertips; the embodiment of the present invention utilizes Bluetooth remote sensing, decoupling, self-adaptation and other spatial remote control of the operation process of the manipulator gripper, and under the actual control of the operator, simple operations such as grasping, moving and rotating can be realized in a high-risk environment, which can effectively reduce the harm caused by dangerous environments to human skin, etc. The operator can operate the operation object within the effective range, which has high safety and easy operability.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of robot technology, in particular to a multi-finger spatial collaborative control manipulator in a high-risk pollution environment. Background Art

[0002] With the continuous development of robotics and related disciplines, the application field of bionic manipulators continues to expand. In traditional mechanical maintenance, biological experiments, nuclear tests and other isolated environments that are harmful to the human body, some precision instruments and operation processes must be performed by hand. Improper operation can cause great harm to the human body. A robot bionic manipulator claw with multi-sensor fusion, Bluetooth perception, adaptive error adjustment and wide adaptability is of great significance. It can help replace the human body to achieve flexible operation processes, greatly reduce the occurrence of harmful accidents, and improve people's quality of life. On the other hand, existing manipulators generally have the problem of insufficient coordinated control between fingers, and there is no good algorithm to unify the execution, so that delicate work cannot be completed. Summary of the invention

[0003] Based on this, it is necessary to provide a multi-finger spatial collaborative control manipulator in a high-risk pollution environment to address the above problems. In addition to the characteristics of flexible fingers and accurate positioning, it also has remote bionic motion control.

[0004] The present invention provides a multi-finger spatial collaborative control manipulator in a high-risk pollution environment, including a bionic manipulator and a wearable sensing glove. The bionic manipulator includes a gripper support platform, a mobile control system and a manipulator gripper. The gripper support platform includes a U-shaped wearable structure, a mobile control board support structure and a manipulator gripper support structure. The mobile control system includes an Arduino control development board, a Bluetooth receiving sensor and an STM32 data processing single-chip microcomputer. The manipulator gripper part includes fingers, palms and rotating supports. The fingers are composed of finger heels, knuckles and fingertips. The wearable sensing gloves include cotton silicone wearable gloves, joint monitoring sensors, data processing development boards and Bluetooth transmission sensors.

[0005] The gripper support platform is used to support the mobile control system and the mechanical gripper. The mobile control system is installed in the middle of the support platform and protected by an embedded protection box. The 6-way output terminal of the control development board on the control system is connected to the fingers and palm of the bionic gripper; the input terminal of the development board is connected to the Bluetooth receiving sensor; the computing center of the development board maps the motion intention of each actual finger into the motion trajectory of a single fingertip, and combines the single finger motion equation, joint space method, and operation space method to map the fingertip motion trajectory into the trajectory planning of each motion unit, with the minimum time as the objective function, and the premise of satisfying natural constraints and operation constraints, with the optimal solution of the motion path; the dynamic model is used to implement feedback servo control on the driving units of the fingers and grippers; the control algorithm is calculated using PID control, and the feedforward, compensation, decoupling, and adaptive control technology are used to obtain the required speed, displacement, and angle control quantities, so as to realize the coordinated control of multi-finger spatial trajectories.

[0006] The bionic manipulator preliminarily analyzes some operation characteristics of the operation object and operation resources, extracts the most basic hand movement elements, equates the finger model to a joint-link model, applies the DH parameter method to perform matrix transformation calculations on adjacent joint points, establishes a local coordinate system for each link, and then uses a coordinate transformation matrix to represent the correlation between the local coordinate systems, and finally establishes a mathematical connection between any point on the finger and the base to obtain a fingertip motion space equation; based on the single-finger fingertip motion equation, a multi-finger motion equation is constructed to describe the relationship between the multi-finger motion target and the participating single-finger fingertip motion trajectory.

[0007] The wearable sensing gloves use muscle bioelectric field sensors to perform motion analysis, and study the changing rules and internal patterns of the bioelectromagnetic field during typical muscle movements such as rotation, flexion and extension; use wavelet analysis and empirical mode decomposition technology to build an adaptive noise reduction algorithm to achieve effective separation of electromyography and myomagnetic characteristic signals from background noise; use compressed sensing, independent component analysis and other technologies to extract electromyography and myomagnetic signal patterns based on the time series measured by multiple electromyography and myomagnetic sensors; integrate electromyography, myomagnetic, bending, pressure and other signal inputs, use Bayesian estimation, weighted decision-making and other methods to fuse multi-source signals, convert muscle movement into finger movement spatial information, and finally obtain a finger movement intention perception model, use the model to package the perception data, and send the data to the bionic manipulator receiving end through the Bluetooth sensor.

[0008] The U-shaped wearable structure is mainly designed to simulate the shape of a human arm, and can be worn on the operator's arm in a portable manner to achieve operation in a long-distance isolated environment.

[0009] The mobile control board support structure is made of lightweight aluminum alloy material and is mainly used for the safe packaging of the mobile control board to prevent the external environment from corroding the chip parts in a high-risk environment.

[0010] The manipulator support structure is connected to the manipulator claw horizontal control by a mobile control board support structure, and mainly controls the horizontal movement of the palm and fingers.

[0011] The mobile control system is installed in an aluminum alloy support installation box structure. After the joint position is received by the Bluetooth receiving sensor, the data is transmitted to the STM32 microcontroller for data conversion and control of the movement of each finger and palm joint servo.

[0012] Furthermore, the receiving frequency of the Bluetooth receiving sensor is the same as that of the Bluetooth sending sensor. The sending end packages and sends multiple data bit bytes at a fixed baud rate, and the receiving end sensor parses and packages the data according to the frequency to split the step and angle data of each joint.

[0013] Furthermore, the STM32 single-chip microcomputer is embedded in the Arduino program development board, and the output I / O of the control board 10 is connected to the 6-way servos with 6*3 lines. After the Bluetooth receiving end parses the data packet, the data is converted into the stepping distance of each servo after A / D conversion. Each servo is controlled by 3 wires, namely the sending, receiving and common ground ports.

[0014] Furthermore, except for the palm horizontal servo, the other 6 servos mainly control the bending degree of each finger joint 6.

[0015] The movement and grasping of the mechanical gripper are controlled by 6-way servos, the movement of the palm is mainly controlled by horizontal and left and right rotation servos, and the heels, knuckles and fingertips of each finger 6 are connected by 3 levers.

[0016] Furthermore, the stepping distances of the three joints of the finger 6 are controlled by the stepping distance of the servo and the lever principle. The stepping of the servo can realize forward and reverse rotation, and the bending degree of the finger joints can be realized under the action of the lever principle.

[0017] Furthermore, the bending degree of the finger is composed of three joints, and the joints of each finger are connected and fixed with rotating screws. The heel, knuckle and fingertip can be straightened to 180°, and the maximum bending degree in the palm is 25°.

[0018] The wearing sensing gloves are made of cotton silicone pattern gloves. When worn on a person's hand, the gloves can sense the position of the operator's hand and have good softness and sensitivity.

[0019] The joint monitoring sensor is fixed on the upper end of the finger of the cotton silicone pattern glove. The sensor on each finger has 22 sensing nodes, which can enhance the sensing effect.

[0020] The data processing development board and the Bluetooth sending sensor are connected to the finger monitoring sensors. The data processing development board analyzes and calculates the data of each sensing node, and synthesizes a set of finger joint bending degree data packets, which are transmitted to the Bluetooth sending sensor end. The data is transmitted via spatially unlimited Bluetooth data at a prescribed frequency and sent to the data receiving end to control the movement of the robotic gripper 4.

[0021] The embodiment of the present invention utilizes Bluetooth remote sensing, decoupling, self-adaptation and other spatial remote control of the operation process of the manipulator gripper. Under the actual control of the operator, simple operations such as grasping, moving, rotating, etc. can be achieved in a high-risk environment, which can effectively reduce the harm caused by dangerous environments (such as high radiation, low temperature and air pollution environments) to human skin. The operator can operate the operation object within the effective range, which has high safety and easy operation. BRIEF DESCRIPTION OF THE DRAWINGS

[0022] Figure 1 A side view of an intelligent bionic gripper for use in a high-risk environment provided by the present invention;

[0023] Figure 2 A front view of an intelligent bionic gripper for use in a high-risk environment provided by the present invention;

[0024] Figure 3 A mechanical gripper part of an intelligent bionic gripper for use in a high-risk environment provided by the present invention;

[0025] Figure 4 The present invention provides a wearable sensing glove with an intelligent bionic gripper for use in high-risk environments. DETAILED DESCRIPTION

[0026] In order to facilitate the understanding of the present invention, the present invention will be described more fully below with reference to the relevant drawings. The preferred embodiments of the present invention are given in the drawings. However, the present invention can be implemented in many different forms and is not limited to the embodiments described herein. On the contrary, the purpose of providing these embodiments is to make the disclosure of the present invention more thoroughly understood.

[0027] The present invention provides an intelligent bionic gripper for high-risk environments, including a bionic manipulator 1 and a wearable sensing glove 17. The bionic manipulator 1 includes a gripper support platform 2, a mobile control system 3 and a manipulator gripper 4. The gripper support platform 2 includes a U-shaped wearable structure 7, a mobile control board support structure 8 and a manipulator gripper support structure 9. The mobile control system 3 includes an Arduino control development board 10, a Bluetooth receiving sensor 11 and an STM32 data processing single-chip microcomputer 12. The manipulator gripper 4 includes fingers 6, a palm 5 and a support 13. The fingers are composed of a heel 14, a knuckle 15 and a fingertip 16. The wearable sensing glove 17 includes a cotton silicone pattern wearable glove 18, a joint monitoring sensor 19, a data processing development board 20 and a Bluetooth sending sensor 21.

[0028] The U-shaped wearable structure 7 on the gripper support platform 2 is mainly designed to simulate the shape of a human arm, and can be worn on the operator's arm in a portable manner to achieve operation in a remote isolated environment.

[0029] The mobile control board support structure 8 is made of lightweight aluminum alloy material and is mainly used for the safe packaging of the mobile control board 3 to prevent the external environment from corroding the chip parts in a high-risk environment.

[0030] The manipulator support structure 9 is connected to the manipulator claw 4 by a mobile control board support structure 9 and is horizontally controlled to mainly control the horizontal movement of the palm 5 and the fingers 6 .

[0031] The mobile control system 3 is installed in the aluminum alloy support 8 mounting box structure. After the joint position is received by the Bluetooth receiving sensor 11, it is transmitted to the STM32 microcontroller 12 for data conversion and control of the movement of each finger 6 and palm 5 joint servo.

[0032] Furthermore, the receiving frequency of the Bluetooth receiving sensor 11 is the same as that of the Bluetooth sending sensor 21. The sending end packages and sends multiple data bit bytes at a fixed baud rate, and the receiving end sensor 11 parses and packages the data according to the frequency to split the step and angle data of each joint.

[0033] Furthermore, the STM32 single-chip computer 12 is embedded in the Arduino program development board 10, and the output I / O of the control board 10 is connected to the 6-way servos by 6*3 lines. After the Bluetooth receiving end 11 parses the data packet, the data is converted into the stepping distance of each servo after A / D conversion. Each servo is controlled by 3 wires, namely the sending, receiving and common ground ports.

[0034] Furthermore, except for the palm horizontal servo, the other 6 servos mainly control the bending degree of each finger joint 6.

[0035] The movement and grasping of the mechanical gripper 4 are controlled by a 6-way servo 23, the movement of the palm 5 is mainly controlled by the horizontal and left and right rotation servos, and the heel 14, the knuckle 15, and the fingertip 16 of each finger 6 are connected by three levers.

[0036] Furthermore, the stepping distances of the three joints of the finger 6 are controlled by the stepping distance of the servo and the lever principle. The stepping of the servo can realize forward and reverse rotation, and the bending degree of the finger joint 23 can be realized under the action of the lever principle.

[0037] Furthermore, the bending degree of the finger 6 is composed of three joints 23, and the finger joints 23 are connected and fixed by rotating screws. The finger heel 14, finger joint 15, and fingertip 16 are straightened to 180 degrees, and the maximum bending degree in the palm 5 is 25 degrees.

[0038] The wearing sensing gloves 17 use cotton silicone pattern gloves 18. When worn on a person's hand, the gloves can sense the position of the operator's hand and have good softness and sensitivity.

[0039] The joint monitoring sensor 19 is fixed on the upper ends of 18 fingers of the cotton silicone pattern gloves. The sensor 19 on each finger has 22 sensing nodes, which can enhance the sensing effect.

[0040] The data processing development board 20 and the Bluetooth sending sensor 21 are connected to the finger monitoring sensors 19. The data processing development board 20 analyzes and calculates the data of each sensing node, and synthesizes a set of finger joint 6 bending degree data packets, and transmits the data packets to the Bluetooth sending sensor end 19. The data is transmitted via spatially unlimited Bluetooth data at a prescribed frequency and sent to the data receiving end 11 to control the movement of the robotic gripper 4.

[0041] This embodiment provides an intelligent bionic gripper for high-risk environments, including a bionic manipulator and a wearable sensing glove. The bionic manipulator includes a gripper support platform, a mobile control system, and a manipulator gripper. The gripper support platform includes a U-shaped wearable structure, a mobile control board support structure, and a manipulator gripper support structure. The mobile control system includes an Arduino control development board, a Bluetooth receiving sensor, and an STM32 data processing microcontroller. The manipulator gripper part includes fingers, palms, and rotating supports. The fingers are composed of heels, knuckles, and fingertips. The wearable sensing gloves include cotton silicone wearable gloves, joint monitoring sensors, data processing development boards, and Bluetooth sending sensors. The specific embodiments are as follows:

[0042] As a preferred embodiment of the present invention, the gripper support platform is used to support the mobile control system and the mechanical gripper. The mobile control system is installed in the middle of the support platform and protected by an embedded protection box. The control system controls the 6-way output terminal of the development board to be connected to the fingers and palm of the bionic gripper. The input terminal of the development board is connected to a Bluetooth receiving sensor. The development board computing center maps the motion intention of each actual finger into a single fingertip motion trajectory. Combined with the single finger motion equation, the joint space method and the operation space method, the fingertip motion trajectory is mapped into the trajectory planning of each motion unit. The minimum time is used as the objective function, and the premise of satisfying the natural constraints and the operation constraints is the optimal solution of the motion path. The dynamic model is used to implement feedback servo control on the driving units of the fingers and grippers. Using the calculation PID control as the control algorithm, the feedforward, compensation, decoupling and adaptive control technology are used to obtain the required speed, displacement and angle control quantities, and realize the coordinated control of the multi-finger spatial trajectory.

[0043] As a preferred embodiment of the present invention, the bionic manipulator preliminarily analyzes some operation characteristics of the operation object and the operation resource, extracts the most basic hand movement elements, equates the finger model to a joint-link model, applies the DH parameter method to perform matrix transformation calculations on adjacent joint points, establishes a local coordinate system for each link, and then uses a coordinate transformation matrix to represent the correlation between the local coordinate systems, and finally establishes a mathematical connection between any point on the finger and the base to obtain a fingertip motion space equation; based on the single-finger fingertip motion equation, a multi-finger motion equation is constructed to describe the relationship between the multi-finger motion target and the motion trajectory of the participating single-finger fingertips.

[0044] As a preferred embodiment of the present invention, the wearable sensing gloves use muscle bioelectric field sensors to perform motion analysis, and analyze the changing laws and internal patterns of the bioelectromagnetic field during typical muscle movements such as rotation, flexion and extension; use wavelet analysis, empirical mode decomposition and other technologies to construct an adaptive noise reduction algorithm to achieve effective separation of electromyographic and myomagnetic characteristic signals from background noise; according to the time series measured by multiple electromyographic and myomagnetic sensors, use compressed sensing, independent component analysis and other technologies to extract electromyographic and myomagnetic signal patterns; integrate electromyographic, myomagnetic, bending, pressure and other signal inputs, use Bayesian estimation, weighted decision-making and other methods to fuse multi-source signals, convert muscle movement into finger movement spatial information, and finally obtain a finger movement intention perception model, use the model to package the perception data, and send it to the bionic manipulator receiving end through the Bluetooth sensor.

[0045] The embodiment of the present invention utilizes Bluetooth remote sensing, decoupling, self-adaptation and other spatial remote control of the operation process of the manipulator gripper. Under the actual control of the operator, simple operations such as grasping, moving, rotating, etc. can be achieved in a high-risk environment, which can effectively reduce the harm caused by dangerous environments (such as high radiation, low temperature and air pollution environments) to human skin. The operator can operate the operation object within the effective range, which has high safety and easy operation.

[0046] The technical features of the above-described embodiments may be arbitrarily combined. To make the description concise, not all possible combinations of the technical features in the above-described embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0047] The above-mentioned embodiments only express several implementation methods of the present invention, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the invention patent. It should be pointed out that, for ordinary technicians in this field, several variations and improvements can be made without departing from the concept of the present invention, and these all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention shall be subject to the attached claims.

Claims

1. A multi-finger spatial collaborative control manipulator in a high-risk pollution environment, characterized in that: include: Bionic manipulator and wearable sensing gloves, wherein the bionic manipulator comprises a gripper support platform, a mobile control system and a manipulator gripper; The gripper support platform includes a U-shaped wearable structure, a mobile control board support structure and a mechanical gripper support structure. The mobile control system includes an Arduino control development board, a Bluetooth receiving sensor and an STM32 data processing single chip microcomputer. The mechanical gripper part includes fingers, palms and rotating supports. The fingers are composed of finger heels, knuckles and fingertips. The wearable sensing gloves include cotton silicone wearable gloves, joint monitoring sensors, data processing development boards and Bluetooth sending sensors. The gripper support platform is used to support the mobile control system and the mechanical gripper. The mobile control system is installed in the middle of the support platform and protected by an embedded protection box. The 6-way output terminal of the control development board on the control system is connected to the fingers and palm of the bionic gripper; the input terminal of the development board is connected to the Bluetooth receiving sensor; the computing center of the development board maps the motion intention of each actual finger into the motion trajectory of a single fingertip, combines the single finger motion equation, the joint space method, and the operation space method, and maps the fingertip motion trajectory into the trajectory planning of each motion unit, with the minimum time as the objective function, and the premise of satisfying natural constraints and operation constraints, with the optimal solution of the motion path; the dynamic model is used to implement feedback servo control on the driving units of the fingers and grippers; the control algorithm is calculated using PID control, and the feedforward, compensation, decoupling, and adaptive control technology are used to obtain the required speed, displacement, and angle control quantities, so as to realize the coordinated control of multi-finger spatial trajectories; The wearable sensing gloves use muscle bioelectric field sensors to perform motion analysis, and study the changing rules and internal patterns of the bioelectromagnetic field during typical muscle movements such as rotation, flexion and extension; use wavelet analysis and empirical mode decomposition technology to build an adaptive noise reduction algorithm to achieve effective separation of electromyography and myomagnetic characteristic signals from background noise; use compressed sensing, independent component analysis and other technologies to extract electromyography and myomagnetic signal patterns based on the time series measured by multiple electromyography and myomagnetic sensors; integrate electromyography, myomagnetic, bending, pressure and other signal inputs, use Bayesian estimation and weighted decision methods to fuse multi-source signals, convert muscle movement into finger movement spatial information, and finally obtain a finger movement intention perception model, use the model to package the perception data, and package and send them to the bionic manipulator receiving end through the Bluetooth sending sensor.

2. The robot according to claim 1, characterized in that: The bionic manipulator preliminarily analyzes some operation characteristics of the operation object and operation resources, extracts the most basic hand movement elements, equates the finger model to a joint-link model, applies the DH parameter method to perform matrix transformation calculations on adjacent joint points, establishes a local coordinate system for each link, and then uses a coordinate transformation matrix to represent the correlation between the local coordinate systems, and finally establishes a mathematical connection between any point on the finger and the base to obtain a fingertip motion space equation; based on the single-finger fingertip motion equation, a multi-finger motion equation is constructed to describe the relationship between the multi-finger motion target and the participating single-finger fingertip motion trajectory.

3. The robot according to claim 1, characterized in that: The U-shaped wearable structure is mainly designed to simulate the shape of a human arm, and can be worn on the operator's arm in a portable manner to achieve operation in a long-distance isolated environment.

4. The robot according to claim 1, characterized in that: The mobile control board support structure is made of lightweight aluminum alloy material and is mainly used for the safe packaging of the mobile control board to prevent the external environment from corroding the chip parts in a high-risk environment.

5. The robot according to claim 1, characterized in that: The manipulator support structure is connected to the manipulator claw horizontal control by a mobile control board support structure, and mainly controls the horizontal movement of the palm and fingers.

6. The robot according to claim 1, characterized in that: The receiving frequency of the Bluetooth receiving sensor is the same as that of the Bluetooth sending sensor. The sending end packages and sends multiple data bit bytes at a fixed baud rate. The Bluetooth receiving sensor parses and packages the data according to the frequency and separates the step and angle data of each joint.

7. The robot according to claim 1, characterized in that: The STM32 data processing microcontroller is embedded in an Arduino program development board. The output I / O of the Arduino control development board is connected to 6 servos with 6*3 lines. After the Bluetooth receiving sensor parses the data packet, the data is converted into the stepping distance of each servo after A / D conversion. Each servo is controlled by 3 lines, which are respectively a sending port, a receiving port and a common ground port.

8. The robot according to claim 1, characterized in that: The bending degree of the fingers is composed of three joints, and the joints of each finger are fixed with rotating screws. The heel, knuckles and fingertips can be straightened to 180°, and the maximum bending degree within the palm is 25°.

9. The robot according to claim 1, characterized in that: The joint monitoring sensor is fixed on the upper end of the finger of the cotton silicone pattern wearable glove. The sensor on each finger has 22 sensing nodes, which can enhance the sensing effect.