A force compensation device and method for TMS treatment equipment with external cable

By installing force sensors and fixtures at the end of the robotic arm of the TMS treatment equipment and separating the tension of the condensation cable, the problem of accuracy error of the robotic arm end force sensor in the TMS treatment equipment is solved, and the positioning accuracy and treatment effect of the robotic arm are improved.

CN112274780BActive Publication Date: 2024-11-15王昕 +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202011300287.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2020-11-19
Publication Date
2024-11-15
Estimated Expiration
2040-11-19

AI Technical Summary

Technical Problem

The external flexible cable and stimulation coil of the TMS treatment device cause errors in the precision of the force sensor at the end of the robotic arm, affecting the treatment effect.

Method used

A force compensation device for external cables is designed. By adding a force sensor at the end of the robot arm, using a special fixture and gravity compensation scheme, the cable tension and force sensor readings are separated, and the force sensor readings are made only with the stimulation coil and the patient's head. The contact force is related to the part to ensure the accuracy of the reading of the force sensor.

Benefits of technology

The positioning accuracy of the robotic arm is improved, so that the robotic arm can accurately follow the force changes of the stimulation coil, and improve the treatment effect.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN112274780B_ABST
    Figure CN112274780B_ABST
Patent Text Reader

Abstract

The present application discloses a force compensation device and method for a TMS (transcranial magnetic stimulation, TMS for short) treatment device with an external cable, which relates to the field of medical robots, and includes a control system, a fixed base, a phase conversion disk, a force sensor, a TMS chuck, a shift fixing plate, and a condenser clamp. The force applied to the end of a robotic arm is measured by adding a force sensor to the end of the robotic arm. The cable tension of the condenser is separated from the force measured by the force sensor by a specially designed clamp, and a gravity compensation scheme is used to compensate for the influence of the self-weight of the stimulation coil on the force sensor reading, so that the reading of the force sensor is only related to the actual contact force between the stimulation coil and the patient's head, thereby obtaining the actual contact force between the stimulation coil and the patient's head, improving the positioning accuracy of the robotic arm, and allowing the robotic arm to drive the stimulation coil to perform force following.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of medical robots, and in particular to a force compensation device and method for a TMS treatment device with an external cable. Background Art

[0002] Transcranial Magnetic Stimulation (TMS) is a non-invasive, painless and green neuromodulation method. Due to its unique functions, low cost and easy operation, this technology has been quickly promoted to various fields of clinical and scientific research. However, in actual applications, since TMS treatment equipment is usually connected to flexible cables such as condensers and stimulation coils, it brings large accuracy errors to the force sensor at the end of the robotic arm, resulting in incorrect positioning of the robotic arm during treatment and poor treatment effect. Therefore, it is urgent to develop a method that can compensate for the force of external flexible devices of TMS treatment equipment. Summary of the invention

[0003] In view of the above problems, in order to solve the problem that the flexible cables such as condenser tubes and stimulation coils external to the TMS treatment device affect the accuracy of the force sensor at the end of the robot arm, the present invention provides a force compensation device and method for a TMS treatment device with an external cable, which performs force compensation on the TMS treatment device and its external flexible cables, reduces the positioning error of the robot arm, and ensures the accuracy of positioning and tracking of the robot arm. Specifically, the technical solution of the present application is as follows:

[0004] A force compensation device for a TMS treatment device with an external cable measures the force on the end of a robotic arm by adding a force sensor to the end of a robotic arm; the cable tension on a condenser is transferred by a specially designed fixture, and the cable tension is separated from the force measured by the force sensor, so that the reading of the force sensor is only related to the structure of a stimulation coil, the current position of the robotic arm, and the contact force between the patient and the stimulation coil, thereby eliminating the influence of the cable tension of the condenser on the force on the end of the force sensor; a special gravity compensation scheme is designed to compensate for the influence of the self-weight of the stimulation coil on the force sensor reading, so that the reading of the force sensor is only related to the actual contact force between the stimulation coil and the patient's head, thereby obtaining the actual contact force between the stimulation coil and the patient's head, and then the robotic arm drives the stimulation coil to perform force following.

