Force control system and method for root cutting in oral apex operation process

Through the force control system of oral surgery robot, using force/position hybrid control and optical positioning technology, the problem of visual field and hand sensory limitation in traditional dental apical surgery is solved, achieving accurate and safe apical root cutting operation, improving the The accuracy and safety of the surgery.

CN119055367APending Publication Date: 2024-12-03TONGJI HOSPITAL ATTACHED TO TONGJI MEDICAL COLLEGE HUAZHONG SCI TECH
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
CN202411286535.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-13
Publication Date
2024-12-03

AI Technical Summary

Technical Problem

In traditional dental apical surgery, doctors are affected by field of vision and hand sensation when removing the apical with a hand held by a dental mobile phone under a microscope. The existing robotic arms are insufficient in terms of force perception and cannot achieve accurate and safe force control.

Method used

A force control system for oral surgical robots is designed, including a control unit, navigation positioning end, execution end and end force sensor. Through force/position mixing control, combined with optical positioning and force sensor data, the precise control of the robotic arm is achieved. Ensure force interaction and precise root cutting during the surgery.

Benefits of technology

Improves the accuracy and safety of the surgery, provides better operating feel and tactile feedback, allowing the operator to better perceive and control the surgical process, and is suitable for the force control value of root cutting in oral apical surgery to achieve accurate cutting. Root and force interaction process.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119055367A_ABST
    Figure CN119055367A_ABST
Patent Text Reader

Abstract

The invention discloses a force control system and method for root cutting in the oral root tip operation process. The system comprises a control unit, a navigation positioning end, an execution end and a tail end force sensor. The control unit converts the information into control variables of the mechanical arm through a conversion module according to the target pose of the execution end assembly, target information output by the navigation positioning end in real time and data of the tail end force sensor, and hybrid control is conducted through input variables of force control and position control. The control of feeding, returning and keeping the current position of the execution end is realized; the control variables of the mechanical arm include but not limited to space pose information, force control and / or speed and the like. The precise root cutting and force interaction process can be achieved in the root tip operation process, the precision of the root tip operation is improved, and safe execution of the operation is ensured.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of medical equipment, and in particular relates to a force control system and method for root cutting during oral apex surgery. Background Art

[0002] In traditional dental apical surgery, the doctor needs to hold a high-speed reverse-angle handpiece to remove 3mm of the root apex under a microscope. The root cutting process is easily affected by the limited field of view, the doctor's experience and the feeling of the hand. Studies have shown that more than 90% of the root apex and lateral root canals exist in the 3mm of the root apex. In order to prevent the failure of apical surgery, the root apex section should be kept regular and perpendicular to the long axis of the tooth as much as possible. In robot-assisted apical surgery, the robotic arm can be combined with the end dental handpiece to use a trephine to perform 3mm of apical resection. Since the tooth root is not a plane, but mostly an irregular surface of oblate or ellipse, and the hardness of the tooth root is higher than that of bone, and the existing robotic arm does not have the force sensing function when the free hand is performed, a force control system for root cutting during apical surgery is needed to ensure the safe execution of apical surgery.

[0003] The existing patent documents disclose the following technologies:

[0004] The Chinese patent document with publication number CN 108784852 A discloses "A Dental Implant Drilling Control System and Method", which is composed of automatically controlling the drilling feed speed and motor speed of the robot arm according to the drilling force information fed back by the force sensor to achieve safe and reliable automatic drilling. Although this method aims to reduce the doctor's manual intervention during the operation, the lack of the force interaction process between the doctor and the drilling feed makes it impossible for the doctor to make timely feedback on environmental changes during the operation. Based on the above, it can be seen that this method is obviously not applicable to apical surgery. Summary of the invention

[0005] In view of the deficiencies in the prior art, the present invention provides a force control system and method for an oral surgical robot, which can achieve precise root cutting and force interaction during apical surgery, improve the accuracy of apical surgery, and ensure the safe execution of the surgery.

