Control algorithm for improving positioning precision of B ultrasonic probe
Through motor-driven mechanical structure and image processing technology, the precise positioning and scanning path planning of the B-ultrasound probe are realized, which solves the problems of inaccurate positioning and long time caused by traditional manual operations, improves scanning speed and accuracy, and improves image quality and Diagnostic efficiency improves patient experience and medical resource allocation.
Patent Information
- Application Number
- CN202410862615.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-06-28
- Publication Date
- 2024-11-08
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The positioning and movement of traditional B-ultrasound probes depend on the operator's experience and skills, and there are problems such as long operation time and inaccurate positioning, which affects image quality and inspection efficiency.
Using motor-driven mechanical structure and image processing technology, the target area coordinates in medical ultrasound images are converted into coordinates required for motor control through spatial transformation matrix, and combined with path planning algorithms such as RRT algorithm, the motor movement is accurately controlled to realize B-ultrasound probes. High-precision positioning and scanning path planning.
It improves scanning speed and accuracy, reduces operational difficulty and time consumption, ensures high-quality image data, improves diagnostic basis and patient experience, and promotes the optimal configuration of medical resources.
Smart Images

Figure CN118902487A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of medical equipment, and in particular relates to a control algorithm for improving the positioning accuracy of a B-ultrasound probe. Background Art
[0002] In the field of medical imaging, especially in organ ultrasound examination, the positioning and movement of the B-ultrasound probe is crucial to obtaining high-quality images. The traditional manual operation method relies on the operator's experience and skills, and may have problems such as long operation time and inaccurate positioning.
[0003] In order to achieve precise control of the B-ultrasound probe, a motor-driven mechanical structure, such as a robotic arm or a connecting arm, is required to simulate the doctor's operation. These mechanical structures are usually composed of multiple joints, each of which may be controlled by a motor to achieve complex spatial movements. The accuracy and response speed of motor control directly affect the positioning effect of the probe. Combining technologies and methods from multiple fields such as medical imaging, mechatronics, image processing, path planning and control systems, the aim is to improve the speed and quality of organ B-ultrasound scanning in an automated or semi-automated manner. To this end, we propose a control algorithm that improves the positioning accuracy of the B-ultrasound probe to solve the above-mentioned problems. Summary of the invention
[0004] The purpose of the present invention is to provide a control algorithm for improving the positioning accuracy of a B-ultrasound probe, so as to solve the problems raised in the above-mentioned background technology.
[0005] To achieve the above-mentioned purpose, the present invention provides the following technical solutions: A probe control device for improving the positioning accuracy of a B-ultrasound probe, comprising a base and a control unit, wherein a first motor is fixedly connected to the upper end of the base, and an output shaft of the first motor is fixedly connected to a turntable, and the turntable is rotatably connected to the top of the base, and a second motor is installed at the side end of the turntable, and an output shaft of the second motor is fixedly connected to a connecting arm, and a side end of the connecting arm is rotatably connected to a connecting plate, and a third motor is installed at the side end of the connecting plate, and an output shaft of the third motor is fixedly connected to the connecting arm, and a fourth motor is installed at the side end of the connecting plate, and an output shaft of the fourth motor is fixedly connected to a clamping seat, and a camera is fixedly connected to the side end of the clamping seat, and the camera is signal-connected to the control unit.
[0006] Preferably, the B-ultrasound probe is snapped into the inner wall of the camera head, and the first motor, the second motor, the third motor and the fourth motor are all controlled by a control unit.
[0007] Preferably, a control algorithm for improving the positioning accuracy of a B-ultrasound probe comprises the following steps:
[0008] A. Locate the target area
[0009] After the acquired medical ultrasound image is digitized, it is output to the lower computer through serial communication to read the spatial coordinate value of the organ to be observed. Image processing technology (such as edge detection, morphological operation, etc.) is used to identify the specific area to be detected. Assuming that the center point of the target area is P (x, y, z), where x, y, and z are the coordinate values of the point in the organ coordinate system, the coordinates of the center point P of the target area are converted into the coordinates required for motor control. Assuming that the coordinate system of motor control is M (X, Y, Z), it is necessary to convert it through the space transformation matrix T: The transformation matrix T contains the information of rotation and translation, which is used to transform the points in the organ coordinate system into the motor control coordinate system.
[0010] B. Planning the path
[0011] The scanning path of the B-ultrasound probe is planned according to the size and shape of the target area. A path planning algorithm, such as the RRT (Rapidly-exploring Random Tree) algorithm, may be used. The objective function of path planning may consider the shortest time or the least movement.
[0012] C. Control motor movement
[0013] According to the converted coordinates (X, Y, Z), the angle or displacement that each motor needs to rotate is calculated. Assume that four motors control the translation of the terminal B-ultrasound probe in the X, Y, and Z directions and the rotation around the Z axis respectively. The control signal of the motor can be expressed as:
[0014] Motor1=f1(X)
[0015] Motor2=f2(Y)
[0016] Motor3=f3(Z)
[0017] Motor4=f4(rotation around Z)
[0018] Among them, f1, f2, f3, and f4 are functions defined according to the mechanical structure and motor characteristics, which are used to convert the target position into the control signal of the motor.
[0019] D. Perform a scan:
[0020] The control unit sends a signal to the motor, causing the motor to drive the connecting arm to move the B-ultrasound probe to a specified position. After the B-ultrasound probe reaches the specified position, the scanning operation begins.
[0021] E. Feedback Adjustment:
[0022] Based on the scan results and patient feedback, the position of the target area was adjusted if necessary.
[0023] Repeat steps B to D until all pre-determined areas have been scanned.
[0024] Compared with the prior art, the present invention has the following beneficial effects:
[0025] Improve scanning speed: By automatically controlling the movement of the B-ultrasound probe, the time consumption of traditional manual operation is greatly reduced. Especially when performing large-scale or multi-region organ scanning, it can quickly locate the next scanning area, shorten the patient's time on the examination table, and improve the efficiency of the overall examination process.
[0026] Enhanced scanning accuracy: The high-precision electrical control system can achieve precise control of the position of the B-ultrasound probe, avoiding repeated scanning caused by operator hand shaking or inaccurate positioning. In addition, combined with image processing technology, it can ensure that high-quality image data can be obtained for each scan, providing doctors with more accurate diagnosis basis.
[0027] Reduced operating difficulty and workload: Traditional B-ultrasound operations rely on the technician’s experience and skills. Long hours of operation not only increase the technician’s workload, but may also lead to operating errors due to fatigue. The application of this technology reduces the reliance on the operator’s skills and workload, while maintaining high quality standards for scanning, allowing more patients to benefit from efficient and accurate medical services.
[0028] Improved patient experience: Automated probe control reduces the discomfort that may be caused by manual probe adjustment, making patients more comfortable throughout the examination process. At the same time, due to the shortened examination time, the patient's waiting and examination time is reduced, which improves the patient's overall medical experience.
[0029] Promote optimal allocation of resources: An efficient inspection process means that more patients can be served in the same amount of time, which is an effective way to ease the shortage of medical resources. Hospitals and clinics can use the saved time and manpower for other more needed areas, such as improving service quality, adding diagnosis and treatment items, etc., thereby improving the overall level of medical services. BRIEF DESCRIPTION OF THE DRAWINGS
[0030] Figure 1 It is a structural diagram of the device of the present invention.
[0031] In the figure: 1. base; 2. first motor; 3. turntable; 4. second motor; 5. connecting arm; 6. third motor; 7. connecting plate; 8. fourth motor; 9. clamping seat; 10. camera. DETAILED DESCRIPTION
[0032] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0033] See also Figure 1 The present invention provides a probe control device for improving the positioning accuracy of a B-ultrasound probe, comprising a base 1 and a control unit, wherein a first motor 2 is fixedly connected to the upper end of the base 1, an output shaft of the first motor 2 is fixedly connected to a turntable 3, the turntable 3 is rotatably connected to the top of the base 1, a second motor 4 is installed at the side end of the turntable 3, an output shaft of the second motor 4 is fixedly connected to a connecting arm 5, a side end of the connecting arm 5 is rotatably connected to a connecting plate 7, a side end of the connecting plate 7 is installed with a third motor 6, an output shaft of the third motor 6 is fixedly connected to the connecting arm 5, a side end of the connecting plate 7 is installed with a fourth motor 8, an output shaft of the fourth motor 8 is fixedly connected to a clamping seat 9, a side end of the clamping seat 9 is fixedly connected to a camera 10, and the camera 10 is signal-connected to the control unit.
[0034] In this embodiment, the B-ultrasound probe is clamped in the inner wall of the camera head 10, and the first motor 2, the second motor 4, the third motor 6 and the fourth motor 8 are all controlled by the control unit.
[0035] In this embodiment, a control algorithm for improving the positioning accuracy of the B-ultrasound probe includes the following steps:
[0036] A. Locate the target area
[0037] After the acquired medical ultrasound image is digitized, it is output to the lower computer through serial communication to read the spatial coordinate value of the organ to be observed. Image processing technology (such as edge detection, morphological operation, etc.) is used to identify the specific area to be detected. Assuming that the center point of the target area is P (x, y, z), where x, y, and z are the coordinate values of the point in the organ coordinate system, the coordinates of the center point P of the target area are converted into the coordinates required for motor control. Assuming that the coordinate system of motor control is M (X, Y, Z), it is necessary to convert it through the space transformation matrix T: The transformation matrix T contains the information of rotation and translation, which is used to transform the points in the organ coordinate system into the motor control coordinate system.
[0038] In a preferred embodiment, the spatial position data of at least three non-collinear image three-dimensional feature points can be extracted and counted as a matrix P.
[0039] Assume that there are n three-dimensional feature points in the image, where n is a positive integer greater than or equal to 3; P1 is the first point, Pn is the nth point, x, y, z represent the three-dimensional spatial coordinates of each three-dimensional feature point of the image, and the matrix dimension is 4*n;
[0040] The spatial position data Q of the three-dimensional feature points of each contacted part is obtained by calculation, as shown in the following formula 2:
[0041]
[0042] Assume that there are n three-dimensional feature points, where n is a positive integer greater than or equal to 3; Q1 is the first point, Qn is the nth point, x, y, z represent the three-dimensional spatial coordinates of each three-dimensional feature point, and the matrix dimension is 4*n;
[0043] The spatial position data of the three-dimensional feature points is transformed into the coordinate system of the structured light camera of the spatial position of the three-dimensional feature points of the image, as shown in the following formula 3:
[0044]
[0045] That is, P = R1*Q, R1 is a 4x4 spatial transformation matrix; the R1 matrix is obtained by the least squares method, as shown in Formula 4:
[0046] R1=P*Q T *(Q*Q T ) -1 ;
[0047] Wherein, T represents the transpose of the matrix; alternatively, the R1 matrix is obtained by QR decomposition or SVD decomposition, and the R1 matrix is the spatial transformation matrix of the medical image space relative to the camera space.
[0048] In addition, when higher registration accuracy is required, the skin point cloud can be extracted from the preoperative medical image through the MC algorithm (marching cubes); then the three-dimensional feature points and the R1 matrix are used as input, and the R1 matrix is optimized through the ICP algorithm (Iterative Closest Point) to obtain a more accurate R2 matrix to achieve higher-precision registration requirements. With this solution, the registration accuracy can reach within 0.25 mm.
[0049] The specific calculation method is as follows:
[0050] Select the target point cloud P as the skin point cloud feature point and the source point cloud S as the head three-dimensional feature point, find the nearest point (pi, si), use the R1 matrix as the iteration starting parameter, and then calculate the optimal transformation matrix R2 to minimize the error function. The error function E(R2) is as follows: Formula 5:
[0051]
[0052] The essence of this step is to obtain the converted coordinates (X, Y, Z) to achieve path motion and planning in subsequent steps.
[0053] B. Planning the path
[0054] The scanning path of the B-ultrasound probe is planned according to the size and shape of the target area. A path planning algorithm, such as the RRT (Rapidly-exploring Random Tree) algorithm, may be used. The objective function of path planning may consider the shortest time or the least movement.
[0055] C. Control motor movement
[0056] According to the converted coordinates (X, Y, Z), the angle or displacement that each motor needs to rotate is calculated. Assume that four motors control the translation of the terminal B-ultrasound probe in the X, Y, and Z directions and the rotation around the Z axis respectively. The control signal of the motor can be expressed as:
[0057] Motor1=f1(X)
[0058] Motor2=f2(Y)
[0059] Motor3=f3(Z)
[0060] Motor4=f4(rotation around Z)
[0061] Among them, f1, f2, f3, and f4 are functions defined according to the mechanical structure and motor characteristics, which are used to convert the target position into the control signal of the motor.
[0062] D. Perform a scan:
[0063] The control unit sends a signal to the motor, causing the motor to drive the connecting arm to move the B-ultrasound probe to a specified position. After the B-ultrasound probe reaches the specified position, the scanning operation begins.
[0064] E. Feedback Adjustment:
[0065] Based on the scan results and patient feedback, the position of the target area was adjusted if necessary.
[0066] Repeat steps B to D until all pre-determined areas have been scanned.
[0067] Furthermore, the space transformation matrix Used to convert points in the organ coordinate system to the motor control coordinate system. This conversion is necessary because electrical control systems usually operate in three-dimensional space, not on a two-dimensional image plane. Through accurate coordinate conversion, it can be ensured that the B-ultrasound probe moves precisely along the predetermined path, thereby achieving accurate scanning of the target area. This helps to improve the accuracy and efficiency of the scan;
[0068] Path planning techniques such as the RRT algorithm can help calculate optimal or near-optimal paths in complex environments. In this case, the algorithm was used to plan the scanning path of the B-ultrasound probe, taking into account factors such as the shortest time or least movement. Such path planning not only optimizes the scanning process and reduces unnecessary movement, but also helps to shorten the scanning time and improve the efficiency of the overall examination. This means less discomfort and faster diagnostic results for patients;
[0069] Motor1=f1(X)
[0070] Motor2=f2(Y)
[0071] Motor3=f3(Z)
[0072] Motor4=f4(rotation around Z)
[0073] According to the mechanical structure and motor characteristics, the target position is converted into the control signal of the motor. By accurately controlling the rotation angle or displacement of each motor, the B-ultrasound probe can be accurately positioned and moved in space. This control not only improves the accuracy of the scan, but also ensures that the probe can move smoothly along the predetermined path, thereby improving the quality and stability of the image.
[0074] Specifically, a mechanical arm may be used, and according to the current position of the mechanical arm and the contact force data, the target position of the mechanical arm is determined by the following formula:
[0075]
[0076] Where Pd is the target position of the robot, xd, yd, zd are the X, Y, and Z coordinates of the target position of the robot, respectively, (x0, y0, z0) is the current position of the robot, fx, fy, and fz are the contact force data in the XYZ direction collected by the six-dimensional force sensing device, fx0, fy0, and fz0 are the set initial force values, and PID is the control function of the PID controller.
[0077] The electronic components and modules used in the invention can be parts commonly used in the market and can realize the specific functions in this case, and the specific models and sizes can be selected and adjusted according to actual needs.
[0078] The above shows and describes the basic principles, main features and advantages of the present invention. It should be understood by those skilled in the art that the present invention is not limited to the above embodiments. The above embodiments and descriptions are only for explaining the principles of the present invention. Without departing from the spirit and scope of the present invention, the present invention may have various changes and improvements, which fall within the scope of the present invention to be protected. The scope of protection of the present invention is defined by the attached claims and their equivalents.
Claims
1. A probe control device for improving the positioning accuracy of a B-ultrasound probe, characterized in that: The invention comprises a base (1) and a control unit, wherein the upper end of the base (1) is fixedly connected to a first motor (2), the output shaft of the first motor (2) is fixedly connected to a turntable (3), the turntable (3) is rotatably connected to the top end of the base (1), a second motor (4) is installed at the side end of the turntable (3), the output shaft of the second motor (4) is fixedly connected to a connecting arm (5), the side end of the connecting arm (5) is rotatably connected to a connecting plate (7), a third motor (6) is installed at the side end of the connecting plate (7), the output shaft of the third motor (6) is fixedly connected to the connecting arm (5), a fourth motor (8) is installed at the side end of the connecting plate (7), the output shaft of the fourth motor (8) is fixedly connected to a clamping seat (9), the side end of the clamping seat (9) is fixedly connected to a camera (10), and the camera (10) is connected to the control unit signal.
2. The probe control device for improving the positioning accuracy of a B-ultrasound probe according to claim 1, characterized in that: The B-ultrasound probe is clamped in the inner wall of the camera head (10), and the first motor (2), the second motor (4), the third motor (6) and the fourth motor (8) are all controlled by a control unit.
3. A control algorithm for improving the positioning accuracy of a B-ultrasound probe according to claim 1-2, comprising the following steps: A. Locate the target area After the acquired medical ultrasound image is digitized, it is output to the lower computer through the serial port for parsing the coordinate values of the observed organs. Image processing technology (such as edge detection, morphological operations, etc.) is applied to identify the specific area to be detected. Assuming that the center point of the target area is P (x, y, z), where x, y, and z are the coordinate values of the point in the organ coordinate system, the coordinates of the center point P of the target area are converted into the coordinates required for motor control. Assuming that the coordinate system of motor control is M (X, Y, Z), it is necessary to convert it through the space transformation matrix T: The transformation matrix T contains the information of rotation and translation, which is used to transform the points in the organ coordinate system into the motor control coordinate system. B. Planning the path The scanning path of the B-ultrasound probe is planned according to the size and shape of the target area. A path planning algorithm, such as the RRT (Rapidly-exploring Random Tree) algorithm, may be used. The objective function of path planning may consider the shortest time or the least movement. C. Control motor movement According to the converted coordinates (X, Y, Z), the angle or displacement that each motor needs to rotate is calculated. Assume that four motors control the translation of the terminal B-ultrasound probe in the X, Y, and Z directions and the rotation around the Z axis respectively. The control signal of the motor can be expressed as: Motor1=f1(X) Motor2=f2(Y) Motor3=f3(Z) Motor4=f4(rotation around Z) Among them, f1, f2, f3, and f4 are functions defined according to the mechanical structure and motor characteristics, which are used to convert the target position into the control signal of the motor. D. Perform a scan: The control unit sends a signal to the motor, causing the motor to drive the connecting arm to move the B-ultrasound probe to a specified position. After the B-ultrasound probe reaches the specified position, the scanning operation begins. E. Feedback Adjustment: Based on the scan results and patient feedback, the position of the target area was adjusted if necessary. Repeat steps B to D until all pre-determined areas have been scanned.
