HYBRID MASTER-SLAVE MAPPING METHOD, ROBOTIC ARM SYSTEM, AND COMPUTER DEVICE

Information

  • Patent Application
  • 20240042593
  • Publication Number
    20240042593
  • Date Filed
    December 30, 2020
    3 years ago
  • Date Published
    February 08, 2024
    9 months ago
Abstract
A hybrid master-slave mapping method includes the following steps: acquiring a current position and a target position of an end point of a robotic arm; decomposing a displacement from the current position to the target position into a vertical direction and a horizontal plane to obtain a vertical displacement position and a horizontal displacement position; determining a first control amount of a multi-degree-of-freedom parallel platform according to the vertical displacement position, and determining a second control amount of a passive arm according to the horizontal displacement position; controlling the multi-degree-of-freedom parallel platform according to the first control amount, and controlling the passive arm according to the second control amount.
Description
TECHNICAL FIELD

The present disclosure relates to a control field, and more specifically, to a hybrid master-slave mapping method, a robotic arm system and a computer device.


BACKGROUND ART

At present, surgical robots with multi-degree-of-freedom parallel platforms and passive arms are applied to various surgical procedures. The end of the passive arm of this surgical robot is equipped with a multi-degree-of-freedom parallel platform, and the position and posture control of a surgical instrument are realized by disposing the surgical instrument on a movable platform of the multi-degree-of-freedom parallel platform. However, on one hand, although the movement range of the passive arm is relatively large, all joints of the passive arm are locked during the surgery due to the large volume and weight of the passive arm to prevent a patient from being injured by the passive arm during the surgery; and on the other hand, since the working space of the multi-degree-of-freedom parallel platform is relatively small, the surgical robot cannot move in a large range over a patient's body surface depending on the movement of the parallel platform alone. Therefore, the intraoperative movement range of the surgical robot is small, and no effective solution has been proposed so far.


SUMMARY

According to various embodiments of the present disclosure, a hybrid master-slave mapping method is provided and includes the following steps: acquiring a current position and a target position of an end point of a robotic arm, the robotic arm including a passive arm and a multi-degree-of-freedom parallel platform equipped on an end of the passive arm; decomposing a displacement from the current position to the target position into a vertical direction and a horizontal plane, respectively, to obtain a vertical displacement position and a horizontal displacement position; determining a first control amount of the multi-degree-of-freedom parallel platform according to the vertical displacement position, and determining a second control amount of the passive arm according to the horizontal displacement position; and controlling the multi-degree-of-freedom parallel platform according to the first control amount, and controlling the passive arm according to the second control amount.


According to various embodiments of the present disclosure, a robotic arm system is provided. The robotic arm system includes a computer device and a robotic arm including a passive arm and a multi-degree-of-freedom parallel platform equipped on an end of the passive arm, and the computer device is electrically connected to the passive arm and the multi-degree-of-freedom parallel platform, respectively, includes a processor and a storage medium in which a computer program is stored and is disposed to execute the hybrid master-slave mapping method provided by the embodiments of the present disclosure when run.


According to various embodiments of the present disclosure, a computer device is provided. The computer device includes a processor and a storage medium in which a computer program is stored and is disposed to execute the hybrid master-slave mapping method provided by the embodiments of the present disclosure when run.





BRIEF DESCRIPTION OF THE DRAWINGS

In order to better describe and explain those embodiments and/or examples of the disclosure disclosed herein, one or more figures may be provided for reference. Additional details or examples for describing figures should not be considered as limitations of a range of any one of the disclosed invention, currently described embodiments and/or examples and these best modes of the disclosure understood so far.



FIG. 1 is a structure block diagram of a robotic arm system provided by embodiments of the present disclosure.



FIG. 2 is a flow diagram of a hybrid master-slave mapping method provided by embodiments of the present disclosure.



FIG. 3 is a flow diagram of a coordinate conversion method of a passive arm with multiple joints of embodiments of the present disclosure.



FIG. 4 is a structure diagram of a robotic arm provided by optional embodiments of the present disclosure.



FIG. 5 is a diagram of a mechanical coordinate system and a joint coordinate system of a robotic arm provided by optional embodiments of the present disclosure.



FIG. 6 is a motion mapping diagram of a main manipulator and an end point of an ultrasonic probe in a user coordinate system provided by optional embodiments of the present disclosure.





DETAILED DESCRIPTION OF EXEMPLARY EMBODIMENTS

Below the hybrid master-slave mapping method, robotic arm system and computer device provided by the present disclosure will be further described.


The present embodiment provides a robotic arm system. FIG. 1 is a structure diagram of a robotic arm system provided by embodiments of the present disclosure. As shown in FIG. 1, the robotic arm system includes a computer device 101 and a robotic arm 102 including a passive arm 1021 and a multi-degree-of-freedom parallel platform 1022 equipped on an end of the passive arm 1021.


The passive arm 1021 may include a plurality of joints of which types include but are not limited to a moving joint and a rotating joint so as to ensure the passive arm 1021 to be able to move within a relatively large range. Respective joints of the passive arm 1021 all have locking devices which may lock postures of respective joints to keep a fixed displacement or rotating angles.


The passive arm 1021 may be manually pulled to move near a corresponding surgical position during a preoperative positioning. In the related technologies, respective joints of the passive arm 1021 will be locked before the surgery starts to prevent accidents such as patients being injured caused by falling of the passive arm 1021 during the surgery.


The difference from the related technologies is that not all joints of the passive arm 1021 will be locked in the present embodiment, but only a joint that enables an end point of the robotic arm to generate the displacement in a vertical direction is locked, and the joint that enables an end point of the robotic arm to generate the displacement in a vertical direction include but are not limited to at least one of: a moving joint with the displacement in a vertical direction, or a rotating joint rotating in a non-vertical direction.


Generally speaking, for the convenience of calculation, displacement directions or rotating axes of respective joints of the passive arm 1021 are all parallel to a certain coordinate axis in an orthogonal coordinate system. Taking an orthogonal coordinate system, in which the Z-axis is vertically upwards, the X-axis is horizontally to the right, the Y-axis is perpendicular to the plane in which X-axis and Z-axis lie, and the coordinate axis is disposed to follow the right-hand rule, as an example, in such a case, a moving joint with the displacement in the Z-axis direction and a rotating joint rotating around the X-axis or Y-axis direction are possible to enable the end point of the robotic arm to move vertically downwards, thereby causing potential safety hazard.