[0006] The force control system of the oral surgery robot provided by the present invention comprises a control unit, a navigation positioning end, an execution end and a terminal force sensor;

[0007] The execution end includes an execution member for apical surgery operation;

[0008] The navigation and positioning end includes a navigation and positioning end transmitting end, a mechanical arm receiving end, a target position receiving end, and an optical positioning component, which receives data of the execution end component to obtain the target posture of the execution end component, the positioning information of the target element, and the target information (such as the real-time posture and depth of the target) output in real time;

[0009] The control unit converts the above information into control variables of the manipulator through a conversion module according to the target posture of the actuator component, the target information output in real time by the navigation and positioning end, and the data of the end force sensor, and performs mixed control through the input of force control and position control to realize the control of feeding, returning and maintaining the current position of the actuator;

[0010] The control variables of the robotic arm include but are not limited to spatial posture information, force control and / or speed, etc.

[0011] According to an embodiment of the present invention, the execution end includes two execution members for apical surgery, and the operator applies external force to control and provide drilling source power, such as a dental handpiece.

[0012] According to an embodiment of the present invention, the optical positioning component includes a component for emitting and receiving infrared light.

[0013] According to an embodiment of the present invention, the end force sensor is arranged between the robot arm and the execution end, and is used for collecting force data in real time during the apical surgery of the execution end.

[0014] According to an embodiment of the present invention, the force data includes the external force applied by the operator and the resistance during the root cutting process collected in real time by the end force sensor, preferably pre-processed force data. For example, the pre-processing includes denoising and / or filtering.

[0015] According to an embodiment of the present invention, the conversion includes mapping the target pose of the actuator component and the data of the end force sensor acquired by the navigation and positioning end to the robot space;

[0016] Furthermore, the data mapping of the end force sensor includes:

[0017] The external force applied by the operator and the resistance in the root cutting process collected by the end force sensor in real time in the original coordinate system are used as input and preprocessed, and the preprocessed data of the end force sensor are converted through the coordinate system of the receiving end of the robot arm, and finally the reading value reflecting the end force sensor coordinate system is mapped to the external force / torque acting on the needle coordinate system; further, the conversion relationship is as follows:

[0018]

[0019] Among them, F and M are the original forces / torques; F′ and M′ are the coordinates converted to the reference coordinate system of the robot, which need to be projected; the B matrix describes the transformation of the base coordinate system; T represents a transformation matrix, which is responsible for converting forces and torques from one coordinate system to another.

[0020] After the coordinates are transformed to the force coordinate system of the navigation and positioning end power end, the conversion relationship is:

[0021]

[0022] Among them, F″, M″ are the force / torque values ​​F′, M′ in the reference coordinate system of the robot arm converted to the power end coordinate system, and the torque around the axis and the component force along the axis are given.

[0023] According to a further embodiment of the present invention, the conversion further includes mapping the converted external force / torque into a Cartesian space position constrained motion for controlling the actuator subject to positioning information of the navigation positioning end.

[0024] According to an embodiment of the present invention, the control unit performs hybrid control according to input quantities of position control and force control to achieve precise control of the actuator.

[0025] According to an embodiment of the present invention, the control unit includes a position control unit, such as a PD controller, and the PD controller is used to perform position control on the execution end.

[0026] According to an embodiment of the present invention, the control unit comprises a force control unit, which performs hybrid control by processing the external force applied by the operator and the resistance torque signal during the root cutting process.

[0027] According to an embodiment of the present invention, the force system further comprises a foot switch connected to the control unit.

[0028] According to an embodiment of the present invention, the system includes a robotic arm body, and the navigation and positioning end is arranged between the robotic arm body and the execution end, so that it can receive data from the execution end component to obtain the target posture of the execution end component, the positioning information of the target element, and the target information output in real time.

