Moxibustion robot trajectory planning method and device based on tactile guidance and moxibustion robot

Through the haptic guidance-based moxibustion robot trajectory planning method, using Bayesian or deep learning models and Kalman filters, the problem of insufficient precise planning of existing moxibustion robot trajectory planning is solved, and the precise simulation and real-time moxibustion techniques are realized Adjustments ensure the safety and efficacy of the moxibustion process.

CN118990535AActive Publication Date: 2024-11-22CENT SOUTH UNIV
View PDF 9 Cites 0 Cited by

Patent Information

Application Number
CN202411132147.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-19
Publication Date
2024-11-22
Estimated Expiration
2044-08-19

AI Technical Summary

Technical Problem

The existing moxibustion robots are not accurate enough in trajectory planning to reproduce the moxibustionist's techniques, and lack real-time safety monitoring and efficacy guarantees.

Method used

Using the tactile guidance-based moxibustion robot trajectory planning method, the control input, running state and tactile observation signals of the moxibustion robot are recorded, and the haptic guidance model is trained, and the moxibustion trajectory is predicted and fine-tuned in real time, and the moxibustion robot is used to perform the Optimize, combine Kalman filter for status updates to ensure the safety of the moxibustion process.

Benefits of technology

It realizes accurate simulation of moxibustion techniques, adjusts the moxibustion trajectory in real time, ensures the safety and effectiveness of the moxibustion process, and adapts to individual differences between different patients.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118990535A_ABST
    Figure CN118990535A_ABST
Patent Text Reader

Abstract

The invention discloses a moxibustion robot trajectory planning method and device based on tactile guidance and a moxibustion robot, in an off-line training stage, the moxibustion robot is controlled to perform tactile interaction operation of a predetermined moxibustion technique on a moxibustion area, and control and trajectory data in the interaction operation process are utilized to plan the trajectory of the moxibustion robot. Training a tactile guidance model of a predetermined moxibustion technique, and learning and memorizing acupoint positions and tactile observation signals corresponding to different moxibustion technique tracks; and during automatic moxibustion track planning, the moxibustion robot predicts and finely adjusts the moxibustion track of the selected moxibustion manipulation in real time according to the tactile guidance model corresponding to the manipulation and based on the moxibustion acupuncture point and the tactile observation signal at the given initial moment. The device can accurately simulate the moxibustion technique, adjust the moxibustion track in real time, and ensure the safety of the moxibustion process.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of medical health equipment, and in particular to a moxibustion robot trajectory planning method, system and equipment based on tactile guidance. Background Art

[0002] In the field of automated medical equipment, accurate positioning and trajectory planning are essential for performing complex medical operations. Previous vision-based technologies allowed robots to navigate in unknown environments, build environmental maps in real time through sensor data, and locate themselves. However, these methods mostly rely on visual sensors, which are easily affected by changes in ambient light and occlusions, and are not suitable for close-range tasks such as moxibustion. Moxibustion is a traditional Chinese medical treatment method. In automated moxibustion equipment, accurate trajectory planning is essential to reproduce the techniques of moxibustion practitioners and achieve therapeutic effects. However, most existing moxibustion robot systems rely on preset mechanical trajectories and lack adaptability to individual differences in patients. Summary of the invention

[0003] In view of the problems that the trajectory planning of existing moxibustion robots in the process of automated moxibustion is not accurate enough, the techniques of moxibustion practitioners cannot be reproduced, and there is a lack of real-time safety monitoring and efficacy assurance, the present invention provides a moxibustion robot trajectory planning method, system and equipment based on tactile guidance, which can accurately simulate moxibustion techniques, adjust the moxibustion trajectory in real time, and ensure the safety of the moxibustion process.

[0004] In order to achieve the above technical objectives, the present invention adopts the following technical solutions:

[0005] A moxibustion robot trajectory planning method based on tactile guidance, comprising:

[0006] Step 1, the moxibustion robot is controlled to perform a tactile interactive operation of a predetermined moxibustion technique on a moxibustion area, and the following data during the interactive operation are recorded: the control input u, the operating state x, the moxibustion acupoint l and the tactile observation signal h of the moxibustion robot;

[0007] Step 2, using the data recorded in step 1, training a tactile guidance model for a predetermined moxibustion technique; the tactile guidance model is used to predict the moxibustion acupoints and the state of the moxibustion robot at the current moment based on the control input and tactile observation signals at all previous moments;

