The present invention belongs to the technical field of medical instruments, and in particular relates to a flexible mechanical arm control method and a robot system.
Flexible mechanical arms have been widely used for their compact actuators, high precision, and low energy consumption. Compared with rigid mechanical arms, flexible mechanical arms are more flexible, safer and less prone to injury. However, flexible mechanical arms also have a series of problems due to its own flexibility, including: (1) in the process of being driven by a motor, there will be a deviation between the actual end displacement and the expected end displacement of a flexible mechanical arm; (2) changes in position and posture due to changes in the load on the joint output end of the flexible mechanical arm while the output tail end of the flexible mechanical arm is expected to be maintained in a constant position and posture.
In view of the above problems, although some solutions have been proposed in the prior art, it is still impossible to precisely control the position and posture of the flexible mechanical arm, especially when the external force or load on the joint output end of the flexible mechanical arm changes, and it is expected that the output tail end of the flexible mechanical arm keeps its position and posture unchanged.
An object of the present invention is to provide a flexible mechanical arm control method and a robot system. The control method can maintain the position and posture of the joint output end when the load on the joint output end of the flexible mechanical arm changes, so as to maintain the accuracy of the position and posture of the joint output end when the joint is in its holding state, and to maintain the accuracy of the position and posture of the tail end of the flexible mechanical arm when the flexible mechanical arm is in its holding state.
To achieve the above object, the present invention provides a flexible mechanical arm control method, comprising steps of:
Optionally, an output interface is provided on the joint output end, and a first angle sensor is provided on the output interface;
Optionally, an output interface is provided on the joint output end, a first angle sensor is provided on the output interface, and a torque sensor is provided on an output end of the first angle sensor;
Optionally, the elastic constant of the torque sensor is obtained by:
Optionally, an output interface is provided on the joint output end, a torque sensor is provided on the output interface, and a first angle sensor is provided on an output end of the torque sensor;
Optionally, establishing the conversion relationship between the reading variation of the torque sensor and the total amount of angular displacement comprises:
Optionally, an output interface is provided on the joint output end, a torque sensor is provided on the output interface, and a first angle sensor is provided on an output end of the torque sensor; wherein the control method comprises:
Optionally, an output interface is provided on the joint output end, and a torque sensor is provided on the output interface;
Optionally, establishing the conversion relationship between the torque sensor and the total amount of angular displacement comprises:
Optionally, the joint output end is driven to move in the second direction by a driving mechanism, and during the movement of the joint output end in the second direction, a second angle sensor is used to sense a rotational speed of the driving mechanism, and the driving mechanism is servo-controlled according to the rotational speed.
To achieve the above object, the present invention also provides a robot system, comprising:
Optionally, the sensing device comprises a first angle sensor or a torque sensor.
Optionally, an output interface is provided on the joint output end, and the sensing device comprises a first angle sensor and a torque sensor; wherein an input end of the first angle sensor is connected to the output interface, and an output end of the first angle sensor is connected to an input end of the torque sensor; or
Optionally, the first angle sensor comprises an absolute angle encoder.
Optionally, comprising a second angle sensor arranged on the driving mechanism and communicatively connected with the control unit;
Optionally, the second angle sensor comprises an incremental angle encoder or a multi-turn absolute angle encoder.
Optionally, the driving mechanism comprises a servo motor and a reducer connected to each other, and an output end of the reducer is connected to the joint; wherein the second angle sensor is arranged on the servo motor and configured to sense a rotational speed of the servo motor.
Compared with the prior art, the flexible mechanical arm control method and the robot system according to the present invention have the following advantages.
The flexible mechanical arm control method, comprises steps of: obtaining a total amount of angular displacement of a joint output end of the flexible mechanical arm along a first direction when a load on the joint output end changes; driving the joint output end to move in a second direction according to the total amount of angular displacement, so that the joint output end returns to a position and posture before the load changes; the second direction is opposite to the first direction. By controlling the joint output end to move in reverse according to the total amount of angular displacement, the change in the position and posture of the joint output end resulting from the change in the load on the joint output end is compensated, so that the joint output end is maintained in the desired position and posture.
The accompanying drawings are used to better understand the present invention, and do not constitute improper limitations to the present invention.
Embodiments of the present invention are described below through specific examples, and those skilled in the art can easily understand other advantages and effects of the present invention from the content disclosed in this specification. The present invention can also be implemented or applied through other different specific embodiments, and various modifications or changes can be made to the details in this specification based on different viewpoints and applications without departing from the spirit of the present invention. It should be noted that the drawings provided in the embodiments are only schematically illustrating the basic idea of the present invention, and only the components related to the present invention are shown in the drawings rather than the number, shape and shape of the components in actual implementation. Dimensional drawing, the type, quantity and proportion of each component can be changed arbitrarily during actual implementation, and constructions of the components may also be more complicated.
In addition, each embodiment of the content described below has one or more technical features, but this does not mean that the one using the present invention must implement all the technical features in any embodiment at the same time, or can only implement some or all of the technical features of different embodiments separately. In other words, on the premise that the implementation is possible, those skilled in the art can selectively implement some or all of the technical features in any embodiment according to the disclosure of the present invention and depending on design specifications or implementation requirements, or selectively implement a combination of some or all of the technical features in multiple embodiments, thereby increasing the flexibility of the implementation of the present invention.
As used in this specification, the singular forms “a”, “an” and “the” include plural objects, and the plural form “a plurality” includes two or more objects, unless the content clearly states otherwise. As used in this specification, the term “or” is generally used in the sense including “and/or”, unless the content clearly indicates otherwise, and the terms “install”, “connect” and “couple” should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection. It can be a mechanical connection or an electrical connection. It can be directly connected or indirectly connected through an intermediary, and it can be the internal communication of two elements or the interaction relationship between two elements. Those of ordinary skill in the art can understand the specific meanings of the above terms in the present invention according to specific situations.
In order to make the purpose, advantages and features of the present invention clearer, the present invention will be further described in detail below in conjunction with the accompanying drawings. It should be noted that all the drawings are in a very simplified form and use imprecise scales, and are only used to facilitate and clearly assist the purpose of illustrating the embodiments of the present invention. The same or similar reference numerals in the drawings represent the same or similar components.
The present invention aims to provide a flexible mechanical arm control method, which is used to maintain, when the load on the joint output end of the flexible mechanical arm changes, the joint output end in the position and posture before the load changes, so that the position and posture of the tail end of the mechanical arm is maintained. Those skilled in the art should know that the so-called “flexible mechanical arm” refers to a mechanical arm whose joint output end has an angular displacement when the motor driving the mechanical arm is in a holding state and the load on the joint output end of the mechanical arm changes; on the contrary, if the joint output end of a mechanical arm does not have an angular displacement with the change of the load, the mechanical arm is a traditional rigid mechanical arm (in fact, the rigid mechanical arm also has a certain degree of flexibility, but the rigid mechanical arm uses RV reducer or the gearbox to result in minimal flexibility that can be ignored). In addition, the “change in the load on the joint output end” includes two situations, one is that the load directly acting on the joint output end changes, and the other is that the load acting on other parts of the mechanical arm changes, and the change is transmitted to the joint output end, causing the load on the joint output end to change accordingly.
As shown in
Step S100: Obtaining a total amount of angular displacement of the joint output end of the flexible mechanical arm along a first direction when a load on the joint output end changes.
Step S200: Driving the joint output end to move in a second direction according to the total amount of angular displacement, so that the joint output end returns to the position and posture before the load changes. The second direction is opposite to the first direction. For example, in some embodiments, the first direction is clockwise and the second direction is counterclockwise, or the first direction is counterclockwise and the second direction is clockwise.
That is, in the flexible mechanical arm control method, when the load on the joint output end of the flexible mechanical arm changes, the total amount of angular displacement of the joint output end of the flexible mechanical arm resulting from the load change is obtained, and then the joint output end is driven to move in reverse, and the angular displacement resulting from the reverse motion is equivalent to the total amount of the angular displacement, so that the deviation in the position and posture of the joint output end resulting from the load change can be offset. In addition, those skilled in the art can understand that the joint output end may have an angular displacement when the load on the joint output end changes, but for the tail end of the entire flexible mechanical arm, there will be a change in position and/or posture.
An embodiment of the present invention also provides a robot system. As shown in
Further, as shown in
Generally, the driving mechanism 20 includes a servo motor 21 and a reducer 22. The output end of the reducer 22 is connected to the joint. The second angle sensor 40 is arranged on the servo motor 21 to sense the rotational speed of the servo motor 21. The second angle sensor 40 includes but not limited to an incremental angle encoder or a multi-turn absolute angle encoder.
When the robot system is applied, using the flexible robotic arm control method to control the flexible robotic arm can maintain the position and posture of the joint output end of the flexible robotic arm, so as to maintain the position and posture of other devices (such as the tail end of the mechanical arm) connected to the joint output end. For example, the control method is suitable for the case where the position and posture of the osteotomy guide tool is to be maintained in knee arthroplasty, the case where the position and posture of the endoscope is to be maintained when the doctor sutures the wound in various operations using a mirror-holding robot to hold the endoscope, or other cases where the joint output end of the flexible mechanical arm is to be maintained in a fixed position and posture. The application of the flexible mechanical arm control method will be described below by taking the knee arthroplasty as an example.
Please refer to
The flexible mechanical arm 110 includes a plurality of joints. The osteotomy guide tool 600 and the tool target 700 are arranged at the tail end of the flexible mechanical arm 110. More specifically, the tool target 700 may be arranged on the osteotomy guide tool 600. Each of the joints includes a joint input end, a joint output end and an output interface, which are sequentially connected. The output interface of the joint at the tail end of the flexible mechanical arm 110 is an instrument interface. The instrument interface is connected with the osteotomy guide tool 600. The joint input end is connected with the driving mechanism, so as to transmit the driving force generated from the driving mechanism to the joint output end, the instrument interface and the osteotomy guide tool 600.
A preoperative planning is required before the operation begins. Specifically, the doctor imports the CT scan model of the patient's bones into the computer system for preoperative planning, which for example includes planning the coordinates of the osteotomy plane, selecting a suitable type of prosthesis, and planning the position and orientation for installing the prosthesis. It should be known that the computer system includes a main display screen, a keyboard and a controller located in the navigation trolley 200.
The doctor then uses the target pen to point the feature points of the patient's femur and tibia, and the NDI navigation apparatus 210 installed in the navigation trolley 200 takes the base target 500 as a reference to record the positions of the feature points, and send the position information of the feature points to the computer system. Then the computer system obtains the actual positions and orientations of the femur and the tibia through feature matching calculations, which correspond to the positions and orientations of the femur and the tibia in the CT scan model. Subsequently, the NDI navigation apparatus 210 establishes a mapping relationship between the actual position and orientation of the femur and the femoral target 300 installed on the femur, and establishes a mapping relationship between the actual position and orientation of the tibia and the tibial target 400 installed on the tibia. In this way, The actual position of the bones can be tracked according to the femoral target 300 and the tibial target 400. Those skilled in the art should know that during the operation, as long as the mapping relationship between the femoral target 300 and the femur is fixed, and the mapping relationship between the tibial target 400 and the tibia is fixed, the surgical effect will not be affected even if the bones move.
The NDI navigation apparatus 210 sends the preoperatively planned osteotomy plane coordinates to the flexible mechanical arm 110, and the flexible mechanical arm 110 locates the osteotomy plane through the tool target 700 and moves to a predetermined position. Afterwards, the joint output end of the flexible mechanical arm 110 needs to be maintained in a fixed/desired position and posture, so as to maintain the osteotomy guide tool 600 in a fixed pose/desired position and posture. As a result, the doctor can use the pendulum saw 800 to perform an osteotomy operation through the guide slot on the osteotomy guide tool 600, and use an electric drill to perform a drill operation through the guide hole on the osteotomy guide tool 600.
After the osteotomy and drilling operations, doctors can install prostheses and perform other procedures.
In knee arthroplasty, the doctor will apply a certain force to the osteotomy guide tool when performing osteotomy or drilling operation, and the magnitude of the force may be changed as needed. The load on the joint output end includes the osteotomy guide tool 600 and the first force applied by the doctor to the osteotomy guide tool. In addition, the second force applied by the doctor to other parts of the flexible mechanical arm 110 also constitutes a part of the load on the joint output end after being transmitted to the joint output end. When the first force or the second force changes, the joints of the flexible mechanical arm 110 are stressed and will have a certain angular displacement, which will affect the position and posture of the joint output end, thereby affecting the position and posture of the tail end of the flexible mechanical arm 110 or of the osteotomy guide tool 600. At this time, the flexible mechanical arm control method is used to control the flexible mechanical arm to offset changes in the position and posture of the tail end of the flexible mechanical arm or of the osteotomy guide tool resulting from the angular displacement caused from the changes in the load on the joint output end, so that the joint output end can be maintained in the fixed position and posture, thereby ensuring that the tail end of the flexible mechanical arm or the osteotomy guide tool is maintained in the fixed/desired position and posture.
Here, specific embodiments are used to illustrate the specific implementation of obtaining the total amount of angular displacement of the joint output end in the flexible robotic arm control method when the sensing device of the robot system has different configurations.
Please refer to
When the load on the joint output end changes, the rigid components on the flexible mechanical arm, such as the rotating shaft of the driving mechanism 20, will have angular displacements along the first direction, and the angular displacements will be transmitted to the output interface 111 and sensed by the first angle sensor 31. That is to say, the first angular displacement of the output interface 111 sensed by the first angle sensor 31 is the total amount of angular displacement of the joint output end, and the first angular displacement is directly sensed by the first angle sensor 31.
Please refer to
Similar to Embodiment 1, when the load on the joint output end changes, the rigid components on the flexible mechanical arm, such as the rotating shaft of the driving mechanism 20, will have angular displacements along the first direction, and the angular displacements will be transmitted to the output interface 111 and sensed by the first angle sensor 31.
Therefore, as shown in
In Step S130, the elastic constant is obtained as shown in
In this way, when the load on the joint output end changes, the second angular displacement of the torque sensor 32 is the product of the torque of the joint measured by the torque sensor 32 and the elastic constant.
Those skilled in the art can understand that the calibrated angle sensor is installed on the torque sensor 32 and is only used to obtain the elastic constant. After the elastic constant is calculated, the calibrated angle sensor can be removed. In addition, the elastic constant can be measured outside the robot system (that is, the torque sensor can be detached from the flexible mechanical arm to measure the elastic constant), and the elastic constant can also be directly measured on the flexible mechanical arm.
In this embodiment, as shown in
In Step S112′, the first position and posture of the joint output end is obtained using the robot kinematics before the predetermined change occurs, then the second position and posture of the joint output end is obtained using the robot kinematics when the predetermined change occurs, and the total amount of angular displacement of the joint output end in response to the predetermined change occurring in the load can be obtained according to the difference between the first position and posture and the second position and posture.
In this embodiment, the flexible mechanical arm is only provided with a torque sensor 32 and no first angle sensor 31 is provided, and the method of obtaining the total amount of angular displacement of the joint output end in this embodiment is the same as that of Embodiment 3, that is, before the load changes, the conversion relationship between the reading variation of the torque sensor 32 and the total amount of angular displacement of the joint output end is first established, and then, when the load changes, the total amount of angular displacement is obtained according to the reading variation of the torque sensor 32 and the conversion relationship.
In this example, the flexible mechanical arm is provided with a first angle sensor 31 and a torque sensor 32. The input end of the torque sensor 32 is connected to the output interface 111 of the joint, and the output end of the torque sensor 32 is connected to the input end of the first angle sensor 31. In this way, the angular displacement measured by the first angle sensor 31 includes the first angular displacement of the output interface and the second angular displacement of the torque sensor. That is to say, the total amount of angular displacement can be obtained directly by the reading variation of the first angle sensor.
Although the present invention is disclosed above, it is not limited thereto. Those skilled in the art can make various changes and modifications to the present invention without departing from the spirit and scope of the present invention. Thus, if these modifications and variations of the present invention fall within the scope of the claims of the present invention and their equivalences, the present invention also intends to include these modifications and variations.
Number | Date | Country | Kind |
---|---|---|---|
202011024129.8 | Sep 2020 | CN | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/CN2021/108600 | 7/27/2021 | WO |