Disclosure of Invention
The invention provides a control method of an anesthesia needle inserting positioning device, which aims to overcome the defects of the prior art.
In order to achieve the aim, the invention adopts the following technical scheme that the method for controlling the anesthesia needle insertion positioning device is based on the anesthesia needle insertion positioning device, and comprises a platform mechanism, a pressure sensing mechanism, an encoder mechanism, a printing mechanism and an intelligent processing mechanism, wherein the pressure sensing mechanism, the encoder mechanism and the printing mechanism are respectively arranged on the platform mechanism, and the pressure sensing mechanism, the encoder mechanism and the printing mechanism are respectively connected with the intelligent processing mechanism, and the method comprises the following specific steps of:
Step 1, preprocessing an anesthesia needle insertion positioning device, wherein the preprocessing comprises confirming the running states of a pressure sensing mechanism, an encoder mechanism, a printing mechanism and an intelligent processing mechanism;
Step 2, the anesthesia needle insertion positioning device moves along the lumbar surface of the human model spine, the pressure sensing mechanism collects real-time pressure data, and the encoder mechanism collects real-time moving distance data and transmits the real-time moving distance data to the intelligent processing mechanism;
Step 3, after the intelligent processing mechanism processes the data, fitting the data to form a pressure fluctuation curve, and obtaining a target position according to the fitted pressure fluctuation curve;
And 4, controlling the printing head to move to the target position by the intelligent processing mechanism, printing marks on the body surface of the target position by the printing head, and ending the step.
Further, the pressure sensing mechanism comprises three groups of pressure sensing assemblies, the three groups of pressure sensing assemblies are respectively divided into a first channel, a second channel and a third channel, the first channel and the third channel are positioned in the middle of lumbar vertebrae, and the first channel and the third channel are positioned on two sides of the second channel.
Further, the step 3 includes the following steps:
Step 3.1, the intelligent processing mechanism receives the real-time pressure data output by the three groups of pressure detection modules in the step 2 to form corresponding pressure data sets F1 Ti、F2Ti and F3 Ti;
The real-time pressure data set collected by the first channel is set as F1 Ti, the real-time pressure data set collected by the second channel is set as F2 Ti, the real-time pressure data set collected by the third channel is set as F3 Ti,F1Ti=(F1 i,Ti)、F2Ti=(F2i,Ti) and F3 Ti=(F3i,Ti), F represents a pressure value, T represents a sampling time, and i represents an aggregation number;
Step 3.2, the pressure data sets F1 Ti、F2Ti and F3 Ti are processed by a normalization function, and the pressure data sets are respectively obtained after the processing And
Step 3.3, the intelligent processing mechanism receives real-time moving distance data acquired by the encoder mechanism in the step2 and pressure data processed in the step 3.2, and fits a 3D image;
step 3.4, kalman filtering the pressure data image and the 3D image;
And 3.5, the intelligent processing mechanism samples the data filtered in the step 3.4, a pressure fluctuation curve is formed by fitting, and a target position is obtained according to the fitted pressure fluctuation curve.
Further, in the step 3.2
In the formulas (1) - (3), prF ti_list is the data list of the pressure data set F1 Ti, prF ti_list is the data list of the pressure data set F2 Ti, prF3ti_list is the data list of the pressure data set F3 Ti, prF ti_list.max () is the data maximum value of the pressure data set F1 Ti, prF ti_list.max () is the data maximum value of the pressure data set F2 Ti, prF ti_list.max () is the data maximum value of the pressure data set F3 Ti, and α is the weight coefficient of the spring 1233 in the three sets of pressure sensing members 12.
Further, the formula for fitting the 3D image in the step 3.3 is:
in the formula (4), N represents the first, second, and third channels, Y represents the position distances in the distribution directions of the first, second, and third channels, and D represents the pressing distance of the roller 126.
Further, the calculation formula of the kalman filter in the step 3.4 includes:
X(k,k-1)=AX(k-1)+BU(k)....................(5);
In the formula (5), k represents the current time, k-1 represents the last time, X (k-1) represents the last state optimum result of the system, X (k, k-1) represents the result of the current state of the system predicted by the last state optimum result of the system, A and B are system parameters, A and B are set as matrixes, U (k) represents the control quantity of the system at the current time, A, B and U (k) are set as set values, and U (k) can be set as 0, namely
No control amount;
Covariance calculation formula corresponding to X (k, k-1):
P(k,k-1)=AP(k-1)AT+Q.......................(6);
In the formula (6), P (k, k-1) is covariance corresponding to X (k, k-1), P (k-1) is covariance corresponding to X (k-1), A T is transposed matrix of A, Q is covariance of system process, and Q is set value not changed along with system state change;
From the formulas (5) and (6), the formula (7) is obtained,
X(k)=X(k,k-1)+K(k)[Z(k)-HX(k,k-1)]....................(7)
In the formula (7), X (K) is an optimal estimated value at the moment K, K (K) is a Kalman gain, In the formula (4), H is a parameter of a measurement system, for a multi-measurement system, H is set as a matrix, H T is a transposed matrix of H, R is covariance of system measurement, H, R is a set value, Z (k) is a system measurement value, and Z (k) is a set value;
covariance calculation formula corresponding to X (k):
P(k)=[I-K(k)H]P(k,k-1)........................(9);
In the formula (9), P (k) is a covariance corresponding to X (k), where I is set as a matrix and I is a set value.
Further, α=0.9 in the step 3.2.
Further, the pressure sensing mechanism further comprises a back plate and a transverse moving assembly, the pressure sensing assembly is arranged on the back plate through the transverse moving assembly, and the transverse moving assembly controls the pressure sensing assembly to synchronously move inwards or outwards.
Further, the pressure sensing assembly comprises a vertical plate, a pressure detection module, a pressure conduction module and an elastic module, wherein the pressure detection module and the pressure conduction module are arranged on the vertical plate, the pressure detection module comprises a sensor, the vertical plate is provided with a sensor mounting seat, the sensor is arranged on the sensor mounting seat, the sensor faces the pressure conduction module, and the sensor is connected with the intelligent processing mechanism.
Further, the pressure detection module comprises a sensor, the vertical plate is provided with a sensor mounting seat, the sensor is arranged on the sensor mounting seat, the sensor faces the pressure conduction module, and the sensor is connected with the intelligent processing mechanism.
In summary, the invention has the following advantages:
1) The intelligent processing mechanism automatically calculates the optimal needle inserting position according to the curve, controls the printing head to move to the target position for marking, accurately positions the needle inserting position of the anesthesia outside the hard film in the simulation practice process, improves the accuracy of the needle inserting point of anesthesia, shortens the confirmation time of the needle inserting point, has high intelligent degree, and is used for simulating the positioning reaction speed and the positioning accuracy of the needle inserting point of anesthesia.
2) According to the invention, the pressure sensing assemblies synchronously move inwards or outwards through the transverse moving assemblies, so that the distance between adjacent pressure sensing assemblies is adjusted, and the pressure sensing assemblies are moved to proper positions.
3) The invention is provided with the elastic module, and the adjusting nut of the elastic module can compress or loosen the spring, so that the prestress of the roller is increased or reduced.
4) The limiting block is arranged, and the sliding range of the lower sliding block is limited by the limiting block, so that the roller support frame is prevented from sliding downwards, and the spring is continuously compressed downwards, so that larger elastic stress is applied to the roller.
5) The platform mechanism is provided with the registering block, the spring force of the pressure sensing assembly is balanced with the self gravity of the device through the registering block, the platform mechanism is provided with a plurality of groups of side wheels, the side wheels provide stable supporting force for the device, and meanwhile, the resistance of the device in the pushing process can be reduced.
Detailed Description
Other advantages and effects of the present invention will become apparent to those skilled in the art from the following disclosure, which describes the embodiments of the present invention with reference to specific examples. The invention may be practiced or carried out in other embodiments that depart from the specific details, and the details of the present description may be modified or varied from the spirit and scope of the present invention. It should be noted that the following embodiments and features in the embodiments may be combined with each other without conflict.
It should be noted that the illustrations provided in the following embodiments merely illustrate the basic concept of the present invention by way of illustration, and only the components related to the present invention are shown in the drawings and are not drawn according to the number, shape and size of the components in actual implementation, and the form, number and proportion of the components in actual implementation may be arbitrarily changed, and the layout of the components may be more complicated.
All directional indications (such as up, down, left, right, front, rear, lateral, longitudinal) in embodiments of the present invention are merely used to explain the relative positional relationship, movement, etc. between the components in a particular pose, and if the particular pose changes, the directional indication changes accordingly.
For reasons of installation errors, the parallel relationship referred to in the embodiments of the present invention may be an approximately parallel relationship, and the perpendicular relationship may be an approximately perpendicular relationship.
Embodiment one:
As shown in fig. 1-7, an anesthesia needle insertion positioning device comprises a platform mechanism 2, a pressure sensing mechanism 1, an encoder mechanism 3, a printing mechanism 4 and an intelligent processing mechanism, wherein the pressure sensing mechanism 1, the encoder mechanism 3 and the printing mechanism 4 are respectively arranged on the platform mechanism 2, and the pressure sensing mechanism 1, the encoder mechanism 3 and the printing mechanism 4 are respectively connected with the intelligent processing mechanism.
The pressure sensing mechanism 1 comprises a back plate 10, a transverse moving assembly 11 and a pressure sensing assembly 12, wherein the pressure sensing assembly 12 is arranged on the back plate 10 through the transverse moving assembly 11, the transverse moving assembly 11 comprises transverse sliding rails 110, transverse sliding blocks 111, bearing seats 112, knobs 114, screws 113 and adjusting plates 115, the transverse sliding blocks 111 and the adjusting plates 115 are fixedly arranged on the pressure sensing assembly 12, the transverse sliding rails 110 and the bearing seats 112 are fixedly arranged on two side surfaces of the back plate 10, the transverse sliding rails 110 face the pressure sensing assembly 12, the transverse sliding blocks 111 are arranged on the transverse sliding rails 110, the transverse sliding blocks 111 are in sliding connection with the transverse sliding rails 110, preferably, the transverse sliding rails 110 are arranged in two, the two transverse sliding rails 110 are perpendicular to the length direction of the back plate and are distributed up and down along the length direction of the back plate, and the length direction of the back plate is the x direction in fig. 1, so that the stability of connection with the pressure sensing assembly 12 and the transverse moving stability of the pressure sensing assembly 12 are guaranteed.
The back plate 10 is provided with a through cavity 101, the adjusting plate 115 penetrates through the cavity 101, the screw 113 is rotationally connected with the bearing seat 112, two ends of the screw 113 are fixedly connected with the knob 114, the screw 113 is in threaded connection with the adjusting plate 115, preferably, the adjusting plate 115 is provided with two pieces, the two adjusting plates 115 are symmetrically arranged on two sides of the bearing seat 112, the screw 113 is provided with threads with opposite rotation directions, the adjusting plate 115 is arranged on the threads with opposite rotation directions of the screw 113, and any knob 114 is rotated to enable the two adjusting plates 115 to synchronously move inwards or outwards.
The pressure sensing components 12 are arranged in multiple groups, preferably as shown in fig. 1, the pressure sensing components 12 are arranged in three groups, the three groups of pressure sensing components 12 are distributed along the transverse array of the width direction of the back plate 10, the width direction of the back plate 10 is the y direction in fig. 1, the pressure sensing components 12 positioned in the middle are fixedly arranged on the back plate 10, the pressure sensing components 12 positioned at two sides are fixedly arranged on the transverse sliding blocks 111, and the distance between the pressure sensing components 12 positioned in the middle is synchronously adjusted through the transverse sliding components 11.
The pressure sensing component 12 comprises a vertical plate 127, a pressure detection module, a pressure conduction module and an elastic module, wherein the pressure detection module and the pressure conduction module are arranged on the vertical plate 127, the pressure detection module, the elastic module and the pressure conduction module are distributed along the length direction of the vertical plate 127, the length direction of the vertical plate 127 is the x direction in fig. 1, the vertical plate 127 is provided with a vertical sliding rail 128, the vertical sliding rail 128 is distributed along the length direction of the vertical plate 127, and the stress of the pressure conduction module is conducted to the pressure detection module through the elastic module.
The pressure detection module comprises a sensor 121, a vertical plate 127 is provided with a sensor mounting seat 120, the sensor 121 is arranged on the sensor mounting seat 120, the sensor 121 faces the pressure conduction module, the sensor 121 is connected with the intelligent processing mechanism, the sensor 121 converts received force data into electric signals and transmits the electric signals to the intelligent processing mechanism, and the intelligent processing mechanism obtains real-time pressure data.
The pressure conduction module comprises a conduction block 122 and a roller support 124, the conduction block 122 is opposite to the sensor 121, the sensor 121 is used for detecting the pressure conducted by the conduction block 122, the conduction block 122 and the roller support 124 are connected through an elastic module, the conduction block 122 is provided with an upper sliding block 1221, the upper sliding block 1221 is arranged on a vertical sliding rail 128, the upper sliding block 1221 is in sliding connection with the vertical sliding rail 128, the roller support 124 is provided with a lower sliding block 1241, the lower sliding block 1241 is arranged on the vertical sliding rail 128, the lower end of the roller support 124 is provided with a roller 126, and the upper end of the roller support 124 is connected with the conduction block 122 through the elastic module.
The elastic module includes an adjusting nut 1231, a screw rod 1232 and a spring 1233, the screw rod 1232 is connected with the conducting block 122 and the roller support 124, the spring 1233 is sleeved on the screw rod 1232, the adjusting nut 1231 is arranged on the screw rod 1232, in this embodiment, the spring 1233 is located between the adjusting nut 1231 and the roller support 124, and the adjusting nut 1231 is rotated to compress or loosen the spring 1233, so that the prestress of the roller 126 is increased or reduced.
The stopper 125 is set at the lower end of the vertical plate 127, and the stopper 125 is located at the lower end of the limiting vertical slide rail 128 to limit the sliding range of the lower slide block 1241, so as to block the roller support 124 from sliding downwards, and the spring is compressed downwards continuously to apply larger elastic stress to the roller 126.
In the implementation process of the pressure sensing component 12, when the roller 126 contacts with the body surface and rolls, and the roller 126 rolls to the soft tissue position of the human body model, under the action of the elastic force of the elastic module, the roller 126 sags, at this time, the conduction block 122 moves downwards, the stress of the sensor 121 is reduced, the reading of the sensor is also reduced, when the roller 126 rolls to the bone tissue position of the human body model, the roller 126 is jacked up by the bone tissue of the human body model to move upwards, the spring 1233 is further compressed, the elastic force is increased, the conduction block 122 moves upwards, the stress of the sensor 121 is increased, and the reading of the sensor is also increased.
The platform mechanism 2 is a carrier of the pressure sensing mechanism 1, the encoder mechanism 3 and the printing mechanism 4 and comprises an upper end face and a lower end face, the lower end face is opposite to the body surface, the upper end face of the platform mechanism 2 is provided with a registration block 21 and an armrest 22, the registration block 21 is positioned at two ends of the platform mechanism 2 according to the visual angle of fig. 1 so as to ensure the balance of the platform mechanism 2, the registration block 21 is used for adding a counterweight to balance the spring force of the pressure sensing assembly 12 with the self gravity of the device, the number of the registration blocks 21 is increased or decreased according to actual needs, the armrest 22 is provided with two armrests 22 positioned at two sides of the platform mechanism 2 so as to facilitate taking and placing the device, the lower end face of the platform mechanism 2 is provided with an edge wheel frame 23 and an edge wheel 24, the edge wheel frame 23 is arranged at two sides of the platform mechanism 2, the edge wheel frame 23 is arranged at the edge wheel frame 23, and one group of edge wheel frame 23 is preferably provided with two groups of edge wheels 24, and the edge wheel 24 provides stable supporting force for the device, and meanwhile the resistance of the pushing process of the device can be reduced.
The encoder mechanism 3 sets up the lower terminal surface at the platform mechanism 2, the encoder mechanism 3 includes encoder 31, encoder mounting panel 32 and shaft coupling 33, encoder mounting panel 32 sets up in the lower terminal surface of platform mechanism 2, encoder 31 sets up in encoder mounting panel 32, encoder 31 passes through shaft coupling 33 with the axis of rotation of arbitrary side wheel 24 to be connected, drive encoder 31 synchronous rotation through shaft coupling 33 when side wheel 24 rotates, encoder 31 records the number of times of rotation of side wheel 24, encoder 31 is connected with intelligent processing mechanism, encoder 31 converts the number of times of rotation of record side wheel 24 into electric signal transmission to intelligent processing mechanism, intelligent processing mechanism obtains the real-time travel distance of device.
The printing mechanism 4 is arranged on the lower end face of the platform mechanism 2, the printing mechanism 4 comprises a printing head 41 and a printing track 42, the printing track 42 is arranged on the lower end face of the platform mechanism 2 along the y direction, the printing head 41 is arranged on the printing track 42 and can slide along the printing track 42, the printing head 41 is connected with the intelligent processing mechanism, the intelligent processing mechanism controls the printing head 41 to slide on the printing track 42 until reaching a target position for printing, the printing head 41 directly prints a needle-inserting mark on a body surface, and therefore the function of accurately positioning the needle-inserting position for epidural anesthesia is achieved, the printing head 41 is connected with the intelligent processing mechanism, and the intelligent processing mechanism controls the printing head 41 to move to the target position and marks.
The intelligent processing mechanism combines the real-time pressure data and the real-time moving distance to obtain the distance between the spinous processes, and the maximum distance between the spinous processes is used as the needle insertion target position.
In the implementation process of the embodiment, an operator holds the armrest 22, places the device on the back of the mannequin, mediates the traversing assembly 11, separates three rollers 26 of the three groups of pressure sensing assemblies 12 to proper distances, pushes the device, the three groups of pressure sensing assemblies 12 record three groups of real-time pressure data respectively, an encoder records the real-time rotation times of the side wheel so as to obtain real-time moving distance data of the device, an intelligent processing mechanism fits the real-time pressure data with the real-time moving distance data to form a pressure fluctuation curve changing along with the distance, the intelligent processing mechanism automatically calculates the optimal needle feeding position, namely the target position, and when the device is pushed on the back of the person again, the intelligent processing mechanism controls the printing assembly to move to the target position, and marks are printed on the target position.
As shown in fig. 8-14, the application further provides a control method of an anesthesia needle insertion positioning device, the method is based on the anesthesia needle insertion positioning device, the anesthesia needle insertion positioning device comprises a platform mechanism 2, a pressure sensing mechanism 1, an encoder mechanism 3, a printing mechanism 4 and an intelligent processing mechanism, the pressure sensing mechanism 1, the encoder mechanism 3 and the printing mechanism 4 are respectively arranged on the platform mechanism 2, and the pressure sensing mechanism 1, the encoder mechanism 3 and the printing mechanism 4 are respectively connected with the intelligent processing mechanism, and the method comprises the following specific steps:
Step 1, preprocessing an anesthesia needle insertion positioning device, wherein the preprocessing comprises confirming the running states of a pressure sensing mechanism 1, an encoder mechanism 3, a printing mechanism 4 and an intelligent processing mechanism;
step 2, the anesthesia needle insertion positioning device moves along the lumbar surface of the subject spine, such as the lumbar surface of the human model spine (body surface for short), the pressure sensing mechanism 1 collects real-time pressure data, and the encoder mechanism 3 collects real-time moving distance data;
the anesthetic needle insertion positioning device is only used for identifying the lumbar vertebra of a human body model, wherein the total lumbar vertebra of the human body model is 5 knots, as shown in fig. 9, the upper parts of the anesthetic needle insertion positioning device are respectively L1, L2, L3, L4, L5 and L1, the thoracic vertebra is arranged above the anesthetic needle insertion positioning device, the structure of the anesthetic needle insertion positioning device is similar to that of the lumbar vertebra, the sacrum is arranged behind the L5, the sacrum is a large bone with a triangular shape, and in the embodiment, the roller 126 sequentially passes through the spinous processes of the lumbar vertebrae L5-L1, and the pressure sensing mechanism 1 acquires a data curve with at least 5 complete peaks.
Before the anesthesia needle-inserting positioning device is used, the waist of the human body model is bent, so that the lumbar vertebra of the spinal column of the human body model is protruded backwards, the spinous processes of all the lumbar vertebrae can keep larger spacing, and the anesthesia needle-inserting positioning device can better identify the spinous process clearance;
The pressure sensing mechanism 1 comprises three groups of pressure sensing assemblies 12, wherein the contact positions of the rollers 126 of the three groups of pressure sensing assemblies 12 and the body surface are different, and the waist of the human body model is bent when the anesthesia needle inserting positioning device moves, so that the deformation degrees of springs 1233 of elastic modules in the three groups of pressure sensing assemblies 12 are different, the real-time pressure data detected by the pressure detection modules of the three groups of pressure sensing assemblies 12 are different, the three groups of pressure sensing assemblies 12 are respectively divided into a first channel, a second channel and a third channel for convenience of explanation and distinction, the first channel and the third channel are positioned in the center of lumbar vertebrae, the first channel and the third channel are positioned at two sides of the second channel, the real-time pressure data acquired by the first channel, the second channel and the third channel and the real-time moving distance data acquired by the encoder mechanism 3 are transmitted to the intelligent processing mechanism for data processing.
Step 3, after the intelligent processing mechanism processes the data, fitting the data to form a pressure fluctuation curve, and obtaining a target position according to the fitted pressure fluctuation curve;
And 4, controlling the printing head to move to the target position by the intelligent processing mechanism, printing marks on the body surface of the target position by the printing head, and ending the step.
Step 3 the step of data fitting includes:
Step 3.1, the intelligent processing mechanism receives the real-time pressure data output by the three groups of pressure detection modules in the step 2 to form corresponding pressure data sets F1 Ti、F2Ti and F3 Ti;
The real-time pressure data set collected by the first channel is set as F1 Ti, the real-time pressure data set collected by the second channel is set as F2 Ti, the real-time pressure data set collected by the third channel is set as F3 Ti,F1Ti=(F1 i,Ti)、F2Ti=(F2i,Ti) and F3 Ti=(F3i,Ti), F represents a pressure value, T represents a sampling time, and i represents an aggregation number;
Step 3.2, the pressure data sets F1 Ti、F2Ti and F3 Ti are processed by a normalization function, and the pressure data sets are respectively obtained after the processing And
Equation (1) -equation (3) prF ti_list is the data list of the pressure dataset F1 Ti, prF2ti_list is the data list of the pressure dataset F2 Ti, prF3ti_list is the data list of the pressure dataset F3 Ti, prF1ti_list.max () is the data maximum of the pressure dataset F1 Ti, prF2ti_list.max () is the data maximum of the pressure dataset F2 Ti, prF3ti_list.max () is the data maximum of the pressure dataset F3 Ti, α is the weight coefficient of the spring 1233 in the three sets of pressure sensing elements 12, α=0.9;
from pressure data sets AndObtaining pressure data images of the first channel, the second channel and the third channel, which are shown in fig. 10, wherein the pressure data change curve of the first channel is represented by a curve represented by a sensor1, the pressure data change curve of the second channel is represented by a curve represented by a sensor2, and the pressure data change curve of the third channel is represented by a curve represented by a sensor3 in fig. 10;
Step 3.3, the intelligent processing mechanism receives the real-time moving distance data collected by the encoder mechanism 3 in the step 2 and the pressure data processed in the step 3.2, fits a 3D image to obtain a 3D image shown in fig. 11, wherein the X coordinate in the 3D image is the moving distance data collected by the encoder mechanism 3, the Y coordinate is the distance between three groups of rollers 126, the D coordinate is the pressing distance of the rollers 126,
Fitting the 3D image to the calculated formula:
in the formula (4), N represents a first channel, a second channel, and a third channel, Y is a position distance in a distribution direction of the first channel, the second channel, and the third channel, for example, n=1 is the first channel, As shown in the figure, the present embodiment sets the position of the first channel in the direction as the origin, that is, y2=0, where the first channel and the third channel are on both sides of the second channel, Y1 and Y3 are positive and negative values, respectively, and D represents the pressing distance of the roller 126;
step 3.4, kalman filtering the pressure data image and the 3D image;
calculation formula of Kalman filtering:
X(k,k-1)=AX(k-1)+BU(k)....................(5)
In the formula (5), k represents the current time, k-1 represents the last time, X (k-1) represents the last state optimal result of the system, X (k, k-1) represents the result of the current state of the system predicted by the last state optimal result of the system, a and B are system parameters, a and B are set as matrices, U (k) represents the control quantity of the system at the current time, A, B and U (k) are set values, and U (k) can be set to 0, i.e. no control quantity;
Covariance calculation formula corresponding to X (k, k-1):
P(k,k-1)=AP(k-1)AT+Q.......................(6)
In the formula (6), P (k, k-1) is covariance corresponding to X (k, k-1), P (k-1) is covariance corresponding to X (k-1), A T is transposed matrix of A, Q is covariance of system process, and Q is set value not changed along with system state change;
From the formulas (5) and (6), the formula (7) is obtained,
X(k)=X(k,k-1)+K(k)[Z(k)-HX(k,k-1)]....................(7)
In the formula (7), X (K) is an optimal estimated value at the moment K, K (K) is a Kalman gain, In the formula (4), H is a parameter of a measurement system, for a multi-measurement system, H is set as a matrix, H T is a transposed matrix of H, R is covariance of system measurement, H, R is a set value, Z (k) is a system measurement value, and Z (k) is a set value;
covariance calculation formula corresponding to X (k):
P(k)=[I-K(k)H]P(k,k-1)........................(9)
in the formula (9), P (k) is covariance corresponding to X (k), wherein I is set as a matrix, I is a set value, and for a single-model single-measurement system, i=1, the autoregressive operation of the kalman filter is realized through the formula (9).
The pressure data image and the 3D image are filtered according to the formulas (5) - (9), so that the image is smoother after Kalman filtering, the burr is obviously reduced, and whether the spinal spinous process or the noise is easier to distinguish is easy to distinguish.
Step 3.5, the intelligent processing mechanism samples the data filtered in the step 3.4, a pressure fluctuation curve is formed by fitting, and a target position is obtained according to the fitted pressure fluctuation curve;
Based on the same sampling time T, the intelligent processing mechanism acquires the pressure average value of the first channel, the second channel and the third channel corresponding to the 3D image Y=0 plane after filtering in the step 3.4, obtains a data set (F i,di) corresponding to the pressure data and the distance data, forms a pressure fluctuation curve which changes along with the distance as shown in figure 14,
Wherein, the F i is the pressure average value of the first channel, the second channel and the third channel under the same sampling time T, d i is the moving distance data acquired by the encoder mechanism 3 under the same sampling time T, the pressure peak value of the pressure fluctuation curve is set to be F pN, the corresponding distance of the pressure peak value is set to be d pN,Δd=dpN+1-dpN, Δd represents the peak distance, and N represents the sequence number of the peaks.
In this embodiment, the roller 126 sequentially passes through the spinous processes of the lumbar vertebrae L5-L1, and the pressure sensing mechanism 1 collects a data curve with at least 5 complete peaks, since the spinal cord end of the manikin is at the lower edge of L1 and the upper edge of L2. In order to reduce the risk of injury to the spinal cord of the model during the simulation, the epidural puncture is selected to avoid puncturing the spinous process gaps of L1-L2, so in this embodiment, the number N is 4, the spinous process gaps between L5-L2 and L5-L2 correspond to lumbar vertebrae L5-L2, respectively, the spinous process gap at the target position is set to D, D pN+1 corresponding to d=Δd Max,ΔdMax, and D pN are the moving positions of the printing mechanism 4.
In the step 4, the intelligent processing mechanism controls the printing head to move between d pN+1 and d pN corresponding to the delta d Max in the step 3.5, and the printing head prints marks on the body surface of the human model at the target position.
It will be apparent that the described embodiments are only some, but not all, embodiments of the invention. All other embodiments, which can be made by those skilled in the art based on the embodiments of the present invention without making any inventive effort, shall fall within the scope of the present invention.