[0008] Step 3, when a moxibustion technique is selected, the corresponding tactile guidance model is used to predict and fine-tune the moxibustion trajectory of the selected moxibustion technique in real time based on the given moxibustion acupoints and tactile observation signals at the initial moment.

[0009] Furthermore, the tactile observation signal includes the pressure, hardness and texture of the moxibustion acupoints.

[0010] Furthermore, the tactile observation signal also includes the temperature of the moxibustion acupoints;

[0011] During the moxibustion operation, when the temperature exceeds the safety threshold, reduce the moxibustion intensity or temporarily stop the moxibustion operation; when the temperature is lower than the effective threshold of the technique, increase the moxibustion intensity.

[0012] Furthermore, the operating state of the moxibustion robot includes the position and posture of the moxibustion head in the robot coordinate system.

[0013] Furthermore, the tactile guidance model is represented based on Bayesian, deep learning or factor graph, and trained using corresponding optimization methods.

[0014] Further, the tactile guidance model is represented based on Bayesian representation; comprising:

[0015] First set up the tactile guidance question:

[0016] p(x t ,l t |h 1:t ,u 1:t )(1)

[0017] In the formula, the subscript t represents the corresponding time, the subscript 1:t represents the set of all time from 1 to t; t represents the operating state of the moxibustion robot at time t, l t represents the moxibustion point at time t, h 1:t represents the tactile observation signal at all times from 1 to t, u 1:t represents the control input of the moxibustion robot from 1 to t; p(·|·) represents the conditional probability;

[0018] Then, according to the Bayesian formula, the tactile guidance model shown in formula (1) is converted into:

[0019] p(x t ,l t |h 1:t ,u 1:t )∝p(h t |x t ,l t ,h 1:t-1 ,u 1:t )p(x t ,l t |h 1:t-1 ,u 1:t )(2)

[0020] In the formula, ∝ represents a proportional relationship, h 1:t-1 represents the tactile observation signal at all times from 1 to t-1;

[0021] Based on the fact that tactile observation is only related to the moxibustion robot state and moxibustion acupoints at the same time, formula (2) is re-expressed as:

[0022] p(x t ,l t |h 1:t ,u 1:t )∝p(h t |x t ,l t )p(x t ,l t |h 1:t-1 ,u 1:t )(3)

[0023] Among them, based on the fact that the state of the moxibustion robot at a certain moment is only related to the previous moment, that is, the state probability model of the moxibustion robot is a Markov process, the probability p(x t ,l t |h 1:t-1 ,u 1:t ) is expressed as:

[0024] p(x t ,l t |h 1:t-1 ,u 1:t )=∫p(x t |x t-1 ,u t )p(x t-1 ,l t-1 |h 1:t-1 ,u 1:t-1 )dx t-1 (4)

[0025] Combining equations (3) and (4), we can get the posterior probability distribution of the tactile guidance model:

[0026] p(x t ,l t |h 1:t ,u 1:t )=p(h t |x t ,l t )∫p(x t |x t-1 ,u t )p(x t-1 ,l t-1 |h 1:t-1 ,u 1:t-1 )dx t-1 (5)

[0027] Finally, the data recorded in step 1 is used to optimize the posterior probability distribution of the tactile guidance model shown in equation (5).

[0028] Furthermore, the Kalman filter is used to optimize the posterior probability distribution of the tactile guidance model shown in equation (5), and the solution process is:

[0029] Initialization: define the moxibustion robot state x1, moxibustion acupoint l1 and covariance matrix ∑1 at the initial time t=1; each time corresponds to a moxibustion acupoint;

[0030] Prediction: Update time t = t + 1; use the state transition model x of the moxibustion robot t =f(x t-1 ,u t ), predict the moxibustion robot state x t The prior distribution p(x t |x t-1 ,u t );Calculate the Jacobian matrix J of the state transition model t , then update the state covariance matrix ∑ t :

[0031]

[0032] In the formula, f represents the state transition model, ε t is the noise covariance of the prediction process;

[0033] Update: Using tactile observation model Get the current state x t Tactile observation signal And calculate the Jacobian matrix H of the tactile observation model t , get the Kalman gain K t , and then use the current tactile observation h t Update the state and covariance matrix of the moxibustion robot:

[0034]

[0035] ∑ t =(IK t H t )∑ t (11)