Still using the above coordinate axis as an example, if a certain moving joint is parallel to the X-axis or Y-axis, or a rotating axis of a certain rotating joint is parallel to the Z-axis, such a moving joint or rotating joint will not cause the end point of the robotic arm to move vertically downward, therefore, such a moving joint or rotating joint can ensure the safety of the surgical robot even if they are not locked. In addition to the above-mentioned moving joint and rotating joint, the moving joint and rotating joint disposed in other directions in the passive arm 1021 all should be locked during the surgery to ensure surgical safety.


The multi-degree-of-freedom parallel platform of the present embodiment may implement the movement of multiple degrees of freedom. Taking the Stewart parallel platform with six-degree-of-freedom as an example, the Stewart parallel platform includes a static platform, a movable platform and a plurality of telescopic components disposed between the static platform and the movable platform and may implement movements of six degrees of freedom in space, namely, the displacement along the X axis, the displacement along the Y axis, the displacement along the Z axis, rotation around the X axis, rotation around the Y axis and rotation around the Z axis. The Stewart parallel platform is supported by 6 telescopic components, which has higher stiffness and structural stability compared to the passive arm using a series connected cantilever beam structure. Moreover, since the stiffness is higher, the parallel structure has higher load-bearing capacity than the series structure under the same self weight or volume. The errors at the end of the passive arm using a series connected cantilever beam are the accumulation and amplification of various joint errors, resulting in large errors and low accuracy. However, the parallel platform does not have such error accumulation and amplification relationship, but has high micro motion accuracy, which is more appropriate to perform high-precision surgical operations. In addition, the inverse solution of the parallel platform is very easy in terms of position solution, and it is easy to obtain the motion postures of respective telescopic components of the parallel platform according to coordinate positions.


In the above robotic arm system, the computer device 101 is electrically connected to the passive arm 1021 and the multi-degree-of-freedom parallel platform 1022, respectively, and the computer device 101 includes a processor 1011 and a storage medium 1012 in which a computer program 10121 is stored and, when run by the processor, executes a control method of the robotic arm system.



FIG. 2 is a flow diagram of a hybrid master-slave mapping method provided by embodiments of the present disclosure. As shown in FIG. 2, the flow includes the following steps.

    • Step S201: acquiring a current position and a target position of an end point of a robotic arm, the robotic arm including a passive arm and a multi-degree-of-freedom parallel platform equipped on an end of the passive arm.
    • Step S202: decomposing the displacement from the current position to the target position into a vertical direction and a horizontal plane, respectively, to obtain a vertical displacement position and a horizontal displacement position.
    • Step S203: determining a first control amount of the multi-degree-of-freedom parallel platform according to the vertical displacement position, and determining a second control amount of the passive arm according to the horizontal displacement position.
    • Step S204: controlling the multi-degree-of-freedom parallel platform according to the first control amount, and controlling the passive arm according to the second control amount.


Compared to related technologies where all joints of a passive arm must be locked, only a joint that is able to generate the displacement in a vertical direction may be locked in present embodiments, which may be implemented by decomposing the displacement of an end point of the robotic arm into the vertical direction and the horizontal plane. Since the passive arm may move in a larger range within the horizontal plane, and the movement range is much larger than that of the multi-degree-of-freedom parallel platform within the horizontal plane, the movement range of the surgical robot is increased.


In the robotic arm system of the present embodiment, a master-slave mapping method may be adopted to control the passive arm and the multi-degree-of-freedom parallel platform. In some of the embodiments, the robotic arm system further includes a main manipulator; Compared to the related technologies where the main manipulator can only be used to control a multi-degree-of-freedom parallel platform, the difference lies in: in the present embodiment, the main manipulator implements joint control of the passive arm and the multi-degree-of-freedom parallel platform through hybrid mapping.


In some of the embodiments, in order to obtain a current position of the end point of the robotic arm, the end point of the robotic arm may be recorded as the current position at the moment when the main manipulator starts to be operated.


In some of the embodiments, an initial position of the main manipulator is initialized at the moment when the main manipulator starts to be operated, that is, the position where the main manipulator starts to be operated is set to be an initial position. After the main manipulator is operated, the position of the main manipulator is moved to a new position, and this new position is called as a current position of the main manipulator. And a displacement of the main manipulator during the surgery process may be determined according to the initial position of the main manipulator to the current position of the main manipulator, and the displacement will be mapped to the displacement of the robotic arm, so that the end point of the robotic arm is enabled to move from the current position to the target position according to the displacement of the robotic arm determined by the displacement of the main manipulator.


The relationship between the displacement of the main manipulator and the displacement of the end point of the robotic arm is determined according to a preset displacement scale coefficient in the present embodiment. The preset displacement scale coefficient is adjustable. For example, in the case where the preset displacement scale coefficient is less than 1, a displacement value of the main manipulator is greater than a displacement value of the end point of the robotic arm. Thus, in the case where a high-precision surgery is required, the preset displacement scale coefficient may be disposed to be a value less than 1. In the case where the preset displacement scale coefficient is greater than 1, a displacement value of the main manipulator is less than a displacement value of the end point of the robotic arm. Thus, in the case where the end point of the robotic arm is required to move in a larger range, the preset displacement scale coefficient may be disposed to be a value greater than 1 to improve operating experience.


In addition, the first control amount of the multi-degree-of-freedom parallel platform is obtained by inverse solution of a vertical displacement position obtained by decomposing the target position of the end point of the robotic arm in the vertical direction in the above embodiment. Since the inverse solution calculation of the multi-degree-of-freedom parallel platform is very easy, the above manner can reduce the calculation amount and improve control efficiency of the robotic arm.


In some of the embodiments, the determining a second control amount of the passive arm according to the horizontal displacement position includes: determining at least one target moving joint that generates the displacement within a horizontal plane and at least one target rotating joint that rotates around a vertical direction among the plurality of joints; and determining a second control amount of the passive arm according to the horizontal displacement position, in which the second control amount includes a movement amount of the target moving joint and a rotating amount of the target rotating joint.


The inverse solution calculation is more complex than the forward solution calculation in the passive arm using a series structure. In order to reduce the calculation complexity, it is possible to select as few target moving joints and target rotating joints as possible while meeting the requirements of the movement range in some of the embodiments, and ensure that all joints except for the selected target moving joints and target rotating joints are locked. After the other joints are locked, the coordinate conversion relationship between the other joints is fixed, then the unknown coordinate conversion relationship in the inverse solution calculation of the passive arm with a series structure only involves the coordinate conversion relationship between the selected target moving joints and target rotating joints, which greatly reduces calculation complexity.