[0029] According to an embodiment of the present invention, the robotic arm body is connected to the navigation and positioning end robotic arm receiving end.

[0030] According to an embodiment of the present invention, the navigation and positioning end robotic arm receiving end is connected to the execution end component.

[0031] The present invention also provides a method for force control during oral apex surgery, comprising the following steps:

[0032] The navigation and positioning end receives data from the actuator component through optical positioning to obtain the target position and orientation of the actuator component, the positioning information of the target element, and the target information output in real time (such as the real-time position and orientation of the target x d and depth x deep );

[0033] The control unit converts the above information into control variables of the manipulator according to the target posture of the actuator component, the target information output in real time by the navigation and positioning end, and the data of the end force sensor, and realizes the control of feeding, rebounding and maintaining the current position of the actuator through force and position mixed control;

[0034] The control variables of the robotic arm include but are not limited to spatial posture information, force control and / or speed, etc.

[0035] According to the embodiment of the present invention, the execution end, the navigation and positioning end and the control unit have the meanings as shown above.

[0036] According to an embodiment of the present invention, the conversion has the definitions as indicated above.

[0037] According to an embodiment of the present invention, the force and position hybrid control comprises:

[0038] (1) For position control, the real-time position x of the target element is d As input, and perform differential calculation with the posture in the previous loop to calculate the differential mean; or further, process the error with the target element;

[0039] The position control unit controls the controlled object, for example, through the parameter k p Position term, k d Speed ​​term, get the control variable u p , and transmit it to the robot arm and the end force sensor to collect the signal for filtering;

[0040] (2) For force control, the target external force is used as input and the differential value is obtained by performing differential calculation with the posture error in the previous loop. The control variable u under force control is finally obtained through equivalent position and velocity control of force control. f , and pass it into the controller processing signal, and the position information (preferably the control variable u output after the position error is processed by the controller gain) p ) for mixing;

[0041] During the root cutting process, if a resistance torque is encountered, the torque signal acting on the constraint axis will be collected and processed, and the control result will be output;

[0042] (3) Further processing the force control signal: The external force signal and the resistance torque signal obtained in step (2) are combined to determine the current operator's operation intention, and the following piecewise function processing is used:

[0043]

[0044] Among them, x target is the target pose, where xdown , x up , x d , x u They represent root cutting, return, and keep the current posture, respectively. tor is the tolerance value of force control; preferably, the experiment confirms that F tor The value is ±2N.

[0045] According to the implementation scheme of the present invention, in terms of control strategy, the root cutting process and the displacement boundary will be in hard contact, and the control will be strictly limited; in the return stage, when the robot arm reaches the target position and successfully removes 3mm of the root apex, the system adopts a rebound mechanism and directly returns to the initial position along the path designed in the feeding stage.

[0046] The present invention also provides an electronic device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the steps of the force control method are implemented when the processor executes the program.

[0047] The present invention also provides a computer-readable storage medium on which a computer program is stored. When the computer program is executed by a processor, the steps of the force control method are implemented.

[0048] Beneficial Effects

[0049] The present invention realizes precise positioning + force interaction through navigation technology and force / position hybrid control, which improves the flexibility and controllability of the robot to make timely feedback to environmental changes, can adapt to different surgical scenarios and requirements, and can provide precise positioning for the operator, thereby improving the accuracy and safety of the operation. During the surgical operation, the force control system of the present invention can provide a better operating feel and tactile feedback, so that the operator can better perceive and control the surgical process, and is particularly suitable for the force control value of root cutting during oral apical surgery, which can realize precise root cutting and force interaction process, improve the accuracy of apical surgery, and ensure the safe execution of the operation. BRIEF DESCRIPTION OF THE DRAWINGS

[0050] Figure 1 This is a schematic diagram of a use scenario of a force control system of an oral robot in one embodiment of the present invention, wherein:

[0051] 10 computer processor; 20 robot controller; 21 foot signal input device; 30 robot body; 40 navigation positioning end transmitting end; 41 navigation positioning end robot receiving end; 42 navigation positioning end dental handpiece power end, 43 navigation positioning end target position receiving end; 421 root cutting, 422 return stroke, 50 external force applied by the operator;

[0052] Figure 2 is a force control block diagram of an oral robot in one embodiment of the present invention;

[0053] Figure 3 This is a partial analysis diagram of the end force sensor data processing and data conversion in one embodiment of the present invention, wherein:

[0054] 411 navigation and positioning end robot arm receiving end force coordinate system, 412 navigation and positioning end dental handpiece power end force coordinate system, 413 end force sensor original force coordinate system. DETAILED DESCRIPTION

[0055] In one embodiment, the force control system specifically includes:

[0056] 1. Navigation and positioning terminal:

[0057] a. The system adopts optical positioning as the positioning method. The navigation positioning end can monitor the position and depth of the root cutting in real time by emitting and receiving infrared light and processing it, and convert it into control parameters such as spatial posture information, speed and force control of the robotic arm.

[0058] b. In the data collection stage, the system collects force data in the root cutting process in real time through the end force sensor and performs preprocessing, such as denoising and filtering, to obtain more accurate force data.

[0059] c. In the data conversion stage, the preprocessed force / torque data is converted into data in the apical surgery dental handpiece coordinate system in order to control the root cutting depth and speed of the dental handpiece.

[0060] d. In the real-time control stage, the system controls the root cutting depth and speed of the dental handpiece in real time according to the force / torque data in the coordinate system of the apical surgery dental handpiece after conversion, so as to ensure the safety and accuracy of the operation process. Furthermore, according to the force / torque data in the coordinate system of the apical surgery dental handpiece after conversion and the root cutting path information collected and generated by the optical sensor, the system can realize the force-controlled root cutting mode. By identifying the direction and magnitude of the external force acting on the needle tip position of the apical surgery dental handpiece, and identifying the rotation of the drill at the action point to generate an external resistance torque on the root surface, the system can control the dental handpiece to perform a 3mm root apex resection operation along the root cutting path.

[0061] e. In order to limit the speed, the system divides the root cutting process into two stages: feeding and return. When the target position is about to be reached in the root cutting feeding stage, the speed is limited to ensure that the target position is reached accurately and the planned depth is not exceeded. In the return stage, after reaching the target position and successfully removing 3mm of the root apex, the system uses a rebound mechanism to directly return to the initial position along the path designed in the feeding stage.

[0062] 2. Execution side:

[0063] The utility model comprises two actuators for apical surgery, and the operator applies external force to control and provide root cutting power.

[0064] 3. Control unit:

[0065] According to the target posture between the execution end components, the target information output in real time by the navigation and positioning end, and the data of the end force sensor, it is converted into the spatial posture information, speed and / or force control and other control variables of the manipulator. The posture information obtained by the navigation and positioning end and the pre-processed end force sensor data are mapped to the robot space, and the movement of the execution end is controlled.

[0066] a. According to the external force applied by the operator and the resistance during the root cutting process collected in real time by the end force sensor, it is converted into the external force / torque in the reference coordinate system of the robot arm and projected into the coordinate system of the power end.

[0067] b. Mapping the converted external force / torque into a Cartesian spatial position constrained motion for controlling the actuator subject to the positioning information of the navigation positioning end.

[0068] c. Hybrid control is performed based on the input of position control and force control to achieve precise control of the actuator. Position control uses a PD controller to control the actuator, and force control performs hybrid control by processing external force and resistance torque signals, and realizes root cutting, return stroke and maintaining the current position according to the operator's operating intention.

[0069] The technical scheme of the present invention will be further described in detail below in conjunction with specific embodiments. It should be understood that the following embodiments are only exemplary descriptions and explanations of the present invention and should not be construed as limiting the scope of protection of the present invention. All technologies implemented based on the above content of the present invention are included in the scope that the present invention is intended to protect.

