Surgical robot lifting teaching control method, device, equipment and medium
The external control force direction is determined by jitter feedforward, and the dynamic model parameter identification is used to identify the dynamic model parameters, which solves the problem of parameter identification error of the lifting joint dynamic model of surgical robot and high cost, achieving the dual stability and cost promote.
Patent Information
- Application Number
- CN202311729383.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-12-15
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2043-12-15
AI Technical Summary
There are large errors in the identification of dynamic model parameters of the lifting joint of existing surgical robots, and the torque sensor is expensive, which affects the stability of lifting and lowering teaching control.
The external control force direction is determined by jitter feedforward, and the data collected in the current loop control mode is used to identify the dynamic model parameters, reducing the dependence on the torque sensor, and improving the stability of lifting and lowering teaching control.
The cost of lifting and lowering teaching can be reduced without a torque sensor, and the stability and accuracy of lifting and lowering teaching control of surgical robots can be improved.
Smart Images

Figure CN117706931B_ABST
Abstract
Description
Technical Field
[0001] The embodiments of the present invention relate to the field of mechanical control technology, and in particular to a surgical robot lifting teaching control method, device, equipment and medium. Background Art
[0002] When surgical robots are used in surgical operations, they need to go through the key link of preoperative positioning of the lifting joints. That is, the operator's hand applies external force to the end of the robot arm, and the lifting joint responds to the movement trend to assist, allowing the operator to be more smoothly placed in the position required by the surgical procedure.
[0003] At present, most of the dynamic models are established in advance; then, a large amount of data is collected in the position loop for parameter identification; torque sensors are used to compensate for joint gravity torque, friction torque and other related torques to achieve the movement of the lifting joint.
[0004] However, the torque data collected by the position loop in the above process is usually accompanied by very violent fluctuations, resulting in large errors in the identified parameters; and the torque sensor is expensive and has a high production cost. Summary of the invention
[0005] The embodiments of the present invention provide a method, device, equipment and medium for teaching lifting and lowering of a surgical robot. The direction of the external control force of the surgical robot is determined by jitter feedforward, and the lifting and lowering teaching cost is reduced without the need for a torque sensor. The parameters of the dynamic model are identified based on the control data collected in the current loop control mode, thereby improving the stability of the lifting and lowering teaching control process of the surgical robot.
[0006] In a first aspect, an embodiment of the present invention provides a surgical robot lifting teaching method, the method comprising:
[0007] When the target controlled lifting joint is under the action of the external control force and the movement speed is within a preset low-speed threshold interval, controlling the target controlled lifting joint to vibrate;
[0008] During the shaking process of the target controlled lifting joint, determining the direction of application of the external control force;
[0009] According to the force direction, the real-time position information and the real-time speed information of the target controlled lifting joint, and the preset mapping relationship between the torque and the joint motion parameters, the dynamic model parameters are identified to determine the target dynamic model;
[0010] Controlling the target controlled lifting joint to move based on the target dynamics model to complete the lifting teaching control of the surgical robot;
[0011] The preset mapping relationship between the torque and the joint motion parameter is determined based on the movement of the target controlled lifting joint under the current loop control mode of the motor.
[0012] In a second aspect, an embodiment of the present invention further provides a surgical robot lifting teaching device, the device comprising:
[0013] A shaking control module, used for controlling the target controlled lifting joint to shake when the target controlled lifting joint is under the action of an external control force and the movement speed is within a preset low-speed threshold interval;
[0014] A torque direction determination module, used to determine the direction of the external control force during the shaking process of the target controlled lifting joint;
[0015] A compensation torque determination module is used to identify the parameters of the dynamic model according to the force direction, the real-time position information and the real-time speed information of the target controlled lifting joint, and the preset mapping relationship between the torque and the joint motion parameters, so as to determine the target dynamic model;
[0016] A teaching control module, used for controlling the target control lifting joint to move based on the target dynamics model, so as to complete the lifting teaching control of the surgical robot;
[0017] The preset mapping relationship between the torque and the motor control parameter is determined based on the movement of the target controlled lifting joint under the current loop control mode of the motor.
[0018] In a third aspect, an embodiment of the present invention further provides a computer device, the computer device comprising:
[0019] one or more processors;
[0020] A memory for storing one or more programs;
[0021] When the one or more programs are executed by the one or more processors, the one or more processors implement the surgical robot lifting and lowering teaching method provided in any embodiment of the present invention.
[0022] In a fourth aspect, an embodiment of the present invention further provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements a surgical robot lifting and lowering teaching method as provided in any embodiment of the present invention.
[0023] In an embodiment of the present invention, when the target controlled lifting joint is under the action of an external control force and the movement speed is in a preset low-speed threshold interval, the target controlled lifting joint is controlled to shake; during the shaking process of the target controlled lifting joint, the direction of the external control force is determined; according to the force direction and the real-time position information and real-time speed information of the target controlled lifting joint, and the preset torque and joint motion parameter mapping relationship, the dynamic model parameters are identified to determine the target dynamic model; based on the target dynamic model, the target controlled lifting joint is controlled to move to complete the lifting teaching control of the surgical robot; wherein the preset torque and joint motion parameter mapping relationship is determined based on the movement of the target controlled lifting joint under the current loop control mode of the motor. The technical solution of the embodiment of the present invention determines the direction of the external control force of the surgical robot through shaking feedforward, does not require a torque sensor to reduce the lifting teaching cost, and performs parameter identification on the dynamic model based on the control data collected under the current loop control mode, thereby improving the stability of the lifting teaching control process of the surgical robot. BRIEF DESCRIPTION OF THE DRAWINGS
[0024] Figure 1 It is a flow chart of a surgical robot lifting teaching method provided by an embodiment of the present invention;
[0025] Figure 2 is a schematic diagram of determining a preset low-speed threshold interval provided by an embodiment of the present invention;
[0026] Figure 3 is a schematic diagram of determining a target jitter frequency provided by an embodiment of the present invention;
[0027] Figure 4 It is a flow chart of a surgical robot lifting teaching method provided by an embodiment of the present invention;
[0028] Figure 5 is a schematic diagram of determining a set current value provided by an embodiment of the present invention;
[0029] Figure 6 It is a structural schematic diagram of a surgical robot lifting teaching device provided by an embodiment of the present invention;
[0030] Figure 7 A schematic diagram of the structure of a computer device provided in Embodiment 5 of the present invention. DETAILED DESCRIPTION
[0031] The present invention will be further described in detail below in conjunction with the accompanying drawings and embodiments. It is to be understood that the specific embodiments described herein are only used to explain the present invention, rather than to limit the present invention. It should also be noted that, for ease of description, only parts related to the present invention, rather than all structures, are shown in the accompanying drawings.
[0032] Embodiment 1
[0033] Figure 1 This is a flowchart of a surgical robot lifting teaching method provided in Embodiment 1 of the present invention. This embodiment can be applied to the scenario of a surgical robot lifting teaching device. The method can be executed by a surgical robot lifting teaching device, which can be implemented by software and / or hardware and integrated into a computer device with application development function.
[0034] like Figure 1 As shown, the surgical robot lifting teaching method of this embodiment includes the following steps:
[0035] S110: When the target controlled lifting joint is under the action of an external control force and the movement speed is within a preset low-speed threshold interval, the target controlled lifting joint is controlled to vibrate.
[0036] The external control force may be a force applied by a human hand. The external control force acts on the end of the target control lifting joint to place the target control lifting joint to a preset position, and the surgery is performed in the preset position. The preset position is set according to actual needs and is not limited in this embodiment.
[0037] The preset low-speed threshold interval refers to the static low-speed interval during the startup process of the preset target control lifting joint, which has not yet started to move under the action of the external control force. Figure 2 As shown, the motion speed curve of the motor encoder in a stationary state can be collected, the motion speed fluctuation amplitude can be counted, and the upper and lower boundaries of the maximum amplitude of the motion speed fluctuation can be expanded and set as a preset low-speed threshold interval, wherein the degree of expansion can be set according to actual needs. It can be understood that the direction of the motion speed can include two directions, upward and downward, that is, two directions of lifting and lowering, and the preset low-speed threshold interval can include a preset upward low-speed threshold interval and a preset downward low-speed threshold interval, corresponding to the upward speed and the downward speed respectively, the speed of the preset upward low-speed threshold interval is from 0 to the preset upward low-speed threshold, and the speed of the preset downward low-speed threshold interval is from the preset downward low-speed threshold to 0, and the two intervals are symmetrical about the origin, that is, the absolute value of the preset upward low-speed threshold is the same as that of the preset downward low-speed threshold.
[0038] When the movement speed is within the preset low-speed threshold range, the control target controls the lifting joint to vibrate to assist the static friction force, so as to improve the feel of human hand pushing during the starting process.
[0039] In an optional implementation, the target lifting joint is controlled to shake, and a target shaking frequency of the target lifting joint is determined according to the real-time movement speed of the target lifting joint, and the target lifting joint is controlled to shake according to the target shaking frequency.
[0040] Specifically, the target control lifting joint movement speed is obtained in real time. When the speed is the lowest, that is, when it is stationary, the target shaking frequency is set to the maximum shaking frequency. When the speed gradually increases, the target shaking frequency is reduced accordingly. When the endpoint of the preset low-speed threshold interval is reached, the target shaking frequency is reduced to the minimum shaking frequency. The minimum shaking frequency can be 0, that is, the shaking stops after leaving the interval.
[0041] In an optional implementation, the target shaking frequency of the target controlled lifting joint is determined according to the real-time movement speed of the target controlled lifting joint, and the real-time movement speed of the target controlled lifting joint is input into the relationship between the preset speed and the shaking frequency to obtain the target shaking frequency. The relationship between the preset speed and the shaking frequency is: Where f is used to represent the target jitter frequency, v 0 Used to indicate the preset low speed threshold, f min The speed of movement is equal to v 0 The jitter frequency, f max is the frequency of jitter when the motion speed is 0, is the real-time motion speed of the target controlled lifting joint, and α is the coefficient that controls the steepness of the frequency attenuation curve.
[0042] like Figure 3 As shown in the figure, when the target control lifting joint is stationary, the real-time movement speed of the target control lifting joint is Substituting into the relationship between the preset speed and the jitter frequency (hereinafter referred to as formula (1)), the target jitter frequency f = f max , when the speed gradually increases, the real-time motion speed acquired at this time Substitute into formula (1) to obtain the corresponding real-time motion speed The target jitter frequency f, the target jitter frequency f value increases with The target jitter frequency f is decreased as the real-time speed increases until the real-time speed reaches the preset low-speed threshold value, which may be the endpoint value of the preset low-speed threshold interval, so that the target jitter frequency f=f min , f min Can be 0.
[0043] S120. During the process of controlling the target lifting joint to vibrate, determine the direction of application of the external control force.
[0044] Specifically, the direction of the Coulomb friction force is switched by shaking in the preset low-speed threshold range. When the directions of the Coulomb friction force and the external control force are consistent at a certain moment, the static friction force can be broken, thereby improving the pushing feel during the startup process when leaving the preset low-speed threshold range.
[0045] S130, performing dynamic model parameter identification according to the force direction and the real-time position information and real-time speed information of the target controlled lifting joint, and the preset mapping relationship between the torque and the joint motion parameters, and determining the target dynamic model.
[0046] The force application direction may be a force application direction determined within a preset low-speed threshold interval, the real-time speed information may be acquired through a motion sensor, and the real-time position information may be position information acquired from an encoder.
[0047] Among them, the preset torque and joint motion parameter mapping relationship is determined based on the target control lifting joint moving under the current loop control mode of the motor. The preset torque and joint motion parameter mapping relationship can be that the target control lifting joint is lifting and lowering under the preset current value, and the mapping relationship between the position, speed and test torque value in each link of the lifting and lowering of the target control lifting joint is measured. Specifically, the test torque value can be the preset torque value in the lifting and lowering movement of the target control lifting joint under the preset current value, and can specifically be the preset up / down torque value. Correspondingly, the preset current value can be the preset up / down current value. In the current loop control mode, the target control lifting joint movement is controlled by setting a constant preset up / down current value, so that the joint lifts and lowers for a whole cycle. Through the relationship between the preset torque and the preset current value, the preset current value required to set to achieve the preset torque can be obtained.
[0048] The real-time position information, real-time speed information and the preset torque and joint motion parameter mapping relationship are input into the dynamic model for parameter identification, the values of unknown parameters are identified, and the target dynamic model is obtained according to the determined unknown parameter values.
[0049] The target compensation torque of the motor at the real-time speed and real-time position can be determined according to the target dynamics model.
[0050] The goal of parameter identification is to minimize the average absolute value error between the target compensation torque and the preset torque value, thereby ensuring the accuracy of posture placement during teaching. Parameter identification can be performed through an optimization algorithm, and the optimization algorithm can be, for example, the least squares method.
[0051] S140, controlling the control parameters of the motor that controls the movement of the target lifting joint based on the target dynamics model, so as to complete the lifting teaching control of the surgical robot.
[0052] The target compensation torque determined in step S130 and the current value corresponding to the target compensation torque are used to control the lifting joint to perform lifting motion.
[0053] The technical solution of this embodiment is to control the target controlled lifting joint to shake when the target controlled lifting joint is under the action of the external control force and the movement speed is in the preset low-speed threshold interval; during the shaking process of the target controlled lifting joint, determine the force direction of the external control force; identify the parameters of the dynamic model according to the force direction and the real-time position information and real-time speed information of the target controlled lifting joint, and the preset torque and joint motion parameter mapping relationship, and determine the target dynamic model; control the target controlled lifting joint to move based on the target dynamic model, so as to complete the lifting teaching control of the surgical robot; wherein the preset torque and joint motion parameter mapping relationship is determined based on the movement of the target controlled lifting joint under the current loop control mode of the motor. The technical solution of the embodiment of the present invention determines the direction of the external control force of the surgical robot through shaking feedforward, does not require a torque sensor to reduce the lifting teaching cost, and identifies the parameters of the dynamic model based on the control data collected under the current loop control mode, so as to improve the stability of the lifting teaching control process of the surgical robot.
[0054] Figure 4 A flowchart of a surgical robot lifting teaching method provided in an embodiment of the present invention. This embodiment and the surgical robot lifting teaching method in the above embodiment belong to the same inventive concept. The method can be executed by a surgical robot lifting teaching device, which can be implemented by software and / or hardware and integrated in a computer device with application development function.
[0055] like Figure 4 As shown, the surgical robot lifting teaching method includes the following steps:
[0056] S210. In the current loop control mode, the motor is controlled to work according to a plurality of preset current values, so that the target controlled lifting joint performs lifting cycle operation.
[0057] Specifically, the lifting and lowering cycle may be a full cycle of first lifting and then lowering. In each lifting and lowering cycle, the movement is performed at different preset current values, and as the number of cycles increases, the corresponding preset current value also increases.
[0058] Optionally, the motor is controlled to operate according to a plurality of set current values respectively. The plurality of set current values may be determined according to a preset initial current value and a preset current adjustment step; and the motor is controlled to operate at each set current value respectively.
[0059] Specifically, Figure 5As shown, a preset initial current value is set, for example, it can be ±100, and the current value iup in the ascending (upward) direction is specified to be positive, and the current value idown in the descending (downward) direction is specified to be negative. When the preset initial current value is used for a full cycle, the cycle number i increases from 0 to 1, and enters the second cycle. The current value set for the second cycle is the preset initial current value plus or minus the preset current adjustment step step multiplied by the cycle number 1. The preset current adjustment step can be, for example, 20, then the current value set for the second cycle is ±120, and the set current values for multiple cycles can be calculated by analogy. It can be understood that as the set current value increases, the speed of the target controlled lifting joint movement will also be faster, so that the lifting cycle operation covers the preset speed range of the lifting joint. The preset speed range can be set according to actual needs, and this embodiment is not limited. For example, it can be a commonly used joint lifting speed range.
[0060] S220. During the lifting cycle operation of the target controlled lifting joint, the position, speed and test torque value of the target controlled lifting joint are collected.
[0061] The position of the target controlled lifting joint is acquired through the encoder, the speed is acquired through the motion sensor, and the torque value is tested. The test torque value can be a preset torque value when the target controlled lifting joint performs lifting motion under a preset current value.
[0062] S230, establishing an association relationship between each set of test torque values and the corresponding position and speed as a preset mapping relationship between torque and joint motion parameters.
[0063] Specifically, the collected position and speed corresponding to a test torque value are grouped together, and each group of test torque values and the collected position and speed corresponding to the test torque value are associated with each other as a preset torque and joint motion parameter mapping relationship.
[0064] S240: When the target controlled lifting joint is under the action of the external control force and the movement speed is within a preset low-speed threshold range, the target controlled lifting joint is controlled to vibrate.
[0065] S250: During the process of controlling the target lifting joint to vibrate, determine the direction of application of the external control force.
[0066] S260, determining corresponding acceleration information according to the real-time speed information, and inputting the real-time speed information, acceleration information, and real-time position information into a preset dynamic model.
[0067] Specifically, based on the real-time speed information, the time information corresponding to the real-time speed and the real-time position information, the acceleration information corresponding to the real-time speed information can be determined, and the real-time speed information, the acceleration information and the real-time position information are substituted into the preset dynamic model.
[0068] Optionally, the default kinetic model can be expressed as Among them, τ is the target compensation torque, θ is the real-time position, For real-time speed, is the acceleration, M is the inertia coefficient, F c is the Coulomb friction force, σ is the viscous friction coefficient; h(θ) is the position-dependent resistance; where {M,σ,F c The unknown coefficients in} and h(θ) are the parameters to be identified.
[0069] S270 , performing parameter identification on the preset dynamics model according to the preset mapping relationship between torque and joint motion parameters and the preset constraint target, and determining unknown parameter values in the preset dynamics model.
[0070] The preset constraint target can be to minimize the average absolute error between the predicted torque value output by the preset dynamic model based on the preset torque and joint motion parameter mapping relationship and the collected torque value, and determine {M,σ,F c} and the values of the unknown coefficients in h(θ).
[0071] S280: Determine a target dynamics model corresponding to the preset dynamics model based on the unknown parameter value.
[0072] {M,σ,F c Substitute the values of the unknown coefficients in} and h(θ) into the preset dynamic model to obtain the target dynamic model.
[0073] S290, controlling the control parameters of the motor that controls the lifting joint to move based on the target dynamics model to complete the lifting teaching control of the surgical robot.
[0074] Among them, the preset mapping relationship between the torque and the joint motion parameter is determined based on the target control of the lifting joint to move in the current loop control mode of the motor.
[0075] The real-time position information and real-time speed information of the target controlled lifting joint acquired in real time are input into the target dynamics model to obtain the target compensation torque, and the target controlled lifting joint is driven with the target compensation current value corresponding to the target compensation torque.
[0076] The technical solution of this embodiment is to control the target controlled lifting joint to shake when the target controlled lifting joint is under the action of the external control force and the movement speed is in the preset low-speed threshold interval; during the shaking process of the target controlled lifting joint, determine the direction of the external control force; identify the parameters of the dynamic model according to the force direction and the real-time position information and real-time speed information of the target controlled lifting joint, and the preset torque and joint motion parameter mapping relationship to determine the target dynamic model; control the target controlled lifting joint to move based on the target dynamic model to complete the lifting teaching control of the surgical robot; wherein the preset torque and joint motion parameter mapping relationship is determined based on the movement of the target controlled lifting joint under the current loop control mode of the motor. The technical solution of the embodiment of the present invention determines the direction of the external control force of the surgical robot through shaking feedforward, does not require a torque sensor to reduce the lifting teaching cost, and identifies the parameters of the dynamic model based on the control data collected under the current loop control mode, thereby improving the stability of the lifting teaching control process of the surgical robot.
[0077] Figure 6 This is a schematic diagram of the structure of a surgical robot lifting teaching device provided in an embodiment of the present invention. This embodiment can be applied to the scenario of a surgical robot lifting teaching device. The device can be implemented by software and / or hardware and integrated into a computer device with application development function.
[0078] like Figure 6 As shown, the surgical robot lifting teaching device includes: a vibration control module 310, a torque direction determination module 320, a compensation torque determination module 330 and a teaching control module 340.
[0079] The shaking control module 310 is used to control the target controlled lifting joint to shake when the target controlled lifting joint is under the action of an external control force and the movement speed is within a preset low-speed threshold range.
[0080] The torque direction determination module 320 is used to determine the direction of the external control force during the shaking process of the target controlled lifting joint.
[0081] The compensation torque determination module 330 performs dynamic model parameter identification according to the force direction and the real-time position information and real-time speed information of the target controlled lifting joint, and the preset mapping relationship between the torque and the joint motion parameters, and determines the target dynamic model.
[0082] The teaching control module 340 is used to control the target controlled lifting joint to move based on the target dynamics model to complete the lifting teaching control of the surgical robot.
[0083] The preset mapping relationship between the torque and the motor control parameter is determined based on the movement of the target controlled lifting joint under the current loop control mode of the motor.
[0084] The technical solution of this embodiment is to control the target controlled lifting joint to shake when the target controlled lifting joint is under the action of the external control force and the movement speed is in the preset low-speed threshold interval; during the shaking process of the target controlled lifting joint, determine the direction of the external control force; identify the parameters of the dynamic model according to the force direction and the real-time position information and real-time speed information of the target controlled lifting joint, and the preset torque and joint motion parameter mapping relationship to determine the target dynamic model; control the target controlled lifting joint to move based on the target dynamic model to complete the lifting teaching control of the surgical robot; wherein the preset torque and joint motion parameter mapping relationship is determined based on the movement of the target controlled lifting joint under the current loop control mode of the motor. The technical solution of the embodiment of the present invention determines the direction of the external control force of the surgical robot through shaking feedforward, does not require a torque sensor to reduce the lifting teaching cost, and identifies the parameters of the dynamic model based on the control data collected under the current loop control mode, thereby improving the stability of the lifting teaching control process of the surgical robot.
[0085] Optionally, the jitter control module 310 specifically includes:
[0086] A target shaking frequency determining unit, used to determine a target shaking frequency for controlling the target controlled lifting joint to shake according to the real-time movement speed of the target controlled lifting joint;
[0087] A shaking control unit is used to control the target controlled lifting joint to shake according to the target shaking frequency.
[0088] Optionally, the target jitter frequency determination unit is specifically used to:
[0089] Inputting the real-time movement speed of the target controlled lifting joint into the relationship between the preset speed and the shaking frequency to obtain the target shaking frequency;
[0090] The relationship between the preset speed and the jitter frequency is: Wherein, f is used to represent the target jitter frequency, v 0 Used to represent the preset low speed threshold, f min The speed of movement is equal to v 0 The jitter frequency, f max is the frequency of jitter when the motion speed is 0, is the real-time movement speed of the lifting joint for the target control, and α is the coefficient for controlling the steepness of the frequency attenuation curve.
[0091] Optionally, the compensation torque determination module 330 further includes:
[0092] The preset dynamic model input unit is used to determine the corresponding acceleration information according to the real-time speed information, and input the real-time speed information, the acceleration information, and the real-time position information into the preset dynamic model.
[0093] The parameter identification unit is used to perform parameter identification on the preset dynamic model according to the preset torque and joint motion parameter mapping relationship and the preset constraint target, and determine the unknown parameter values in the preset dynamic model.
[0094] The target compensation torque determination unit is used to determine the target dynamics model corresponding to the preset dynamics model based on the unknown parameter value.
[0095] Optionally, the preset kinetic model of the preset kinetic model input unit is expressed as:
[0096] Among them, τ is the target compensation torque, θ is the real-time position, For real-time speed, is the acceleration, M is the inertia coefficient, F c is the Coulomb friction force, σ is the viscous friction coefficient; h(θ) is the position-dependent resistance; where {M,σ,F c The unknown coefficients in} and h(θ) are the parameters to be identified.
[0097] Optionally, the surgical robot lifting teaching device further includes:
[0098] The mapping relationship determination module is used for:
[0099] In the current loop control mode, the motor is controlled to work according to a plurality of preset current values respectively, so that the target controlled lifting joint performs lifting cycle operation;
[0100] During the lifting cycle operation of the target controlled lifting joint, collecting the position, speed and test torque value of the target controlled lifting joint;
[0101] An association relationship between each set of the test torque values and the corresponding position and speed is established as the preset torque and joint motion parameter mapping relationship.
[0102] Optionally, the mapping relationship determination module is further used to:
[0103] Determine a plurality of set current values according to a preset initial current value and a preset current adjustment step;
[0104] The motors are controlled to operate at each of the set current values.
[0105] The surgical robot lifting teaching device provided in the embodiment of the present invention can execute the surgical robot lifting teaching method provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.
[0106] Figure 7 A schematic diagram of the structure of a computer device provided in an embodiment of the present invention. Figure 7 A block diagram of an exemplary computer device 12 suitable for use in implementing embodiments of the present invention is shown. Figure 7 The computer device 12 shown is only an example and should not bring any limitation to the functions and scope of use of the embodiments of the present invention. The computer device 12 can be any terminal device with computing capabilities and can be configured in the surgical robot lifting teaching device.
[0107] like Figure 7 As shown, the computer device 12 is in the form of a general-purpose computing device. The components of the computer device 12 may include, but are not limited to: one or more processors or processing units 16, a system memory 28, and a bus 18 that connects various system components (including the system memory 28 and the processing unit 16).
[0108] Bus 18 represents one or more of several types of bus structures, including a memory bus or memory controller, a peripheral bus, an accelerated graphics port, a processor or a local bus using any of a variety of bus architectures. By way of example, these architectures include, but are not limited to, an Industry Standard Architecture (ISA) bus, a Micro Channel Architecture (MAC) bus, an Enhanced ISA bus, a Video Electronics Standards Association (VESA) local bus, and a Peripheral Component Interconnect (PCI) bus.
[0109] The computer device 12 typically includes a variety of computer system readable media. These media can be any available media that can be accessed by the computer device 12, including volatile and non-volatile media, removable and non-removable media.
[0110] The system memory 28 may include computer system readable media in the form of volatile memory, such as random access memory (RAM) 30 and / or cache memory 32. The computer device 12 may further include other removable / non-removable, volatile / non-volatile computer system storage media. By way of example only, the storage system 34 may be used to read and write non-removable, non-volatile magnetic media ( Figure 7 not shown, usually called a "hard drive"). Although Figure 7Not shown in the figure, a disk drive for reading and writing to a removable non-volatile disk (e.g., a "floppy disk"), and an optical disk drive for reading and writing to a removable non-volatile optical disk (e.g., a CD-ROM, a DVD-ROM, or other optical media) may be provided. In these cases, each drive may be connected to the bus 18 via one or more data medium interfaces. The system memory 28 may include at least one program product having a set (e.g., at least one) of program modules that are configured to perform the functions of the various embodiments of the present invention.
[0111] A program / utility 40 having a set (at least one) of program modules 42 may be stored, for example, in system memory 28, such program modules 42 including, but not limited to, an operating system, one or more application programs, other program modules, and program data, each of which or some combination may include an implementation of a network environment. Program modules 42 generally perform the functions and / or methods of the embodiments described herein.
[0112] The computer device 12 may also communicate with one or more external devices 14 (e.g., keyboards, pointing devices, displays 24, etc.), one or more devices that enable a user to interact with the computer device 12, and / or any device that enables the computer device 12 to communicate with one or more other computing devices (e.g., network cards, modems, etc.). Such communication may be performed via an input / output (I / O) interface 22. Furthermore, the computer device 12 may also communicate with one or more networks (e.g., a local area network (LAN), a wide area network (WAN), and / or a public network, such as the Internet) via a network adapter 20. As shown, the network adapter 20 communicates with the other modules of the computer device 12 via the bus 18. It should be understood that although Figure 7 Not shown, other hardware and / or software modules may be used in conjunction with computer device 12, including but not limited to microcode, device drivers, redundant processing units, external disk drive arrays, RAID systems, tape drives, and data backup storage systems.
[0113] The processing unit 16 executes various functional applications and data processing by running the program stored in the system memory 28, for example, implementing the surgical robot lifting teaching method provided in the embodiment of the present invention, the method comprising:
[0114] When the target controlled lifting joint is under the action of the external control force and the movement speed is within a preset low-speed threshold interval, controlling the target controlled lifting joint to vibrate;
[0115] During the shaking process of the target controlled lifting joint, determining the direction of application of the external control force;
[0116] According to the force direction, the real-time position information and the real-time speed information of the target controlled lifting joint, and the preset mapping relationship between the torque and the joint motion parameters, the dynamic model parameters are identified to determine the target dynamic model;
[0117] Controlling the target controlled lifting joint to move based on the target dynamics model to complete the lifting teaching control of the surgical robot;
[0118] The preset mapping relationship between the torque and the joint motion parameter is determined based on the movement of the target controlled lifting joint under the current loop control mode of the motor.
[0119] This embodiment provides a computer-readable storage medium, on which a computer program is stored. When the program is executed by a processor, a surgical robot lifting teaching method as provided in any embodiment of the present invention is implemented. The method includes:
[0120] When the target controlled lifting joint is under the action of the external control force and the movement speed is within a preset low-speed threshold interval, controlling the target controlled lifting joint to vibrate;
[0121] During the shaking process of the target controlled lifting joint, determining the direction of application of the external control force;
[0122] According to the force direction, the real-time position information and the real-time speed information of the target controlled lifting joint, and the preset mapping relationship between the torque and the joint motion parameters, the dynamic model parameters are identified to determine the target dynamic model;
[0123] Controlling the target controlled lifting joint to move based on the target dynamics model to complete the lifting teaching control of the surgical robot;
[0124] The preset mapping relationship between the torque and the joint motion parameter is determined based on the movement of the target controlled lifting joint under the current loop control mode of the motor.
[0125] The computer storage medium of the embodiment of the present invention can adopt any combination of one or more computer-readable media. The computer-readable medium can be a computer-readable signal medium or a computer-readable storage medium. The computer-readable storage medium can be, for example, but not limited to: an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or device, or any combination of the above. More specific examples (non-exhaustive list) of computer-readable storage media include: an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above. In this document, a computer-readable storage medium can be any tangible medium containing or storing a program, which can be used by an instruction execution system, device or device or used in combination with it.
[0126] Computer-readable signal media may include data signals propagated in baseband or as part of a carrier wave, which carry computer-readable program code. Such propagated data signals may take a variety of forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the above. Computer-readable signal media may also be any computer-readable medium other than a computer-readable storage medium, which may send, propagate, or transmit a program for use by or in conjunction with an instruction execution system, apparatus, or device.
[0127] The program code embodied on the computer readable medium may be transmitted using any appropriate medium, including but not limited to wireless, wireline, optical fiber cable, RF, etc., or any suitable combination of the foregoing.
[0128] Computer program code for performing the operations of the present invention may be written in one or more programming languages or combinations thereof, including object-oriented programming languages such as Java, Smalltalk, C++, and conventional procedural programming languages such as "C" or similar programming languages. The program code may be executed entirely on the user's computer, partially on the user's computer, as a separate software package, partially on the user's computer and partially on a remote computer, or entirely on a remote computer or server. In cases involving a remote computer, the remote computer may be connected to the user's computer through any type of network, including a local area network (LAN) or a wide area network (WAN), or may be connected to an external computer (e.g., via the Internet using an Internet service provider).
[0129] It should be understood by those skilled in the art that the modules or steps of the present invention described above can be implemented by a general-purpose computing device, they can be concentrated on a single computing device, or distributed on a network composed of multiple computing devices, optionally, they can be implemented by a program code executable by a computer device, so that they can be stored in a storage device and executed by the computing device, or they can be made into individual integrated circuit modules, or multiple modules or steps therein can be made into a single integrated circuit module for implementation. Thus, the present invention is not limited to any specific combination of hardware and software.
[0130] Note that the above are only preferred embodiments of the present invention and the technical principles used. Those skilled in the art will understand that the present invention is not limited to the specific embodiments herein, and that various obvious changes, readjustments and substitutions can be made by those skilled in the art without departing from the scope of protection of the present invention. Therefore, although the present invention has been described in more detail through the above embodiments, the present invention is not limited to the above embodiments, and may include more other equivalent embodiments without departing from the concept of the present invention, and the scope of the present invention is determined by the scope of the appended claims.
Claims
1. A surgical robot lifting teaching control method, characterized in that: include: When the target controlled lifting joint is under the action of the external control force and the movement speed is within a preset low-speed threshold interval, controlling the target controlled lifting joint to vibrate; During the shaking process of the target controlled lifting joint, determining the direction of application of the external control force; According to the force direction, the real-time position information and the real-time speed information of the target controlled lifting joint, and the preset mapping relationship between the torque and the joint motion parameters, the dynamic model parameters are identified to determine the target dynamic model; Controlling the target controlled lifting joint to move based on the target dynamics model to complete the lifting teaching control of the surgical robot; Wherein, the preset mapping relationship between torque and joint motion parameter is determined based on the movement of the target controlled lifting joint under the current loop control mode of the motor; The controlling the target to control the lifting joint to shake includes: Determining a target shaking frequency for controlling the shaking of the target controlled lifting joint according to the real-time movement speed of the target controlled lifting joint; Controlling the target controlled lifting joint to shake according to the target shaking frequency; The step of determining a target shaking frequency for controlling the target controlled lifting joint to shake according to the real-time movement speed of the target controlled lifting joint comprises: The movement speed of the target controlled lifting joint is acquired in real time. When the movement speed is the lowest, the target jitter frequency is set to the maximum jitter frequency. When the movement speed gradually increases, the target jitter frequency is reduced accordingly. When the movement speed reaches the endpoint of a preset low-speed threshold interval, the target jitter frequency is reduced to 0.
2. The method according to claim 1, characterized in that Determining a target shaking frequency for controlling the target controlled lifting joint to shake according to the real-time movement speed of the target controlled lifting joint includes: Inputting the real-time movement speed of the target controlled lifting joint into the relationship between the preset speed and the shaking frequency to obtain the target shaking frequency; The relationship between the preset speed and the jitter frequency is: ,in, Used to represent the target jitter frequency, used to indicate the preset low speed threshold, The speed of movement is equal to The jitter frequency, is the frequency of jitter when the motion speed is 0, Control the real-time movement speed of the lifting joint for the target, It is a coefficient that controls the steepness of the frequency attenuation curve.
3. The method according to claim 1, characterized in that According to the force direction, the real-time position information and the real-time speed information of the target controlled lifting joint, and the preset torque and joint motion parameter mapping relationship, the dynamic model parameter identification is performed to determine the target dynamic model, including: Determine corresponding acceleration information according to the real-time speed information, and input the real-time speed information, the acceleration information, and the real-time position information into a preset dynamic model; Performing parameter identification on the preset dynamic model according to the preset torque and joint motion parameter mapping relationship and the preset constraint target to determine unknown parameter values in the preset dynamic model; A target dynamics model corresponding to the preset dynamics model is determined based on the unknown parameter value.
4. The method according to claim 3, characterized in that The preset dynamic model is expressed as ,in, is the target compensation torque, For real-time location, For real-time speed, is the acceleration, is the inertia coefficient, is the Coulomb friction force, is the viscous friction coefficient; is the position-dependent resistance; and The unknown coefficients are the parameters to be identified.
5. The method according to any one of claims 1 to 4, characterized in that: The process of determining the preset mapping relationship between torque and joint motion parameters includes: In the current loop control mode, the motor is controlled to work according to a plurality of preset current values respectively, so that the target controlled lifting joint performs lifting cycle operation; During the lifting cycle operation of the target controlled lifting joint, collecting the position, speed and test torque value of the target controlled lifting joint; An association relationship between each set of the test torque values and the corresponding position and speed is established as the preset torque and joint motion parameter mapping relationship.
6. The method according to claim 5, characterized in that Controlling the motor to work according to a plurality of set current values respectively, comprising: Determine a plurality of set current values according to a preset initial current value and a preset current adjustment step; The motors are controlled to operate at each of the set current values.
7. A surgical robot lifting teaching control device, characterized in that: include: A shaking control module, used for controlling the target controlled lifting joint to shake when the target controlled lifting joint is under the action of an external control force and the movement speed is within a preset low-speed threshold interval; A torque direction determination module, used to determine the direction of the external control force during the shaking process of the target controlled lifting joint; A compensation torque determination module is used to identify the parameters of the dynamic model according to the force direction and the real-time position information and real-time speed information of the target controlled lifting joint, and the preset mapping relationship between the torque and the joint motion parameters, and determine the target dynamic model; A teaching control module, used for controlling the target control lifting joint to move based on the target dynamics model, so as to complete the lifting teaching control of the surgical robot; Wherein, the preset torque and motor control parameter mapping relationship is determined based on the movement of the target controlled lifting joint in the current loop control mode of the motor; The jitter control module is specifically used for: Determining a target shaking frequency for controlling the shaking of the target controlled lifting joint according to the real-time movement speed of the target controlled lifting joint; Controlling the target controlled lifting joint to shake according to the target shaking frequency; The jitter control module is further used for: The movement speed of the target controlled lifting joint is acquired in real time. When the movement speed is the lowest, the target jitter frequency is set to the maximum jitter frequency. When the movement speed gradually increases, the target jitter frequency is reduced accordingly. When the movement speed reaches the endpoint of a preset low-speed threshold interval, the target jitter frequency is reduced to 0.
8. A computer device, characterized in that: The computer device comprises: one or more processors; A memory for storing one or more programs; When the one or more programs are executed by the one or more processors, the one or more processors implement the surgical robot lifting teaching control method as described in any one of claims 1-6.
9. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the program is executed by a processor, the surgical robot lifting teaching control method as described in any one of claims 1-6 is implemented.