In some embodiments, the number of the selected target moving joints is 1, and the number of the selected target rotating joint is also 1. The selected one target moving joint may be the moving joint which can move in the maximum range among the moving joints moving in a horizontal plane in the passive arm, thereby ensuring the maximum movement range.


The inverse solution of the passive arm with a series structure may be multiple. In some of the embodiments, in the case where the second control amount of the passive arm is determined according to the horizontal displacement position, after obtaining the control amount of the passive arm according to the inverse solution of the horizontal displacement position, if the control amount of the passive arm obtained from the inverse solution is multiple sets of results, the set of results in which the angle at which the target rotating joint needs to rotate is the smallest is determined as the second control amount; and if the control amount of the passive arm obtained by inverse solution is one set of results, such a set of results is determined to be the second control amount.


Below the present disclosure is described and explained through optional embodiments.


In response to the complex control problem of the passive arm in the related technologies, the present embodiment provides a method for establishing and converting a coordinate system of a passive arm, which is applied to a passive arm including rotating joints and moving joints, and these rotating joints and moving joints are connected in series in order. In order to implement the motion of a passive arm with multiple degrees of freedom in space, the number of rotating joints and moving joints may be set according to the required degree of freedom and movement range, that is, the number of rotating joints and the number of moving joints may be one or more, respectively.



FIG. 3 is a flow diagram of a coordinate conversion method of a passive arm with multiple joints of embodiments of the present disclosure. As shown in FIG. 3, the flow includes the following steps S301 to S303.

    • Step S301: in the case where the passive arm is in an initial state, establishing a mechanical coordinate system of the passive arm and joint coordinate systems of respective joints of the passive arm.


The control of the passive arm is generally converting coordinate systems based on DH parameters. Two connected joints are adjacent joints. The transformation of the joint coordinate systems of two adjacent joints is generally represented by DH parameters or improved DH parameters. Taking the DH parameters as an example, two adjacent joint coordinate systems can coincide with each other by rotating θ around the Z-axis and translating d, and then rotating α around the X-axis and translating a. The above θ, d, α and a are DH parameters. Accordingly, if the DH parameters are more concise, the conversion of two adjacent joint coordinate systems is simpler.


In order to simplify the DH parameters, in the present embodiment, the Z-axis of the joint coordinate system of the rotating joint is disposed along a rotating axis, and the Z-axis of the joint coordinate system of the moving joint is disposed along a moving direction. The mechanical coordinate system and the joint coordinate systems of respective joints are all left-hand or right-hand systems. Moreover, when the joint before the rotating joint is a moving joint, the origin of the joint coordinate system of the rotating joint coincides with the origin of the joint coordinate system of the moving joint.


The above-mentioned mechanical coordinate system may also be called as a global coordinate system, a reference coordinate system or a world coordinate system. The mechanical coordinate system is generally disposed at the center of the base of the passive arm and is located directly below a first joint of the passive arm, such that the conversion relationship between the mechanical coordinate system and the first joint is as simple as possible.


In a multi-joint passive arm, in most cases, in response to the rotating joint receives a command with a rotating angle of 0 or 2π, it may not be necessary to distinguish them, but rather to maintain not rotating or rotate 2πin a set direction according to predetermined settings. However, in some cases, it is necessary to distinguish these two rotating angles. In the case where it is necessary to distinguish rotating angles of 0 and 2π, the rotating angle of the Z-axis in the DH parameters of the rotating joint is not 0 or 2π to avoid confusion between the positions of 0 and 2π.

    • Step S302: acquiring DH parameters of the mechanical coordinate system of the passive arm and joint coordinate systems of respective joints of the passive arm, and determining a conversion relationship between the mechanical coordinate system of the passive arm and the joint coordinate system of an end joint of the passive arm according to the DH parameters.


After establishing the joint coordinate systems of respective joints, the DH parameters between the adjacent joints may be obtained in order, and a conversion relationship between the mechanical coordinate system of the passive arm and the joint coordinate system of the end joint of the passive arm is determined according to the DH parameters.


According to the DH rule therein, the homogeneous transformation from the coordinate of the (i-1)th joint to the coordinate of the i-th joint is constructed as a sequence with two rotations and two transformations, and the adopted matrix may be represented as follows:









i

i
-
1


T

=


[




cos


θ
i






-
sin



θ
i




0



a

i
-
1







sin


θ
i

×
cos


α

i
-
1






cos


θ
i

×
cos


α

i
-
1







-
sin



α

i
-
1







-

d
i


×
sin


α

i
-
1








sin


α

i
-
1


×
sin


θ
i





sin


α

i
-
1


×
cos


θ
i





cos


α

i
-
1







d
i

×
cos


α

i
-
1







0


0


0


1



]

.





where i=2, 3, 4, . . . , n; n is a total number of the rotating joints and the moving joints of the passive arm. The DH parameter of the first joint of the passive arm represents a conversion between the coordinate system of the first joint and the mechanical coordinate system, which is recorded as 10T, and the conversion relationship between the mechanical coordinate system and the joint coordinate system of the first joint is:









1
0

T

=


[




cos


θ
1






-
sin



θ
1




0


0





sin


θ
1

×
cos


α
0





cos


θ
1

×
cos


α
0






-
sin



α
0






-

d
1


×
sin


α
0







sin


α
0

×
sin


θ
1





sin


α
0

×
cos


θ
1





cos


α
0






d
1

×
cos


α
0






0


0


0


1



]

.





Accordingly, the transformation relationship is totally the same as the homogeneous transformation manner from the coordinate of the (i−1)th joint to the coordinate of the i-th joint.


After obtaining 10T and ii−1T, the conversion matrix from the 0th coordinate system (the mechanical coordinate system) to the joint coordinate system of the N-th joint may be represented as:






N
0
T=
1
0

2
1
T . . .
N−1
N−2

N
N−1
T.


where the N-th joint is an end joint.

    • Step S303: performing coordinate conversion between the mechanical coordinate system and the joint coordinate system of the end joint according to the conversion relationship.


The N0T determined in the above step S302 represents the coordinate conversion relationship between the mechanical coordinate system and the joint coordinate system of the end joint, and coordinate conversion between the mechanical coordinate system and the joint coordinate system of the end joint may be implemented according to the conversion relationship.



