Joint control method and device, controller, storage medium and program product
By acquiring the rotational increment data of the target joint and processing it using a fuzzy controller, the problem of low joint operation smoothness in medical robots was solved, achieving smooth control of joint rotation and improving the smoothness of the operator.
Patent Information
- Application Number
- CN202411325314.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-23
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-09-23
AI Technical Summary
When doctors operate medical robots, the rotation of the next part of the joint cannot be controlled before the joint in the same direction of rotation reaches its limit, resulting in low operation smoothness.
By acquiring control data associated with the rotational increment of the target joint, a fuzzy controller is used to obtain influencing parameters. Based on these parameters, the rotation of the target joint is controlled, thereby improving operational smoothness.
It improves the operational fluency of the main operator of the medical robot, ensuring smooth and coordinated joint rotation.
Smart Images

Figure CN118952218A_ABST
Abstract
Description
Technical Field
[0001] The embodiments of the present invention relate to the field of motion control, and in particular to a joint control method, device, controller, storage medium and program product. Background Art
[0002] The main operator of the medical robot is the carrier for doctors to operate the medical robot. The 7-degree-of-freedom main operator with redundant joints is flexible to operate and can reduce the burden on doctors during surgery.
[0003] However, during the doctor's operation, for joints with the same rotation direction, if the joint of the upper part has not reached the rotation limit, the rotation of the joint of the lower part cannot be controlled, and the operation fluency is low, which needs to be solved urgently. Summary of the invention
[0004] Embodiments of the present invention provide a joint control method, device, controller, storage medium and program product to improve the operation fluency of a main operator of a robot.
[0005] According to one aspect of the present invention, a joint control method is provided, which may include:
[0006] For a target joint to be controlled in a main operating hand of the robot, obtaining control data associated with a rotation increment of the target joint;
[0007] Based on the control data and the fuzzy controller, an influence parameter is obtained, wherein the influence parameter is used to characterize the influence of the control data on the rotation increment;
[0008] A rotation increment is obtained based on the influencing parameter, and the target joint is controlled to rotate based on the rotation increment.
[0009] According to another aspect of the present invention, a joint control device is provided, which may include:
[0010] A control data acquisition module, for acquiring control data associated with a rotation increment of a target joint to be controlled in a main operating hand of the robot;
[0011] An influence parameter obtaining module is used to obtain influence parameters based on control data and a fuzzy controller, wherein the influence parameters are used to characterize the influence of the control data on the rotation increment;
[0012] The target joint rotation module is used to obtain a rotation increment based on the influencing parameter, and control the target joint to rotate based on the rotation increment.
[0013] According to another aspect of the present invention, a controller is provided. The controller is configured in the main operator of the robot and may include:
[0014] at least one processor; and
[0015] a memory communicatively connected to at least one processor; wherein,
[0016] The memory stores a computer program that can be executed by at least one processor. The computer program is executed by at least one processor so that the at least one processor implements the joint control method provided by any embodiment of the present invention when executing the computer program.
[0017] According to another aspect of the present invention, a computer-readable storage medium is provided, on which computer instructions are stored. The computer instructions are used to enable a processor to implement the joint control method provided by any embodiment of the present invention when executed.
[0018] According to another aspect of the present invention, a computer program product is provided, comprising: a computer program, which implements any joint control method provided by any embodiment of the present invention when executed by a processor.
[0019] The technical solution in the embodiment of the present invention is to obtain control data associated with the rotation increment of the target joint to be controlled in the main operator of the robot, so as to control the target joint based on the control data; obtain influence parameters based on the control data and the fuzzy controller, wherein the influence parameters are used to characterize the influence of the control data on the rotation increment, and the influence parameters suitable for the target joint can be obtained by designing a fuzzy controller with control rules based on the experience and knowledge of experts; obtain the rotation increment based on the influence parameters, and control the target joint to rotate based on the rotation increment to achieve control of the target joint. The above technical solution processes the control data through the fuzzy controller, thereby controlling the target joint to rotate, which can improve the operating fluency of the main operator of the robot.
[0020] It should be understood that the contents described in this section are not intended to identify the key or important features of the embodiments of the present invention, nor are they intended to limit the scope of the present invention. Other features of the present invention will become easily understood through the following description. BRIEF DESCRIPTION OF THE DRAWINGS
[0021] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0022] Figure 1 is a flow chart of a joint control method provided according to an embodiment of the present invention;
[0023] Figure 2is a schematic diagram of a 7-DOF master manipulator provided according to an embodiment of the present invention;
[0024] Figure 3 is a flow chart of another joint control method provided according to an embodiment of the present invention;
[0025] Figure 4 is a fuzzy operation flow chart of a specific example in another joint control method provided in an embodiment of the present invention;
[0026] Figure 5 is a parameter calculation flow chart of a specific example in another joint control method provided in an embodiment of the present invention;
[0027] Figure 6 is a fuzzy distribution schematic diagram according to a specific example of another joint control method provided by an embodiment of the present invention;
[0028] Figure 7 is a schematic diagram of fuzzy logic reasoning according to a specific example of another joint control method provided in an embodiment of the present invention;
[0029] Figure 8 is a schematic diagram of a surface averaging method according to a specific example of another joint control method provided in an embodiment of the present invention;
[0030] Fig. 9 is another fuzzy distribution schematic diagram according to a specific example of another joint control method provided by an embodiment of the present invention;
[0031] Fig.10 is another fuzzy distribution schematic diagram of a specific example of another joint control method provided by an embodiment of the present invention;
[0032] Fig.11 is another fuzzy distribution schematic diagram according to a specific example of another joint control method provided by an embodiment of the present invention;
[0033] Fig.12 is a structural block diagram of a joint control device provided according to an embodiment of the present invention;
[0034] Fig.13 It is a schematic diagram of the structure of an electronic device for implementing the joint control method according to an embodiment of the present invention. DETAILED DESCRIPTION
[0035] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.
[0036] It should be noted that the terms "first", "second", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchangeable where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. The situations of "target", "original", etc. are similar and will not be repeated here. In addition, the terms "including" and "having" and any of their variations are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0037] Figure 1 is a flow chart of a joint control method provided in an embodiment of the present invention. This embodiment can be applied to the case of joint control, and in particular to the case of joint control of the joints in the main operating hand of a medical robot. The method can be executed by a joint control device provided in an embodiment of the present invention, which can be implemented by software and / or hardware, and can be integrated in an electronic device, which can be various user terminals or servers.
[0038] See also Figure 1 The method of the embodiment of the present invention specifically includes the following steps:
[0039] S110 . For a target joint to be controlled in the main operating hand of the robot, obtain control data associated with a rotation increment of the target joint.
[0040] The target joint can be understood as the joint in the robot's main manipulator to be subjected to redundant posture control. Optionally, the robot can be a medical robot, and the main manipulator can be a 7-DOF main manipulator with a 4-DOF posture mechanism and a 3-DOF position mechanism, such as Figure 2In the 7-DOF master manipulator, the position and posture of the master manipulator can be changed by dragging the 7 joints. The movements of the 5th, 6th, and 7th joints can be directly controlled, but the 4th joint cannot be directly controlled. Redundant posture control is required to achieve the following and avoidance of the 4th joint to the 6th joint.
[0041] For the target joint to be controlled in the main operating hand of the robot, it is necessary to obtain control data associated with the rotation increment of the target joint, such as the rotation angle and rotation speed of the joint associated with it, so as to achieve control of the target joint.
[0042] S120 . Obtaining an influencing parameter based on the control data and the fuzzy controller, wherein the influencing parameter is used to characterize the influence of the control data on the rotation increment.
[0043] Influence parameters for characterizing the influence of control data on rotation increment can be obtained based on control data and fuzzy controller. For example, control data can be input into fuzzy controller, and fuzzy logic in fuzzy controller is used to process control data to obtain influence parameters.
[0044] S130 , obtaining a rotation increment based on the influencing parameter, and controlling the target joint to rotate based on the rotation increment.
[0045] Among them, after obtaining the influencing parameters, the rotation increment that the target joint needs to rotate can be obtained based on the influencing parameters, for example, by calculating the influencing parameters, and the target joint can be controlled to rotate based on the rotation increment. Optionally, controlling the target joint to rotate based on the rotation increment includes: determining the current joint angle of the target joint; adding the rotation increment on the basis of the current joint angle to obtain the target rotation angle of the target joint, and controlling the target joint to rotate toward the target rotation angle. That is, adding the rotation increment to the current joint angle of the target joint to obtain the target rotation angle to which the target joint needs to rotate, and controlling the target joint to rotate toward the target rotation angle, so as to achieve control of the target joint through a specific target rotation angle.
[0046] The technical solution in the embodiment of the present invention is to obtain control data associated with the rotation increment of the target joint to be controlled in the main operator of the robot, so as to control the target joint based on the control data; obtain influence parameters based on the control data and the fuzzy controller, wherein the influence parameters are used to characterize the influence of the control data on the rotation increment, and the influence parameters suitable for the target joint can be obtained by designing a fuzzy controller with control rules based on the experience and knowledge of experts; obtain the rotation increment based on the influence parameters, and control the target joint to rotate based on the rotation increment to achieve control of the target joint. The above technical solution processes the control data through the fuzzy controller, thereby controlling the target joint to rotate, which can improve the operating fluency of the main operator of the robot.
[0047] An optional technical solution, based on control data and a fuzzy controller, obtains influencing parameters, including: determining the input variables of the fuzzy controller based on the control data; fuzzifying the input variables to obtain fuzzy subsets, and constructing a fuzzy distribution map based on the fuzzy subsets, and establishing fuzzy rules based on the input variables; constructing a control rule adjustment table based on the fuzzy subsets and fuzzy rules; determining the variable values of the input variables based on the control data; obtaining fuzzy outputs based on the variable values, the fuzzy distribution map and the control rule adjustment table; and clarifying the fuzzy outputs to obtain influencing parameters.
[0048] Among them, all or part of the control data can be selected from the control data as the input variables of the fuzzy controller. Then, the input variables can be fuzzified by dividing them into multiple fuzzy subsets to obtain fuzzy subsets. For example, five fuzzy subsets, namely, very small (VS), small and medium (MS), medium (MM), medium and large (MB) and very large (VB), can be defined to fuzzify the input variables and obtain five fuzzy subsets. Then, a fuzzy distribution graph is constructed based on the fuzzy subsets. Optionally, a fuzzy distribution graph can be constructed using a triangular membership function, and fuzzy rules can be artificially established based on the input variables and expert experience. Further, a control rule adjustment table can be constructed based on the fuzzy subsets and fuzzy rules to characterize all possible control rules. Then, the variable values of the input variables are determined based on the control data, and the fuzzy output is obtained based on the variable values, the fuzzy distribution graph and the control rule adjustment table. Finally, the fuzzy output is clarified to obtain the influencing parameters. Optionally, the obtained fuzzy output can be clarified using the surface average method to finally obtain the influencing parameters.
[0049] The above technical solution processes the control data through the fuzzy controller to obtain the influencing parameters that meet the control rules set manually.
[0050] On this basis, optionally, a fuzzy output is obtained based on the variable value, the fuzzy distribution map and the control rule adjustment table, including: determining the membership corresponding to the variable value based on the variable value and the fuzzy distribution map, and determining the control rule corresponding to the input variable based on the variable value and the control rule adjustment table; obtaining the fuzzy output based on the membership and the control rule.
[0051] Among them, based on the variable value, the membership degree and the corresponding control rule corresponding to each variable value can be obtained from the fuzzy distribution diagram, and the fuzzy output can be calculated based on the membership degree and the control rule.
[0052] Figure 3 It is a flow chart of another joint control method provided in an embodiment of the present invention. This embodiment is optimized based on the above-mentioned technical solutions. In this embodiment, optionally, the number of fuzzy controllers is multiple, and the influencing parameters are obtained based on the control data and the fuzzy controllers, including: dividing all control data into multiple data groups, wherein the number of data groups is the same as the number of fuzzy controllers; for each data group in the multiple data groups, inputting the data group into the fuzzy controller corresponding to the data group in the multiple fuzzy controllers to obtain the influencing parameters. Among them, the explanations of the terms that are the same or corresponding to the above-mentioned embodiments are not repeated here.
[0053] See also Figure 3 The method of this embodiment may specifically include the following steps:
[0054] S210 . For a target joint to be controlled in the main operating hand of the robot, obtain control data associated with a rotation increment of the target joint.
[0055] S220, dividing all control data into a plurality of data groups, wherein the number of the data groups is the same as the number of the plurality of fuzzy controllers.
[0056] Among them, since the more inputs a fuzzy controller has, the more complex its rules are, and the longer the calculation time will be. Therefore, in order to improve the calculation efficiency and accuracy, multiple fuzzy controllers can be used, and all control data can be divided into multiple data groups equal to the number of fuzzy controllers to process the control data synchronously.
[0057] S230. For each data group in the multiple data groups, input the data group into a fuzzy controller corresponding to the data group in the multiple fuzzy controllers to obtain an influence parameter, wherein the influence parameter is used to characterize the influence of the control data on the rotation increment.
[0058] For each data group in the multiple data groups, the data group can be input into a fuzzy controller corresponding to the data group in the multiple fuzzy controllers, and one fuzzy controller processes a group of corresponding data to reduce processing complexity and improve processing efficiency.
[0059] S240 , obtaining a rotation increment based on the influencing parameter, and controlling the target joint to rotate based on the rotation increment.
[0060] The technical solution of the embodiment of the present invention can effectively reduce the complexity of control rules and improve the calculation speed by utilizing multiple fuzzy controllers to process grouped control data in parallel.
[0061] An optional technical solution, all influencing parameters include proportional parameters, the proportional parameters are obtained based on a proportional data group in multiple data groups, the control data in the proportional data group is data associated with at least one of the target joint, the first joint and the second joint, wherein the first joint is the joint in the hand of the main operator located in front of the target joint, and the second joint is the joint in the hand of the main operator located in front of the first joint.
[0062] Among them, all influencing parameters include proportional parameters, which are obtained based on proportional data groups in multiple data groups. The control data in the proportional data group is data associated with the first joint before the target joint and at least one of the second joints before the first joint, for example, data such as the speed and angle of the first joint and the second joint.
[0063] The above technical solution obtains the proportional parameter based on the data associated with the joint before the target joint, so that the control of the target joint can be associated with the joint before the target joint, thereby improving the operating fluency of the main operator.
[0064] On this basis, an optional technical solution is provided, wherein the proportional parameters include a first proportional parameter, a second proportional parameter and a third proportional parameter, the proportional data group includes a first data group corresponding to the first proportional parameter, a second data group corresponding to the second proportional parameter and a third data group corresponding to the third proportional parameter, and the rotation increment is applied in the current control cycle; the control data in the first data group includes a first joint angle of the first joint and a second joint angle of the second joint; the control data in the second data group includes a joint rotation speed of the first joint and a historical total proportional parameter calculated based on all historical proportional parameters applied in the previous control cycle of the current control cycle; the control data in the third data group includes the current joint angle of the target joint.
[0065] The above technical solution can calculate different proportional parameters through data in different data groups, thereby reducing the complexity of fuzzy calculation and improving the speed of fuzzy calculation, and can also improve multiple proportional parameters to fully reflect the impact of data in different data groups on the rotation increment.
[0066] Based on any of the above embodiments, an optional technical solution is provided, in which all influencing parameters include step parameters, and the step parameters are obtained based on a step data group in multiple data groups, and the control data in the step data group includes the joint rotation speed and historical increment of the second joint, wherein the historical increment is the rotation increment applied by the target joint in the previous control cycle.
[0067] The above technical solution, by characterizing the influence of the data in the supplementary data group on the rotation increment through the step size parameter, can further improve the operation fluency of the main operator of the robot.
[0068] On this basis, optionally, when the influencing parameters include the first proportional parameter, the second proportional parameter and the third proportional parameter, obtaining the rotation increment based on the influencing parameters includes:
[0069] The first proportional parameter, the second proportional parameter and the third proportional parameter are multiplied to obtain the current total proportional parameter of the current control cycle; the current total proportional parameter and the step size parameter are multiplied to obtain the rotation increment.
[0070] Among them, the obtained multiple scale parameters can be multiplied to obtain a total scale parameter, and then multiplied with the step parameter to obtain a rotation increment.
[0071] The above technical solution can comprehensively consider the influence of all control data on the rotation increment by calculating the obtained proportional parameters and step parameters, thereby improving the operating fluency of the robot's main operator.
[0072] In order to better understand the above-mentioned technical solutions, the following is an exemplary description in combination with a specific example. In this specific example, the structural diagram of the main operator is as follows: Figure 2 As shown, the target joint is 4 joints, the first joint is 5 joints, and the second joint is 6 joints. The specific flow chart is as follows Figure 4 As shown, the specific steps are as follows:
[0073] Step 1: Obtain control data and determine the structure of the fuzzy controller
[0074] The rotation increment Δθ4 of the 4 joints is directly affected by the angles θ4, θ5, θ6 of the 4, 5, and 6 joints, as well as the movement speeds ν5 and ν6 of the 5 and 6 joints. At the same time, in order to ensure the flexibility of the rotation of the 4 joints, the Δθ4 calculated in each control cycle should be as smooth as possible. Δθ4 is also affected by the rotation increments of the 4 joints calculated in the previous cycle. And the historical total ratio parameter k calculated in the previous period t-1 Therefore, it is necessary to obtain the above control data.
[0075] Step 2: Control data grouping for fuzzy calculation
[0076] The control data is divided into (θ5, θ6), (ν5, k t-1 ), and (θ4), each set of data is input into the corresponding fuzzy controller for fuzzy operation. The specific flow chart is as follows: Figure 5 shown.
[0077] 2.1. Calculation of proportional parameter k1
[0078] 2.1.1、Define the fuzzy distribution of input and output. The distance between θ5 and 90° |θ5-90| and the distance between θ6 and the center point of the 6-joint motion space |θ6-θ 6,0 | and the proportional coefficient k1 are divided into five fuzzy subsets: very small (VS), medium small (MS), medium (MM), medium large (MB), and very large (VB), and the fuzzy distribution is constructed using the triangular membership function. The fuzzy distribution diagram is shown in Figure 6 As shown;
[0079] 2.1.2. Establish fuzzy rules based on input variables. The farther the current angle θ6 of the 6 joint is from the center point, that is, |θ6-θ 6,0 The larger | is, the larger k1 is; the farther the current angle θ5 of the 5th joint is from 90°, that is, the larger |θ5-90| is, the larger k1 is; a control rule adjustment table is drawn based on fuzzy rules and fuzzy subsets, as shown in Table 1 below:
[0080] Table 1
[0081]
[0082] 2.1.3 Fuzzy logic reasoning. Substitute the values of θ5 and θ6 into |θ5-90| and |θ6-θ 6,0 The value of | is Figure 7 As shown in the left figure, according to Table 1, four rules, R2 = VS (2), R3 = MS (3), R7 = MS (7), and R8 = MM (8), are activated, and the corresponding membership degrees are:
[0083] MS(|θ5-90|)=i1
[0084] MM(|θ5-90|)=i2
[0085] VS(|θ6-θ 6,0 |)=i3
[0086] MS(|θ6-θ 6,0 |)=i4
[0087] According to the formula Calculate the fuzzy value, that is:
[0088]
[0089]
[0090]
[0091]
[0092] U=U2+U3+U7+U8
[0093] in, It means that after taking the minimum value between the membership degrees i1 and i3, the corresponding fuzzy rule VS(2) is synthesized. The fuzzy value obtained after the operation is as follows Figure 7 As shown in the right figure.
[0094] 2.1.4、Output fuzzy value clarification. Figure 8 As shown, the surface averaging method is used to clarify the output fuzzy value, and finally the proportional coefficient k1 is obtained.
[0095] 2.2 Calculation of the proportional parameter k2
[0096] 2.2.1、Define the fuzzy distribution of input and output. t-1 The proportional coefficient k2 is fuzzily divided into five fuzzy subsets: positive large PB, positive medium PM, positive small PS, zero O, negative small NS, negative medium NM, and negative large NB. The fuzzy distribution is constructed using the triangular membership function. The fuzzy distribution diagram is shown in the figure. Fig. 9 As shown;
[0097] 2.2.2. Establish fuzzy rules based on input variables. The larger ν5 is, the larger k2 is; k t-1 The larger the value, the larger the k2. Based on the fuzzy rules and fuzzy subsets, the control rule adjustment table is drawn, as shown in Table 2 below:
[0098] Table 2
[0099]
[0100] 2.2.3, Fuzzy logic reasoning. The specific process is the same as step 2.1.3
[0101] 2.2.4. Clarification of output fuzzy values: The output fuzzy values are clarified using the surface average method, and the proportional coefficient k2 is finally obtained.
[0102] 2.3. Calculation of scale parameter k3
[0103] 2.3.1、Define the fuzzy distribution of input and output. The distance between θ4 and the center point of the 4-joint motion space |θ4-θ 4,0| and the proportional coefficient k3 are divided into five fuzzy subsets: very small (VS), medium small (MS), medium (MM), medium large (MB), and very large (VB), and the fuzzy distribution is constructed using the triangular membership function. The fuzzy distribution diagram is shown in Fig.10 As shown;
[0104] 2.3.2. Establish fuzzy rules based on input variables. |θ4-θ 4,0 | is larger, k3 is larger; a control rule adjustment table is drawn based on fuzzy rules and fuzzy subsets, as shown in Table 3 below:
[0105] Table 3
[0106]
[0107] 2.3.3, Fuzzy logic reasoning. The specific process is the same as step 2.1.3
[0108] 2.3.4. Clarification of output fuzzy values: The output fuzzy values are clarified using the surface average method, and the proportional coefficient k3 is finally obtained.
[0109] 2.4. Calculation of step size parameter L
[0110] 2.4.1、Define the fuzzy distribution of input and output. The 6 joint motion speed ν6 and the 4 joint position increment command calculated in the previous cycle are The fuzzy division of the 4-joint motion step length L into seven fuzzy subsets: positive large PB, positive medium PM, positive small PS, zero O, negative small NS, negative medium NM, and negative large NB. The fuzzy distribution is constructed using the triangular membership function. The fuzzy distribution diagram is shown in the figure. Fig.11 As shown;
[0111] 2.4.2. Establish fuzzy rules based on input variables. The larger ν6 is, the larger L is; The larger the value, the larger L is; a control rule adjustment table is drawn based on fuzzy rules and fuzzy subsets, as shown in Table 4 below:
[0112] Table 4
[0113]
[0114] 2.4.3, Fuzzy logic reasoning. The specific process is the same as step 2.1.3
[0115] 2.4.4. Clarification of output fuzzy value: The output fuzzy value is clarified by using the surface average method, and the proportional coefficient L is finally obtained.
[0116] Step 3: Calculate the rotation increment and control the rotation
[0117] According to the formula Δθ4=k t*L=k1*k2*k3*L, calculate the rotation increment Δθ4 of the 4 joints in the current control cycle. Further, based on the position θ'4 of the 4 joints in the previous control cycle, θ4=θ'4+Δθ4 can be obtained as the position instruction of the 4 joints in the current control cycle, and the 4 joints can be controlled to rotate to the angle θ4.
[0118] In this specific example, the control data is processed by the fuzzy controller to control the rotation of the target joint, which can improve the operating smoothness of the robot's main operator.
[0119] Fig.12 This is a structural block diagram of a joint control device provided in an embodiment of the present invention, and the device is used to execute the joint control method provided in any of the above embodiments. The device and the joint control method of the above embodiments belong to the same inventive concept, and the details not described in detail in the embodiment of the joint control device can refer to the embodiment of the above joint control method. Fig.12 The device may specifically include: a control data acquisition module 310, an influence parameter acquisition module 320, and a target joint rotation module 330.
[0120] The control data acquisition module 310 is used to acquire control data associated with the rotation increment of the target joint to be controlled in the main operating hand of the robot;
[0121] An influence parameter obtaining module 320 is used to obtain influence parameters based on control data and a fuzzy controller, wherein the influence parameters are used to characterize the influence of the control data on the rotation increment;
[0122] The target joint rotation module 330 is used to obtain a rotation increment based on the influencing parameter, and control the target joint to rotate based on the rotation increment.
[0123] Optionally, there are multiple fuzzy controllers, and the influencing parameter obtaining module 320 includes:
[0124] A data group division submodule is used to divide all control data into a plurality of data groups, wherein the number of the data groups is the same as the number of the fuzzy controllers;
[0125] The influencing parameter obtaining module is used for inputting the data group into a fuzzy controller corresponding to the data group among the multiple fuzzy controllers for each data group in the multiple data groups to obtain the influencing parameter.
[0126] On this basis, optionally, all influencing parameters include proportional parameters, which are obtained based on a proportional data group in multiple data groups, and the control data in the proportional data group is data associated with at least one of the target joint, the first joint, and the second joint, wherein the first joint is the joint in the hand of the main operator that is located in front of the target joint, and the second joint is the joint in the hand of the main operator that is located in front of the first joint.
[0127] On this basis, optionally, the proportional parameter includes a first proportional parameter, a second proportional parameter and a third proportional parameter, the proportional data group includes a first data group corresponding to the first proportional parameter, a second data group corresponding to the second proportional parameter and a third data group corresponding to the third proportional parameter, and the rotation increment is applied in the current control cycle;
[0128] The control data in the first data group includes a first joint angle of the first joint and a second joint angle of the second joint;
[0129] The control data in the second data group includes the joint rotation speed of the first joint and the historical total proportional parameter calculated based on all historical proportional parameters applied in the previous control cycle of the current control cycle;
[0130] The control data in the third data set includes the current joint angle of the target joint.
[0131] Based on any of the above-mentioned devices, optionally, all influencing parameters include step parameters, which are obtained based on a step data group in multiple data groups, and the control data in the step data group includes the joint rotation speed and historical increment of the second joint, wherein the historical increment is the rotation increment applied by the target joint in the previous control cycle.
[0132] On this basis, optionally, when the influencing parameters include the first proportional parameter, the second proportional parameter and the third proportional parameter, the target joint rotation module 330 includes:
[0133] A current total proportional parameter obtaining module is used to multiply the first proportional parameter, the second proportional parameter and the third proportional parameter to obtain the current total proportional parameter of the current control cycle;
[0134] The rotation increment obtaining module is used to multiply the current total scale parameter and the step size parameter to obtain the rotation increment.
[0135] Alternatively, the influencing parameter obtaining module 320 includes:
[0136] An input variable determination submodule, used for determining an input variable of the fuzzy controller based on control data;
[0137] A fuzzy rule establishment submodule is used to perform fuzzification processing on input variables to obtain fuzzy subsets, construct fuzzy distribution graphs based on the fuzzy subsets, and establish fuzzy rules based on the input variables;
[0138] A control rule adjustment table construction submodule is used to construct a control rule adjustment table based on fuzzy subsets and fuzzy rules;
[0139] A variable value driving submodule, used for determining the variable value of the input variable based on the control data;
[0140] A fuzzy output obtaining submodule is used to obtain a fuzzy output based on a variable value, a fuzzy distribution map and a control rule adjustment table;
[0141] The influencing parameter obtaining submodule is used to clarify the fuzzy output and obtain the influencing parameters.
[0142] On this basis, optional, fuzzy output is obtained from sub-modules, including:
[0143] A control rule determination unit, used to determine the membership degree corresponding to the variable value based on the variable value and the fuzzy distribution map, and to determine the control rule corresponding to the input variable based on the variable value and the control rule adjustment table;
[0144] The fuzzy output obtaining unit is used to obtain the fuzzy output based on the membership degree and the control rule.
[0145] Another optional target joint rotation module 330 includes:
[0146] A current joint angle determination submodule is used to determine the current joint angle of the target joint;
[0147] The rotation control submodule is used to add a rotation increment to the current joint angle to obtain a target rotation angle of the target joint, and control the target joint to rotate toward the target rotation angle.
[0148] The joint control device in the embodiment of the present invention obtains control data associated with the rotation increment of the target joint to be controlled in the main operator of the robot through a control data acquisition module, so as to control the target joint based on the control data; obtains influence parameters based on the control data and the fuzzy controller through an influence parameter acquisition module, wherein the influence parameters are used to characterize the influence of the control data on the rotation increment, and the fuzzy controller whose control rules are designed based on the experience and knowledge of experts can be used to obtain the influence parameters suitable for the target joint; obtains the rotation increment based on the influence parameters through a target joint rotation module, and controls the target joint to rotate based on the rotation increment, thereby realizing the control of the target joint. The above technical scheme processes the control data through a fuzzy controller, thereby controlling the target joint to rotate, which can improve the operation fluency of the main operator of the robot.
[0149] The joint control device provided in the embodiment of the present invention can execute the joint control method provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.
[0150] It is worth noting that in the embodiment of the above-mentioned joint control device, the various units and modules included are only divided according to functional logic, but are not limited to the above-mentioned division, as long as the corresponding functions can be achieved; in addition, the specific names of the functional units are only for the convenience of distinguishing each other, and are not used to limit the scope of protection of the present invention.
[0151] Fig.13 A schematic diagram of the structure of an electronic device 10 that can be used to implement an embodiment of the present invention is shown. The electronic device is intended to represent various forms of digital computers, such as laptop computers, desktop computers, workstations, personal digital assistants, servers, blade servers, mainframe computers, and other suitable computers. The electronic device can also represent various forms of mobile devices, such as personal digital processing, cellular phones, smart phones, wearable devices (such as helmets, glasses, watches, etc.) and other similar computing devices. The components shown herein, their connections and relationships, and their functions are merely examples and are not intended to limit the implementation of the present invention described and / or required herein.
[0152] like Fig.13As shown, the electronic device 10 includes at least one processor 11, and a memory connected to the at least one processor 11, such as a read-only memory (ROM) 12, a random access memory (RAM) 13, etc., wherein the memory stores a computer program that can be executed by at least one processor, and the processor 11 can perform various appropriate actions and processes according to the computer program stored in the read-only memory (ROM) 12 or the computer program loaded from the storage unit 18 to the random access memory (RAM) 13. In the RAM 13, various programs and data required for the operation of the electronic device 10 can also be stored. The processor 11, ROM 12 and RAM 13 are connected to each other through a bus 14. An input / output (I / O) interface 15 is also connected to the bus 14.
[0153] A number of components in the electronic device 10 are connected to the I / O interface 15, including: an input unit 16, such as a keyboard, a mouse, etc.; an output unit 17, such as various types of displays, speakers, etc.; a storage unit 18, such as a disk, an optical disk, etc.; and a communication unit 19, such as a network card, a modem, a wireless communication transceiver, etc. The communication unit 19 allows the electronic device 10 to exchange information / data with other devices through a computer network such as the Internet and / or various telecommunication networks.
[0154] The processor 11 may be a variety of general and / or special processing components with processing and computing capabilities. Some examples of the processor 11 include, but are not limited to, a central processing unit (CPU), a graphics processing unit (GPU), various dedicated artificial intelligence (AI) computing chips, various processors running machine learning model algorithms, a digital signal processor (DSP), and any appropriate processor, controller, microcontroller, etc. The processor 11 executes the various methods and processes described above, such as the joint control method.
[0155] In some embodiments, the joint control method may be implemented as a computer program, which is tangibly contained in a computer-readable storage medium, such as a storage unit 18. In some embodiments, part or all of the computer program may be loaded and / or installed on the electronic device 10 via the ROM 12 and / or the communication unit 19. When the computer program is loaded into the RAM 13 and executed by the processor 11, one or more steps of the joint control method described above may be performed. Alternatively, in other embodiments, the processor 11 may be configured to perform the joint control method in any other appropriate manner (e.g., by means of firmware).
[0156] Various implementations of the systems and techniques described above herein can be implemented in digital electronic circuit systems, integrated circuit systems, field programmable gate arrays (FPGAs), application specific integrated circuits (ASICs), application specific standard products (ASSPs), systems on chips (SOCs), load programmable logic devices (CPLDs), computer hardware, firmware, software, and / or combinations thereof. These various implementations can include: being implemented in one or more computer programs that can be executed and / or interpreted on a programmable system including at least one programmable processor, which can be a special purpose or general purpose programmable processor that can receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
[0157] Computer programs for implementing the methods of the present invention may be written in any combination of one or more programming languages. These computer programs may be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, so that when the computer program is executed by the processor, the functions / operations specified in the flow chart and / or block diagram are implemented. The computer program may be executed entirely on the machine, partially on the machine, partially on the machine as a stand-alone software package and partially on a remote machine, or entirely on a remote machine or server.
[0158] In the context of the present invention, a computer-readable storage medium may be a tangible medium that may contain or store a computer program for use by or in combination with an instruction execution system, device or equipment. A computer-readable storage medium may include, but is not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices or equipment, or any suitable combination of the foregoing. Alternatively, a computer-readable storage medium may be a machine-readable signal medium. A more specific example of a machine-readable storage medium may include an electrical connection based on one or more lines, 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 foregoing.
[0159] To provide interaction with a user, the systems and techniques described herein may be implemented on an electronic device having: a display device (e.g., a CRT (cathode ray tube) or LCD (liquid crystal display) monitor) for displaying information to the user; and a keyboard and a pointing device (e.g., a mouse or trackball) through which the user can provide input to the electronic device. Other types of devices may also be used to provide interaction with the user; for example, the feedback provided to the user may be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and input from the user may be received in any form (including acoustic input, voice input, or tactile input).
[0160] The systems and techniques described herein may be implemented in a computing system that includes backend components (e.g., as a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes frontend components (e.g., a user computer with a graphical user interface or a web browser through which a user can interact with implementations of the systems and techniques described herein), or a computing system that includes any combination of such backend components, middleware components, or frontend components. The components of the system may be interconnected by any form or medium of digital data communication (e.g., a communication network). Examples of communication networks include: a local area network (LAN), a wide area network (WAN), a blockchain network, and the Internet.
[0161] A computing system may include a client and a server. The client and the server are generally remote from each other and usually interact through a communication network. The client and server relationship is generated by computer programs running on the corresponding computers and having a client-server relationship with each other. The server may be a cloud server, also known as a cloud computing server or cloud host, which is a host product in the cloud computing service system to solve the defects of difficult management and weak business scalability in traditional physical hosts and VPS services.
[0162] It should be understood that the various forms of processes shown above can be used to reorder, add or delete steps. For example, the steps described in the present invention can be executed in parallel, sequentially or in different orders, as long as the desired results of the technical solution of the present invention can be achieved, and this document does not limit this.
[0163] The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims
1. A joint control method, characterized in that: include: For a target joint to be controlled in a main operating hand of the robot, acquiring control data associated with a rotation increment of the target joint; Based on the control data and the fuzzy controller, an influence parameter is obtained, wherein the influence parameter is used to characterize the influence of the control data on the rotation increment; The rotation increment is obtained based on the influencing parameter, and the target joint is controlled to rotate based on the rotation increment.
2. The method according to claim 1, characterized in that The number of the fuzzy controllers is multiple, and the influencing parameters are obtained based on the control data and the fuzzy controllers, including: Dividing all of the control data into a plurality of data groups, wherein the number of the data groups is the same as the number of the fuzzy controllers; For each of the plurality of data groups, the data group is input into a fuzzy controller corresponding to the data group among the plurality of fuzzy controllers to obtain an influencing parameter.
3. The method according to claim 2, characterized in that All of the influencing parameters include a proportional parameter, which is obtained based on a proportional data group in the multiple data groups. The control data in the proportional data group is data associated with at least one of the target joint, the first joint, and the second joint, wherein the first joint is a joint in the hand of the main operator that is located in front of the target joint, and the second joint is a joint in the hand of the main operator that is located in front of the first joint.
4. The method according to claim 3, characterized in that: The proportional parameters include a first proportional parameter, a second proportional parameter and a third proportional parameter, the proportional data group includes a first data group corresponding to the first proportional parameter, a second data group corresponding to the second proportional parameter and a third data group corresponding to the third proportional parameter, and the rotation increment is applied in the current control cycle; The control data in the first data group includes a first joint angle of the first joint and a second joint angle of the second joint; The control data in the second data group includes the joint rotation speed of the first joint and a historical total proportional parameter calculated based on all historical proportional parameters applied in a previous control cycle of the current control cycle; The control data in the third data set includes a current joint angle of the target joint.
5. The method according to any one of claims 2 to 4, characterized in that: All of the influencing parameters include a step parameter, which is obtained based on a step data group in the multiple data groups. The control data in the step data group includes the joint rotation speed and historical increment of the second joint, wherein the historical increment is the rotation increment applied to the target joint in the previous control cycle.
6. The method according to claim 5, characterized in that In the case where the influencing parameters include a first proportional parameter, a second proportional parameter, and a third proportional parameter, obtaining the rotation increment based on the influencing parameters includes: Multiplying the first proportional parameter, the second proportional parameter and the third proportional parameter to obtain a current total proportional parameter of a current control cycle; The current total scale parameter and the step size parameter are multiplied to obtain the rotation increment.
7. The method according to claim 1, characterized in that The influencing parameters are obtained based on the control data and the fuzzy controller, including: determining an input variable of the fuzzy controller based on the control data; Performing fuzzification processing on the input variables to obtain fuzzy subsets, constructing a fuzzy distribution map based on the fuzzy subsets, and establishing fuzzy rules based on the input variables; Constructing a control rule adjustment table based on the fuzzy subsets and the fuzzy rules; determining a variable value of the input variable based on the control data; Obtaining a fuzzy output based on the variable value, the fuzzy distribution map and the control rule adjustment table; The fuzzy output is clarified to obtain the influencing parameters.
8. The method according to claim 7, characterized in that The obtaining of fuzzy output based on the variable value, the fuzzy distribution map and the control rule adjustment table comprises: Determining the membership degree corresponding to the variable value based on the variable value and the fuzzy distribution map, and determining the control rule corresponding to the input variable based on the variable value and the control rule adjustment table; Based on the membership degree and the control rule, a fuzzy output is obtained.
9. The method according to claim 1, characterized in that: The step of controlling the target joint to rotate based on the rotation increment comprises: Determining a current joint angle of the target joint; The rotation increment is added to the current joint angle to obtain a target rotation angle of the target joint, and the target joint is controlled to rotate toward the target rotation angle.
10. A joint control device, characterized in that: include: A control data acquisition module, for acquiring control data associated with a rotation increment of a target joint to be controlled in a main operating hand of the robot; An influence parameter obtaining module, used for obtaining an influence parameter based on the control data and the fuzzy controller, wherein the influence parameter is used for characterizing the influence of the control data on the rotation increment; The target joint rotation module is used to obtain the rotation increment based on the influencing parameter, and control the target joint to rotate based on the rotation increment.
11. A controller, characterized in that: The controller is configured in the main operator's hand of the robot and includes: at least one processor; and a memory communicatively connected to the at least one processor; wherein, The memory stores a computer program executable by the at least one processor, and the computer program is executed by the at least one processor to enable the at least one processor to perform the joint control method according to any one of claims 1 to 9.
12. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the joint control method as described in any one of claims 1-9 when executed.
13. A computer program product, characterized in that include: A computer program, which, when executed by a processor, implements the joint control method according to any one of claims 1 to 9.
Citation Information
Patent Citations
Rotor dynamic balance variable step size optimizing method based on fuzzy control
CN104792459A
Master-slave robot control system and control method
CN106003034A
Fuzzy-PID-based PMSM self-adaptive control system
CN110687779A
Servo motor control parameter optimization method based on evolution reinforcement learning
CN118034129A
Control method, device and system for mechanical arm based on self-adaptive controller and storage medium
CN118493408A