[0036] In the formula, h represents the tactile observation model, ζ t is the noise covariance of tactile observation; x t represents the state of the moxibustion robot predicted by the state transition model, h t represents the tactile observation signal actually collected, represents the tactile observation signal obtained by the tactile observation model, represents the updated state of the moxibustion robot, and I represents the identity matrix;

[0037] The above prediction step and update step are repeated until the tactile interaction operation of the predetermined moxibustion technique on all acupoints is completed.

[0038] Furthermore, step 3 performs real-time prediction and fine-tuning of the moxibustion trajectory, specifically:

[0039] Step 3-1, given the initial state x1 and moxibustion point l1 of the moxibustion robot at time t=1;

[0040] Step 3-2, update time t=t+1; use the tactile guidance model to update the control input u from time 1 to time t 1:t and the tactile observation signal h 1:t , predict the state of the moxibustion robot at time t and moxibustion acupoints

[0041] Step 3-3, real-time acquisition of the moxibustion robot's prediction of moxibustion acupoints using the tactile guidance model Tactile observation signals collected from multiple points around the body are used to predict moxibustion acupoints using a tactile guidance model The tactile observation signal is Select the tactile observation signals collected from all points The tactile observation signal with the greatest similarity is recorded as the current best tactile observation

[0042] Step 3-4, control the moxibustion robot to maintain the current best tactile observation Corresponding status

[0043]

[0044] In the formula, Keep the moxibustion robot in shape Control input of

[0045] Step 3-5, when the moxibustion of the current acupoint is completed, return to step 3-2 and continue to perform moxibustion on the next moxibustion acupoint.

[0046] A moxibustion robot trajectory planning device based on tactile guidance, comprising:

[0047] The data recording module is used to record the following data during the tactile interaction operation of the moxibustion robot receiving control to perform a predetermined moxibustion technique on the moxibustion area: the control input u, the operation state x, the moxibustion acupoint l and the tactile observation signal h of the moxibustion robot;

[0048] The model training module is used to: train a tactile guidance model of a predetermined moxibustion technique using the data recorded by the data recording module; the tactile guidance model is used to predict the moxibustion acupoints and the state of the moxibustion robot at the current moment according to the control input and tactile observation signals at all previous moments;

[0049] The tactile guidance module is composed of a trained tactile guidance model and is used to: when the corresponding moxibustion technique is selected, based on the moxibustion points and tactile observation signals at the given initial moment, perform real-time prediction and fine-tuning of the moxibustion trajectory of the selected moxibustion technique.

[0050] A moxibustion robot comprises a memory and a processor, wherein the memory stores a computer program, and when the computer program is executed by the processor, the processor implements any one of the above-mentioned moxibustion robot trajectory planning methods based on tactile guidance.

[0051] Compared with the prior art, the present invention has the following technical effects:

[0052] The moxibustion robot trajectory planning method based on tactile guidance provided by the present invention is divided into two parts: offline training and online automatic moxibustion trajectory planning. In the offline training stage, the moxibustion robot is controlled to perform tactile interactive operations of predetermined moxibustion techniques on the moxibustion area, and uses the control and trajectory data in the interactive operation process to train the tactile guidance model of the predetermined moxibustion technique, learn and memorize the acupoint positions and tactile observation signals corresponding to different moxibustion technique trajectories; in the automatic moxibustion trajectory planning, the moxibustion robot predicts and fine-tunes the moxibustion trajectory of the selected moxibustion technique in real time based on the moxibustion acupoints and tactile observation signals at the given initial moment according to the tactile guidance model corresponding to the technique, and tracks the moxibustion trajectory at a certain running speed; at the same time, the temperature feedback collected by the tactile sensor can be used to control the distance between the moxibustion and the human body surface, ensuring that the moxibustion process is both safe and effective. Therefore, the present invention can accurately simulate the moxibustion technique, adjust the moxibustion trajectory in real time, and ensure the safety of the moxibustion process. BRIEF DESCRIPTION OF THE DRAWINGS

[0053] Figure 1 It is a flow chart of the trajectory planning method of the moxibustion robot based on tactile guidance in the present invention;

[0054] Figure 2 Schematic diagram of the moxibustion head with a tactile sensor of the present invention; reference numerals: 1-moxibustion placement, 2-sensor, 3-communication port, 4-sensor protection shell, 5-cover, 6-pressing plate, 7-box body, 8-ventilation hole;

[0055] Figure 3 This is a diagram showing the trajectory predicted by the tactile guidance model used in the present invention;