FIG. 4 is a structure diagram of a robotic arm provided by optional embodiments of the present disclosure. The robotic arm shown in FIG. 4 includes a passive arm and a multi-degree-of-freedom parallel platform in order, and the passive arm includes: moving joint 1, rotating joint 2, moving joint 3, rotating joint 4, rotating joint 5, moving joint 6, rotating joint 7, moving joint 8, rotating joint 9 and moving joint 10. The multi-degree-of-freedom parallel platform is fixed to an end of a joint arm of the moving joint 10. The robotic arm further includes a base 11 fixed to the moving joint 1.


The coordinate conversion method of the robotic arm of the optional embodiment includes step 1 to step 3, which correspond to step S301 to step S303 in FIG. 3, respectively.

    • Step 1: establishing a mechanical coordinate system and joint coordinate systems of respective joints at a base of the passive arm according to a rule of a world coordinate system.



FIG. 5 is a diagram of a mechanical coordinate system and a joint coordinate system of a robotic arm provided by optional embodiments of the present disclosure.


Referring to FIG. 5, a coordinate system origin F0 of the mechanical coordinate system F0-X0Y0Z0 is fixed to the base of the passive arm, the Z0-axis points towards the moving joint 1 from F0, the Y0-axis points towards the passive arm from the base F0 point, and the pointed direction of the X0-axis meets the right-hand coordinate system.


The origin L1 of the joint coordinate system L0-X1Y1Z1 of the moving joint 1 is fixed to the moving joint 1, and the pointed directions of respective coordinate axes are the same as that of the corresponding axis of the mechanical coordinate system.


The origin R2 of the joint coordinate system R2-X2Y2Z2 of the rotating joint 2 is fixed to the rotating joint 2 and coincides with L1, the pointed direction of the Z2-axis is the same as that of the Z1-axis, and the pointed directions of the X2-axis and the Y2-axis are contrary to those of the X1-axis and the Y1-axis, respectively.


The origin L3 of the joint coordinate system L3-X3Y3Z3 of the moving joint 3 is fixed to the moving joint 3, the Z3 axis points towards L3 point from L1 point, and the pointed directions of the X3-axis and the Y3-axis are the same as those of the X2-axis and the Z2-axis, respectively.


The origin R4 of the joint coordinate system R4-X4Y4Z4 of the rotating joint 4 is fixed to the rotating joint 4 and coincides with L3 point (L3 and R4 are separately marked in order to clearly mark the joint coordinate system of the moving joint 3 an the joint coordinate system of the rotating joint 4 in FIG. 5, the same below), the pointed direction of the Z4-axis is contrary to that of the Y3-axis, and initially, the pointed directions of the X4-axis and Y4-axis are contrary to those of the X3-axis and Z3-axis, respectively.


The origin R5 of the joint coordinate system R5-X5Y5Z5 of the rotating joint 5 is fixed to the rotating joint 5, the pointed direction of the Z5-axis is the same as that of the Z4-axis, and initially, the pointed directions of the X5-axis and Y5-axis are contrary to those of the X4-axis and Y4-axis, respectively.


The origin L6 of the joint coordinate system L6-X6Y6Z6 of the moving joint 6 is fixed to the moving joint 6, the Z6-axis points towards L6 point from R5 point, and the pointed directions of the X6-axis and the Y6-axis are the same as those of the X5-axis and the Z5-axis, respectively.


The origin R7 of the joint coordinate system R7-X7Y7Z7 of the rotating joint 7 is fixed to the rotating joint 7 and coincides with L6 point, initially, the pointed directions of the Z7-axis and the Y7-axis are contrary to those of the Y6-axis and the X6-axis, respectively, and the pointed direction of the X7-axis is the same as that of the Z6-axis.


The origin L8 of the joint coordinate system L8-X8Y8Z8 of the moving joint 8 is fixed to the moving joint 8, the Z8-axis points towards R7 point from L8 point, and the pointed directions of the X8-axis and the Y8-axis are the same as those of the X7-axis and the Y7-axis, respectively.


The origin R9 of the joint coordinate system R9-X9Y9Z9 of the rotating joint 9 is fixed to the rotating joint 9 and coincides with L8 point, the direction of the Z9-axis is contrary to that of the Y8-axis, initially, the direction of the X9-axis is contrary to that of the Z8-axis, and the direction of the Y9-axis is the same as that of the X8-axis.


The origin L10 of the joint coordinate system L10-X10Y10Z10 of the moving joint 10 is fixed to the moving joint 10, the Z10-axis points towards L10 point from R9 point, and the pointed directions of the X10-axis and the Y10-axis are the same as those of the X9-axis and the Z9-axis, respectively.


The length of F0R2 is l1, the length of R2R4 is l2, the length of R4R5 is l3, the length of R5R7 is l4, the length of R7R9 is l5, the length of R9L10 is l6, an points L1, R2, L3, R4, R5, L6 and R7 are located on the same horizontal plane.

    • Step 2: acquiring DH parameters, and calculating a conversion relationship between the mechanical coordinate system and the end point of the multi-joint passive arm, and the DH parameters may be traditional DH parameters or improved DH parameters.


DH parameters are illustrated in Table 1.









TABLE 1







DH Parameter Table of Multi-joint Passive Arm Shown in FIG. 5









Item No.



















0
1
2
3
4
5
6
7
8
9
10





Z-axis

d1
0
d3
0
0
d6
0
d8
0
d10


translates di
















Z-axis rotates θi

0
π + θ2
0
π + θ4
π + θ5
0





π
2

+

θ
7





0





-

π
2


+

θ
9





0





X-axis rotates αi

0
0




π
2








π
2




0




π
2








π
2




0




π
2








π
2









X-axis

0
0
0
0
a4
0
0
0
0
0


translates ai









A parallel platform may be further equipped on the end joint of the multi-joint robotic arm as shown in FIG. 4, the parallel platform includes a static platform, a movable platform and a plurality of telescopic components disposed between the static platform and the movable platform, the calculation coordinate system of the parallel platform totally coincides with the joint coordinate system of the end joint of the multi-joint robotic arm, and an ultrasonic detection device is disposed on the movable platform.