[0005] It includes a control system, a fixed base, a phase conversion disk, a force sensor, a TMS chuck, a shifting fixed plate, and a condenser clamp. The fixed base is fixedly connected to the end of the mechanical arm; the phase conversion disk is fixedly connected to the fixed base and the force sensor, and is connected to the control system for adjusting the posture of the force sensor; the force sensor is connected to the control system, and its tail is fixedly connected to the phase conversion disk along the axial direction; the TMS chuck is fixedly connected to the end of the force sensor along the axial direction for clamping the stimulation coil; the shifting fixed plate is movably connected to the side of the fixed base; the condenser clamp is fixedly connected to the shifting fixed plate for clamping the condenser.

[0006] Furthermore, the condenser tube clamp includes an upper condenser tube clamp and a lower condenser tube clamp, the upper condenser tube clamp and the lower condenser tube clamp are arranged opposite to each other up and down, the lower condenser tube clamp is fixedly connected to the shift fixing plate, and the upper condenser tube clamp is connected to the lower condenser tube clamp so as to be movable up and down relative to the lower condenser tube clamp.

[0007] Furthermore, the phase conversion disk is used to correct the posture of the force sensor so that its axis is parallel to the axis of the robotic arm.

[0008] Furthermore, the force sensor is used to measure the weight of the TMS clamp and / or the stimulation coil, and transmit the measured information to the control system.

[0009] A force compensation method for a TMS treatment device with an external cable is applied to the force compensation device for the TMS treatment device with an external cable as described above, and the steps are as follows:

[0010] S1 determines the gravity and center of mass position of the stimulation coil and the TMS chuck, that is, moves the mechanical arm, selects several fixed points, and the force sensor measures the gravity and torque of the stimulation coil at each fixed point, and transmits the measured information to the control system, and the control system obtains the center of mass position of the stimulation coil and the TMS chuck according to the algorithm;

[0011] S2 determines the gravity and gravity moment of the stimulation coil and the TMS chuck in the end coordinate system of the manipulator and compensates for them, that is, the gravity of the stimulation coil and the TMS chuck is applied to the end base coordinate system of the manipulator according to its original magnitude, and the direction is the gravity direction. The conversion relationship between the end coordinate system of the manipulator and the base coordinate system is obtained according to the forward kinematics of the manipulator. According to the conversion relationship, the gravity vector applied to the base coordinate system is converted to the end coordinate system of the manipulator, and the gravity moment in the end coordinate system is obtained through the gravity and the center of mass position in the end coordinate system;

[0012] S3 compensates for the gravity and gravity torque of the stimulation coil and TMS chuck, that is, based on the current reading of the force sensor and the expression of the gravity and gravity torque of the stimulation coil and TMS chuck in the coordinate system of the end of the robotic arm, the actual contact force between the patient's head and the stimulation coil is calculated, and the moving speed and angular velocity of the end of the robotic arm are calculated based on the actual contact force and contact torque obtained, so that the robotic arm drives the stimulation coil to perform force following.

[0013] Beneficial effect: The positioning accuracy of the end of the robotic arm is improved, so that the robotic arm drives the stimulation coil to perform force following. BRIEF DESCRIPTION OF THE DRAWINGS

[0014] Figure 1 A schematic diagram of the structure of a force compensation device for a TMS treatment device with an external cable;

[0015] Figure 2 A schematic structural diagram of a force compensation device of a TMS treatment device with an external cable from another perspective;

[0016] Figure 3 It is a schematic diagram of the structure in which the force compensation device, the stimulation coil and the mechanical arm are assembled together;

[0017] Figure 4 It is a front view of the force compensation device, the stimulation coil and the mechanical arm assembled together;

[0018] Figure 5 This is a bottom view of the force compensation device, stimulation coil, and robotic arm assembled together.

[0019] Reference numerals:

[0020] Fixed base 1; phase conversion disk 2; force sensor 3; TMS chuck 4; shift fixing plate 5; condenser clamp 6, upper condenser clamp 61, lower condenser clamp 62; condenser 7; mechanical arm 8; stimulation coil 9. DETAILED DESCRIPTION