[0056] Figure 4This is a schematic diagram of temperature feedback in the present invention to ensure the safety and effectiveness of moxibustion. DETAILED DESCRIPTION

[0057] The following is a detailed description of an embodiment of the present invention. This embodiment is based on the technical solution of the present invention, and provides a detailed implementation method and a specific operation process to further explain the technical solution of the present invention.

[0058] Example 1

[0059] This embodiment provides a moxibustion robot trajectory planning method based on tactile guidance. Figure 1 As shown, the following steps are included:

[0060] Step 1: The moxibustion robot is controlled to perform tactile interactive operations of predetermined moxibustion techniques on the moxibustion area, and the control and trajectory data during the interactive operation are recorded.

[0061] Step 1-1, start the moxibustion robot equipped with a tactile sensor. Under the guidance and control of the moxibustion practitioner, the moxibustion robot performs a series of tactile interactive operations such as pressing and sliding on the moxibustion points of the human body according to the predetermined moxibustion technique. The moxibustion head of the moxibustion robot performs tactile interactive operations, such as Figure 2 shown.

[0062] Step 1-2, record the following data during the tactile interaction operation: the control input u, operation status x, moxibustion acupoints and their tactile signals h of the moxibustion robot.

[0063] Among them, the control input of the moxibustion robot refers to the control input quantity of the driving motors of each joint of the moxibustion robot.

[0064] The running state x of the moxibustion robot refers to the state variables such as the position and posture of the moxibustion head of the moxibustion robot in the robot coordinate system.

[0065] Different moxibustion techniques are formed by performing moxibustion operations on multiple moxibustion points in sequence (i.e., tactile interactive operations).

[0066] The tactile signal includes tactile data such as pressure and tactile images, which are used as observation data and preprocessed for subsequent training of the tactile guidance model. In addition, the tactile signal also includes temperature data, which is used for subsequent moxibustion intensity control.

[0067] Step 2, using the data recorded in step 1, training a tactile guidance model for a predetermined moxibustion technique; the tactile guidance model is used to predict the state of the moxibustion points and the moxibustion robot at the current moment based on the control input and tactile observation signals at all previous moments.

[0068] For a fixed moxibustion object, during the tactile interaction of its moxibustion operation, there is a certain correspondence between the control input u, the operating state x, the moxibustion acupoints, and the tactile signal h. For example, when a new control input is input, the moxibustion robot will generate a new state, so that the moxibustion robot interacts with different acupoints, and then generates tactile observation data of the corresponding acupoints. The purpose of training the tactile guidance model is to obtain the relationship between these data.

[0069] This embodiment represents the tactile guidance model based on Bayesian, including the following process:

[0070] Step 2-1, express the tactile guidance model of moxibustion manipulation in Bayesian form:

[0071] p(x t ,l t |h 1:t ,u 1:t )(1)

[0072] In the formula, the subscript t represents the corresponding time, the subscript 1:t represents the set of all time from 1 to t; t represents the operating state of the moxibustion robot at time t, l t represents the moxibustion point at time t, h 1:t represents the tactile observation signal at all times from 1 to t, u 1:t represents the control input of the moxibustion robot from 1 to t; p(·|·) represents the conditional probability.

[0073] Therefore, the purpose of equation (1) is to calculate the tactile observation h at all times from 1 to t. 1:t and control input u 1:t , calculate the current state x of the moxibustion robot t and acupuncture point locations t The joint posterior probability density function of .

[0074] Step 2-2, according to the Bayesian formula, the tactile guidance model shown in formula (1) is converted into:

[0075] p(x t ,l t |h 1:t ,u 1:t )∝p(h t |x t ,l t ,h 1:t-1 ,u 1:t )p(x t ,l t |h 1:t-1 ,u 1:t )(2)

[0076] In the formula, ∝ represents a proportional relationship, h 1:t-1 Represents the tactile observation signal at all times from 1 to t-1.

[0077] Step 2-3, since the tactile observations are independent, the probability model is p(h t |x t ,l t ), that is, the tactile observation at the current moment is only related to the moxibustion robot state and moxibustion acupoints at the current moment, and formula (2) can be re-expressed as:

[0078] p(x t ,l t |h 1:t ,u 1:t )∝p(h t |x t ,l t )p(x t ,l t |h 1:t-1 ,u 1:t )(3)