[0070] The present invention will be described in detail with reference to the accompanying drawings.

[0071] like Figure 1 The force control system of the oral robot shown in the figure includes a control unit, a navigation positioning end, an execution end, and a terminal force sensor ( Figure 1 (not shown), a robot arm controller, a robot arm body, a computer processor, wherein:

[0072] The actuator end includes two actuators, which are used to apply external force to the operator and provide root cutting power to realize surgical operation;

[0073] The navigation and positioning end is used for the positioning information of the robot execution end component data receiving end and the target element, and the real-time position and depth of the target;

[0074] The control unit is used to convert the target posture between the execution end components into control variables such as spatial posture information, speed and / or force control of the robot arm based on the target information output in real time by the navigation and positioning end, and the data of the end force sensor. Through force and position mixed control, the control of feeding, rebounding and maintaining the current position of the execution end is realized.

[0075] In this embodiment, the force control system of the oral robot includes a computer processor 10, a mechanical arm controller 20, a mechanical arm body 30 and a navigation and positioning end, and the navigation and positioning end includes a navigation and positioning end transmitter 40, a navigation and positioning end mechanical arm receiver 41, a navigation and positioning end dental handpiece power end 42 and a navigation and positioning end target position receiver 43. The navigation and positioning end mechanical arm receiver 41 is transformed to the navigation and positioning end dental handpiece power end 42 and the navigation and positioning end target position receiver 43 to obtain the relative posture in space through the signal of the navigation and positioning end transmitter 40. The force control unit maps the posture information obtained by the navigation and positioning end to the surgical robot space; combines the external force applied by the operator and the resistance in the root cutting process collected in real time by the end force sensor as the input and pre-processes the reading value in the original coordinate system, converts the pre-processed data of the end force sensor through the navigation and positioning end receiver coordinate system 411, and finally maps the reading value reflected in the end force sensor coordinate system to the external force / torque acting on the needle coordinate system. The conversion relationship is as follows:

[0076]

[0077] Among them, F, M are the original forces / torques 43. F', M' are the coordinates converted to the manipulator reference coordinate system 411, which need to be projected; the B matrix describes the transformation of the base coordinate system; T represents a transformation matrix, which is responsible for converting forces and torques from one coordinate system to another.

[0078] After the coordinates are transformed to the force coordinate system 412 of the power end of the dental handpiece at the navigation positioning end, the conversion relationship is:

[0079]

[0080] Among them, F″, M″ are the force / torque values ​​F′, M′ in the reference coordinate system of the robot arm converted to the power end coordinate system, and the torque around the axis and the component force along the axis are given.

[0081] Further, it is converted into a Cartesian space position constraint motion for controlling the actuator under the positioning information of the navigation and positioning end transmitting end 40 and the navigation and positioning end mechanical arm receiving end 41 .

[0082] Furthermore, the force / position hybrid control process in the control unit is combined with Figure 2 The control block diagram shown is described as follows:

[0083] The force control is started and stopped by triggering the foot switch 21 as shown in the figure. The current posture or the position in the previous loop is taken as input.

[0084] For position control, the robot controller 20 sets the target position x d As input, it is differentiated from the posture in the previous loop to calculate the differential mean, and further, the error with the target is processed.

[0085] The PD controller is used to control the controlled object. The parameter k in this embodiment of the present invention is p The position is 0.8, the angle is 0.05, and k d The position is 0.8, the angle is not controlled, and the control variable u is obtained p , and transmit it to the robot arm and end force sensor to collect signals for filtering.

[0086] For force control, the control variable from the previous loop is added as an input to the control system.

[0087] The target external force is taken as input and is differentially calculated with the posture error in the previous loop to obtain the differential value.

[0088] Through the equivalent position and speed control of force control, the control variable u is finally obtained f , and passes it into the controller processing signal to be mixed with the position information.

[0089] During the root cutting process, if a resistance torque is encountered, the torque signal acting on the constraint axis will be collected and processed, and the control result will be output.

[0090] The force control signal is further processed. The processing method is: the external force signal and the resistance torque signal are combined to determine the operation intention of the current operator 50, that is, cutting the root 421, returning 422, or the navigation positioning end dental handpiece power end 42 maintains the current position. The following piecewise function processing is used:

[0091]

[0092] Among them, x target is the target pose, where x down , x up , x d They represent root cutting, return, and maintaining the current posture, respectively. tor is the tolerance value of force control. It has been verified by experiments that F tor The value is ±2N.

[0093] Furthermore, in terms of control strategy, the root cutting process and the displacement boundary will be in hard contact, and the control will be strictly limited; in the return stage, when the robot arm reaches the target position and successfully removes 3mm of the root apex, the system adopts a rebound mechanism and directly returns to the initial position along the path designed in the feeding stage.

[0094] Another embodiment provides an electronic device, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the steps of the force control method described above are implemented when the processor executes the program.

[0095] Another embodiment provides a computer-readable storage medium having a computer program stored thereon, which implements the steps of the force control method when executed by a processor. "Computer-readable storage medium" includes, but is not limited to, a read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk, etc.

[0096] The above is an explanation of the embodiments of the present invention. However, the present invention is not limited to the above embodiments. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.

Claims

1. A force control system for an oral surgery robot, characterized in that: The force control system includes a control unit, a navigation and positioning end, an execution end, and a terminal force sensor; The execution end includes an execution member for apical surgery operation; The navigation and positioning end includes a navigation and positioning end transmitting end, a mechanical arm receiving end, a target position receiving end, and an optical positioning component, which receives data of the execution end component to obtain the target posture of the execution end component, the positioning information of the target element, and the target information (such as the real-time posture and depth of the target) output in real time; The control unit converts the above information into control variables of the manipulator through a conversion module according to the target posture of the actuator component, the target information output in real time by the navigation and positioning end, and the data of the end force sensor, and performs mixed control through the input of force control and position control to realize the control of feeding, returning and maintaining the current position of the actuator; The control variables of the robotic arm include but are not limited to spatial posture information, force control and / or speed.

2. The force control system according to claim 1, characterized in that: The execution end includes two execution parts for apical surgery, and is controlled by an operator applying external force and providing drilling source power; And / or, the optical positioning assembly includes an assembly for emitting and receiving infrared light; And / or, the end force sensor is arranged between the robot arm and the execution end, and is used for collecting force data in real time during the apical surgery of the execution end.

3. The force control system according to claim 1, characterized in that: The force data include the external force applied by the operator and the resistance during the root cutting process collected in real time by the end force sensor, and are preferably pre-processed force data.

4. The force control system according to claim 1, characterized in that: The conversion includes mapping the target position and posture of the actuator component and the data of the end force sensor obtained by the navigation and positioning end to the robot space; Preferably, the data mapping of the end force sensor includes: The external force applied by the operator and the resistance in the root cutting process collected by the end force sensor in real time in the original coordinate system are used as input and preprocessed, and the preprocessed data of the end force sensor are converted through the coordinate system of the receiving end of the robot arm, and finally the reading value reflecting the end force sensor coordinate system is mapped to the external force / torque acting on the needle coordinate system; further, the conversion relationship is as follows: Among them, F and M are the original forces / torques; F′ and M′ are the coordinates converted to the reference coordinate system of the robot, which need to be projected; the B matrix describes the transformation of the base coordinate system; T represents a transformation matrix, which is responsible for converting forces and torques from one coordinate system to another. After the coordinates are transformed to the force coordinate system of the navigation and positioning end power end, the conversion relationship is: Among them, F″, M″ are the force / torque values ​​F′, M′ in the reference coordinate system of the manipulator converted to the coordinate system of the power end, and give the torque around the axis and the component force along the axis direction; Preferably, the conversion further comprises mapping the converted external force / torque into a Cartesian space position constrained motion for controlling the actuator subject to the positioning information of the navigation positioning end.

5. The force control system according to claim 1, characterized in that: The control unit includes a position control unit for performing position control on the execution end; The control unit comprises a force control unit, which performs mixed control by processing the external force applied by the operator and the resistance torque signal during the root cutting process.

6. The force control system according to any one of claims 1 to 5, characterized in that: The force system also includes a foot switch connected to the control unit; And / or, the system includes a robot body, and the navigation positioning end is arranged between the robot body and the execution end, so that it receives data of the execution end component to obtain the target posture of the execution end component, the positioning information of the target element, and the target information output in real time; And / or, the mechanical arm body is connected to the receiving end of the navigation and positioning end mechanical arm; And / or, the navigation and positioning end robotic arm receiving end is connected to the execution end component.

7. A method for force control during oral apical surgery, characterized in that: The force control method comprises the following steps: The navigation and positioning end receives data from the actuator component through optical positioning to obtain the target position of the actuator component, the positioning information of the target element, and the real-time output target information (such as the real-time position x of the target). d and depth x deep ); The control unit converts the above information into control variables of the manipulator according to the target posture of the actuator component, the target information output in real time by the navigation and positioning end, and the data of the end force sensor, and realizes the control of feeding, rebounding and maintaining the current position of the actuator through force and position mixed control; The control variables of the robotic arm include but are not limited to spatial posture information, force control and / or speed.