The parallel platform of the present embodiment may implement the movement of multiple degrees of freedom. Taking the Stewart parallel platform with six-degree-of-freedom as an example, the Stewart parallel platform includes a static platform, a movable platform and a plurality of telescopic components disposed between the static platform and the movable platform and may implement movements of six degrees of freedom in space, namely, the displacement along the X axis, the displacement along the Y axis, the displacement along the Z axis, rotation around the X axis, rotation around the Y axis and rotation around the Z axis. The Stewart parallel platform is supported by 6 telescopic components, which has higher stiffness and structural stability compared to the passive arm using a series connected cantilever beam structure. Moreover, since the stiffness is higher, the parallel structure has higher load-bearing capacity than the series structure under the same self weight or volume. The errors at the end of the passive arm using a series connected cantilever beam are the accumulation and amplification of various joint errors, resulting in large errors and low accuracy. However, the parallel platform does not have such error accumulation and amplification relationship, but has high micro motion accuracy, which is more appropriate to perform high-precision surgical operations. In addition, the inverse solution of the parallel platform is very easy in terms of position solution, and it is easy to obtain the motion postures of respective telescopic components of the parallel platform according to coordinate positions.


It is precisely based on the characteristic of easy inverse solution of parallel platforms, in the above embodiments, the position information of the target position in the calculation coordinate system may be obtained by establishing a slave user coordinate system on the static platform, mapping the displacement amount of the main operator to the slave user coordinate system, and then converting between the slave user coordinate system and the calculation coordinate system. According to the position information, the motion posture of respective telescopic components of the parallel platform can be easily obtained by inverse solution. Compared to the position information of the end of the parallel platform solved by forward kinematics in related technologies, the above method greatly reduces the calculation complexity, improves the control efficiency and saves calculation resources.


To solve the conversion matrix from the Stewart calculation coordinate system to the mechanical coordinate system is to move the conversion matrix and the inverse matrix from the joint coordinate system L10-X10Y10Z10 to the mechanical coordinate system F0-X0Y0Z0.


According to the forward kinematics of robot, the conversion matrix between two adjacent joints may be known as:







T
i

=


[




cos


θ
i






-
sin



θ
i




0



a

i
-
1







sin


θ
i

×
cos


α

i
-
1






cos


θ
i

×
cos


α

i
-
1







-
sin



α

i
-
1







-

d
i


×
sin


α

i
-
1








sin


α

i
-
1


×
sin


θ
i





sin


α

i
-
1


×
cos


θ
i





cos


α

i
-
1







d
i

×
cos


α

i
-
1







0


0


0


1



]

.





The conversion matrix from the m-th joint (including a degree of freedom of the m-th joint) to the n-th joint may be represented as:






n
m
T=
m+1
m

m+2
m+1
T . . .
n−1
n−2

n
n−1
T.


A conversion matrix 100T of a single passive arm from the base to the static platform of the Stewart platform may be solved, that is, a conversion matrix from the mechanical coordinate system to the Stewart calculation coordinate system is named as Ttrans_mach_st, and a conversion matrix from the Stewart calculation coordinate system to the mechanical coordinate system is the inverse matrix Ttrans_mach_st−1.

    • Step 3: performing coordinate conversion between the mechanical coordinate system and the Stewart calculation coordinate system according to the conversion matrix and the inverse matrix of the conversion matrix.


In the robotic arm system using master-slave control, a user coordinate system may be further established on the robotic arm in order to simplify the motion mapping of the master-slave control.


In the case where the robotic arm is a single arm, the coordinate conversion method of the robotic arm as shown in FIG. 3 may further include the following steps.

    • Step 1: establishing a user coordinate system, in which an XY coordinate plane of the user coordinate system is parallel to an XY plane of the mechanical coordinate system, and the origin of the user coordinate system coincides with the origin of the joint coordinate system of the end joint.
    • Step 2: acquiring a visual angle value input by the user and determining a conversion relationship between the user coordinate system and the mechanical coordinate system according to the visual angle value and the conversion relationship between the mechanical coordinate system and the joint coordinate system of the end joint.


The angle that the XY coordinate plane of the user coordinate system established in step 2 rotates around the Z-axis is the visual angle value. The visual angle value is voluntarily input by the user according to a visual angle during the work with a single arm, and is named as θtheta_mach_user. According to the definition manner of the user coordinate, a conversion matrix of the user coordinate system with respect to the mechanical coordinate system may be obtained:







T

trans

_

mach

_

user


=


[




cos

(

θ

theta

_

mach

_

user


)




-

sin

(

θ

theta

_

mach

_

user


)




0






10
0

T



(

1
,
4

)







sin


(

θ

theta

_

mach

_

user


)





cos


(

θ

theta

_

mach

_

user


)




0






10
0

T



(

2
,
4

)






0


0


0






10
0

T



(

3
,
4

)






0


0


0


1



]

.





where 100T(1,4) represents data in line 1 and column 4 of the above 100T.


Below the hybrid master-slave mapping method of the present optional embodiment is explained by taking equipping an ultrasonic detection device on a movable platform of the multi-degree-of-freedom parallel platform as an example. Since the ultrasonic detection device needs to move in a wide range over a patient's body surface to obtain comprehensive images, hybrid mapping of the robotic arm may be implemented using the control method of the robotic arm system of the present optional embodiment, and moving in a wide range can be realized.


In the present optional embodiment, an end point of the ultrasonic detection device is located on the axis of the movable platform of the multi-degree-of-freedom parallel platform.


Manipulating an ultrasonic probe requires a wide movement range over a patient's body surface during clinical application, that is, in the XY plane of the mechanical coordinate system, while the direction perpendicular to the patient's body surface does not require a wide movement range, that is, in the Z-axis direction of the mechanical coordinate system. Since the volume of the passive arm is relatively large and the weight of the passive arm is heavy, the moving joints along the Z-axis direction and the rotating joints around the X-axis and Y-axis directions must be locked during the surgery to ensure surgery safety. Thus, the movement of the main manipulator along the Z-axis direction of the mechanical coordinate system (the Z-axis of the mechanical coordinate system is parallel to the Z-axis of the user coordinate system according to a user coordinate system establishment guideline) is mapped to the Stewart parallel platform to be finished, and the movement of the main manipulator in the XY plane of the mechanical coordinate system (the XY plane of the mechanical coordinate system is parallel to the XY plane of the user coordinate system according to a user coordinate system establishment guideline) is mapped to one rotating joint and one moving joint of the passive arm.


The hybrid mapping method of the present optional embodiment includes the following steps.

    • Step 1: selecting one moving joint d6 and one rotating joint θ5 around the Z-axis of the passive arm in the XY plane of the mechanical coordinate system as two control objects in the series part of the hybrid control. The Stewart parallel platform is used as a control object of the parallel part.
    • Step 2: the surgical operation period from the moment when the operator holds the main manipulator to start the surgical operation to the moment when the hand leaves the main manipulator and stops is considered as a work cycle T.
    • Step 3: the moment when the operator holds the main manipulator to start the