[0079] Assume that the motion probability model of the moxibustion robot is a Markov process p(x t |x t-1 ,u t ), that is, the current state of the moxibustion robot is only related to the state at the previous moment, so the probability p(x t ,l t |h 1:t-1 ,u 1:t ) is expressed as:

[0080] p(x t ,l t |h 1:t-1 ,u 1:t )=∫p(x t |x t-1 ,u t )p(x t-1 ,l t-1 |h 1:t-1 ,u 1:t-1 )dx t-1 (4)

[0081] Step 2-4, combining equation (3) and equation (4) to obtain the posterior probability distribution representation of the tactile guidance model:

[0082] p(x t ,l t |h 1:t ,u 1:t )=p(h t |x t ,l t)∫p(x t |x t-1 ,u t )p(x t-1 ,l t-1 |h 1:t-1 ,u 1:t-1 )dx t-1 (5)

[0083] The ultimate optimization goal of the above formula is to make the posterior probability p(x t ,l t |h 1:t ,u 1:t ) is maximized, that is, based on past experience p(x t-1 ,l t-1 |h 1:t-1 ,u 1:t-1 ), the robot’s prior knowledge of state transition p(x t |x t-1 ,u t ) and the probability model of tactile observation p(h t |x t ,l t ), find the most likely state of the current moxibustion robot and the most likely position of the corresponding moxibustion point.

[0084] Step 2-5, using the data recorded in step 1, optimize and solve the posterior probability distribution of the tactile guidance model shown in equation (5).

[0085] The optimal solution of the posterior probability in formula (5) can be obtained by using a series of classical optimization methods suitable for Bayesian problems, such as Monte Carlo and Kalman filter, thereby simultaneously realizing the construction of human moxibustion area and the positioning of specific human acupoints.

[0086] This embodiment uses a Kalman filter to optimize and solve equation (5), and the process is:

[0087] Initialization: define the moxibustion robot state x1, moxibustion point l1 and covariance matrix ∑1 at the initial time t=1; each moment corresponds to a moxibustion point.

[0088] Prediction: Update time t = t + 1; use the state transition model x of the moxibustion robot t =f(x t-1 ,u t ), predict the moxibustion robot state x t The prior distribution p(x t |x t-1 ,u t );Calculate the Jacobian matrix J of the state transition model t , then update the state covariance matrix ∑ t :

[0089]

[0090] In the formula, f represents the state transition model, ε t is the noise covariance of the prediction process.

[0091] The state transition model x used in the above prediction t =f(x t-1 ,u t ), is determined by the forward and reverse operation of the moxibustion robot. That is, at the previous moment, the robot's state x t-1 Next, a new input u is given at the current moment t , the robot will move to the new state x t , that is, the position and posture of the moxibustion robot have changed accordingly according to the new input. In the field of robot control, the state transition model is usually described as x t =Jx t-1 +Bu t +ω t ,ω t is Gaussian noise, which is related to the actual control system and specific structural parameters of the moxibustion robot. The present invention only uses the function to express x t =f(x t-1 ,u t ).

[0092] In the Bayesian expression of this embodiment, the state transition model x t =Jx t-1 +Bu t +ω t Considered as a Gaussian distribution, the predicted state is x t The prior distribution p(x t |x t-1 ,u t ).

[0093] Update: Using tactile observation model Update the current state x t Tactile observation signal And calculate the Jacobian matrix H of the tactile observation model t , get the Kalman gain K t , and then use the current tactile observation h t Update the state and covariance matrix of the moxibustion robot:

[0094]

[0095] ∑ t =(IK t H t )∑t (11)

[0096] In the formula, h represents the tactile observation model, ζ t is the noise covariance of tactile observation; x t represents the state of the moxibustion robot predicted by the state transition model, h t represents the tactile observation signal actually collected, represents the tactile observation signal obtained by the tactile observation model, represents the updated state of the moxibustion robot, and I represents the identity matrix;

[0097] Repeat the above prediction steps and update steps until the tactile interaction operation of the predetermined moxibustion technique on all acupoints is completed. After the training is completed, the probability model of formula (1) is obtained, which is the final problem to be solved, so that step 3 can be continued to collect a tactile observation based on the initial given state of the moxibustion robot and the corresponding moxibustion acupoints, and then start to predict the state that the robot should reach at the next moment and the corresponding moxibustion acupoints. Finally, all the moxibustion acupoints and corresponding robot states that the moxibustion technique passes through during the teaching process can be predicted in sequence.