8. The force control method according to claim 7, characterized in that: The force and position hybrid control includes: (1) For position control, the real-time position x of the target element is d As input, and perform differential calculation with the posture in the previous loop to calculate the differential mean; or further, process the error with the target element; The position control unit controls the controlled object, for example, through the parameter k p Position term, k d Speed ​​term, get the control variable u p , and transmit it to the robot arm and the end force sensor to collect the signal for filtering; (2) For force control, the target external force is used as input and the differential value is obtained by performing differential calculation with the posture error in the previous loop. The control variable u under force control is finally obtained through equivalent position and velocity control of force control. f , and pass it into the controller processing signal, and the position information (preferably the control variable u output after the position error is processed by the controller gain) p ) for mixing; During the root cutting process, if a resistance torque is encountered, the torque signal acting on the constraint axis will be collected and processed, and the control result will be output; (3) Further processing the force control signal: The external force signal and the resistance torque signal obtained in step (2) are combined to determine the current operator's operation intention, and the following piecewise function processing is used: Among them, x target is the target pose, where x down , x up , x d , x u They represent root cutting, return, and keep the current posture, respectively. tor is the tolerance value of force control; preferably, the experiment confirms that F tor The value of is ±2N; Preferably, in terms of control strategy, the root cutting process and the displacement boundary will be in hard contact, and the control will be strictly limited; in the return stage, when the robot arm reaches the target position and successfully cuts off 3mm of the root apex, the system adopts a rebound mechanism and directly returns to the initial position along the path designed in the feeding stage; Preferably, the force control method is performed in a force control system as described in any one of claims 1-6.

9. An electronic device, characterized in that: The electronic device includes a memory, a processor, and a computer program stored in the memory and executable on the processor. When the processor executes the program, the steps of the force control method according to claim 7 or 8 are implemented.

10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, which implements the steps of the force control method according to claim 7 or 8 when executed by a processor.

Citation Information

Patent Citations

  • Dental implanting drilling control system and method

    CN108784852A

  • Dental surgical robot system, control method and readable storage medium

    CN115252139A

  • Force control method, device and equipment for power tool at tail end of mechanical arm and medium

    CN117414197A

  • Force sensor installation information determination method and apparatus, and device and medium

    WO2024131888A1