[0021] In order to make the purpose, technical solution and advantages of the present invention clearer, the technical solution of the present invention will be clearly and completely described below in combination with the specific embodiments of the present invention and the corresponding drawings. It should be understood that the orientation or position relationship indicated by the terms "upper", "lower", "left", "right", "axial", "radial", etc. is based on the orientation or position relationship shown in the drawings, which is only for the convenience of describing the present invention, and does not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as a limitation on 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 in the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of the present invention.

[0022] A force compensation device for a TMS treatment device with an external cable is installed at the end of a mechanical arm 8, and is used to clamp a stimulation coil 9, and compensate for the gravity of the stimulation coil 9 and the clamp and shield the gravity of the condenser 7, so that the reading of the force sensor 3 is only related to the actual contact force between the stimulation coil 9 and the patient's head. The device comprises a control system, a fixed base 1, a phase conversion disk 2, a force sensor 3, a TMS clamp 4, a shift fixing plate 5, and a condenser clamp 6.

[0023] The fixed base 1 is fixedly connected to the end of the mechanical arm 8 .

[0024] The phase conversion disk 2 is fixedly connected to the fixed base 1 and the force sensor 3 , and is connected to the control system. The force sensor 3 is connected to the fixed base 1 through the phase conversion disk 2 .

[0025] The force sensor 3 is connected to the control system, and its tail is fixedly connected to the phase conversion disk 2 along the axial direction. The phase conversion disk 2 can adjust the posture of the force sensor 3 so that the axial direction of the force sensor 3 is parallel to the axial direction of the end of the robotic arm 8.

[0026] The TMS clamp 4 is fixedly connected to the end of the force sensor 3 along the axial direction and is used to clamp the stimulation coil 9.

[0027] The shift fixing plate 5 is movably connected to the side surface of the fixed base 1 , and can move relative to the fixed base 1 along the axial direction of the end of the mechanical arm 8 .

[0028] The condenser tube clamp 6 is fixedly connected to the displacement fixing plate 5 and is used for clamping the condenser tube 7 .

[0029] Since the condenser 7 is made of flexible material, its center of gravity is erratic and difficult to track and monitor. Therefore, the present application fixes the condenser 7 on the condenser clamp 6 and connects it to the fixed base 1 through a shift fixing plate 5. This shields the weight of the condenser 7 so that it will not affect the reading of the force sensor 3, thereby ensuring the accuracy of the reading of the force sensor 3.

[0030] The condenser tube fixture 6 includes an upper condenser tube fixture 61 and a lower condenser tube fixture 62, which are arranged opposite to each other up and down, and the lower condenser tube fixture 62 is fixedly connected to the shift fixing plate 5, and the upper condenser tube fixture 61 is connected to the lower condenser tube fixture 62 so as to be movable up and down relative to the lower condenser tube fixture 62. Specifically, the upper condenser tube fixture 61 is connected to the lower condenser tube fixture 62 by screws, and the distance between the upper and lower condenser tube fixtures 62 can be adjusted by the screws to clamp or release the condenser tube 7.

[0031] The force sensor 3 is used to measure the weight of the TMS chuck 4 and / or the stimulation coil 9, and transmit the measured information to the control system. The function of the force sensor 3 is to detect the actual contact force between the stimulation coil 9 and the patient's head. In actual measurement, the reading of the force sensor 3 will be affected by the weight of the TMS chuck 4 and the stimulation coil 9. If ignored, it will cause the reading to deviate from the actual contact force. Therefore, it is necessary to use a scientific algorithm to measure the weight of the TMS chuck 4 and the stimulation coil 9 and compensate for it, so that the reading of the force sensor 3 is only related to the actual contact force between the stimulation coil 9 and the patient's head.

[0032] A force compensation method for a TMS treatment device with an external cable is applied to the force compensation device of the TMS treatment device with an external cable, and the steps are as follows:

[0033] S1 determines the gravity and center of mass position of the stimulation coil 9 and the TMS chuck 4, that is, the mechanical arm 8 is moved, several fixed points are selected, the force sensor 3 measures the gravity and torque of the stimulation coil 9 at each fixed point, and transmits the measured information to the control system, and the control system obtains the center of mass position of the stimulation coil 9 and the TMS chuck 4 according to the algorithm, wherein the specific point selection calculation method is:

[0034] Move the robot 8 so that the X-axis of the coordinate system at the end of the robot 8 coincides with the gravity direction of the stimulation coil 9, and read the force Fx and torque Tx in the X direction of the force sensor 3 at this time; move the robot 8 so that the Y-axis of the coordinate system at the end of the robot 8 coincides with the gravity direction of the stimulation coil 9, and read the force F in the Y direction of the force sensor 3 at this time. y and torque T y ; Move the mechanical arm 8 so that the Z axis of the end coordinate system of the mechanical arm 8 coincides with the gravity direction of the stimulation coil 9, and read the force Fz and torque Tz in the Z direction of the force sensor 3 at this time; according to the magnitude of the forces in each direction in the end coordinate system, calculate the gravity G of the stimulation coil 9 = (Fx + Fy + Fz) / 3 and the center of gravity position of the stimulation coil 9 in the coordinate system of the force sensor 3;

[0035] S2 determines the gravity and gravity moment of the stimulation coil 9 and the TMS chuck 4 in the end coordinate system of the robot 8 and compensates for them, that is, the gravity of the stimulation coil 9 and the TMS chuck 4 is applied to the end base coordinate system of the robot 8 according to its original size, and the direction is the gravity direction, and the conversion relationship between the end coordinate system of the robot 8 and the base coordinate system is obtained according to the forward kinematics of the robot 8. According to the conversion relationship, the gravity vector applied to the base coordinate system is converted to the end coordinate system of the robot 8, and the gravity moment in the end coordinate system is obtained through the gravity and the center of mass position in the end coordinate system;

[0036] S3 compensates for the gravity and gravity torque of the stimulation coil 9 and the TMS chuck 4, that is: based on the current reading of the force sensor 3 and the expression of the gravity and gravity torque of the stimulation coil 9 and the TMS chuck 4 in the coordinate system of the end of the robotic arm 8, the actual contact force between the patient's head and the stimulation coil 9 is calculated, and the moving speed and angular velocity of the end of the robotic arm 8 are calculated based on the actual contact force and contact torque obtained, so that the robotic arm 8 drives the stimulation coil 9 to perform force following.

[0037] Beneficial effect: The positioning accuracy of the end of the mechanical arm 8 is improved, so that the mechanical arm 8 drives the stimulation coil 9 to perform force following.

[0038] The embodiments and methods described above are merely descriptions of preferred implementation modes of the present invention, and are not intended to limit the scope of the present invention. Without departing from the design spirit of the present invention, various modifications and improvements made to the technical solutions of the present invention by ordinary technicians in this field should all fall within the scope of protection determined by the claims of the present invention.

Claims