[0098] Step 3, when a moxibustion technique is selected, the corresponding tactile guidance model is used to predict, fine-tune and execute the moxibustion trajectory of the selected moxibustion technique in real time based on the moxibustion acupoints and tactile observation signals at a given initial moment.

[0099] Step 3-1, select the moxibustion technique, and give the moxibustion robot the initial state x1 and moxibustion point l1 at the initial time t=1.

[0100] Step 3-2, update time t=t+1; use the tactile guidance model to update the control input u from time 1 to time t 1:t and the tactile observation signal h 1:t , predict the state of the moxibustion robot at time t and moxibustion acupoints This will enable the planning of a complete set of moxibustion trajectories.

[0101] Step 3-3, since the distance distribution of acupoints in the moxibustion area of ​​different patients is generally slightly different, it is impossible to be exactly the same. These acupoints generally show similarities in tactile observation, so the current state can be fine-tuned with the help of the robot's real-time tactile observation. Therefore, this embodiment obtains the tactile observation collected by the moxibustion robot during its current operation in real time, and is committed to achieving consistency between the tactile observation and the tactile observation corresponding to the acupoint position predicted by the tactile guidance model. Assume that the acupoint position predicted by tactile guidance at time t is The corresponding tactile observation is The tactile observations obtained by the current operation of the moxibustion robot are The similarity evaluation function is Sim, and the most consistent current tactile observation is obtained as:

[0102]

[0103] In order to find the tactile observation more quickly, the moxibustion robot will only search at multiple points near the current acupuncture point. The similarity evaluation function of tactile observation can use a series of similarity evaluation methods for tactile signals, including distance measurement of tactile signals in time series form, bag-of-words measurement, rotation invariant factor measurement of tactile image signals, etc. Finally, the measurement results of these signals are weighted summed.

[0104] Step 3-4, when the most consistent tactile observation is found, it is considered that the tactile observation is the most consistent with the tactile data generated by the corresponding moxibustion acupoint, so it can be considered that the best moxibustion position is found, and the moxibustion operation is limited to the state of the moxibustion robot corresponding to the tactile observation:

[0105]

[0106] In the formula, Keep the moxibustion robot in shape control input.

[0107] like Figure 3 As shown, trajectory A represents the trajectory of the selected moxibustion technique predicted by the tactile guidance model, and trajectory A' is the moxibustion trajectory after fine-tuning based on real tactile observation.

[0108] Step 3-5, when the moxibustion of the current acupoint is completed, return to step 3-2 and continue to perform moxibustion on the next moxibustion acupoint.

[0109] During the moxibustion operation, when the temperature exceeds the safety threshold, the moxibustion intensity is reduced or the moxibustion operation is temporarily stopped to ensure the safety and effectiveness of the moxibustion process; when the temperature is lower than the effective threshold of the technique, the moxibustion intensity is increased to ensure the effectiveness of the moxibustion technique. The moxibustion intensity is achieved by dynamically adjusting the distance between the moxibustion head and the human body surface. Specifically, the classic PID method can be used to adjust the distance between the moxibustion head and the human body surface according to the feedback temperature.

[0110] like Figure 4 As shown, B1 represents when the safety threshold is exceeded, move away to reduce the intensity of moxibustion or stop moxibustion; B2 represents the abnormal temperature position; B3 represents the starting position; B4 represents the running direction; B5 represents below the effective threshold, move closer to increase the intensity of moxibustion.

[0111] Example 2

[0112] This embodiment provides a moxibustion robot trajectory control device based on tactile guidance, comprising:

[0113] The data recording module is used to record the following data during the tactile interaction operation of the moxibustion robot receiving control to perform a predetermined moxibustion technique on the moxibustion area: the control input u, the operation state x, the moxibustion acupoint l and the tactile observation signal h of the moxibustion robot;

[0114] The model training module is used to: train a tactile guidance model of a predetermined moxibustion technique using the data recorded by the data recording module; the tactile guidance model is used to predict the moxibustion acupoints and the state of the moxibustion robot at the current moment according to the control input and tactile observation signals at all previous moments;

[0115] The tactile guidance module is composed of a trained tactile guidance model and is used to: when the corresponding moxibustion technique is selected, based on the moxibustion points and tactile observation signals at the given initial moment, perform real-time prediction and fine-tuning of the moxibustion trajectory of the selected moxibustion technique.