surgical operation is time T(0), and the position coordinate of the main manipulator at the moment is set to be an origin M0 (0, 0, 0); and the position coordinate of the instrument end point at the moment in the user coordinate system is S0 (X0, Y0, Z0), and the system will calculate and save S0 (X0, Y0, Z0) as a known value recorded as Ccoord_now_user.

    • Step 4: the position coordinate of the main manipulator is set to be Mt (Xmt, Ymt, Zmt) at any time t within the work cycle, recorded as Ccoord_offset_mas:





Ccoord_offset_mas=[cxcoord_offset_mas cycoord_offset_mas czcoord_offset_mas].


The position coordinate St (Xt, Yt, Zt) of the motion target point of the instrument end point in the user coordinate system may be obtained through Mt (Xmt, Ymt, Zmt) by the displacement scaling-up coefficient K1:






X
t
=X
0
+K
1
*X
mt;






Y
t
=Y
0
+K
1
*Y
mt;






Z
t
=Z
0
+K
1
*Z
mt.


The position coordinate of the instrument end point in the user coordinate system based on time T(0) is S0 (X0, Y0, Z0), and the main manipulator will transmit the current coordinate Mt (Xmt, Ymt, Zmt) to solve the coordinate St (Xt, Yt, Zt) of the instrument end point at the moment in the user coordinate system during each motion execution cycle, recorded as Ccoord_new_user:






C
coord_new_user
=C
coord_now_user
+K
0
×C
coord_offset_mas




    • Step 5: decomposing the motion of the main manipulator in the user coordinate system into the displacement in the Z-axis direction and the displacement in the XY plane, and the motion decomposition point S′ (X0, Y0, Z0) from the initial point S0 (X0, Y0, Z0) to the target point St (Xt, Yt, Zt) is recorded as Ccoord_znew_user:








Ccoord_znew_user=[Ccoord_now_user(1) Ccoord_now_user(2) Ccoord_new_user(3) 1]T.

    • Step 6: converting the coordinate of the motion decomposition point S′ (X0, Y0, Z0) in the user coordinate system to the Stewart calculation coordinate system through a conversion matrix from the user coordinate system to the Steward calculation coordinate system, recorded as Ccoord_znew_st:






C
coord_znew_st
=T
trans_st_user
·C
coord_znew_user.


where Ttrans_st_user is the conversion matrix from the user coordinate system to the Steward calculation coordinate system.

    • Step 7: given the coordinate of the instrument end point in the Stewart calculation coordinate system, solving the motion amounts of respective joints in the platform through the inverse kinematics of the Stewart platform and finishing the motion mapping from the motion of the main manipulator in the Z-axis direction of the mechanical coordinate to the Stewart parallel platform.
    • Step 8: next, solving the motion mapping from the motion of the main manipulator in the XY plane of the mechanical coordinate to the passive arm; since the motion of the passive arm does not affect the coordinate of the end point of the ultrasonic probe in the Stewart calculation coordinate system, after one motion execution cycle, the coordinate of the end point of the ultrasonic probe in the Stewart calculation coordinate system is still Ccoord_znew_st, while the coordinate in the user coordinate system is changed to Ccoord_new_user, the coordinate transformation formula may be obtained:






C
coord_new_user
=T
trans_user_mach·4065107T·Ccoord_znew_st.


where Ttrans_user_mach is the conversion matrix from the mechanical coordinate system to the user coordinate system.


where iiT represents a conversion matrix from the j-th joint to the i-th joint on the passive arm.


The above formula is transformed to:






4
0
T
−1
t
trans_user_mach
−1
C
coord_new_user=6t(107T·Ccoord_znew_st).


Since other motion joints of the passive arm are all locked except that two motion amounts of θ5 and d6 are involved in the hybrid control, the motion amounts of the other joints are all determined, and conversion matrices between joints are also known, thus, the left side of the equation is a known quantity, which is replaced with [x2,y2,z2,1]T: the coordinate Ccoord_znew_st of the end point of the ultrasonic probe in the Stewart calculation coordinate system has been solved in the last step, and is not changed due to the motion of the passive arm, thus, the right side of the equation 107T·Ccoord_znew_st is also a known quantity, which is replaced with [x1,y1,z1,1]T.


Furthermore, the above equation may be simplified into the following form by incorporating the DH parameters of the joints 5 and 6 into the conversion matrix 65T:







[




x
2






y
2






z
2





1



]

=


[




cos

(


θ
5

+
π

)



0



sin

(


θ
5

+
π

)






d
6

·

sin

(


θ
5

+
π

)


+

a
4







sin

(


θ
5

+
π

)



0



-

cos

(


θ
5

+
π

)






-

d
6


·

cos

(


θ
5

+
π

)






0


1


0


0




0


0


0


1



]

·


[




x
2






y
2






z
2





1



]

.






The equation is solved to obtain:





θ5=atan2(a4−x2, y2)−atan2(x1,±√{square root over ((a4−x2)2+y22−x12))}.


Regarding the situation where inverse solutions are multiple in the last step, the principle of proximity is adopted, the closest value is selected as the final solution, by subtracting the initial value of θ5 with two solutions, respectively, and taking absolute values, and taking the solution with the smaller absolute value, so that the rotating joint of the passive arm can rotate by the minimum angle to reach the target point.


In the case where θ5 is known, the moving joint d6 may be obtained:







d
6

=






x
1

·
sin



θ
5


+

y
2



cos


θ
5



-


z
1

.






So far, the motion mapping from the motion of the main manipulator in the XY plane of the mechanical coordinate to the passive arm is finished.


The motion mapping diagram of the main manipulator and the end point of the ultrasonic probe in the user coordinate system is illustrated in FIG. 6, in which the motion of the probe from S0 to S′ is implemented through the motion of the Stewart platform, and the motion from S′ to St is implemented by the motions of the rotating joint and the moving joint of the passive arm. It is worth noting that S′ is the hypothetical reference point that decomposes the motion of the probe in the Z-axis direction and the motion in the XY plane, but is not the trajectory point of the probe in actual work.


A computer device is further provided in the present embodiment and includes a storage medium in which a computer program is stored and a processor which is disposed to execute the computer program to execute steps in the above any one method embodiment.


Alternatively, the above computer device may further include a transmission device and an input and output device, wherein the transmission device is connected to the above processor, and the input and output device is connected to the above processor.


