Joint module testing method, device, equipment and storage medium
By sending running instructions to the robot joint module and calculating the angle position deviation, the problem of inability to test control accuracy in the prior art is solved, and efficient control accuracy testing and stable operation of the robot joint module are achieved.
Patent Information
- Application Number
- CN202210947937.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-08-08
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2042-08-08
AI Technical Summary
The prior art cannot effectively test the control accuracy of the robot joint module, resulting in the inability to ensure its stable operation under the control of the driving equipment.
By sending running instructions to the joint module, collecting its actual angle position, and calculating the deviation between the actual angle position and the target angle position, the control accuracy of the joint module is determined, thereby achieving testing of control accuracy.
The robot joint module control accuracy is tested, the testing efficiency and automation are improved, and the joint module is stable operation under the driving equipment.
Smart Images

Figure CN115302506B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of robot joint module performance testing, and in particular to a joint module testing method, device, equipment and storage medium. Background Art
[0002] With the development of robot technology, robots are being used more and more widely, and they are playing an increasingly important role in the industrial field and people's daily lives. The performance of a robot is related to the performance of the robot joint module. Therefore, in order to ensure that the joint module can operate stably under the control of the drive device, it is necessary to test the performance of the robot joint module. However, the current performance test of the joint module still remains at the test and evaluation of nominal data such as torque and speed, and it is impossible to effectively test the control accuracy of the joint module. Summary of the invention
[0003] Based on the above requirements, the present application proposes a testing method, device, equipment and storage medium for a joint module to solve the problem in the prior art that the control accuracy of the joint module cannot be effectively tested.
[0004] The technical solutions proposed in this application are as follows:
[0005] On the one hand, the present application provides a method for testing a joint module, comprising:
[0006] Sending an operation instruction to the joint module so that the joint module operates according to the operation instruction; the operation instruction includes a target rotation angle position that the joint module should reach when executing the operation instruction;
[0007] Collecting the actual angular position reached by the joint module when executing the operation instruction;
[0008] The control accuracy of the joint module is determined by calculating the deviation between the actual rotation angle position and the target rotation angle position.
[0009] As an optional implementation, in the method described above, the number of the running instructions is multiple groups;
[0010] Determining the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position includes:
[0011] Determine an effective actual rotation angle position from the collected multiple sets of actual rotation angle positions; the effective actual rotation angle position includes the actual rotation angle position reached by the joint module when executing the operation instruction in a stable state;
[0012] The control accuracy of the joint module is determined by calculating the deviation between the effective actual rotation angle position and the target rotation angle position corresponding to the effective actual rotation angle position; wherein the target rotation angle position corresponding to the effective actual rotation angle position is the target rotation angle position included in the operating instruction executed when the effective rotation angle position is reached.
[0013] As an optional implementation, in the method described above, determining the effective actual rotation angle position from the collected multiple sets of actual rotation angle positions includes:
[0014] Collecting the torque deviation corresponding to the joint module when executing each set of the operation instructions; the torque deviation includes the deviation between the load torque of the joint module and the output torque generated by the joint module under the action of the load torque;
[0015] If the torque deviation corresponding to the execution of any operation instruction by the joint module is less than a preset torque deviation threshold, the actual rotation angle position reached by executing the operation execution command is determined to be a valid actual rotation angle position.
[0016] As an optional implementation, in the method described above, the process of collecting the output torque includes:
[0017] Sending a torque instruction to the load device of the joint module so that the load device operates according to the torque instruction during the process of the joint module executing the operation instruction; the torque instruction includes the load torque that the load device should achieve when executing the torque instruction;
[0018] The output torque of the joint module during the process of the load device executing the torque instruction is collected.
[0019] As an optional implementation, in the above method, sending a torque instruction to the load device of the joint module includes:
[0020] Sending the torque command to the joint module according to a preset load device characteristic curve;
[0021] The load device characteristic curve includes an input voltage-braking torque characteristic curve of the load device.
[0022] As an optional implementation, in the method described above, the control accuracy of the joint module is determined by calculating the deviation between the effective actual rotation angle position and the target rotation angle position corresponding to the effective actual rotation angle position, including:
[0023] Calculating the deviation rate between each group of the effective actual turning angle positions and the corresponding target turning angle positions;
[0024] According to the deviation rate between each group of the effective actual rotation angle positions and the corresponding target rotation angle positions, the average deviation rate between all the effective actual rotation angle positions and the corresponding target rotation angle positions is calculated as the control accuracy of the joint module.
[0025] As an optional implementation, in the method described above, sending an operation instruction to the joint module includes:
[0026] Sending multiple sets of identical operation instructions to the joint module;
[0027] Determining the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position includes:
[0028] The stability control accuracy of the joint module is determined by calculating the deviation between the actual rotation angle position and the target rotation angle position.
[0029] As an optional implementation, in the method described above, sending an operation instruction to the joint module includes:
[0030] Sending multiple sets of different operating instructions to the joint module;
[0031] Determining the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position includes:
[0032] The anti-disturbance control accuracy of the joint module is determined by calculating the deviation between the actual rotation angle position and the target rotation angle position.
[0033] On the other hand, the present application provides a testing device for a joint module, comprising:
[0034] A sending module, used for sending an operation instruction to the joint module, so that the joint module operates according to the operation instruction; the operation instruction includes a target rotation angle position that the joint module should reach when executing the operation instruction;
[0035] A collection module, used for collecting the actual angular position reached by the joint module when executing the operation instruction;
[0036] The determination module is used to determine the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position.
[0037] On the other hand, the present application provides a test device for a joint module, comprising: a host computer, and a motion controller electrically connected to the host computer and the joint module respectively;
[0038] The host computer is used to send an operation instruction to the joint module through the motion controller, so that the joint module operates according to the operation instruction; the operation instruction includes a target rotation angle position that the joint module should reach when executing the operation instruction;
[0039] The motion controller is used to collect the actual angular position reached by the joint module when executing the operation instruction;
[0040] The host computer is also used to collect the actual angular position reported by the motion controller, and determine the control accuracy of the joint module by calculating the deviation between the actual angular position and the target angular position.
[0041] As an optional implementation, the above-mentioned device further includes: a torque sensor device and a load device electrically connected to the motion controller;
[0042] The first end of the torque sensor device is connected to the joint module shaft, and the second end of the torque sensor device is connected to the load device shaft;
[0043] The host computer is further used to send a torque instruction to the load device through the motion controller, so that the load device operates according to the torque instruction during the process of the joint module executing the operation instruction; the torque instruction includes the load torque that the load device should achieve when executing the torque instruction;
[0044] The motion controller is also used to obtain the output torque collected by the torque sensor device and report the output torque to the host computer.
[0045] As an optional implementation, in the above-mentioned device, the load device includes an encoder;
[0046] The motion controller is also used to determine the actual angular position reached by the joint module when executing the operation instruction based on the position value of the encoder.
[0047] On the other hand, the present application provides a storage medium having a computer program stored thereon. When the computer program is executed by a processor, the various steps of the joint module testing method described in any one of the above items are implemented.
[0048] The testing method of the joint module proposed in the present application can send operating instructions to the joint module so that the joint module operates according to the operating instructions; the operating instructions include the target angular position that the joint module should reach when executing the operating instructions; the actual angular position reached by the joint module when executing the operating instructions is collected; the control accuracy of the joint module is determined by calculating the deviation between the actual angular position and the target angular position, thereby realizing the test of the control accuracy of the joint module. Moreover, the testing method of the present application has a high degree of automation and can effectively improve the testing efficiency. BRIEF DESCRIPTION OF THE DRAWINGS
[0049] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on the provided drawings without paying any creative work.
[0050] Figure 1 It is a flow chart of a joint module testing method provided in an embodiment of the present application;
[0051] Figure 2 It is a curve of the joint module following the instruction provided in the embodiment of the present application;
[0052] Figure 3 is a target corner position-time curve provided in an embodiment of the present application;
[0053] Figure 4 is a comparison curve between the target corner position and the actual corner position provided in the embodiment of the present application;
[0054] Figure 5 It is a schematic diagram of a flow chart of determining the control accuracy of a joint module provided in an embodiment of the present application;
[0055] Figure 6 It is a schematic diagram of a process for collecting output torque provided in an embodiment of the present application;
[0056] Figure 7 is a load torque-time curve provided in an embodiment of the present application;
[0057] Figure 8 is a comparison curve of load torque and output torque provided in an embodiment of the present application;
[0058] Fig. 9 is an input voltage-brake torque characteristic curve provided in an embodiment of the present application;
[0059] Fig.10 It is another flow chart of determining the control accuracy of a joint module provided in an embodiment of the present application;
[0060] Fig.11 It is a structural schematic diagram of a testing device for a joint module provided in an embodiment of the present application;
[0061] Fig.12 It is a structural schematic diagram of a joint module testing device provided in an embodiment of the present application;
[0062] Fig.13 It is a structural diagram of a host computer provided in an embodiment of the present application. DETAILED DESCRIPTION
[0063] The technical solution of the embodiment of the present application is suitable for application scenarios of testing joint modules. By adopting the technical solution of the embodiment of the present application, the control accuracy of the joint module can be tested and the testing efficiency of the joint module can be improved.
[0064] Exemplarily, the technical solution of the embodiment of the present application can be applied to hardware devices such as hardware processors, or packaged into a software program to be run. When the hardware processor executes the processing of the technical solution of the embodiment of the present application, or the above-mentioned software program is run, the test of the joint module can be realized. The embodiment of the present application only exemplarily introduces the specific processing of the technical solution of the present application, and does not limit the specific execution form of the technical solution of the present application. Any form of technical implementation that can execute the processing of the technical solution of the present application can be adopted by the embodiment of the present application.
[0065] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.
[0066] This embodiment proposes a method for testing a joint module. Figure 1 As shown, the method includes:
[0067] S101. Send an operation instruction to the joint module so that the joint module operates according to the operation instruction.
[0068] The joint module mentioned above refers to the module at the movable joint of the robot, which is composed of motors, reducers, encoders, etc. The joint module can output the corresponding angular position, speed, torque, etc. according to the input control instructions.
[0069] The performance of joint modules is different, and their ability to execute instructions is also different. Figure 2 The following is a typical curve diagram of a joint module following an instruction. Figure 2 The middle dotted line represents the control amount corresponding to the control instruction, and the solid line represents the actual execution amount fed back by the joint module. The deviation between the actual execution amount of the joint module and the control amount corresponding to the control instruction can reflect the performance of the joint module, that is, the smaller the deviation between the actual execution amount of the joint module and the control amount corresponding to the control instruction, the higher the performance of the joint module. The performance of the robot is related to the performance of the robot joint module. In order to ensure that the joint module can operate stably under the control of the drive device, the control accuracy of the joint module is tested in this embodiment.
[0070] The above-mentioned operation instruction refers to the instruction used to control the operation state of the joint module during the test process of the joint module, including the target angular position that the joint module should reach when executing the operation instruction. Among them, the angular position of the joint module refers to the angle of rotation or swing of the joint module. The target angular position refers to the target angle that the joint module is expected to rotate or swing to by sending the operation instruction to the joint module.
[0071] In the embodiment of the present application, the running time of the running instruction and the target angular position corresponding to each moment in the running time can be set according to the actual situation, and are not limited in this embodiment. For example, the angular position of the joint module in actual work can be set as follows: Figure 3 The target angular position-time curve shown is sent to the joint module as an operation instruction.
[0072] It should be noted that Figure 3 The target rotation angle position-time curve shown is only for explanation as an example and is not intended to be limiting.
[0073] In an embodiment of the present application, an operation instruction is sent to the joint module so as to control the joint module to operate according to the operation instruction.
[0074] S102, collecting the actual angular position reached by the joint module when executing the operation instruction.
[0075] The above-mentioned actual angular position refers to the angular position that the joint module can actually achieve when it operates according to the target angular position.
[0076] In this embodiment, the actual angular position reached by the joint module during the execution of the operation instruction is collected.
[0077] S103, determining the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position.
[0078] There is a certain deviation between the target corner position and the actual corner position of the joint module, and the deviation can reflect the control accuracy of the joint module, that is, the smaller the deviation between the target corner position and the actual corner position of the joint module, the higher the control accuracy of the joint module, and the larger the deviation between the target corner position and the actual corner position of the joint module, the lower the control accuracy of the joint module. In this embodiment, the deviation between the actual corner position and the target corner position is calculated, and then the control accuracy of the joint module is determined according to the deviation.
[0079] For example, if only a set of operating instructions are sent to the joint module during the test of the joint module, sampling can be performed according to the preset sampling frequency, and the deviation rate between the target angular position and the actual angular position corresponding to each sampling moment can be calculated, and then the average value of the deviation rate corresponding to all sampling moments can be calculated as the control accuracy of the joint module.
[0080] It should be noted that, in order to collect valid data, the sampling frequency should be greater than the control frequency. For example, the sampling frequency should be controlled to be more than 10 times the control frequency.
[0081] As another example, if the joint module sends multiple sets of operating instructions during the testing of the joint module, the control accuracy of the joint module under each set of operating instructions can be calculated according to the records in the above example, and then the average value of the control accuracy of the joint module under all operating instructions can be calculated as the control accuracy of the joint module.
[0082] After determining the control accuracy of the joint module, the control accuracy can be output to inform the user of the test result of the joint module. In addition, when outputting the control accuracy, a comparison curve between the target rotation angle position and the actual rotation angle position of the joint module can also be output, so that the user can understand the control accuracy of the joint module more intuitively.
[0083] For example, Figure 4 is a comparison curve between the target corner position and the actual corner position provided in the embodiment of the present application, such as Figure 4 As shown, the dotted line represents the target turning angle position, and the solid line represents the actual turning angle position. Figure 4 The comparison curve between the target rotation angle position and the actual rotation angle position is only provided as an example for explanation and does not constitute a limitation.
[0084] In the above embodiments, an operating instruction can be sent to the joint module so that the joint module operates according to the operating instruction; the operating instruction includes the target angle position that the joint module should reach when executing the operating instruction; the actual angle position reached by the joint module when executing the operating instruction is collected; the control accuracy of the joint module is determined by calculating the deviation between the actual angle position and the target angle position, thereby realizing the test of the control accuracy of the joint module. Moreover, the testing method of the present application has a high degree of automation and can effectively improve the testing efficiency.
[0085] As an optional implementation, Figure 5 As shown, in another embodiment of the present application, the steps of the above embodiment can specifically include the following steps by calculating the deviation between the actual corner position and the target corner position:
[0086] S501. Determine an effective actual turning angle position from multiple sets of collected actual turning angle positions.
[0087] In this embodiment, the number of operating instructions is multiple groups. Compared with the case where there is only one group of operating instructions, this embodiment can increase the amount of data, avoid the influence of accidental factors on the test results, and thus obtain more accurate test results. Moreover, if there are multiple groups of operating instructions, then the actual corner positions collected are also multiple groups. Under normal circumstances, the number of actual corner positions should be the same as the number of operating instructions. That is, the joint module runs a group of operating instructions, and a corresponding group of actual corner positions can be collected.
[0088] In the embodiment of the present application, the effective actual rotation angle position is determined from the collected multiple groups of actual rotation angle positions, wherein the effective actual rotation angle position includes the actual rotation angle position reached by the joint module when executing the operation instruction in a stable state.
[0089] Whether the joint module is in a stable state can be judged according to a variety of conditions. For example, it is judged whether the working current value of the joint module is stable within a preset current value interval, and whether the working voltage value is stable within a preset voltage value interval. If the working current value of the joint module is stable within a preset current value interval and the working voltage value of the joint module is stable within a preset voltage value interval, it means that the joint module is in a stable state. For another example, it is judged whether the deviation between the load torque of the joint module and the output torque generated by the joint module under the action of the load torque is within a preset deviation value interval. If the deviation between the load torque of the joint module and the output torque generated by the joint module under the action of the load torque is within a preset deviation value interval, it means that the joint module is in a stable state. For another example, the staff observes the operating state of the joint module, and judges whether the joint module is in a stable state based on the experience of the staff, etc., which is not limited in this embodiment.
[0090] It should be noted that the above-mentioned preset voltage value interval, preset current value interval and preset deviation value interval can be set according to actual conditions, and this embodiment does not limit them.
[0091] S502. Determine the control accuracy of the joint module by calculating the deviation between the effective actual rotation angle position and the target rotation angle position corresponding to the effective actual rotation angle position.
[0092] The target rotation angle position corresponding to the effective actual rotation angle position refers to the target rotation angle position included in the operation instruction executed when the effective rotation angle position is reached.
[0093] In this embodiment, the deviation between the effective actual rotation angle position and the target rotation angle position corresponding to the effective actual rotation angle position is calculated, and then the control accuracy of the joint module is determined according to the deviation between the effective actual rotation angle position and the target rotation angle position corresponding to the effective actual rotation angle position.
[0094] Exemplarily, sampling can be performed from the effective actual angle position and the target angle position corresponding to the effective actual angle position at a preset sampling frequency, and then the control accuracy of the joint module can be calculated based on the deviation rate between the effective target angle position and the target angle position corresponding to the effective actual angle position at each sampling moment.
[0095] As another example, sampling can be performed from all actual angle positions and target angle positions according to a preset sampling frequency, and then the effective actual angle position and the target angle position corresponding to the effective actual angle position are extracted from the sampled actual angle position and target angle position, and then the control accuracy of the joint module is calculated.
[0096] In the above embodiments, the control accuracy of the joint module is determined based on the actual angular position reached by the joint module when executing operating instructions in a stable state, and the target angular position corresponding to the actual angular position. This can eliminate the influence of abnormal data generated by the joint module executing operating instructions in an unstable state, thereby ensuring the reliability of the test results.
[0097] As an optional implementation, another embodiment of the present application discloses that the steps of the above embodiment determine the effective actual corner position from the collected multiple groups of actual corner positions, which may specifically include the following steps:
[0098] The torque deviation corresponding to the joint module when executing each set of operating instructions is collected; if the torque deviation corresponding to the joint module when executing any operating instruction is less than the preset torque deviation threshold, the actual angular position reached by executing the operating execution command is determined to be the effective actual angular position.
[0099] The torque deviation includes the deviation between the load torque of the joint module and the output torque generated by the joint module under the action of the load torque. The load torque refers to the torque output by the load device that simulates the load of the joint module during the test of the joint module. The load torque output by the load device is added to the tested joint module. The output torque refers to the torque output by the joint module under the action of the load torque.
[0100] In this embodiment, if the corresponding torque deviation when the joint module executes any operation instruction is less than the preset torque deviation threshold, it can be determined that the actual angular position reached by executing the operation execution command is a valid actual angular position; if the corresponding torque deviation when the joint module executes any operation instruction is greater than or equal to the preset torque deviation threshold, it can be determined that the actual angular position reached by executing the operation execution command is not a valid actual angular position.
[0101] The above torque deviation threshold can be set according to actual conditions and is not limited in this embodiment.
[0102] Exemplarily, the torque deviation corresponding to the joint module executing any operation instruction can be calculated in the following way:
[0103] When the joint module executes any running instruction, it samples according to the preset sampling frequency, calculates the deviation between the load torque and the output torque corresponding to each sampling moment, and then calculates the average value of the deviations corresponding to all sampling moments as the corresponding torque deviation when the joint module executes the running instruction.
[0104] It should be noted that, in order to collect valid data, the sampling frequency should be greater than the control frequency. For example, the sampling frequency should be controlled to be more than 10 times the control frequency.
[0105] When the joint module executes any operating instruction, the load torque and output torque, as well as the actual angular position and the target angular position can be sampled at the same sampling frequency, which is not limited in this embodiment.
[0106] In the above embodiments, whether the joint module is in a stable state when executing each set of operating instructions is determined based on the torque deviation corresponding to the joint module when executing the operating instructions, thereby eliminating the influence of abnormal data generated by the joint module executing the operating instructions in an unstable state, thereby ensuring the reliability of the test results.
[0107] As an optional implementation, Figure 6 As shown, in another embodiment of the present application, the output torque acquisition process of the above embodiment may specifically include the following steps:
[0108] S601. Send a torque instruction to the load device of the joint module, so that the load device operates according to the torque instruction when the joint module executes the operation instruction.
[0109] The above-mentioned load device refers to the device used to simulate the load of the joint module during the test of the joint module. The load device is generally a servo motor or a magnetic powder loader, which is coaxially connected to the joint module. The load device outputs the braking torque as the load torque and applies it to the joint module.
[0110] The torque command refers to a command for controlling the operating state of the load device during the test of the joint module, including the load torque that the load device should achieve when executing the torque command. In the embodiment of the present application, the operating time of the torque command and the load torque corresponding to each moment within the operating time can be set according to actual conditions, and are not limited in this embodiment.
[0111] For example, the following can be set according to the load conditions of the joint module in actual work: Figure 7 The load torque-time curve is shown. The load torque-time curve is sent to the load device as a torque command, so that the load device operates according to the torque command when the joint module executes the operation command.
[0112] It should be noted that Figure 7 The load torque-time curves shown are for illustrative purposes only and are not intended to be limiting.
[0113] Since there are multiple groups of operating instructions in the embodiment of the present application, multiple groups of torque instructions of the same number can be set accordingly, and the operating duration of the torque instruction should be greater than or equal to the operating duration of the operating instruction. When the joint module executes any operating instruction, the time when the load device starts to execute the torque instruction should be earlier than or equal to the time when the joint module executes the operating instruction, and the time when the load device ends to execute the torque instruction should be later than or equal to the time when the joint module ends to execute the operating instruction, so as to ensure that the load device can output load torque when the joint module executes any operating instruction and ensure the normal progress of the test.
[0114] Exemplarily, the running time of the torque instruction can be set according to the running time of the running instruction to ensure that each set of running instructions has a torque instruction with the same running time. When the joint module is executing any running instruction, the load device is controlled to simultaneously execute the torque instruction with the same running time as the running instruction. With such a configuration, when the joint module executes any running instruction, the load device can simultaneously execute the torque instruction of the same duration, so that the joint module and the load device can run at the same time and stop at the same time. Avoiding the load device being powered on when the joint module has not started running and the load device being powered on when the joint module has stopped running effectively saves energy consumption during the test. Moreover, the actual angular position and output torque of the joint module can be detected at the same time to ensure the synchronization of data acquisition.
[0115] S602, collecting the output torque of the joint module when the load device executes the torque command.
[0116] When the load device is executing the torque instruction and the joint module is executing the operation instruction, the output torque of the load device can be collected in real time.
[0117] Furthermore, a torque-time characteristic curve of the joint module can be generated and output so that the user can intuitively understand the deviation between the output torque and load torque of the joint module. Figure 8 : is a comparison curve of load torque and output torque provided in an embodiment of the present application, wherein the dotted line represents the load torque and the solid line represents the output torque. Figure 8 The load torque versus output torque curve shown is provided for illustrative purposes only and is not intended to be limiting.
[0118] Through the above embodiments, the output torque of the joint module during the process of the load device executing the torque instruction can be collected, and then the deviation between the output torque and the load torque when the joint module reaches the output torque can be determined.
[0119] As an optional implementation, another embodiment of the present application discloses that the steps of the above embodiment send a torque instruction to the load device of the joint module, which may specifically include the following steps:
[0120] According to a preset load device characteristic curve, a torque command is sent to the joint module; the load device characteristic curve includes an input voltage-braking torque characteristic curve of the load device.
[0121] Specifically, in actual control of the load device, sometimes a control signal, such as a voltage control signal or a current control signal, is sent to the load device to control the load torque output by the load device. For example, if the load device is a magnetic powder loader, a voltage signal can be sent to the magnetic powder control component in the magnetic powder loader, and the magnetic powder control component converts the voltage signal into a current signal to control the magnetic powder brake component in the magnetic powder loader to output a corresponding brake torque, that is, the load torque loaded on the joint module.
[0122] Based on this, in the embodiments of the present application, the control signal of the required braking torque can be consulted based on the characteristic curve of the load device, and then a control signal-time curve can be produced, that is, the control signal replaces the load torque of the above embodiment, and the control signal-time curve is sent to the load device, so that the load device outputs the corresponding load torque according to the control signal-time curve during the process of the joint module executing the operating instructions.
[0123] Exemplarily, the load device characteristic curve includes an input voltage-brake torque characteristic curve of the load device. If the load device is controlled based on a voltage signal, the voltage signal of the required brake torque can be referenced to the input voltage-brake torque characteristic curve.
[0124] In the above embodiments, if the load device is controlled by a control signal such as a voltage signal or a current signal, the control signal of the required braking torque can be consulted based on the characteristic curve of the load device, so that the load device outputs the corresponding load torque according to the control signal during the process of the joint module executing the operating instruction.
[0125] As an optional implementation, another embodiment of the present application discloses that the load device characteristic curve can be determined by the following steps:
[0126] A control signal is sent to the load device according to a preset step length to obtain a load torque corresponding to each control signal; and a load device characteristic curve is generated according to the test signal and the load torque corresponding to the test signal.
[0127] Before the test begins, the characteristic curve of the load device can be determined. Specifically, a control signal can be sent to the load device according to a preset step length. If the load device is a device controlled by a voltage signal, a voltage signal can be sent to the load device according to a preset step length. If the load device is a device controlled by a current signal, a current signal can be sent to the load device according to a preset step length.
[0128] Detect and record the load torque output by each control signal load device.
[0129] According to the test signal and the load torque corresponding to the test signal, a load device characteristic curve is generated, for example, Fig. 9The input voltage-brake torque characteristic curve shown is used to facilitate the control signal of the required brake torque to be consulted according to the characteristic curve, and to control the load device to output the corresponding load torque.
[0130] As an optional implementation, Fig.10 As shown, in another embodiment of the present application, the steps of the above embodiment determine the control accuracy of the joint module by calculating the deviation between the effective actual rotation angle position and the target rotation angle position corresponding to the effective actual rotation angle position, which may specifically include the following steps:
[0131] S1001. Calculate the deviation rate between each group of effective actual turning angle positions and the corresponding target turning angle positions.
[0132] In this embodiment, there are multiple groups of operating instructions. When the joint module executes any group of operating instructions, it will sample and obtain multiple groups of effective actual angular positions and target angular positions corresponding to the effective actual angular positions.
[0133] The calculation formula for calculating the deviation rate between each group of multiple effective actual corner positions and the target corner positions corresponding to the effective actual corner positions is as follows:
[0134]
[0135] In the above formula, P represents the deviation rate between any set of effective actual corner positions and the target corner positions corresponding to the effective actual corner positions, S2 represents the effective actual corner positions, and S1 represents the target corner positions corresponding to the effective actual corner positions.
[0136] S1002. According to the deviation rate between each group of effective actual rotation angle positions and the corresponding target rotation angle positions, the average deviation rate between all effective actual rotation angle positions and the corresponding target rotation angle positions is calculated as the control accuracy of the joint module.
[0137] Calculate the average deviation rate between all effective actual rotation angle positions and the corresponding target rotation angle positions as the control accuracy of the joint module. The calculation formula is as follows:
[0138]
[0139] In the above formula, It represents the control accuracy of the joint module, n represents the number of valid actual angular positions sampled when the joint module executes all operating instructions, and Pn represents the deviation rate between each group of valid actual angular positions and the corresponding target angular positions.
[0140] In the above embodiment, the deviation rate between each group of effective actual rotation angle positions and the corresponding target rotation angle positions is calculated, and then the average value of the deviation rate between all effective actual rotation angle positions and the corresponding target rotation angle positions is calculated according to the deviation rate between each group of effective actual rotation angle positions and the corresponding target rotation angle positions, as the control accuracy of the joint module. Such a setting can reflect the general situation and average level of the sampled data, making the reliability of the control accuracy higher.
[0141] As an optional implementation, another embodiment of the present application discloses that the steps of the above embodiment send an operation instruction to the joint module, which may specifically include the following steps:
[0142] Send multiple sets of identical operating instructions to the joint module;
[0143] Correspondingly, the steps of the above embodiment determine the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position, which may specifically include the following steps:
[0144] The stability control accuracy of the joint module is determined by calculating the deviation between the actual rotation angle position and the target rotation angle position.
[0145] In an embodiment of the present application, by sending multiple sets of identical operating instructions to the joint module, the actual angular position generated during the joint module running the multiple sets of identical operating instructions is collected, and based on the deviation between the actual angular position and the target angular position, the stability control accuracy of the joint module can be determined.
[0146] Among them, the stability control accuracy can evaluate the stability of the joint module when executing the same instructions.
[0147] As an optional implementation, another embodiment of the present application discloses that the steps of the above embodiment send an operation instruction to the joint module, which may specifically include the following steps:
[0148] Send multiple sets of different operating instructions to the joint module;
[0149] Correspondingly, the steps of the above embodiment determine the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position, which may specifically include the following steps:
[0150] By calculating the deviation between the actual angular position and the target angular position, the anti-disturbance control accuracy of the joint module is determined.
[0151] In an embodiment of the present application, by sending multiple sets of different operating instructions to the joint module, the actual angular position generated during the joint module running the multiple sets of different operating instructions is collected, and based on the deviation between the actual angular position and the target angular position, the anti-disturbance control accuracy of the joint module can be determined.
[0152] Among them, the anti-disturbance control accuracy can evaluate the anti-disturbance of the joint module when executing different instructions.
[0153] Corresponding to the above-mentioned joint module testing method, the present application embodiment also discloses a joint module testing device, see Fig.11 As shown, the device comprises:
[0154] The sending module 100 is used to send an operation instruction to the joint module so that the joint module operates according to the operation instruction; the operation instruction includes a target rotation angle position that the joint module should reach when executing the operation instruction;
[0155] The acquisition module 110 is used to acquire the actual rotation angle position reached by the joint module when executing the operation instruction;
[0156] The determination module 120 is used to determine the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position.
[0157] As an optional implementation, another embodiment of the present application discloses that the number of running instructions is multiple groups;
[0158] The determination module 120 in the above embodiment includes:
[0159] The first determination unit is used to determine the effective actual rotation angle position from the collected multiple sets of actual rotation angle positions; the effective actual rotation angle position includes the actual rotation angle position reached by the joint module executing the operation instruction in a stable state;
[0160] The second determination unit is used to determine the control accuracy of the joint module by calculating the deviation between the effective actual angle position and the target angle position corresponding to the effective actual angle position; wherein the target angle position corresponding to the effective actual angle position is the target angle position included in the operating instruction executed when the effective angle position is reached.
[0161] As an optional implementation, another embodiment of the present application discloses that when the first determination unit determines the effective actual rotation angle position from the collected multiple groups of actual rotation angle positions, it is specifically used to:
[0162] Collect the torque deviation corresponding to the joint module when executing each set of operation instructions; the torque deviation includes the deviation between the load torque of the joint module and the output torque generated by the joint module under the action of the load torque;
[0163] If the torque deviation corresponding to the joint module executing any operation command is less than the preset torque deviation threshold, the actual angular position reached by executing the operation command is determined to be the effective actual angular position.
[0164] As an optional implementation, another embodiment of the present application discloses that the process of the first determination unit collecting the output torque includes:
[0165] Sending a torque command to the load device of the joint module so that the load device operates according to the torque command when the joint module executes the operation command; the torque command includes the load torque that the load device should achieve when executing the torque command;
[0166] Collect the output torque of the joint module when the load device executes the torque command.
[0167] As an optional implementation, in another embodiment of the present application, when the first determination unit sends a torque instruction to the load device of the joint module, it is specifically used to:
[0168] Send torque instructions to the joint module according to the preset load device characteristic curve;
[0169] The load device characteristic curve includes an input voltage-braking torque characteristic curve of the load device.
[0170] As an optional implementation, in another embodiment of the present application, the second determination unit determines the control accuracy of the joint module by calculating the deviation between the effective actual rotation angle position and the target rotation angle position corresponding to the effective actual rotation angle position, and is specifically used to:
[0171] Calculate the deviation rate between each set of effective actual turning angle positions and the corresponding target turning angle positions;
[0172] According to the deviation rate between each set of effective actual rotation angle positions and the corresponding target rotation angle positions, the average deviation rate between all effective actual rotation angle positions and the corresponding target rotation angle positions is calculated as the control accuracy of the joint module.
[0173] As an optional implementation, another embodiment of the present application discloses that the sending module 100 includes:
[0174] A first sending unit, used for sending multiple groups of identical operation instructions to the joint module;
[0175] The determination module 120 further includes:
[0176] The third determination unit is further used to determine the stability control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position.
[0177] As an optional implementation, another embodiment of the present application discloses that the sending module 100 includes:
[0178] A second sending unit is used to send multiple groups of different operation instructions to the joint module;
[0179] The determination module 120 further includes:
[0180] The fourth determination unit is also used to determine the anti-disturbance control accuracy of the joint module by calculating the deviation between the actual angular position and the target angular position.
[0181] Specifically, for the specific working contents of each unit of the testing device of the joint module, please refer to the contents of the above-mentioned method embodiment, which will not be repeated here.
[0182] Corresponding to the above-mentioned joint module testing method, the present application embodiment also discloses a joint module testing device, see Fig.12 As shown, the device includes:
[0183] A host computer 200, and a motion controller 210 electrically connected to the host computer 200 and the joint module respectively.
[0184] The host computer is used to send an operation instruction to the joint module through the motion controller 210 so that the joint module operates according to the operation instruction; the operation instruction includes the target angular position that the joint module should reach when executing the operation instruction;
[0185] The motion controller 210 is used to collect the actual angular position reached by the joint module when executing the operation command;
[0186] The host computer 200 is also used to collect the actual angular position reported by the motion controller 210, and determine the control accuracy of the joint module by calculating the deviation between the actual angular position and the target angular position.
[0187] The host computer 200 can communicate with the motion controller 210 via Ethernet (EtherNET); the motion controller 210 and the joint module can communicate with each other via the CAN bus.
[0188] As an optional implementation, another embodiment of the present application discloses that the number of running instructions is multiple groups;
[0189] The host computer 200 determines the control accuracy of the joint module by calculating the deviation between the actual angular position and the target angular position, which is specifically used for:
[0190] The effective actual rotation angle position is determined from multiple groups of actual rotation angle positions reported by the motion controller 210; the effective actual rotation angle position includes the actual rotation angle position reached by the joint module when executing the operating instruction in a stable state; the control accuracy of the joint module is determined by calculating the deviation between the effective actual rotation angle position and the target rotation angle position corresponding to the effective actual rotation angle position; wherein the target rotation angle position corresponding to the effective actual rotation angle position is the target rotation angle position included in the operating instruction executed when the effective rotation angle position is reached.
[0191] As an optional implementation, another embodiment of the present application discloses that when the host computer 200 determines the effective actual corner position from the collected multiple sets of actual corner positions, it is specifically used to:
[0192] The torque deviation corresponding to the joint module when executing each set of operating instructions reported by the motion controller 210 is collected; the torque deviation includes the deviation between the load torque of the joint module and the output torque generated by the joint module under the action of the load torque; if the torque deviation corresponding to the joint module when executing any operating instruction is less than the preset torque deviation threshold, the actual angular position reached by executing the operating execution command is determined to be the effective actual angular position.
[0193] As an optional implementation, another embodiment of the present application discloses: Fig.12 As shown, the testing equipment of the joint module also includes a torque sensor device 220 and a load device 230 electrically connected to the motion controller 210 .
[0194] The first end of the torque sensing device 220 is connected to the axis of the joint module, and the second end of the torque sensing device 220 is connected to the axis of the load device 230; the torque sensing device 220 is used to collect the output torque of the joint module.
[0195] The host computer 200 is also used to send a torque instruction to the load device 230 through the motion controller 210, so that the load device 230 operates according to the torque instruction during the process of the joint module executing the operation instruction; the torque instruction includes the load torque that the load device 230 should achieve when executing the torque instruction;
[0196] The motion controller 210 is also used to obtain the output torque collected by the torque sensor 220 and report the output torque to the host computer 200 .
[0197] The motion controller 210 and the torque sensor device 220 may use RS485 bus for data communication.
[0198] Furthermore, the torque sensing device 220 includes a torque sensor, a torque collector and a matching cable, and the torque sensor and the torque collector are electrically connected through the matching cable. The torque sensor is arranged on the connecting shaft between the load device 230 and the joint module, and is used to collect the output torque of the joint module. The torque collector converts the output torque collected by the torque sensor into a digital signal, and converts the output torque into a digital signal and sends it to the motion controller 210 through the RS485 bus.
[0199] The motion controller 210 and the load device 230 may use a CAN bus for data communication. To further improve the stability of data communication, the motion controller 210 and the load device 230 may use a CANopen protocol.
[0200] Furthermore, the loading device 230 may be a servo loading device or a magnetic powder loading device.
[0201] The magnetic powder loading device includes a magnetic powder brake and a magnetic powder controller. The magnetic powder controller is electrically connected to the magnetic powder brake and the motion controller 210 respectively. The magnetic powder brake is connected to the second end shaft of the torque sensor 220. Exemplarily, the magnetic powder loading device generally also includes a matching cable, and the magnetic powder brake and the magnetic powder controller are electrically connected through the matching cable. The motion controller 210 can output a 0-10V voltage signal. After the magnetic powder controller obtains the 0-10V control signal, it outputs a corresponding 0-2A control current. This current is used to control the magnetic powder brake to output a load torque so that the load torque can be added to the torque sensor 220 and the joint module.
[0202] The servo loading device includes a servo motor and a servo controller, the servo controller is electrically connected to the servo motor and the motion controller 210 respectively, and the servo motor is connected to the second end shaft of the torque sensing device 220. The motion controller 11 can output a control signal, and the servo controller outputs a corresponding control current after obtaining the control signal. This current is used to control the servo motor to output a load torque so that the load torque can be added to the torque sensing device 220 and the joint module.
[0203] As an optional implementation method, disclosed in another embodiment of the present application, the testing equipment of the joint module also includes a voltage-stabilized power supply 240 electrically connected to the motion controller 210 and the joint module.
[0204] The first end of the voltage-stabilized power supply 240 is electrically connected to the joint module to supply power to the joint module and detect the working voltage and working current of the joint module; the second end of the voltage-stabilized power supply 240 is electrically connected to the motion controller 210 through the CAN bus to send the working voltage and working current of the joint module to the motion controller 210, and the motion controller 210 reports the working voltage and working current of the joint module to the host computer 200. The host computer 200 can analyze the relationship between the working voltage and working current of the joint module and the output torque according to the working voltage and working current of the joint module.
[0205] As an optional implementation, another embodiment of the present application discloses that when the host computer 200 sends a torque instruction to the load device of the joint module, it is specifically used to:
[0206] According to a preset load device characteristic curve, a torque instruction is sent to the joint module through the motion controller 210; the load device characteristic curve includes an input voltage-braking torque characteristic curve of the load device.
[0207] As an optional implementation, another embodiment of the present application discloses that the host computer 200 determines the control accuracy of the joint module by calculating the deviation between the effective actual angular position and the target angular position corresponding to the effective actual angular position, which is specifically used for:
[0208] Calculate the deviation rate between each set of effective actual rotation angle positions and the corresponding target rotation angle positions; based on the deviation rate between each set of effective actual rotation angle positions and the corresponding target rotation angle positions, calculate the average deviation rate between all effective actual rotation angle positions and the corresponding target rotation angle positions as the control accuracy of the joint module.
[0209] As an optional implementation, another embodiment of the present application discloses that when the host computer 200 sends an operation instruction to the joint module, it is specifically used to: send multiple groups of identical operation instructions to the joint module through the motion controller 210;
[0210] When the upper computer 200 determines the control accuracy of the joint module by calculating the deviation between the actual angle position and the target angle position, it is specifically used to determine the stability control accuracy of the joint module by calculating the deviation between the actual angle position and the target angle position.
[0211] As an optional implementation, another embodiment of the present application discloses that when the host computer 200 sends an operation instruction to the joint module, it is specifically used to: send multiple groups of different operation instructions to the joint module through the motion controller 210;
[0212] When the upper computer 200 determines the control accuracy of the joint module by calculating the deviation between the actual angle position and the target angle position, it is specifically used to determine the anti-disturbance control accuracy of the joint module by calculating the deviation between the actual angle position and the target angle position.
[0213] The testing equipment for the joint module provided in this embodiment belongs to the same application concept as the testing method for the joint module provided in the above embodiments of this application, can execute the testing method for the joint module provided in any of the above embodiments of this application, and has functional modules and beneficial effects corresponding to executing the above testing methods for the joint modules. For technical details not fully described in this embodiment, please refer to the specific processing content of the testing method for the joint module provided in the above embodiments of this application, which will not be repeated here.
[0214] Another embodiment of the present application further provides a host computer, see Fig.13 As shown, the host computer includes:
[0215] Memory 300 and processor 310;
[0216] The memory 300 is connected to the processor 310 and is used to store programs;
[0217] The processor 310 is used to implement the joint module testing method disclosed in any of the above embodiments by running the program stored in the memory 300.
[0218] Specifically, the host computer may further include: a bus, a communication interface 320 , an input device 330 and an output device 340 .
[0219] The processor 310, the memory 300, the communication interface 320, the input device 330 and the output device 340 are connected to each other via a bus.
[0220] A bus may include a pathway that transfers information between components of a computer system.
[0221] The processor 310 may be a general-purpose processor, such as a general-purpose central processing unit (CPU), a microprocessor, etc., or an application-specific integrated circuit (ASIC), or one or more integrated circuits for controlling the execution of the program of the present application. It may also be a digital signal processor (DSP), an application-specific integrated circuit (ASIC), a field programmable gate array (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components.
[0222] The processor 310 may include a main processor, and may also include a baseband chip, a modem, and the like.
[0223] The memory 300 stores a program for executing the technical solution of the present application, and may also store an operating system and other key services. Specifically, the program may include a program code, and the program code includes computer operation instructions. More specifically, the memory 300 may include a read-only memory (ROM), other types of static storage devices that can store static information and instructions, a random access memory (RAM), other types of dynamic storage devices that can store information and instructions, a disk storage, a flash, and the like.
[0224] The input device 330 may include a device for receiving data and information input by a user, such as a keyboard, a mouse, a camera, a scanner, a light pen, a voice input device, a touch screen, a pedometer, or a gravity sensor.
[0225] Output device 340 may include devices that allow information to be output to a user, such as a display screen, printer, speaker, etc.
[0226] The communication interface 320 may include any transceiver or the like to communicate with other devices or communication networks, such as Ethernet, Radio Access Network (RAN), Wireless Local Area Network (WLAN), etc.
[0227] The processor 310 executes the program stored in the memory 300 and calls other devices, which can be used to implement the various steps of the joint module testing method provided in the above embodiments of the present application.
[0228] In addition to the above-mentioned methods and devices, an embodiment of the present application may also be a computer program product, which includes computer program instructions. When the computer program instructions are executed by the processor 310, the processor 310 executes each step of the joint module testing method provided in the above-mentioned embodiment.
[0229] The computer program product may be written in any combination of one or more programming languages to write program codes for performing the operations of the embodiments of the present application, including object-oriented programming languages such as Java, C++, etc., and conventional procedural programming languages such as "C" language or similar programming languages. The program code may be executed entirely on the user computing device, partially on the user device, as a separate software package, partially on the user computing device and partially on a remote computing device, or entirely on a remote computing device or server.
[0230] In addition, an embodiment of the present application may also be a computer-readable storage medium on which computer program instructions are stored. When the computer program instructions are executed by the processor, the processor 310 executes each step of the joint module testing method provided in the above embodiment.
[0231] The computer readable storage medium can adopt any combination of one or more readable media. The readable medium can be a readable signal medium or a readable storage medium. The readable storage medium can include, for example, but is not limited to, a system, device or device of electricity, magnetism, light, electromagnetic, infrared, or semiconductor, or any combination of the above. More specific examples (non-exhaustive list) of readable storage media include: an electrical connection with one or more wires, a portable disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above.
[0232] For the aforementioned method embodiments, for the sake of simplicity, they are all described as a series of action combinations, but those skilled in the art should be aware that the present application is not limited by the order of the actions described, because according to the present application, some steps can be performed in other orders or simultaneously. Secondly, those skilled in the art should also be aware that the embodiments described in the specification are all preferred embodiments, and the actions and modules involved are not necessarily required by the present application.
[0233] It should be noted that each embodiment in this specification is described in a progressive manner, and each embodiment focuses on the differences from other embodiments, and the same or similar parts between the embodiments can be referred to each other. For the device embodiment, since it is basically similar to the method embodiment, the description is relatively simple, and the relevant parts can be referred to the partial description of the method embodiment.
[0234] The steps in the methods of each embodiment of the present application can be adjusted in order, combined and deleted according to actual needs, and the technical features recorded in each embodiment can be replaced or combined.
[0235] The modules and sub-modules in the devices and terminals of the various embodiments of the present application can be combined, divided and deleted according to actual needs.
[0236] In the several embodiments provided in the present application, it should be understood that the disclosed terminals, devices and methods can be implemented in other ways. For example, the terminal embodiments described above are only schematic, for example, the division of modules or submodules is only a logical function division, and there may be other division methods in actual implementation, for example, multiple submodules or modules can be combined or integrated into another module, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be an indirect coupling or communication connection through some interfaces, devices or modules, which can be electrical, mechanical or other forms.
[0237] The modules or submodules described as separate components may or may not be physically separated, and the components of the modules or submodules may or may not be physical modules or submodules, that is, they may be located in one place, or they may be distributed on multiple network modules or submodules. Some or all of the modules or submodules may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0238] In addition, each functional module or submodule in each embodiment of the present application may be integrated into one processing module, or each module or submodule may exist physically separately, or two or more modules or submodules may be integrated into one module. The above-mentioned integrated modules or submodules may be implemented in the form of hardware or in the form of software functional modules or submodules.
[0239] Professionals may further appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, computer software, or a combination of the two. In order to clearly illustrate the interchangeability of hardware and software, the composition and steps of each example have been generally described in the above description according to function. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professionals and technicians may use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of this application.
[0240] The steps of the method or algorithm described in conjunction with the embodiments disclosed herein may be implemented directly by hardware, software units executed by a processor, or a combination of the two. The software units may be placed in a random access memory (RAM), a memory, a read-only memory (ROM), an electrically programmable ROM, an electrically erasable programmable ROM, a register, a hard disk, a removable disk, a CD-ROM, or any other form of storage medium known in the art.
[0241] Finally, it should be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the presence of other identical elements in the process, method, article or device including the elements.
[0242] The above description of the disclosed embodiments enables those skilled in the art to implement or use the present application. Various modifications to these embodiments will be apparent to those skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present application. Therefore, the present application will not be limited to the embodiments shown herein, but will conform to the widest scope consistent with the principles and novel features disclosed herein.
Claims
1. A method for testing a joint module, characterized in that: include: Sending multiple sets of operation instructions to the joint module so that the joint module operates according to the operation instructions; the operation instructions include the target angular position that the joint module should reach when executing the operation instructions; wherein the target angular position that should be reached when executing the operation instructions includes: the target angular position corresponding to each moment within the operation time of the operation instructions; Collecting the actual angular position reached by the joint module when executing the operation instruction; Determining the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position; The step of determining the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position comprises: Determine an effective actual rotation angle position from the collected multiple sets of actual rotation angle positions; the effective actual rotation angle position includes the actual rotation angle position reached by the joint module when executing the operation instruction in a stable state; The control accuracy of the joint module is determined by calculating the deviation between the effective actual rotation angle position and the target rotation angle position corresponding to the effective actual rotation angle position.
2. The method according to claim 1, characterized in that Determine the effective actual rotation angle position from the collected multiple sets of actual rotation angle positions, including: Collecting the torque deviation corresponding to the joint module when executing each set of the operation instructions; the torque deviation includes the deviation between the load torque of the joint module and the output torque generated by the joint module under the action of the load torque; If the torque deviation corresponding to the execution of any operation instruction by the joint module is less than a preset torque deviation threshold, the actual rotation angle position reached by executing the operation execution command is determined to be a valid actual rotation angle position.
3. The method according to claim 2, characterized in that The output torque acquisition process includes: Sending a torque instruction to the load device of the joint module so that the load device operates according to the torque instruction during the process of the joint module executing the operation instruction; the torque instruction includes the load torque that the load device should achieve when executing the torque instruction; The output torque of the joint module during the process of the load device executing the torque instruction is collected.
4. The method according to claim 3, characterized in that Sending a torque instruction to a load device of the joint module includes: Sending the torque command to the joint module according to a preset load device characteristic curve; The load device characteristic curve includes an input voltage-braking torque characteristic curve of the load device.
5. The method according to claim 1, characterized in that Determining the control accuracy of the joint module by calculating the deviation between the effective actual rotation angle position and the target rotation angle position corresponding to the effective actual rotation angle position includes: Calculating the deviation rate between each group of the effective actual turning angle positions and the corresponding target turning angle positions; According to the deviation rate between each group of the effective actual rotation angle positions and the corresponding target rotation angle positions, the average deviation rate between all the effective actual rotation angle positions and the corresponding target rotation angle positions is calculated as the control accuracy of the joint module.
6. The method according to claim 1, characterized in that Send operation instructions to the joint module, including: Sending multiple sets of identical operation instructions to the joint module; Determining the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position includes: The stability control accuracy of the joint module is determined by calculating the deviation between the actual rotation angle position and the target rotation angle position.
7. The method according to claim 1, characterized in that Send operation instructions to the joint module, including: Sending multiple sets of different operating instructions to the joint module; Determining the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position includes: The anti-disturbance control accuracy of the joint module is determined by calculating the deviation between the actual rotation angle position and the target rotation angle position.
8. A testing device for a joint module, characterized in that: include: A sending module, used for sending multiple groups of operation instructions to the joint module, so that the joint module operates according to the operation instructions; the operation instructions include the target angular position that the joint module should reach when executing the operation instructions; wherein the target angular position that should be reached when executing the operation instructions includes: the target angular position corresponding to each moment within the operation time of the operation instructions; A collection module, used for collecting the actual angular position reached by the joint module when executing the operation instruction; A determination module, used to determine the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position; The determination module includes: a first determination unit and a second determination unit; The first determination unit is used to determine the effective actual rotation angle position from the collected multiple groups of actual rotation angle positions; the effective actual rotation angle position includes the actual rotation angle position reached by the joint module when executing the operation instruction in a stable state; The second determination unit is used to determine the control accuracy of the joint module by calculating the deviation between the effective actual rotation angle position and the target rotation angle position corresponding to the effective actual rotation angle position.
9. A testing device for a joint module, characterized in that: It includes: a host computer, and a motion controller electrically connected to the host computer and the joint module respectively; The host computer is used to send an operation instruction to the joint module through the motion controller so that the joint module operates according to the operation instruction; the operation instruction includes a target angular position that the joint module should reach when executing the operation instruction; wherein the target angular position that should be reached when executing the operation instruction includes: the target angular position corresponding to each moment within the operation time of the operation instruction; The motion controller is used to collect the actual angular position reached by the joint module when executing the operation instruction; The host computer is further used to collect the actual rotation angle position reported by the motion controller, and determine the control accuracy of the joint module by calculating the deviation between the actual rotation angle position and the target rotation angle position; The host computer is specifically used to determine the effective actual angle position from multiple sets of actual angle positions collected; the effective actual angle position includes the actual angle position reached by the joint module when executing the operation instruction in a stable state; by calculating the deviation between the effective actual angle position and the target angle position corresponding to the effective actual angle position, the control accuracy of the joint module is determined.
10. The joint module testing device according to claim 9, characterized in that: It also includes: a torque sensor device and a load device electrically connected to the motion controller; The first end of the torque sensor device is connected to the joint module shaft, and the second end of the torque sensor device is connected to the load device shaft; The host computer is further used to send a torque instruction to the load device through the motion controller, so that the load device operates according to the torque instruction during the process of the joint module executing the operation instruction; the torque instruction includes the load torque that the load device should achieve when executing the torque instruction; The motion controller is also used to obtain the output torque collected by the torque sensor device and report the output torque to the host computer.
11. The joint module testing device according to claim 10, characterized in that: The load device includes an encoder; The motion controller is also used to determine the actual angular position reached by the joint module when executing the operation instruction based on the position value of the encoder.
12. A storage medium, characterized in that: include: The storage medium stores a computer program, and when the computer program is executed by the processor, the various steps of the joint module testing method as described in any one of claims 1 to 7 are implemented.
Citation Information
Patent Citations
Test piece torque - corner measuring apparatus
CN101413837A
Positioning precision measuring system and method for joint module
CN114536403A