[0116] The implementation methods of the above modules are the same as those described in Example 1, and will not be repeated in this embodiment.

[0117] Example 3

[0118] This embodiment provides a moxibustion robot, including a memory and a processor, wherein the memory stores a computer program, and when the computer program is executed by the processor, the processor implements the moxibustion robot trajectory planning method based on tactile guidance described in Example 1.

[0119] The above embodiments are preferred embodiments of the present application. Ordinary technicians in this field can also make various changes or improvements on this basis. Without departing from the overall concept of the present application, these changes or improvements should fall within the scope of protection required by the present application.

Claims

1. A moxibustion robot trajectory planning method based on tactile guidance, characterized in that: include: Step 1, the moxibustion robot is controlled to perform a tactile interactive operation of a predetermined moxibustion technique on a moxibustion area, and the following data during the interactive operation are recorded: the control input u, the operating state x, the moxibustion acupoint l and the tactile observation signal h of the moxibustion robot; Step 2, using the data recorded in step 1, training a tactile guidance model for a predetermined moxibustion technique; the tactile guidance model is used to predict the moxibustion acupoints and the state of the moxibustion robot at the current moment based on the control input and tactile observation signals at all previous moments; Step 3, when a moxibustion technique is selected, the corresponding tactile guidance model is used to predict and fine-tune the moxibustion trajectory of the selected moxibustion technique in real time based on the given moxibustion acupoints and tactile observation signals at the initial moment.

2. The tactile-guided moxibustion robot trajectory planning method according to claim 1, characterized in that: The tactile observation signals include pressure, hardness and texture of the moxibustion acupoints.

3. The tactile-guided moxibustion robot trajectory planning method according to claim 2, characterized in that: The tactile observation signal also includes the temperature of the moxibustion acupoints; During the moxibustion operation, when the temperature exceeds the safety threshold, reduce the moxibustion intensity or temporarily stop the moxibustion operation; when the temperature is lower than the effective threshold of the technique, increase the moxibustion intensity.

4. The moxibustion robot trajectory planning method based on tactile guidance according to claim 1, characterized in that: The operating status of the moxibustion robot, including the position and posture of the moxibustion head in the robot coordinate system.

5. The moxibustion robot trajectory planning method based on tactile guidance according to claim 1, characterized in that: The tactile guidance model is represented based on Bayesian, deep learning or factor graph, and trained using corresponding optimization methods.

6. The moxibustion robot trajectory planning method based on tactile guidance according to claim 1, characterized in that: The tactile guidance model is represented based on Bayesian method; comprising: First set up the tactile guidance question: p(x t ,l t |h 1:t ,u 1:t )(1) In the formula, the subscript t represents the corresponding time, the subscript 1:t represents the set of all time from 1 to t; t represents the operating state of the moxibustion robot at time t, l t represents the moxibustion point at time t, h 1:t represents the tactile observation signal at all times from 1 to t, u 1:t represents the control input of the moxibustion robot from 1 to t; p(·|·) represents the conditional probability; Then, according to the Bayesian formula, the tactile guidance model shown in formula (1) is converted into: p(x t ,l t |h 1:t ,u 1:t )∝p(h t |x t ,l t ,h 1:t-1 ,u 1:t )p(x t ,l t |h 1:t-1 ,u 1:t )(2) In the formula, ∝ represents a proportional relationship, h 1:t-1 represents the tactile observation signal at all times from 1 to t-1; Based on the fact that tactile observation is only related to the moxibustion robot state and moxibustion acupoints at the same time, formula (2) is re-expressed as: p(x t ,l t |h 1:t ,u 1:t )∝p(h t |x t ,l t )p(x t ,l t |h 1:t-1 ,u 1:t )(3) Among them, based on the fact that the state of the moxibustion robot at a certain moment is only related to the previous moment, that is, the state probability model of the moxibustion robot is a Markov process, the probability p(x t ,l t |h 1:t-1 ,u 1:t ) is expressed as: p(x t ,l t |h 1:t-1 ,u 1:t )=∫p(x t |x t-1 ,u t )p(x t-1 ,l t-1 |h 1:t-1 ,u 1:t-1 )dx t-1 (4) Combining equations (3) and (4), we can get the posterior probability distribution of the tactile guidance model: p(x t ,l t |h 1:t ,u 1:t )=p(h t |x t ,l t )∫p(x t |x t-1 ,u t )p(x t-1 ,l t-1 |h 1:t-1 ,u 1:t-1 )dx t-1 (5) Finally, the data recorded in step 1 is used to optimize the posterior probability distribution of the tactile guidance model shown in equation (5).