Alternatively, the above processor may be disposed to execute the following steps through the computer program in the present embodiment.

    • S1: acquiring a current position and a target position of an end point of a robotic arm, the robotic arm including a passive arm and a multi-degree-of-freedom parallel platform equipped on an end of the passive arm.
    • S2: decomposing the displacement from the current position to the target position into a vertical direction and a horizontal plane, respectively, to obtain vertical and horizontal displacement positions.
    • S3: determining a first control amount of the multi-degree-of-freedom parallel platform according to the vertical displacement position, and determining a second control amount of the passive arm according to the horizontal displacement position.
    • S4: controlling the multi-degree-of-freedom parallel platform according to the first control amount, and controlling the passive arm according to the second control amount.


It should be noted that for the specific example in the present embodiment, the examples described in the above embodiments and optional embodiments may be provided for reference, and will not be described again in the present embodiment.


According to various embodiments of the present disclosure, a hybrid master-slave mapping method is provided and includes the following steps: acquiring a current position and a target position of an end point of a robotic arm, the robotic arm including a passive arm and a multi-degree-of-freedom parallel platform equipped on an end of the passive arm; decomposing a displacement from the current position to the target position into a vertical direction and a horizontal plane, respectively, to obtain a vertical displacement position and a horizontal displacement position; determining a first control amount of the multi-degree-of-freedom parallel platform according to the vertical displacement position, and determining a second control amount of the passive arm according to the horizontal displacement position; and controlling the multi-degree-of-freedom parallel platform according to the first control amount, and controlling the passive arm according to the second control amount.


The above hybrid master-slave mapping method has following advantages: compared to related technologies where all joints of a passive arm must be locked, only a joint that is able to generate the displacement in a vertical direction may be locked in present embodiments, which may be implemented by decomposing the displacement of an end point of the robotic arm into the vertical direction and the horizontal plane. Since the passive arm may move in a larger range within the horizontal plane, and the movement range is much larger than that of the multi-degree-of-freedom parallel platform within the horizontal plane, the movement range of the surgical robot is increased, the problem of the small intraoperative movement range of the surgical robot in the related technologies is solved, and the movement range of the surgical robot is improved.


In some of the embodiments, the robotic arm is controlled by a main manipulator; and the acquiring a current position of an end point of the robotic arm includes: recording a position of the end point of the robotic arm as the current position at the moment when the main manipulator starts to be operated.


In some of the embodiments, the robotic arm is controlled by a main manipulator; and the acquiring a target position of an end point of the robotic arm includes: initializing an initial position of the main manipulator at the moment when the main manipulator starts to be operated; after the main manipulator is operated, determining a current position of the main manipulator and determining a displacement of the main manipulator according to the current position and the initial position of the main manipulator; and converting the displacement of the main manipulator into a target displacement of the robotic arm according to a preset displacement scale coefficient and determining the target position according to the target displacement and the current position of the end point of the robotic arm.


In some of the embodiments, the preset displacement scale coefficient is adjustable.


In some of the embodiments, the passive arm includes a plurality of joints; the determining a second control amount of the passive arm according to the horizontal displacement position includes: determining at least one target moving joint that generates the displacement within a horizontal plane and at least one target rotating joint that rotates around a vertical direction among the plurality of joints; and determining a second control amount of the passive arm according to the horizontal displacement position, in which the second control amount includes a movement amount of the target moving joint and a rotating amount of the target rotating joint.


In some of the embodiments, the determining a second control amount of the passive arm according to the horizontal displacement position includes: obtaining a control amount of the passive arm by inverse solution according to the horizontal displacement position; in the case where a control amount of the passive arm obtained by inverse solution is multiple sets of results, determining a set of results of the minimum angle at which the target rotating joint needs to rotate to be the second control amount; and in the case where a control amount of the passive arm obtained by inverse solution is one set of results, determining such a set of results to be the second control amount.


According to various embodiments of the present disclosure, a robotic arm system is provided. The robotic arm system includes a computer device and a robotic arm including a passive arm and a multi-degree-of-freedom parallel platform equipped on an end of the passive arm, and the computer device is electrically connected to the passive arm and the multi-degree-of-freedom parallel platform, respectively, includes a processor and a storage medium in which a computer program is stored and is disposed to execute the hybrid master-slave mapping method provided by the embodiments of the present disclosure when run.


In some of the embodiments, the passive arm includes a plurality of joints among which a joint that enables an end point of the robotic arm to generate the displacement in a vertical direction is locked.


In some of the embodiments, a joint that enables an end point of the robotic arm to generate the displacement in a vertical direction among the plurality of joints includes at least one of: a moving joint with the displacement in a vertical direction, or a rotating joint rotating in a non-vertical direction.


According to various embodiments of the present disclosure, a computer device is provided. The computer device includes a processor and a storage medium in which a computer program is stored and is disposed to execute the hybrid master-slave mapping method provided by the embodiments of the present disclosure when run.


In addition, combined with the method in the above embodiment, the embodiment of the present disclosure further provides a storage medium for implementation. Computer program instructions are stored on the medium; The computer program instructions, when run by the processor, implement any one hybrid master-slave mapping method in the above embodiment.


It should be noted that for the specific example in the present embodiment, the examples described in the above embodiments and optional embodiments may be provided for reference, and will not be described again in the present embodiment.


The various technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of respective technical features in the above embodiments have been described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be the scope of the present description. The articles “a”, “an” and “the” are intended to include the plural forms as well, unless the context clearly indicates otherwise.


The above-mentioned embodiments only express several embodiments of the present disclosure, and their descriptions are more specific and detailed, but cannot be understood as limiting the scope of the patent disclosure. It should be pointed out that, to those ordinary skilled in the art, several modifications and improvements may also be made without breaking away from the concept of the present disclosure, and they pertain to the extent of protection of the present disclosure. Therefore, the extent of protection of the disclosure for a patent shall be determined by the terms of the attached claims.

