Robot rehabilitation physiotherapy system based on dragon cupping jar
By integrating robot control modules and sensors on the dragon fire pot, intelligent and unmanned dragon fire pot physiotherapy is achieved, which solves the problem of low manual operation efficiency and improves service efficiency and robot work reliability.
Patent Information
- Application Number
- CN202411125327.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-16
- Publication Date
- 2024-11-26
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The existing Longhuoguan physiotherapy relies on manual operation, which leads to high labor intensity and low service efficiency of medical staff, making it difficult to provide services continuously for a long time.
Design a robot rehabilitation physiotherapy system based on dragon fire pot, adopts a sports robot equipped with dragon fire pot, integrates a database, perceptual feedback module and user interface, and realizes intelligent and unmanned physiotherapy through the robot control module, and is equipped with obstacle avoidance unit and battery life planning unit. Use sensors and algorithms for environmental monitoring and power management.
The intelligent and unmanned dragon fire pot physiotherapy has been realized, which reduces the intensity of manual labor, increases service efficiency and robot work reliability, and ensures that the robot can move safely and last in the environment.
Smart Images

Figure CN119015108A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of traditional Chinese medicine physiotherapy, and in particular to a robot rehabilitation physiotherapy system based on dragon fire cupping. Background Art
[0002] Dragon Fire Cupping (Fire Dragon Cupping) is a special Chinese medicine therapy. Fire Dragon Cupping moxibustion originated from the ancient royal court health-preserving technique and is an ancient traditional Chinese medicine moxibustion method. It uses fire to attack evil, dispel cold and relieve stagnation, and promote blood circulation; it dredges the meridians and activates the collaterals, opens up the meridians, and improves blood supply to the heart and brain; it balances the qi of the internal organs, regulates nerve function, warms the uterus and regulates menstruation; it removes evil, replenishes the body, and activates the immune system function; it is mainly used for lumbar disc herniation, facial paralysis, cervical spondylosis and other diseases. It can effectively dispel cold evil, nourish yang, regulate the balance of yin and yang in the human body, improve the patient's own immunity, and is beneficial to the recovery of deficiency and cold diseases.
[0003] It is suitable for spinal soft injury diseases, such as cervical spondylosis, lumbar disc herniation, etc. Back muscle injuries, such as upper back pain, acute lumbar sprain, etc. Gastrointestinal diseases, such as constipation, indigestion, etc. Gynecological diseases, such as irregular menstruation, dysmenorrhea, etc. Arthritis caused by wind, cold and dampness, etc.
[0004] In the prior art, dragon fire cupping therapy relies on manual labor. Since the therapy process is relatively long, it takes up a lot of resources for the medical staff or technicians, so the manual labor intensity is high and the service load has great limitations.
[0005] To this end, the present invention proposes a robotic rehabilitation therapy system based on dragon fire cupping Summary of the invention
[0006] The purpose of the present invention is to solve the shortcomings of the prior art and to propose a robotic rehabilitation therapy system based on dragon fire cupping.
[0007] In order to achieve the above object, the present invention adopts the following technical solutions:
[0008] The robotic rehabilitation therapy system based on the dragon fire cup is based on a sports robot and is mounted on the sports robot, including:
[0009] The dragon fire cup is fixed at the end of the motion arm of the motion robot. The dragon fire cup is made of a mixture of black stone and purple sand. There is a moxa stick inside the dragon fire cup, and the mouth of the dragon fire cup is inlaid with gold and silver materials;
[0010] A robot control module, which is used to control the movement of the robot;
[0011] Database, which is used to collect rehabilitation therapy data;
[0012] The sensory feedback module includes a pressure sensor mounted on the end of the manipulator arm, a temperature sensor mounted inside the dragon fire cup, and a visual sensor located in the treatment area;
[0013] A user interface, which is used to provide medical staff and patients with an operating interface for interacting with the system;
[0014] The database establishment logic includes the following steps:
[0015] A1: According to the patient's lesions and physiological parameters, medical staff will formulate a corresponding rehabilitation therapy plan for the patient;
[0016] A2: The rehabilitation therapy plan is matched with the patient’s personal information and bound and stored as block data.
[0017] Preferably, the robot control module also has a built-in robot obstacle avoidance unit, and the obstacle avoidance logic of the robot obstacle avoidance unit includes the following steps:
[0018] S1: Environmental data collection, using a camera to capture environmental images and obtain real-time data of nearby environmental images;
[0019] S2: Data processing, the data processing module processes and analyzes the collected images to determine the relative position of the surrounding environment and the robot;
[0020] S3: Positioning: According to the robot model, determine the maximum three-dimensional space occupied by the robot when it moves;
[0021] S4: Execution control, controlling the robot to move to avoid obstacles according to the relative position of the robot and the surrounding environment and the maximum three-dimensional space occupied by the robot when moving;
[0022] S5: During movement, the laser radar and ultrasonic radar continuously scan the surrounding area to ensure successful obstacle avoidance.
[0023] Preferably: in the step S2, the data processing method is:
[0024] S21: Image acquisition, obtaining image information of the external environment captured by the camera;
[0025] S22: image preprocessing, preprocessing the collected image;
[0026] S23: feature extraction, performing feature extraction on the processed image;
[0027] S24: feature matching, matching the extracted features with existing features to identify objects in the image;
[0028] S25: relative position calculation, determining the positions of the robot and the object according to the shooting angle of the camera and the position of the object relative to the environment, thereby obtaining the relative position.
[0029] Preferably, in S24, the feature matching algorithm adopts a matching algorithm based on Gaussian difference pyramid and gradient direction histogram or adopts an algorithm based on Hessian matrix and Haar wavelet features to detect and describe feature points.
[0030] Preferably, the matching algorithm based on Gaussian difference pyramid and gradient direction histogram specifically includes the following steps:
[0031] B1: Scale space extreme value detection, obtain the scale space of the image through the Gaussian difference pyramid, perform Gaussian blur on each scale space, and then use Gaussian difference to detect the extreme points in the image;
[0032] B2: Key point location, by detecting extreme points in the scale space, using interpolation to accurately locate the position and scale of key points;
[0033] B3: Direction assignment: In the neighborhood around the key point, the histogram of gradient magnitude and direction is calculated to obtain the main direction, and the gradient in the neighborhood is rotated to make its direction consistent with the main direction;
[0034] B4: Key point description, in the neighborhood around the key point, calculate the histogram of gradient amplitude and direction to obtain the feature vector, and normalize the feature vector to obtain the descriptor.
[0035] Preferably: the algorithm for detecting and describing feature points based on Hessian matrix and Haar wavelet features specifically includes the following steps:
[0036] C1: Scale space extreme value detection, obtain the scale space of the image through the Gaussian Laplacian pyramid, perform Gaussian blur on each scale space, and then use the determinant of the Hessian matrix to detect the extreme points in the image;
[0037] C2: Key point location, by detecting extreme points in the scale space and using interpolation to accurately locate the position and scale of key points;
[0038] C3: Direction assignment, in the neighborhood around the key point, the Haar wavelet features are calculated and the principal direction is obtained using principal component analysis;
[0039] C4: Key point description, in the neighborhood around the key point, calculate the Haar wavelet features and use integral image acceleration to obtain the descriptor.
[0040] Preferably, the obstacle avoidance unit is also used in conjunction with a path planning unit, and the path planning method of the path planning unit is calculated using the following formula:
[0041]
[0042] st
[0043] x i ∈[x min , x max ],y i ∈[y min ,y max ]
[0044] θ i ∈[-π,π]
[0045]
[0046] Among them, x i ,y i is the current plane coordinate of the robot, θ i is the angle of the robot, d i,i+1 is the spatial distance between the robot’s current position and the next moving position;
[0047] The speed control is performed using the following formula:
[0048] where v max is the maximum speed, p is the distance between the robot and the obstacle, p0 is the safe distance, and k is the coefficient.
[0049] In the speed control formula, p0∈(0.1p m , 0.2p m ), where p m It is the maximum span distance in the X or Y direction when the robot is moving.
[0050] Preferably: the robot control module also has a built-in endurance planning unit, and the working method of the endurance planning unit includes the following steps:
[0051] D1: Determine the robot's cruising range based on the voltage detection of the real-time monitoring unit;
[0052] D2: Determine the robot's working area;
[0053] D3: Obtain a topographic map of the work area, and determine the robot's working path loop based on the topographic map and the robot's cruising range. The working path loop is from the robot's standby position to the staff's working position and then from the working position back to the standby position;
[0054] D4: The robot position information and battery output voltage information are fed back in real time through the positioning unit and the real-time monitoring unit, and the working path is adjusted in real time according to the position information.
[0055] Preferably: in D4, the method for adjusting the working path is:
[0056] D41: During the working process, the positioning unit and the real-time monitoring unit feed back the actual distance information of the robot and the voltage information of the battery pack;
[0057] D42: The central processing chip uses real-time algorithms to adjust the path based on feedback information and actual terrain information.
[0058] Preferably: in the D42, in the real-time algorithm, the entire path length is set to S, the inspected path is S1, the initial battery pack output voltage is U, and the real-time voltage is U1. During the entire process, the power consumption includes horizontal displacement consumption and height potential energy consumption, so U-U1=W 水平 +W 势能 , then W 势能 Assume Mgh, and let the friction resistance be F, then W level = FS, and we can conclude that U-U1 = FS1 + Mgh1 in the traveled path, then According to the next path, the formula F(S-S1)+Mgh2=U1-U k , combined with equation F, it can be inferred that the energy consumption required for the next journey is Where h1 is the terrain index in the S1 path, h2 is the terrain index in the remaining path, and the real-time altitude is H, then judge With U1-U k The size of U k is the safe reserve of electricity, if Greater than U1-U k , the remaining power is insufficient to complete the subsequent journey, and the robot returns to the original position. Less than U1-U k , the remaining power can complete the subsequent journey and the robot moves forward normally.
[0059] The beneficial effects of the present invention are:
[0060] 1. The present invention uses a robot as a carrier, and the integrated database can form a physical therapy plan. Combined with the control of the robot by the robot control module, it can realize intelligent and unmanned dragon fire cupping physical therapy, thereby reducing the intensity of manual labor and increasing the load of personnel serving at the same time.
[0061] 2. The present invention utilizes sensors and algorithm control to monitor the environment of the robot in real time during its movement, thereby realizing obstacle avoidance during the movement and increasing the reliability of the robot's operation.
[0062] 3. The present invention monitors the battery life of the robot, combines the length of the path between the standby state and the working state, changes in altitude, etc., and uses the law of conservation of energy to calculate in real time whether the robot's battery life can complete the entire path, thereby further ensuring the working reliability of the robot. BRIEF DESCRIPTION OF THE DRAWINGS
[0063] Figure 1 The workflow of the robotic rehabilitation therapy system based on dragon fire cupping proposed by the present invention;
[0064] Figure 2 This is the obstacle avoidance logic flow chart of the robotic rehabilitation physiotherapy system based on dragon fire cupping proposed by the present invention. DETAILED DESCRIPTION
[0065] The technical solution of the present invention is further described in detail below in conjunction with specific implementation methods.
[0066] In the description of the present invention, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected", "connected", and "set" should be understood in a broad sense, for example, they can be fixedly connected or set, or detachably connected or set, or integrally connected or set. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0067] Embodiment 1:
[0068] The robot rehabilitation therapy system based on the dragon fire cup is based on a sports robot and is mounted on the sports robot, and includes:
[0069] The dragon fire cup is fixed at the end of the motion arm of the motion robot. The dragon fire cup is made of a mixture of black stone and purple sand. There is a moxa stick inside the dragon fire cup, and the joint of the dragon fire cup is inlaid with gold and silver materials;
[0070] A robot control module, which is used to control the movement of the robot;
[0071] Database, which is used to collect rehabilitation therapy data;
[0072] The sensory feedback module includes a pressure sensor mounted on the end of the manipulator arm, a temperature sensor mounted inside the dragon fire cup, and a visual sensor located in the treatment area;
[0073] User interface, which is used to provide medical staff and patients with an operating interface for interacting with the system.
[0074] The database establishment logic includes the following steps:
[0075] A1: According to the patient's lesions and physiological parameters, medical staff will formulate a corresponding rehabilitation therapy plan for the patient;
[0076] A2: The rehabilitation therapy plan is matched with the patient’s personal information and bound and stored as block data.
[0077] The present invention uses a robot as a carrier, and the database integrated therein can form a physical therapy plan. Combined with the control of the robot by the robot control module, intelligent and unmanned dragon fire cupping physical therapy can be realized, thereby reducing the intensity of manual labor and increasing the load of personnel serving at the same time.
[0078] Embodiment 2:
[0079] The robot rehabilitation therapy system based on the dragon fire cup is based on a sports robot and is mounted on the sports robot, and includes:
[0080] The dragon fire cup is fixed at the end of the motion arm of the motion robot. The dragon fire cup is made of a mixture of black stone and purple sand. There is a moxa stick inside the dragon fire cup, and the joint of the dragon fire cup is inlaid with gold and silver materials;
[0081] A robot control module, which is used to control the movement of the robot;
[0082] Database, which is used to collect rehabilitation therapy data;
[0083] The sensory feedback module includes a pressure sensor mounted on the end of the manipulator arm, a temperature sensor mounted inside the dragon fire cup, and a visual sensor located in the treatment area;
[0084] User interface, which is used to provide medical staff and patients with an operating interface for interacting with the system.
[0085] The database establishment logic includes the following steps:
[0086] A1: According to the patient's lesions and physiological parameters, medical staff will formulate a corresponding rehabilitation therapy plan for the patient;
[0087] A2: The rehabilitation therapy plan is matched with the patient’s personal information and bound and stored as block data.
[0088] The robot control module also has a built-in robot obstacle avoidance unit, and the obstacle avoidance logic of the robot obstacle avoidance unit includes the following steps:
[0089] S1: Environmental data collection, using a camera to capture environmental images and obtain real-time data of nearby environmental images;
[0090] S2: Data processing, the data processing module processes and analyzes the collected images to determine the relative position of the surrounding environment and the robot;
[0091] S3: Positioning: According to the robot model, determine the maximum three-dimensional space occupied by the robot when it moves;
[0092] S4: Execution control, controlling the robot to move to avoid obstacles according to the relative position of the robot and the surrounding environment and the maximum three-dimensional space occupied by the robot when moving;
[0093] S5: During movement, the laser radar and ultrasonic radar continuously scan the surrounding area to ensure successful obstacle avoidance.
[0094] In the step S2, the data processing method is:
[0095] S21: Image acquisition, obtaining image information of the external environment captured by the camera;
[0096] S22: image preprocessing, preprocessing the collected image;
[0097] S23: feature extraction, performing feature extraction on the processed image;
[0098] S24: feature matching, matching the extracted features with existing features to identify objects in the image;
[0099] S25: relative position calculation, determining the positions of the robot and the object according to the shooting angle of the camera and the position of the object relative to the environment, thereby obtaining the relative position.
[0100] In S24, the feature matching algorithm adopts a matching algorithm based on Gaussian difference pyramid and gradient direction histogram.
[0101] The matching algorithm based on Gaussian difference pyramid and gradient direction histogram specifically includes the following steps:
[0102] B1: Scale space extreme value detection, obtain the scale space of the image through the Gaussian difference pyramid, perform Gaussian blur on each scale space, and then use Gaussian difference to detect the extreme points in the image;
[0103] B2: Key point location, by detecting extreme points in the scale space, using interpolation to accurately locate the position and scale of key points;
[0104] B3: Direction assignment: In the neighborhood around the key point, the histogram of gradient magnitude and direction is calculated to obtain the main direction, and the gradient in the neighborhood is rotated to make its direction consistent with the main direction;
[0105] B4: Key point description, in the neighborhood around the key point, calculate the histogram of gradient amplitude and direction to obtain the feature vector, and normalize the feature vector to obtain the descriptor.
[0106] Embodiment 3:
[0107] The robot rehabilitation therapy system based on the dragon fire cup is based on a sports robot and is mounted on the sports robot, and includes:
[0108] The dragon fire cup is fixed at the end of the motion arm of the motion robot. The dragon fire cup is made of a mixture of black stone and purple sand. There is a moxa stick inside the dragon fire cup, and the joint of the dragon fire cup is inlaid with gold and silver materials;
[0109] A robot control module, which is used to control the movement of the robot;
[0110] Database, which is used to collect rehabilitation therapy data;
[0111] The sensory feedback module includes a pressure sensor mounted on the end of the manipulator arm, a temperature sensor mounted inside the dragon fire cup, and a visual sensor located in the treatment area;
[0112] User interface, which is used to provide medical staff and patients with an operating interface for interacting with the system.
[0113] The database establishment logic includes the following steps:
[0114] A1: According to the patient's lesions and physiological parameters, medical staff will formulate a corresponding rehabilitation therapy plan for the patient;
[0115] A2: The rehabilitation therapy plan is matched with the patient’s personal information and bound and stored as block data.
[0116] The robot control module also has a built-in robot obstacle avoidance unit, and the obstacle avoidance logic of the robot obstacle avoidance unit includes the following steps:
[0117] S1: Environmental data collection, using a camera to capture environmental images and obtain real-time data of nearby environmental images;
[0118] S2: Data processing, the data processing module processes and analyzes the collected images to determine the relative position of the surrounding environment and the robot;
[0119] S3: Positioning: According to the robot model, determine the maximum three-dimensional space occupied by the robot when it moves;
[0120] S4: Execution control, controlling the robot to move to avoid obstacles according to the relative position of the robot and the surrounding environment and the maximum three-dimensional space occupied by the robot when moving;
[0121] S5: During movement, the laser radar and ultrasonic radar continuously scan the surrounding area to ensure successful obstacle avoidance.
[0122] In the step S2, the data processing method is:
[0123] S21: Image acquisition, obtaining image information of the external environment captured by the camera;
[0124] S22: image preprocessing, preprocessing the collected image;
[0125] S23: feature extraction, performing feature extraction on the processed image;
[0126] S24: feature matching, matching the extracted features with existing features to identify objects in the image;
[0127] S25: relative position calculation, determining the positions of the robot and the object according to the shooting angle of the camera and the position of the object relative to the environment, thereby obtaining the relative position.
[0128] In S24, the feature matching algorithm uses an algorithm based on Hessian matrix and Haar wavelet features to detect and describe feature points.
[0129] The algorithm for detecting and describing feature points based on Hessian matrix and Haar wavelet features specifically includes the following steps:
[0130] C1: Scale space extreme value detection, obtain the scale space of the image through the Gaussian Laplacian pyramid, perform Gaussian blur on each scale space, and then use the determinant of the Hessian matrix to detect the extreme points in the image;
[0131] C2: Key point location, by detecting extreme points in the scale space and using interpolation to accurately locate the position and scale of key points;
[0132] C3: Direction assignment, in the neighborhood around the key point, the Haar wavelet features are calculated and the principal direction is obtained using principal component analysis;
[0133] C4: Key point description, in the neighborhood around the key point, calculate the Haar wavelet features and use integral image acceleration to obtain the descriptor.
[0134] The present invention utilizes sensors and algorithm control to monitor the environment when the robot is moving in real time, thereby realizing obstacle avoidance during the movement and increasing the reliability of the robot's operation.
[0135] Embodiment 4:
[0136] The robot rehabilitation therapy system based on the dragon fire cup is based on a sports robot and is mounted on the sports robot, and includes:
[0137] The dragon fire cup is fixed at the end of the motion arm of the motion robot. The dragon fire cup is made of a mixture of black stone and purple sand. There is a moxa stick inside the dragon fire cup, and the joint of the dragon fire cup is inlaid with gold and silver materials;
[0138] A robot control module, which is used to control the movement of the robot;
[0139] Database, which is used to collect rehabilitation therapy data;
[0140] The sensory feedback module includes a pressure sensor mounted on the end of the manipulator arm, a temperature sensor mounted inside the dragon fire cup, and a visual sensor located in the treatment area;
[0141] User interface, which is used to provide medical staff and patients with an operating interface for interacting with the system.
[0142] The database establishment logic includes the following steps:
[0143] A1: According to the patient's lesions and physiological parameters, medical staff will formulate a corresponding rehabilitation therapy plan for the patient;
[0144] A2: The rehabilitation therapy plan is matched with the patient’s personal information and bound and stored as block data.
[0145] The robot control module also has a built-in robot obstacle avoidance unit, and the obstacle avoidance logic of the robot obstacle avoidance unit includes the following steps:
[0146] S1: Environmental data collection, using a camera to capture environmental images and obtain real-time data of nearby environmental images;
[0147] S2: Data processing, the data processing module processes and analyzes the collected images to determine the relative position of the surrounding environment and the robot;
[0148] S3: Positioning: According to the robot model, determine the maximum three-dimensional space occupied by the robot when it moves;
[0149] S4: Execution control, controlling the robot to move to avoid obstacles according to the relative position of the robot and the surrounding environment and the maximum three-dimensional space occupied by the robot when moving;
[0150] S5: During movement, the laser radar and ultrasonic radar continuously scan the surrounding area to ensure successful obstacle avoidance.
[0151] In the step S2, the data processing method is:
[0152] S21: Image acquisition, obtaining image information of the external environment captured by the camera;
[0153] S22: image preprocessing, preprocessing the collected image;
[0154] S23: feature extraction, performing feature extraction on the processed image;
[0155] S24: feature matching, matching the extracted features with existing features to identify objects in the image;
[0156] S25: relative position calculation, determining the positions of the robot and the object according to the shooting angle of the camera and the position of the object relative to the environment, thereby obtaining the relative position.
[0157] In S24, the feature matching algorithm adopts a matching algorithm based on Gaussian difference pyramid and gradient direction histogram or adopts an algorithm based on Hessian matrix and Haar wavelet features to detect and describe feature points.
[0158] The matching algorithm based on Gaussian difference pyramid and gradient direction histogram specifically includes the following steps:
[0159] B1: Scale space extreme value detection, obtain the scale space of the image through the Gaussian difference pyramid, perform Gaussian blur on each scale space, and then use Gaussian difference to detect the extreme points in the image;
[0160] B2: Key point location, by detecting extreme points in the scale space, using interpolation to accurately locate the position and scale of key points;
[0161] B3: Direction assignment: In the neighborhood around the key point, the histogram of gradient magnitude and direction is calculated to obtain the main direction, and the gradient in the neighborhood is rotated to make its direction consistent with the main direction;
[0162] B4: Key point description. In the neighborhood around the key point, the histogram of gradient magnitude and direction is calculated to obtain the feature vector, and the feature vector is normalized to obtain the descriptor.
[0163] The algorithm for detecting and describing feature points based on Hessian matrix and Haar wavelet features specifically includes the following steps:
[0164] C1: Scale space extreme value detection, obtain the scale space of the image through the Gaussian Laplacian pyramid, perform Gaussian blur on each scale space, and then use the determinant of the Hessian matrix to detect the extreme points in the image;
[0165] C2: Key point location, by detecting extreme points in the scale space and using interpolation to accurately locate the position and scale of key points;
[0166] C3: Direction assignment, in the neighborhood around the key point, the Haar wavelet features are calculated and the principal direction is obtained using principal component analysis;
[0167] C4: Key point description, in the neighborhood around the key point, calculate the Haar wavelet features and use integral image acceleration to obtain the descriptor.
[0168] The obstacle avoidance unit is also used in conjunction with a path planning unit, and the path planning method of the path planning unit is calculated using the following formula:
[0169]
[0170] st
[0171] x i ∈[x min , x max ],y i ∈[y min ,y max ]
[0172] θ i ∈[-π,π]
[0173]
[0174] Among them, x i ,y i is the current plane coordinate of the robot, θ i is the angle of the robot, d i,i+1 is the spatial distance between the robot’s current position and the next moving position;
[0175] The speed control is performed using the following formula:
[0176] where v max is the maximum speed, p is the distance between the robot and the obstacle, p0 is the safe distance, and k is the coefficient.
[0177] In the speed control formula, p0∈(0.1p m , 0.2p m ), where p m It is the maximum span distance in the X or Y direction when the robot is moving.
[0178] Embodiment 5:
[0179] The robot control module also has a built-in endurance planning unit, and the working method of the endurance planning unit includes the following steps:
[0180] D1: Determine the robot's cruising range based on the voltage detection of the real-time monitoring unit;
[0181] D2: Determine the robot's working area;
[0182] D3: Obtain a topographic map of the work area, and determine the robot's working path loop based on the topographic map and the robot's cruising range. The working path loop is from the robot's standby position to the staff's working position and then from the working position back to the standby position;
[0183] D4: The robot position information and battery output voltage information are fed back in real time through the positioning unit and the real-time monitoring unit, and the working path is adjusted in real time according to the position information.
[0184] In D4, the method for adjusting the working path is:
[0185] D41: During the working process, the positioning unit and the real-time monitoring unit feed back the actual distance information of the robot and the voltage information of the battery pack;
[0186] D42: The central processing chip uses real-time algorithms to adjust the path based on feedback information and actual terrain information.
[0187] In D42, in the real-time algorithm, the entire path length is set to S, the inspected path is S1, the initial battery group output voltage is U, and the real-time voltage is U1. During the entire process, the power consumption includes horizontal displacement consumption and height potential energy consumption, so U-U1=W 水平 +W 势能 , then W 势能 Assume Mgh, and let the friction resistance be F, then W level = FS, and we can conclude that U-U1 = FS1 + Mgh1 in the traveled path, then According to the next path, the formula F(S-S1)+Mgh2=U1-U k , combined with equation F, it can be inferred that the energy consumption required for the next journey is Where h1 is the terrain index in the S1 path, h2 is the terrain index in the remaining path, and the real-time altitude is H, then judge With U1-U k The size of U k is the safe reserve of electricity, if Greater than U1-U k , the remaining power is insufficient to complete the subsequent journey, and the robot returns to the original position. Less than U1-U k , the remaining power can complete the subsequent journey and the robot moves forward normally.
[0188] The present invention monitors the battery life of the robot, combines the length of the path between the standby state and the working state, changes in altitude, etc., and uses the law of conservation of energy to calculate in real time whether the robot's battery life can complete the entire path, thereby further ensuring the working reliability of the robot.
[0189] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can make equivalent replacements or changes according to the technical scheme and inventive concept of the present invention within the technical scope disclosed by the present invention, which should be covered by the protection scope of the present invention.
Claims
1. A robot rehabilitation therapy system based on dragon fire cupping, which is based on a sports robot and is mounted on the sports robot, and is characterized in that: include: The dragon fire cup is fixed at the end of the motion arm of the motion robot. The dragon fire cup is made of a mixture of black stone and purple sand. There is a moxa stick inside the dragon fire cup, and the mouth of the dragon fire cup is inlaid with gold and silver materials. A robot control module, which is used to control the movement of the robot; Database, which is used to collect rehabilitation therapy data; The sensory feedback module includes a pressure sensor mounted on the end of the manipulator arm, a temperature sensor mounted inside the dragon fire cup, and a visual sensor located in the treatment area; A user interface, which is used to provide medical staff and patients with an operating interface for interacting with the system; The database establishment logic includes the following steps: A1: According to the patient's lesions and physiological parameters, medical staff will formulate a corresponding rehabilitation therapy plan for the patient; A2: The rehabilitation therapy plan is matched with the patient’s personal information and bound and stored as block data.
2. The robot rehabilitation therapy system based on dragon fire cupping according to claim 1 is characterized in that: The robot control module also has a robot obstacle avoidance unit built in. The robot obstacle avoidance unit has an obstacle avoidance logic. The following steps are involved: S1: Environmental data collection, using a camera to capture environmental images and obtain real-time data of nearby environmental images; S2: Data processing, the data processing module processes and analyzes the collected images to determine the relative position of the surrounding environment and the robot; S3: Positioning: According to the robot model, determine the maximum three-dimensional space occupied by the robot when it moves; S4: Execution control, controlling the robot to move to avoid obstacles according to the relative position of the robot and the surrounding environment and the maximum three-dimensional space occupied by the robot when moving; S5: During movement, the laser radar and ultrasonic radar continuously scan the surrounding area to ensure successful obstacle avoidance.
3. The robot rehabilitation therapy system based on dragon fire cupping according to claim 2 is characterized in that: In the step S2, the data processing method is: S21: Image acquisition, obtaining image information of the external environment captured by the camera; S22: image preprocessing, preprocessing the collected image; S23: feature extraction, performing feature extraction on the processed image; S24: feature matching, matching the extracted features with existing features to identify objects in the image; S25: relative position calculation, determining the positions of the robot and the object according to the shooting angle of the camera and the position of the object relative to the environment, thereby obtaining the relative position.
4. The robot rehabilitation therapy system based on dragon fire cupping according to claim 3 is characterized in that: In S24, the feature matching algorithm adopts a matching algorithm based on Gaussian difference pyramid and gradient direction histogram or adopts an algorithm based on Hessian matrix and Haar wavelet features to detect and describe feature points.
5. The robot rehabilitation therapy system based on dragon fire cupping according to claim 4 is characterized in that: The matching algorithm based on Gaussian difference pyramid and gradient direction histogram specifically includes the following steps: B1: Scale space extreme value detection, obtain the scale space of the image through the Gaussian difference pyramid, perform Gaussian blur on each scale space, and then use Gaussian difference to detect the extreme points in the image; B2: Key point location, by detecting extreme points in the scale space, using interpolation to accurately locate the position and scale of key points; B3: Direction assignment: In the neighborhood around the key point, the histogram of gradient magnitude and direction is calculated to obtain the main direction, and the gradient in the neighborhood is rotated to make its direction consistent with the main direction; B4: Key point description. In the neighborhood around the key point, the histogram of gradient magnitude and direction is calculated to obtain the feature vector, and the feature vector is normalized to obtain the descriptor.
6. The robot rehabilitation therapy system based on dragon fire cupping according to claim 4 is characterized in that: The algorithm for detecting and describing feature points based on Hessian matrix and Haar wavelet features specifically includes the following steps: C1: Scale space extreme value detection, obtain the scale space of the image through the Gaussian Laplacian pyramid, perform Gaussian blur on each scale space, and then use the determinant of the Hessian matrix to detect the extreme points in the image; C2: Key point location, by detecting extreme points in the scale space and using interpolation to accurately locate the position and scale of key points; C3: Direction assignment, in the neighborhood around the key point, the Haar wavelet features are calculated and the principal direction is obtained using principal component analysis; C4: Key point description, in the neighborhood around the key point, calculate the Haar wavelet features and use integral image acceleration to obtain the descriptor.
7. The robot rehabilitation therapy system based on dragon fire cupping according to claim 2 is characterized in that: The obstacle avoidance unit is also used in conjunction with a path planning unit, and the path planning method of the path planning unit is calculated using the following formula: st x i ∈[x min ,x max ],and i ∈[and min ,and max ] i i ∈[-π,π] Among them, x i ,y i is the current plane coordinate of the robot, θ i is the angle of the robot, d i,i+1 is the spatial distance between the robot’s current position and the next moving position; The speed control is performed using the following formula: where v max is the maximum speed, p is the distance between the robot and the obstacle, p0 is the safe distance, and k is the coefficient. In the speed control formula, p0∈(0.1p m , 0.2p m ), where p m It is the maximum span distance in the X or Y direction when the robot is moving.
8. The robot rehabilitation therapy system based on dragon fire cupping according to claim 1 is characterized in that: The robot control module also has a built-in endurance planning unit, and the working method of the endurance planning unit includes the following steps: D1: Determine the robot's cruising range based on the voltage detection of the real-time monitoring unit; D2: Determine the robot's working area; D3: Obtain a topographic map of the work area, and determine the robot's working path loop based on the topographic map and the robot's cruising range. The working path loop is from the robot's standby position to the staff's working position and then from the working position back to the standby position; D4: The robot position information and battery output voltage information are fed back in real time through the positioning unit and the real-time monitoring unit, and the working path is adjusted in real time according to the position information.
9. The robot rehabilitation therapy system based on dragon fire cupping according to claim 8 is characterized in that: In D4, the method for adjusting the working path is: D41: During the working process, the positioning unit and the real-time monitoring unit feed back the actual distance information of the robot and the voltage information of the battery pack; D42: The central processing chip uses real-time algorithms to adjust the path based on feedback information and actual terrain information.
10. The robot rehabilitation therapy system based on dragon fire cupping according to claim 9 is characterized in that: In D42, in the real-time algorithm, the entire path length is set to S, the inspected path is S1, the initial battery group output voltage is U, and the real-time voltage is U1. During the entire process, the power consumption includes horizontal displacement consumption and height potential energy consumption, so U-U1=W 水平 +W 势能 , then W 势能 Assume Mgh, and let the friction resistance be F, then W level = FS, and we can conclude that U-U1 = FS1 + Mgh1 in the traveled path, then According to the next path, the formula F(S-S1)+Mgh2=U1-U k , combined with equation F, it can be inferred that the energy consumption required for the next journey is Where h1 is the terrain index in the S1 path, h2 is the terrain index in the remaining path, and the real-time altitude is H, then judge With U1-U k The size of U k is the safe reserve of electricity, if Greater than U1-U k , the remaining power is insufficient to complete the subsequent journey, and the robot returns to the original position. Less than U1-U k , the remaining power can complete the subsequent journey and the robot moves forward normally.
Citation Information
Patent Citations
Mowing robot and control method thereof
CN109634285A
Intelligent thermosensitive moxibustion system based on collaborative robot
CN111098314A
System and method for remote operation of moxibustion equipment
CN112587402A
Intelligent control method for moxibustion robot
CN113470820A
Multi-axis moxibustion physiotherapy robot
CN116617077A