7. The tactile-guided moxibustion robot trajectory planning method according to claim 6, characterized in that: The Kalman filter is used to optimize the posterior probability distribution of the tactile guidance model shown in equation (5). The solution process is: Initialization: define the moxibustion robot state x1, moxibustion acupoint l1 and covariance matrix ∑1 at the initial time t=1; each time corresponds to a moxibustion acupoint; Prediction: Update time t = t + 1; use the state transition model x of the moxibustion robot t =f(x t-1 ,u t ), predict the moxibustion robot state x t The prior distribution p(x t |x t-1 ,u t );Calculate the Jacobian matrix J of the state transition model t , then update the state covariance matrix ∑ t : In the formula, f represents the state transition model, ε t is the noise covariance of the prediction process; Update: Using tactile observation model Get the current state x t Tactile observation signal And calculate the Jacobian matrix H of the tactile observation model t , get the Kalman gain K t , and then use the current tactile observation h t Update the state and covariance matrix of the moxibustion robot: ∑ t =(I-K t H t )∑ t (11) Where h represents the tactile observation model, ζ t is the noise covariance of tactile observation; x t represents the state of the moxibustion robot predicted by the state transition model, h t represents the tactile observation signal actually collected, represents the tactile observation signal obtained by the tactile observation model, represents the updated state of the moxibustion robot, and I represents the identity matrix; The above prediction step and update step are repeated until the tactile interaction operation of the predetermined moxibustion technique on all acupoints is completed.

8. The tactile-guided moxibustion robot trajectory planning method according to claim 1, characterized in that: Step 3: Real-time prediction and fine-tuning of the moxibustion trajectory, specifically: Step 3-1, given the initial state x1 and moxibustion point l1 of the moxibustion robot at time t=1; Step 3-2, update time t=t+1; Using the tactile guidance model, according to the control input u from time 1 to t 1:t and the tactile observation signal h 1:t , predict the state of the moxibustion robot at time t and moxibustion acupoints Step 3-3, real-time acquisition of the moxibustion robot's prediction of moxibustion acupoints using the tactile guidance model Tactile observation signals collected from multiple points around the body are used to predict moxibustion acupoints using a tactile guidance model The tactile observation signal is Select the tactile observation signals collected from all points The tactile observation signal with the greatest similarity is recorded as the current best tactile observation Step 3-4, control the moxibustion robot to maintain the current best tactile observation Corresponding status In the formula, Keep the moxibustion robot in shape Control input of Step 3-5, when the moxibustion of the current acupoint is completed, return to step 3-2 and continue to perform moxibustion on the next moxibustion acupoint.

9. A moxibustion robot trajectory planning device based on tactile guidance, characterized in that: include: The data recording module is used to record the following data during the tactile interaction operation of the moxibustion robot receiving control to perform a predetermined moxibustion technique on the moxibustion area: the control input u, the operation state x, the moxibustion acupoint l and the tactile observation signal h of the moxibustion robot; The model training module is used to: train a tactile guidance model of a predetermined moxibustion technique using the data recorded by the data recording module; the tactile guidance model is used to predict the moxibustion acupoints and the state of the moxibustion robot at the current moment according to the control input and tactile observation signals at all previous moments; The tactile guidance module is composed of a trained tactile guidance model and is used to: when the corresponding moxibustion technique is selected, based on the moxibustion points and tactile observation signals at the given initial moment, perform real-time prediction and fine-tuning of the moxibustion trajectory of the selected moxibustion technique.

10. A moxibustion robot, comprising a memory and a processor, wherein the memory stores a computer program, characterized in that: When the computer program is executed by the processor, the processor is caused to implement the method according to any one of claims 1 to 8.

Citation Information

Patent Citations

  • Multi-agent dynamic multi-target collaboration tracking method based on finite-state automata

    CN101303589A

  • Vehicle motion trail prediction method and system of improved Gaussian mixture model

    CN111079804A

  • Intelligent thermosensitive moxibustion system based on collaborative robot

    CN111098314A

  • Gaussian process trajectory tracking control method for space robot

    CN112318509A

  • Method for acquiring and reproducing moxibustion manipulation trajectory

    CN112621749A