Claims
  • 1. A hybrid master-slave mapping method, comprising: acquiring a current position and a target position of an end point of a robotic arm, the robotic arm including a passive arm and a multi-degree-of-freedom parallel platform equipped on an end of the passive arm;decomposing a displacement from the current position to the target position into a vertical direction and a horizontal plane, respectively, to obtain a vertical displacement position and a horizontal displacement position;determining a first control amount of the multi-degree-of-freedom parallel platform according to the vertical displacement position, and determining a second control amount of the passive arm according to the horizontal displacement position; andcontrolling the multi-degree-of-freedom parallel platform according to the first control amount, and controlling the passive arm according to the second control amount.
  • 2. The method of claim 1, wherein the robotic arm is controlled by a main manipulator; and the acquiring a current position of an end point of the robotic arm comprises: recording a position of the end point of the robotic arm as the current position at the moment when the main manipulator starts to be operated.
  • 3. The method of claim 1, wherein the robotic arm is controlled by the main manipulator; and the acquiring a target position of an end point of the robotic arm comprises: initializing an initial position of the main manipulator at the moment when the main manipulator starts to be operated;after the main manipulator is operated, determining a current position of the main manipulator, and determining a displacement of the main manipulator according to the current position and the initial position of the main manipulator; andconverting the displacement of the main manipulator into a target displacement of the robotic arm according to a preset displacement scale coefficient, and determining the target position according to the target displacement and the current position of the end point of the robotic arm.
  • 4. The method of claim 3, wherein the preset displacement scale coefficient is adjustable.
  • 5. The method of claim 1, wherein the passive arm comprises a plurality of joints; and the determining a second control amount of the passive arm according to the horizontal displacement position comprises: determining at least one target moving joint that generates the displacement within a horizontal plane and at least one target rotating joint that rotates around a vertical direction among the plurality of joints; anddetermining a second control amount of the passive arm according to the horizontal displacement position, wherein the second control amount comprises a movement amount of the target moving joint and a rotating amount of the target rotating joint.
  • 6. The method of claim 5, wherein the determining a second control amount of the passive arm according to the horizontal displacement position comprises: obtaining a control amount of the passive arm by inverse solution according to the horizontal displacement position;in the case where the control amount of the passive arm obtained by inverse solution is multiple sets of results, determining a set of results of the minimum angle at which the target rotating joint needs to rotate to be the second control amount; andin the case where the control amount of the passive arm obtained by inverse solution is one set of results, determining such a set of results to be the second control amount.
  • 7. A robotic arm system, wherein the robotic arm system comprises a computer device and a robotic arm including a passive arm and a multi-degree-of-freedom parallel platform equipped on an end of the passive arm, and the computer device is electrically connected to the passive arm and the multi-degree-of-freedom parallel platform, respectively, comprises a processor and a storage medium in which a computer program is stored, the computer program being disposed to execute the hybrid master-slave mapping method when run, wherein the hybrid master-slave mapping method comprises:acquiring a current position and a target position of an end point of a robotic arm, the robotic arm including a passive arm and a multi-degree-of-freedom parallel platform equipped on an end of the passive arm;decomposing a displacement from the current position to the target position into a vertical direction and a horizontal plane, respectively, to obtain a vertical displacement position and a horizontal displacement position;determining a first control amount of the multi-degree-of-freedom parallel platform according to the vertical displacement position, and determining a second control amount of the passive arm according to the horizontal displacement position; andcontrolling the multi-degree-of-freedom parallel platform according to the first control amount, and controlling the passive arm according to the second control amount.
  • 8. A The robotic arm system of claim 7, wherein the passive arm comprises a plurality of joints among which a joint that enables an end point of the robotic arm to generate the displacement in a vertical direction is locked.
  • 9. A The robotic arm system of claim 8, wherein the joint that enables an end point of the robotic arm to generate the displacement in a vertical direction among the plurality of joints comprises at least one of: a moving joint with the displacement in a vertical direction, or a rotating joint rotating around a non-vertical direction.
  • 10. A computer device, wherein the computer device comprises a processor and a storage medium in which a computer program is stored, the computer program being disposed to execute the hybrid master-slave mapping method when run, wherein the hybrid master-slave mapping method comprises:acquiring a current position and a target position of an end point of a robotic arm, the robotic arm including a passive arm and a multi-degree-of-freedom parallel platform equipped on an end of the passive arm;decomposing a displacement from the current position to the target position into a vertical direction and a horizontal plane, respectively, to obtain a vertical displacement position and a horizontal displacement position;determining a first control amount of the multi-degree-of-freedom parallel platform according to the vertical displacement position, and determining a second control amount of the passive arm according to the horizontal displacement position; andcontrolling the multi-degree-of-freedom parallel platform according to the first control amount, and controlling the passive arm according to the second control amount.
  • 11. The method of claim 5, wherein the number of the target moving joint is one, and the number of the target rotating joint is one, wherein the selected one target moving joint is a moving joint which is able to move in the maximum range among moving joints moving in a horizontal plane of the passive arm.
  • 12. The method of claim 1, wherein the passive arm comprises a plurality of joints among which a joint that enables an end point of the robotic arm to generate the displacement in a vertical direction is locked.
  • 13. The method of claim 1, wherein the first control amount of the multi-degree-of-freedom parallel platform is obtained by inverse solution of the vertical displacement position obtained by decomposing the target position of the end point of the robotic arm in the vertical direction.
  • 14. The method of claim 1, wherein the multi-degree-of-freedom parallel platform comprises a static platform, a movable platform and a plurality of telescopic components disposed between the static platform and the movable platform and is able to implement movements of six degrees of freedom in space.
  • 15. The method of claim 14, wherein an ultrasonic detection device is equipped on the movable platform of the multi-degree-of-freedom parallel platform.
  • 16. The method of claim 15, wherein an end point of the ultrasonic detection device is located on an axis of the movable platform of the multi-degree-of-freedom parallel platform.
  • 17. The robotic arm system of claim 7, wherein the multi-degree-of-freedom parallel platform comprises a static platform, a movable platform and a plurality of telescopic components disposed between the static platform and the movable platform and is able to implement movements of six degrees of freedom in space.
  • 18. The robotic arm system of claim 17, wherein an ultrasonic detection device is equipped on the movable platform of the multi-degree-of-freedom parallel platform.
  • 19. The robotic arm system of claim 7, wherein the robotic arm is controlled by a main manipulator; and the acquiring a current position of an end point of the robotic arm comprises: recording a position of the end point of the robotic arm as the current position at the moment when the main manipulator starts to be operated.
  • 20. The robotic arm system of claim 7, wherein the robotic arm is controlled by the main manipulator; and the acquiring a target position of an end point of the robotic arm comprises: initializing an initial position of the main manipulator at the moment when the main manipulator starts to be operated;after the main manipulator is operated, determining a current position of the main manipulator, and determining a displacement of the main manipulator according to the current position and the initial position of the main manipulator; andconverting the displacement of the main manipulator into a target displacement of the robotic arm according to a preset displacement scale coefficient, and determining the target position according to the target displacement and the current position of the end point of the robotic arm.
PCT Information
Filing Document Filing Date Country Kind
PCT/CN2020/141175 12/30/2020 WO