1. A force compensation device for a TMS treatment device with an external cable, used to shield the gravity effect of a condenser tube and compensate for the gravity effect of a TMS stimulation coil, characterized in that: Fixedly connected to the end of the TMS treatment device's robotic arm, including: Control system, fixed base, phase conversion plate, force sensor, TMS chuck, shift fixing plate, condenser fixture; The fixed base is fixedly connected to the end of the mechanical arm; The phase conversion disk is fixedly connected to the fixed base and the force sensor, and is connected to the control system to adjust the posture of the force sensor; The force sensor is connected to the control system, and its tail is fixedly connected to the phase conversion disk along the axial direction; The TMS clamp is fixedly connected to the end of the force sensor along the axial direction and is used to clamp the stimulation coil; The shift fixing plate is movably connected to the side surface of the fixing base; The condenser tube clamp is fixedly connected to the displacement fixing plate and is used to clamp the condenser tube; The force sensor is used to measure the weight of the TMS clamp and / or the stimulation coil, and transmit the measured information to the control system, and the control system compensates the weight of the TMS clamp and the stimulation coil. The compensation method includes: S1 determines the gravity and center of mass position of the stimulation coil and the TMS chuck, that is: move the robotic arm, select several fixed points, and the force sensor measures the gravity and torque of the stimulation coil at each fixed point, and transmits the measured information to the control system. The control system obtains the center of mass position of the stimulation coil and the TMS chuck according to the algorithm; the calculation method for selecting several fixed points is: move the robotic arm so that the X axis of the coordinate system of the end of the robotic arm coincides with the gravity direction of the stimulation coil, and read the force Fx and torque Tx in the X direction in the force sensor at this time; move the robotic arm so that the Y axis of the coordinate system of the end of the robotic arm (8) coincides with the gravity direction of the stimulation coil, and read the force Fy and torque Ty in the Y direction in the force sensor at this time; move the robotic arm so that the Z axis of the coordinate system of the end of the robotic arm coincides with the gravity direction of the stimulation coil, and read the force Fz in the Z direction in the force sensor at this time and torque Tz; according to the magnitude of the forces in each direction in the terminal coordinate system, the gravity G of the stimulation coil is obtained = (Fx + Fy + Fz) / 3, and the center of gravity position of the stimulation coil in the force sensor coordinate system; S2 determines the gravity and gravity torque of the stimulation coil and TMS chuck in the end coordinate system of the robot arm and compensates for them, that is, the gravity on the stimulation coil and TMS chuck is applied to the end base coordinate system of the robot arm according to its original size, and the direction is the gravity direction. The conversion relationship between the end coordinate system of the robot arm and the base coordinate system is obtained according to the forward kinematics of the robot arm. According to the conversion relationship, the gravity vector applied to the base coordinate system is converted to the end coordinate system of the robot arm, and the gravity torque in the end coordinate system is obtained by the gravity and center of mass position in the end coordinate system; S3 compensates for the gravity and gravity torque of the stimulation coil and TMS chuck, that is, according to the current reading of the force sensor and the expression of the gravity and gravity torque of the stimulation coil and TMS chuck in the end coordinate system of the robot arm, the actual contact force between the patient's head and the stimulation coil is calculated, and the moving speed and angular velocity of the end of the robot arm are obtained according to the actual contact force and contact torque.

2. The force compensation device of the TMS treatment device with an external cable according to claim 1, characterized in that: The condenser tube clamp includes an upper condenser tube clamp and a lower condenser tube clamp, which are arranged opposite to each other up and down. The lower condenser tube clamp is fixedly connected to the shift fixing plate, and the upper condenser tube clamp is connected to the lower condenser tube clamp so as to be movable up and down relative to the lower condenser tube clamp.

3. The force compensation device of the TMS treatment device with an external cable according to claim 2, characterized in that: The phase conversion disk is used to correct the posture of the force sensor so that its axial direction is parallel to the axial direction of the end of the mechanical arm.

4. A force compensation method for a TMS treatment device with an external cable, applied to the force compensation device for a TMS treatment device with an external cable as claimed in any one of claims 1 to 3, characterized in that: Here are the steps: S1 determines the gravity and center of mass position of the stimulation coil and the TMS chuck, that is, moves the robotic arm, selects several fixed points, and the force sensor measures the gravity and torque of the stimulation coil at each fixed point, and transmits the measured information to the control system, and the control system obtains the center of mass position of the stimulation coil and the TMS chuck according to the algorithm; S2 Determine the gravity and gravity moment of the stimulation coil and TMS chuck in the end coordinate system of the manipulator and compensate for them, that is, apply the gravity of the stimulation coil and TMS chuck to the end base coordinate system of the manipulator according to its original magnitude, in the direction of gravity, and obtain the conversion relationship between the end coordinate system of the manipulator and the base coordinate system based on the forward kinematics of the manipulator. According to the conversion relationship, convert the gravity vector applied to the base coordinate system to the end coordinate system of the manipulator, and obtain the gravity moment in the end coordinate system through the gravity and center of mass position in the end coordinate system; S3 compensates for the gravity and gravity torque of the stimulation coil and TMS chuck, that is, according to the current reading of the force sensor and the expression of the gravity and gravity torque of the stimulation coil and TMS chuck in the coordinate system of the end of the robot arm, the actual contact force between the patient's head and the stimulation coil is calculated, and the moving speed and angular velocity of the end of the robot arm are obtained based on the actual contact force and contact torque.