Methods for determining the number of rotations of a speed reducer, joint modules, dexterous hands, and robots
By setting single-turn absolute encoders on the input and output sides of the reducer, and combining the reduction ratio and initial deviation angle, candidate values for the number of revolutions on the input and output sides are determined. The historical number of revolutions is then recovered through reliability screening, solving the problem of encoder revolution loss after power failure and enabling accurate positioning and torque calculation of robots and automated equipment.
Patent Information
- Application Number
- CN202611130902.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-07-28
- Publication Date
- 2026-11-17
AI Technical Summary
Single-turn absolute encoders cannot recover their rotation count after a power outage, which makes them unsuitable for some applications.
By setting single-turn absolute encoders on the input and output sides of the reducer, and combining the reduction ratio, initial deviation angle, and output side rotation candidate values, the input and output side rotation candidate values are determined, and the target reliability is screened out through reliability to recover the historical rotation number.
After the encoder loses power, it can accurately restore the number of rotations of the reducer, ensuring the normal continuity of positioning accuracy and torque calculation after the robot and automated equipment restart, and reducing hardware costs.
Smart Images

Figure CN123115583A_ABST
Abstract
Description
Technical Field
[0001] This application relates to the field of robotics technology, and in particular to a method for determining the number of rotations of a reducer, a joint module, a dexterous hand, and a robot. Background Technology
[0002] In related technologies, speed reducers are widely used in industrial automation, robotics, and other fields, serving to increase output torque and improve control accuracy. In many applications, to ensure control precision, an encoder is installed on both the input and output sides of the speed reducer. The input-side encoder is used for motor control, while the output-side encoder is used for positioning. The feedback angles from the input and output sides can also detect speed reducer deformation, thereby estimating the speed reducer's output torque.
[0003] For single-turn absolute encoders, during normal operation, the number of rotations can be calculated by observing changes in angle. For example, if the angle changes from... A sudden change to 0 indicates that the number of rotations has increased by one revolution. If the angle suddenly changes from 0 to... This indicates that the number of rotations has decreased by one. However, if a single-turn absolute encoder is powered off and then powered on again, the number of rotations before the power failure cannot be determined; that is, the number of rotations will be lost. Therefore, single-turn absolute encoders cannot meet the requirements of some applications that must provide the number of rotations. Summary of the Invention
[0004] This application aims to address at least one of the technical problems existing in the prior art. To this end, this application proposes a method for determining the number of rotations of a reducer, a joint module, a dexterous hand, and a robot, which can estimate the number of rotations already completed on the input and output sides of the reducer after the encoder is powered off, thus meeting the requirements of some applications that must provide the number of rotations.
[0005] In a first aspect, embodiments of this application provide a method for determining the number of rotations of a speed reducer, wherein both the input and output sides of the speed reducer are equipped with a single-turn absolute encoder, and the method includes: The input and output angles of the reducer are obtained by the single-turn absolute encoder. Determine the candidate value ranges for the reduction ratio, initial deviation angle, and number of revolutions on the output side of the reducer; For each output-side rotation candidate value in the candidate value range, the input-side rotation candidate value of the reducer is determined based on the input-side angle, the output-side angle, the reduction ratio, the initial deviation angle, and the output-side rotation candidate value. Determine the reliability of each of the input-side loop number candidate values, and filter out the target reliability from the plurality of reliability values; The input-side historical rotation count and / or output-side historical rotation count of the reducer are determined based on the target reliability.
[0006] According to some embodiments of this application, the single-turn absolute encoder includes a first single-turn absolute encoder disposed on the input side of the reducer and a second single-turn absolute encoder disposed on the output side of the reducer; obtaining the input-side angle and output-side angle of the reducer through the single-turn absolute encoder includes: Obtain the first feedback from the first single-turn absolute encoder and the second feedback from the second single-turn absolute encoder; The input-side angle is determined based on the first feedback and the first resolution of the first single-turn absolute encoder; The output side angle is determined based on the second feedback and the second resolution of the second single-turn absolute encoder.
[0007] According to some embodiments of this application, one of the following is included: The input-side angle is determined by the ratio of the first feedback to the first resolution, wherein the first feedback is greater than or equal to zero and less than the first resolution, and the input-side angle is greater than or equal to zero and less than 2. ; The output-side angle is determined by the ratio of the second feedback to the second resolution, wherein the second feedback is greater than or equal to zero and less than the second resolution, and the output-side angle is greater than or equal to zero and less than 2. .
[0008] According to some embodiments of this application, the candidate value range is determined through the following steps: The reduction ratio numerator and reduction ratio denominator of the reducer are determined according to the reduction ratio, wherein the reduction ratio is the ratio of the reduction ratio numerator to the reduction ratio denominator, and both the reduction ratio numerator and the reduction ratio denominator are positive integers; The candidate range of output-side revolutions of the reducer is determined based on the reduction ratio denominator, wherein the candidate range is greater than or equal to zero and less than the range of the reduction ratio denominator.
[0009] According to some embodiments of this application, the initial deviation angle is the angular position of the input side of the reducer when both the angular position and the number of revolutions on the output side of the reducer are zero.
[0010] According to some embodiments of this application, determining the input-side rotation candidate value of the reducer based on the input-side angle, the output-side angle, the reduction ratio, the initial deviation angle, and the output-side rotation candidate value includes: Determine the cumulative rotation angle of the reducer on the output side under the candidate value of the number of revolutions on the output side and the output side angle; The cumulative rotation angle of the input side of the reducer is determined based on the cumulative rotation angle on the output side and the reduction ratio. The candidate value for the number of revolutions on the input side of the reducer is determined based on the cumulative rotation angle on the input side, the input side angle, and the initial deviation angle.
[0011] According to some embodiments of this application, determining the reliability of each of the input-side loop number candidate values includes: The candidate values for the input side circle number are rounded to obtain the rounded value; Determine the absolute value of the difference between the candidate value of the input side circle number and the rounded value; The reliability of the candidate input-side loop count is determined based on the absolute value of the difference.
[0012] According to some embodiments of this application, the step of selecting a target reliability from a plurality of reliability values includes: selecting the reliability with the largest value from the plurality of reliability values as the target reliability value.
[0013] According to some embodiments of this application, determining the input-side historical rotation number and / or output-side historical rotation number of the reducer based on the target reliability includes: using the rounded value of the candidate value of the input-side rotation number corresponding to the target reliability as the input-side historical rotation number, and / or using the value of the target reliability within the candidate value range as the output-side historical rotation number.
[0014] Secondly, embodiments of this application provide a joint module, including a motor, a reducer, and a controller. The output end of the motor is connected to the reducer. A single-turn absolute encoder is provided on both the input and output sides of the reducer. The controller is connected to the single-turn absolute encoder. The controller is used to execute the method for determining the number of rotations of the reducer as described in the first aspect above.
[0015] Thirdly, embodiments of this application provide a dexterous hand, including a motor, a reducer, and a controller. The output end of the motor is connected to the reducer. A single-turn absolute encoder is provided on both the input and output sides of the reducer. The controller is connected to the single-turn absolute encoder. The controller is used to execute the method for determining the number of rotations of the reducer as described in the first aspect above.
[0016] Fourthly, embodiments of this application provide a robot including the joint module of the second aspect described above, and / or the dexterous hand of the third aspect described above.
[0017] According to the technical solution of this application embodiment, it has at least the following beneficial effects: This application embodiment can obtain and read the input side angle and output side angle after power-on using a single-turn absolute encoder, and calculate the corresponding input side rotation candidate value based on the reduction ratio, initial deviation angle, and output side rotation candidate value. Then, the cumulative rotation number in the past is deduced by comparing and filtering the reliability of the input side rotation candidate value. Therefore, this application embodiment can solve the defect of losing historical rotation number after power failure and restart of single-turn absolute encoder to a certain extent. It can restore the rotation number of the reducer without the need to install other encoders that do not lose data after power failure. It not only retains the advantages of single-turn absolute encoder that does not require mechanical zeroing after power-on and does not generate pulse accumulation position drift, but also provides complete and accurate rotation number parameters, ensuring that the positioning accuracy and torque calculation results can be used normally after the robot and automated equipment restart, and reducing the overall hardware cost.
[0018] Additional aspects and advantages of this application will be set forth in part in the description which follows, and in part will be obvious from the description, or may be learned by practice of this application. Attached Figure Description
[0019] The accompanying drawings are used to provide a further understanding of the technical solutions of this application and constitute a part of the specification. They are used together with the embodiments of this application to explain the technical solutions of this application and do not constitute a limitation on the technical solutions of this application.
[0020] Figure 1 This is a flowchart of a method for determining the number of rotations of a reducer according to an embodiment of this application; Figure 2 yes Figure 1 A flowchart of a sub-step of one embodiment of step S110; Figure 3 This is a flowchart illustrating the process of determining the candidate value range according to one embodiment of this application; Figure 4 yes Figure 1 A flowchart of a sub-step of one embodiment of step S130; Figure 5 yes Figure 1 A flowchart of the sub-steps of an embodiment of the reliability calculation process in step S140; Figure 6 yes Figure 1 A flowchart of a sub-step of one embodiment of step S150; Figure 7 It is a schematic diagram of the input side angle and number of revolutions, the output side angle and number of revolutions, and the initial deviation angle of the reducer; Figure 8This is a schematic diagram for estimating the number of rotations of the output side and the output side when the input side angle and the output side angle are known at the same time. Figure 9 With the reducer's reduction ratio at 4 / 3, the initial deviation angle at 0, and the current input angle at... The output side angle is A schematic diagram under the following circumstances; Figure 10 With the reducer's reduction ratio at 4 / 3, the initial deviation angle at 0, and the current input angle at... The output side angle is A schematic diagram under the following circumstances; Figure 11 This is a schematic diagram of a controller for performing a method for determining the number of rotations of a speed reducer, according to an embodiment of this application. Detailed Implementation
[0021] The embodiments of this application are described in detail below. Examples of the embodiments are shown in the accompanying drawings, wherein the same or similar reference numerals denote the same or similar elements or elements having the same or similar functions throughout. The embodiments described below with reference to the accompanying drawings are exemplary and are only used to explain this application, and should not be construed as limiting this application.
[0022] In the description of this application, it should be understood that the orientation descriptions, such as up, down, front, back, left, right, etc., indicate the orientation or positional relationship based on the orientation or positional relationship shown in the accompanying drawings. They are only for the convenience of describing this application and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, or be constructed and operated in a specific orientation. Therefore, they should not be construed as limitations on this application.
[0023] In the description of this application, "several" means one or more, "more than" means two or more, "greater than," "less than," and "exceeding" are understood to exclude the stated number, while "above," "below," and "within" are understood to include the stated number. The use of "first" and "second" in the description is merely for distinguishing technical features and should not be construed as indicating or implying relative importance, or implicitly indicating the number of indicated technical features, or implicitly indicating the order of the indicated technical features.
[0024] In the description of this application, unless otherwise expressly defined, terms such as "setup," "installation," and "connection" should be interpreted broadly, and those skilled in the art can reasonably determine the specific meaning of the above terms in this application in conjunction with the specific content of the technical solution.
[0025] In some applications, speed reducers are widely used in industrial automation, robotics, and other fields, where they can increase output torque and improve control accuracy. In many applications, to ensure control accuracy, an encoder is installed on both the input and output sides of the speed reducer. The input encoder is used for motor control, while the output encoder is used for positioning. The feedback angles from the input and output sides can also detect speed reducer deformation, thereby estimating the speed reducer's output torque.
[0026] For single-turn absolute encoders, during normal operation, the number of rotations can be calculated by observing changes in angle. For example, if the angle changes from... A sudden change to 0 indicates that the number of rotations has increased by one revolution. If the angle suddenly changes from 0 to... This indicates that the number of rotations has decreased by one. However, if a single-turn absolute encoder is powered off and then powered on again, the number of rotations before the power failure cannot be determined; that is, the number of rotations will be lost. Therefore, single-turn absolute encoders cannot meet the requirements of some applications that must provide the number of rotations.
[0027] Based on the above, this application proposes a method for determining the number of rotations of a reducer, a joint module, a dexterous hand, and a robot, which can estimate the number of rotations of the input and output sides of the reducer after the encoder is powered off, thus meeting the requirements of some applications that must provide the number of rotations.
[0028] The following description, in conjunction with the accompanying drawings, further elaborates on various embodiments of the method for determining the number of rotations of the reducer according to this application.
[0029] like Figure 1 As shown, Figure 1 This is a flowchart of a method for determining the number of rotations of a reducer according to an embodiment of this application. When a single-turn absolute encoder is provided on both the input and output sides of the reducer, the method for determining the number of rotations of the reducer may include, but is not limited to, steps S110, S120, S130, S140, and S150.
[0030] Step S110: Obtain the input side angle and output side angle of the reducer using a single-turn absolute encoder; Step S120: Determine the candidate value ranges for the reduction ratio, initial deviation angle, and number of revolutions on the output side of the reducer; Step S130: For each output-side rotation number candidate value in the candidate value range, determine the input-side rotation number candidate value of the reducer based on the input-side angle, output-side angle, reduction ratio, initial deviation angle, and output-side rotation number candidate value. Step S140: Determine the reliability of each input side loop number candidate value, and select the target reliability from multiple reliability values; Step S150: Determine the historical number of rotations on the input side and / or the historical number of rotations on the output side of the reducer based on the target reliability.
[0031] In one embodiment, firstly, this embodiment uses single-turn absolute encoders on both sides of the reducer to read the residual angles of the input and output sides of the reducer in the range of 0 to 2π after power-on, i.e., the input side angle and the output side angle. Then, this embodiment retrieves the inherent reduction ratio and initial deviation angle of the reducer, and also defines a candidate value range for the number of output side revolutions. Next, this embodiment iterates through each candidate value for the number of output side revolutions in the candidate value range, and calculates the candidate value for the number of input side revolutions that matches the candidate value for the number of output side revolutions by combining the input side angle, the output side angle, the reduction ratio, and the initial deviation angle. Then, this embodiment calculates the reliability of each candidate value for the number of input side revolutions, and selects the reliability that meets the conditions from multiple reliability values as the target reliability. Finally, this embodiment determines the true historical cumulative number of rotations of the reducer's input and output sides before power-off, i.e., the historical number of rotations of the input side and / or the historical number of rotations of the output side, based on a set of candidate values corresponding to the target reliability.
[0032] It should be noted that the embodiments of this application can obtain and read the input and output angles after power-on using a single-turn absolute encoder, and calculate the corresponding input rotation candidate value based on the reduction ratio, initial deviation angle, and output rotation candidate value. Then, the cumulative rotation number in the past is deduced by comparing and filtering the reliability of the input rotation candidate value. Therefore, the embodiments of this application can solve the defect of losing historical rotation numbers after power failure and restart of a single-turn absolute encoder to a certain extent. The rotation number of the reducer can be restored without the need to install other encoders that do not lose data after power failure. It not only retains the advantages of a single-turn absolute encoder that does not require mechanical zeroing after power-on and does not generate pulse accumulation position drift, but also provides complete and accurate rotation parameters, ensuring that the positioning accuracy and torque calculation results can be used normally after the robot and automated equipment restart, and reducing the overall hardware cost.
[0033] In one embodiment, the input side of the reducer is used to connect to the motor, and the output side of the reducer is used to connect to the load.
[0034] In one embodiment, the input side angle of the reducer is the actual rotation angle of the reducer input shaft, which is the rotational displacement of the reducer input shaft; in addition, the output side angle of the reducer is the actual rotation angle of the reducer output shaft, which is the rotational displacement of the reducer output shaft.
[0035] In one embodiment, the reduction ratio of the reducer is the ratio of the input rotational speed to the output rotational speed of the reducer, which can be expressed as a fraction with a coprime numerator and denominator. The ratio is a fixed value determined by the gear structure inside the reducer.
[0036] In one embodiment, the initial deviation angle is the angular position of the input side of the reducer when both the angular position and the number of revolutions on the output side of the reducer are zero. Specifically, the initial deviation angle is a fixed angular difference obtained after the motor and reducer are assembled and calibrated. When the output side of the reducer is adjusted to the standard zero position where the angle is zero and the cumulative number of revolutions is also zero, the real-time angular position corresponding to the input side of the reducer is the initial deviation angle. This initial deviation angle is a fixed offset that needs to be compensated for when the input side rotation angle and the output side rotation angle are matched and calculated.
[0037] In one embodiment, the candidate range of the number of output side turns is a finite integer interval determined by combining the reduction ratio of the simplified numerator and denominator being coprime, wherein the interval contains all integers from 0 to the reduction ratio minus one of the denominator value.
[0038] In one embodiment, the method of this application can be applied to different types of reducers such as harmonic reducers and planetary reducers, and this application does not specifically limit it.
[0039] In addition, such as Figure 2 As shown, Figure 2 yes Figure 1 A flowchart of a sub-step of one embodiment of step S110. The single-turn absolute encoder includes a first single-turn absolute encoder disposed on the input side of the reducer and a second single-turn absolute encoder disposed on the output side of the reducer; regarding the above step S110, it may include, but is not limited to, steps S210, S220 and S230.
[0040] Step S210: Obtain the first feedback from the first single-turn absolute encoder and the second feedback from the second single-turn absolute encoder; Step S220: Determine the input side angle based on the first feedback and the first resolution of the first single-turn absolute encoder; Step S230: Determine the output side angle based on the second feedback and the second resolution of the second single-turn absolute encoder.
[0041] In one embodiment, firstly, this embodiment reads the current first feedback and the factory-fixed first resolution of the first single-turn absolute encoder on the input side of the reducer. Simultaneously, it also reads the current second feedback and the factory-fixed second resolution of the second single-turn absolute encoder on the output side of the reducer. Next, this embodiment combines the first feedback and the first resolution of the first single-turn absolute encoder to calculate the actual angle corresponding to the current input side of the reducer, i.e., the input side angle. Furthermore, this embodiment combines the second feedback and the second resolution of the second single-turn absolute encoder to calculate the actual angle corresponding to the current output side of the reducer, i.e., the output side angle. Therefore, this embodiment can complete the conversion from the raw code value to the standard rotation angle based on the encoder's built-in fixed resolution.
[0042] In one embodiment, the first resolution and the second resolution mentioned above are fixed total scale values determined by the internal code disk and magnetic grating hardware structure of the single-turn absolute encoder at the factory and cannot be changed. This resolution represents the smallest angle range that the encoder can recognize and distinguish in one revolution. Additionally, the first feedback and the second feedback mentioned above are position scale values fed back outward by the encoder.
[0043] In one embodiment, the input-side angle is determined by the ratio of the first feedback to the first resolution, wherein the first feedback is greater than or equal to zero and less than the first resolution, and the input-side angle is greater than or equal to zero and less than 2π.
[0044] In one embodiment, the output side angle is determined by the ratio of the second feedback to the second resolution, wherein the second feedback is greater than or equal to zero and less than the second resolution, and the output side angle is greater than or equal to zero and less than 2π.
[0045] In addition, such as Figure 3 As shown, Figure 3 This is a flowchart illustrating the process of determining the candidate value range according to one embodiment of this application. The process of determining the candidate value range for the number of output-side turns may include, but is not limited to, steps S310 and S320.
[0046] Step S310: Determine the numerator and denominator of the reduction ratio of the reducer according to the reduction ratio, wherein the reduction ratio is the ratio of the numerator and denominator of the reduction ratio, and both the numerator and denominator of the reduction ratio are positive integers; Step S320: Determine the candidate range of the number of revolutions on the output side of the reducer based on the reduction ratio denominator, wherein the candidate range is greater than or equal to zero and less than the range of the reduction ratio denominator.
[0047] In one embodiment, firstly, the present invention will split the reducer into two coprime positive integers representing the numerator and denominator of the reduction ratio according to the predetermined reduction ratio; then, the present invention will use the integer representing the denominator of the reduction ratio as the range boundary to define a continuous integer interval starting from 0 and not including the integer itself as the candidate value range for the number of revolutions on the output side.
[0048] In addition, such as Figure 4 As shown, Figure 4 yes Figure 1 A flowchart illustrating the sub-steps of one embodiment of step S130. Step S130 may include, but is not limited to, steps S410, S420, and S430.
[0049] Step S410: Determine the cumulative rotation angle of the output side of the reducer under the candidate values of the number of revolutions on the output side and the angle on the output side; Step S420: Determine the cumulative rotation angle on the input side of the reducer based on the cumulative rotation angle on the output side and the reduction ratio; Step S430: Determine the candidate value of the input side rotation number of the reducer based on the cumulative rotation angle on the input side, the input side angle, and the initial deviation angle.
[0050] In one embodiment, firstly, this embodiment calculates the complete cumulative total rotation angle of the reducer output side by combining the output side single-turn residual angle (i.e., the output side angle) with the currently selected output side rotation number candidate value; then, based on the transmission correspondence of the reducer's fixed reduction ratio, this embodiment calculates the matching input side cumulative rotation angle according to the output side cumulative rotation angle; next, this embodiment subtracts the input side angle and the initial deviation angle from the input side cumulative rotation angle to obtain the input side rotation number candidate value corresponding to the current output side rotation number candidate value.
[0051] In one embodiment, by means of the above method, for each output-side turn count candidate value, a matching input-side turn count candidate value can be calculated. Therefore, the embodiments of this application will obtain multiple combinations of input-output turn count candidate values, each combination of input-output turn count candidate values including one output-side turn count candidate value and one input-side turn count candidate value.
[0052] In addition, such as Figure 5 As shown, Figure 5 yes Figure 1 A flowchart of the sub-steps of one embodiment of the reliability calculation process in step S140. The determination of the reliability of each input-side cycle number candidate value in step S140 may include, but is not limited to, steps S510, S520, and S530.
[0053] Step S510: Round the candidate values of the input side lap count to obtain the rounded value; Step S520: Determine the absolute value of the difference between the candidate value of the input side lap count and the rounded value; Step S530: Determine the reliability of the candidate values for the number of input side turns based on the absolute value of the difference.
[0054] In one embodiment, firstly, the present invention performs a rounding operation on each candidate value of the input lap count, such as rounding to the nearest integer or other rounding operation, to obtain an integer rounded value close to the candidate value of the input lap count; then, the present invention calculates the absolute value of the difference between the candidate value of the input lap count and the corresponding rounded value, wherein the absolute value of the difference reflects the degree of deviation between the candidate value of the input lap count and the standard integer lap count; next, the present invention uses this absolute value of the difference to deduce the reliability of the candidate value of the input lap count.
[0055] In one embodiment, there is a negative correlation between the reliability of the input side turn number candidate value and the absolute value of the difference, wherein the larger the absolute value of the difference, the lower the reliability of the input side turn number candidate value; and the smaller the absolute value of the difference, the higher the reliability of the input side turn number candidate value.
[0056] Through the above calculation method, the embodiments of this application can quantitatively distinguish the degree to which each input side rotation number candidate value conforms to the actual transmission conditions, and can intuitively screen out the optimal rotation number combination that matches the transmission law of the reducer, and filter out invalid candidate values that do not conform to the actual mechanical transmission relationship, thereby ensuring that the final determined historical rotation number result is more accurate and reliable.
[0057] In one embodiment, the step S530 above, which involves selecting the target reliability from multiple reliability values, can specifically be: selecting the reliability with the largest value from multiple reliability values as the target reliability.
[0058] Specifically, in this embodiment, the values of all reliability scores are compared, and the reliability score with the largest value is selected as the target reliability score. The larger the reliability score, the closer the corresponding input and output side rotation number candidate value combination is to the transmission relationship of the reducer. In this way, the actual historical rotation number of the input and output sides before the power failure can be determined.
[0059] In addition, such as Figure 6 As shown, Figure 6 yes Figure 1 A flowchart of the sub-steps of one embodiment of step S150. The determination of the historical number of input-side rotations and / or output-side rotations of the reducer based on the target reliability in step S150 may include, but is not limited to, steps S610 and / or S620.
[0060] Step S610: Round the candidate value of the number of revolutions on the input side corresponding to the target reliability as the historical number of revolutions on the input side; Step S620: Take the value corresponding to the target reliability in the candidate value range as the historical rotation number on the output side.
[0061] In one embodiment, firstly, the present application embodiment may select the integer obtained by rounding the candidate value of the input side rotation number corresponding to the target reliability, and use the integer as the cumulative historical rotation number of the input side before the power failure; in addition, the present application embodiment may select the candidate value of the output side rotation number previously selected within the candidate value range to generate the target reliability, as the cumulative historical rotation number of the output side before the power failure.
[0062] It should be noted that in the embodiments of this application, step S610 can be executed alone, step S620 can be executed alone, or steps S610 and S620 can be executed simultaneously.
[0063] Based on the methods for determining the number of rotations of the reducer in the above embodiments, the following are overall embodiments of the method for determining the number of rotations of the reducer according to this application.
[0064] In one embodiment, such as Figures 7 to 8 As shown in the figure, this application embodiment relates to a method for estimating the number of rotations of a reducer, specifically including the following steps: Step (1): Read the input side angle of the reducer. and output side angle .
[0065] Specifically, this application embodiment reads the feedback from the encoder on the input side of the reducer. That is, the first feedback of the first single-turn absolute encoder mentioned above, and the readout of the encoder feedback on the output side. That is, the second feedback of the second single-turn absolute encoder mentioned above, and then the input side angle of the reducer is calculated according to the following formula. and output side angle .
[0066]
[0067]
[0068] in, The resolution of the input-side single-turn absolute encoder is the first resolution of the first single-turn absolute encoder mentioned above. This refers to the resolution of the single-turn absolute encoder on the output side, which is the second resolution of the second single-turn absolute encoder mentioned above. The range of values for is [0, ), The range of values for is [0, ), The range of values for is [0, ), The range of values for is [0, ).
[0069] Step (2): Based on the current input side angle of the reducer Output side angle Estimate the number of rotations the current input side has completed. and the number of revolutions already rotated on the output side Among them, the number of laps That is, the historical number of rotations on the input side mentioned above, the number of rotations. That is, the historical number of rotations on the output side mentioned above.
[0070] 2.1 First, determine the reduction ratio of the reducer. Initial deviation of input and output angles ,in, That is, the initial deviation angle mentioned above.
[0071] The reduction ratio is the ratio of the input speed to the output speed, expressed as a fraction. express, and They are coprime, and their greatest common divisor is 1.
[0072] Initial deviation of input and output angles , represents the position on the input side when the output position and the number of revolutions are zero.
[0073] Input side angle Output side angle Enter the number of side rings and output side number of turns The following relationship exists:
[0074] 2.2 Calculate all possible combinations of input-output side loop number candidate values.
[0075] The candidate value range for the number of output side turns is [0, ), that is, 0, 1, 2, ... -1.
[0076] Let the output side turn number candidate value be... The value of n is in the range [0, ... ),and The candidate values for the number of revolutions on each output side are calculated according to the following formula. Corresponding input side loop candidate values .
[0077]
[0078] Using the above formula, we can obtain n sets of candidate values for the number of input and output side turns. , .
[0079] 2.3 Determine the number of turns on the input and output sides.
[0080] Calculate all input side lap count candidate values Reliability Specifically, it can be calculated using the following formula.
[0081]
[0082] in, For absolute value operators, The function represents the rounding operation on the input parameters.
[0083] If the reliability of the input side loop number candidate value is... If the maximum is reached, then the input is the number of side laps. and output side number of turns It can be obtained using the following formula.
[0084]
[0085]
[0086] It should be noted that if the number of rotations on the output side exceeds [0, The calculated number of output side turns will differ from the actual value within the specified range. Integer multiples of .
[0087] In one specific embodiment, such as Figure 9 As shown, the reduction ratio of the reducer is 4 / 3, and the specific steps include: (1) Read the input side angle of the reducer and output side angle .
[0088] Read the encoder feedback on the input side of the reducer That is, the first feedback of the first single-turn absolute encoder mentioned above, and the readout of the encoder feedback on the output side. This refers to the second feedback of the second single-turn absolute encoder mentioned above. Then, the input side angle of the reducer can be calculated according to the following formula. and output side angle .
[0089]
[0090]
[0091] in, The resolution of the input-side single-turn absolute encoder is the first resolution of the first single-turn absolute encoder mentioned above. This refers to the resolution of the single-turn absolute encoder on the output side, which is the second resolution of the second single-turn absolute encoder mentioned above. The range of values for is [0, ), The range of values for is [0, ), The range of values for is [0, ), The range of values for is [0, ).
[0092] (2) Based on the current input side angle of the reducer Output side angle Estimate the number of rotations the current input side has completed. and the number of revolutions already rotated on the output side .
[0093] 2.1 Determine the reduction ratio of the reducer Initial deviation of input and output angles ,in, That is, the initial deviation angle mentioned above.
[0094] In this embodiment, the reduction ratio is =4 / 3, which means =4, =3.
[0095] Initial deviation of input and output angles This represents the position on the input side when the output position and the number of revolutions are zero. In this embodiment, It is zero.
[0096] 2.2 Calculate all possible combinations of input-output side loop number candidate values.
[0097] The output side number ranges from [0, 3), which is 0, 1, 2.
[0098] Let the output side turn number candidate value be... n takes values in the range [0, 3), and The current input angle is The output side angle is The candidate values for the number of revolutions on each output side are calculated according to the following formula. Corresponding input side loop candidate values .
[0099]
[0100] Using the above formula, three sets of candidate values for the number of turns on the input and output sides can be obtained. , ), which are (-1 / 3, 0), (1, 1), and (7 / 3, 2), respectively.
[0101] 2.3 Determine the number of turns on the input and output sides.
[0102] Calculate all input lap number candidate values Reliability It can be calculated using the following formula.
[0103]
[0104] Using the above formula, the reliability of the three candidate input lap numbers can be calculated as follows: , , . The maximum value allows us to calculate the number of revolutions on both the input and output sides:
[0105]
[0106] In another specific embodiment, such as Figure 10 As shown, compared with the previous embodiment, the reduction ratio of the reducer is the same in this embodiment, but the initial deviation of the angles on the input and output sides is different. It is also zero. Only the current input side angle and output side angle are different. Therefore, only steps 2.2 and 2.3 are different from the above embodiment. Therefore, this embodiment only lists steps 2.2 and 2.3. The remaining steps are the same as the above embodiment and will not be repeated here.
[0107] 2.2 Calculate all possible combinations of input-output side loop number candidate values.
[0108] The output side number ranges from [0, 3), which is 0, 1, 2.
[0109] Let the output side turn number candidate value be... n takes values in the range [0, 3), and The current input angle is The output side angle is The candidate values for the number of revolutions on each output side are calculated according to the following formula. Corresponding input side loop candidate values .
[0110]
[0111] Using the above formula, three sets of candidate values for the number of turns on the input and output sides can be obtained. , ), which are (1 / 3, 0), (5 / 3, 1), and (3, 2), respectively.
[0112] 2.3 Determine the number of turns on the input and output sides.
[0113] Calculate all input lap number candidate values Reliability It can be calculated using the following formula:
[0114] Using the above formula, the reliability of the three candidate input lap numbers can be calculated as follows: , , . The maximum value allows us to calculate the number of revolutions on both the input and output sides:
[0115]
[0116] Based on the methods for determining the number of rotations of the reducer in the above embodiments, the following presents various embodiments of the controller, joint module, dexterous hand, robot, computer-readable storage medium, and computer program product of this application.
[0117] like Figure 11 As shown, Figure 11 This is a schematic diagram of a controller for executing a method for determining the number of rotations of a speed reducer, according to an embodiment of this application. The controller 100 implemented in this application includes: a processor 110, a memory 120, and a computer program stored in the memory 120 and executable on the processor 110, wherein... Figure 11 The example uses a processor 110 and a memory 120.
[0118] Processor 110 and memory 120 can be connected via a bus or other means. Figure 11 Taking the example of a connection between China and Israel via a bus.
[0119] Memory 120, as a non-transitory computer-readable storage medium, can be used to store non-transitory software programs and non-transitory computer-executable programs. Furthermore, memory 120 may include high-speed random access memory, and may also include non-transitory memory, such as at least one disk storage device, flash memory device, or other non-transitory solid-state storage device. In some embodiments, memory 120 may optionally include remotely located memories 120 relative to processor 110, which can be connected to controller 100 via a network. Examples of such networks include, but are not limited to, the Internet, intranets, local area networks, mobile communication networks, and combinations thereof.
[0120] Those skilled in the art will understand that Figure 11 The device structure shown does not constitute a limitation on the controller 100 and may include more or fewer components than shown, or combine certain components, or have different component arrangements.
[0121] exist Figure 11 In the controller 100 shown, the processor 110 can be used to call the control program stored in the memory 120, thereby implementing the above-described method for determining the number of rotations of the reducer. Specifically, the non-transient software program and instructions required to implement the method for determining the number of rotations of the reducer in the above embodiment are stored in the memory 120. When executed by the processor 110, the method for determining the number of rotations of the reducer in the above embodiment is executed.
[0122] It is worth noting that, since the controller 100 of this application embodiment can execute the method for determining the number of rotations of the reducer in any of the above embodiments, the specific implementation and technical effects of the controller 100 of this application embodiment can be referred to the specific implementation and technical effects of the method for determining the number of rotations of the reducer in any of the above embodiments.
[0123] In addition, one embodiment of this application provides a joint module, including a motor, a reducer, and a controller. The output end of the motor is connected to the reducer. A single-turn absolute encoder is provided on both the input and output sides of the reducer. The controller is connected to the single-turn absolute encoder and is used to execute the method for determining the number of rotations of the reducer in any of the above embodiments.
[0124] In one embodiment, the controller can be located inside or outside the joint module; this application does not specifically limit this.
[0125] Understandably, the joint module is the core execution unit for robot movement. It typically uses a motor and a reducer to form a small system that can output torque, achieve precise control, and provide dynamic response.
[0126] It is worth noting that, since the joint module of this application embodiment includes the controller of the above embodiments, and the controller of any of the above embodiments is capable of executing the method for determining the number of rotations of the reducer in any of the above embodiments, the specific implementation method and technical effects of the joint module of this application embodiment can be referred to the specific implementation method and technical effects of the method for determining the number of rotations of the reducer in any of the above embodiments.
[0127] In addition, one embodiment of this application provides a dexterous hand, including a motor, a reducer, and a controller. The output end of the motor is connected to the reducer. A single-turn absolute encoder is provided on both the input and output sides of the reducer. The controller is connected to the single-turn absolute encoder and is used to execute the method for determining the number of rotations of the reducer in any of the above embodiments.
[0128] It is worth noting that, since the dexterous hand in this application includes the controller of the above embodiments, and the controller of any of the above embodiments is capable of executing the method for determining the number of rotations of the reducer in any of the above embodiments, the specific implementation and technical effects of the dexterous hand in this application can be referred to the specific implementation and technical effects of the method for determining the number of rotations of the reducer in any of the above embodiments.
[0129] In addition, one embodiment of this application provides a robot including the joint module of the above embodiment, and / or the dexterous hand of the above embodiment.
[0130] It is worth noting that, since the robot in this application embodiment includes the joint module and / or dexterous hand of the above embodiments, and the joint module and / or dexterous hand includes the controller of the above embodiments, and the controller of any of the above embodiments is capable of executing the method for determining the number of rotations of the reducer of any of the above embodiments, the specific implementation method and technical effects of the robot in this application embodiment can refer to the specific implementation method and technical effects of the method for determining the number of rotations of the reducer of any of the above embodiments.
[0131] Furthermore, one embodiment of this application provides a computer-readable storage medium storing computer-executable instructions for performing the aforementioned method for determining the number of rotations of a reducer. Exemplarily, the above-described method is executed... Figures 1 to 6 The methods and steps in the text.
[0132] It is worth noting that, since the computer-readable storage medium of this application embodiment can execute the method for determining the number of rotations of the reducer in any of the above embodiments, the specific implementation and technical effects of the computer-readable storage medium of this application embodiment can be referred to the specific implementation and technical effects of the method for determining the number of rotations of the reducer in any of the above embodiments.
[0133] Furthermore, one embodiment of this application also provides a computer program product, including a computer program or computer instructions, which are stored in a computer-readable storage medium. A processor of a computer device reads the computer program or computer instructions from the computer-readable storage medium and executes the computer program or computer instructions, causing the computer device to perform the aforementioned method for determining the number of rotations of the reducer. Exemplarily, the above-described method is executed... Figures 1 to 6 The methods and steps in the text.
[0134] It is worth noting that, since the computer program product of this application embodiment can execute the method for determining the number of rotations of the reducer in any of the above embodiments, the specific implementation method and technical effects of the computer program product of this application embodiment can refer to the specific implementation method and technical effects of the method for determining the number of rotations of the reducer in any of the above embodiments.
[0135] It will be understood by those skilled in the art that all or some of the steps and systems in the methods disclosed above can be implemented as software, firmware, hardware, and suitable combinations thereof. Some or all of the physical components can be implemented as software executed by a processor, such as a central processing unit, digital signal processor, or microprocessor, or as hardware, or as an integrated circuit, such as an application-specific integrated circuit. Such software can be distributed on a computer-readable medium, which can include computer storage media (or non-transitory media) and communication media (or transient media). As is known to those skilled in the art, the term computer storage media includes volatile and non-volatile, removable and non-removable media implemented in any method or technology for storing information (such as computer-readable instructions, data structures, program modules, or other data). Computer storage media includes, but is not limited to, RAM, ROM, EEPROM, flash memory or other memory technologies, CD-ROM, digital versatile disc (DVD) or other optical disc storage, magnetic cartridges, magnetic tape, disk storage or other magnetic storage devices, or any other medium that can be used to store desired information and is accessible to a computer. Furthermore, as is known to those skilled in the art, communication media typically include computer-readable instructions, data structures, program modules, or other data in modulated data signals such as carrier waves or other transmission mechanisms, and may include any information delivery medium.
[0136] It should be understood that in this application, "at least one (item)" means one or more, and "more than" means two or more. "And / or" is used to describe the relationship between related objects, indicating that three relationships can exist. For example, "A and / or B" can represent three cases: only A exists, only B exists, and both A and B exist simultaneously, where A and B can be singular or plural. The character " / " generally indicates that the preceding and following related objects are in an "or" relationship. "At least one (item) of the following" or similar expressions refer to any combination of these items, including any combination of single or plural items. For example, at least one (item) of a, b, or c can represent: a, b, c, "a and b", "a and c", "b and c", or "a and b and c", where a, b, and c can be single or multiple.
[0137] In the several embodiments provided in this application, it should be understood that the disclosed systems, instruments, and methods can be implemented in other ways. For example, the instrument embodiments described above are merely illustrative; for instance, the division of units is only a logical functional division, and in actual implementation, there may be other division methods. For example, multiple units or components may be combined or integrated into another system, or some features may be ignored or not executed. Furthermore, the shown or discussed mutual couplings, direct couplings, or communication connections may be through some interfaces; indirect couplings or communication connections between instruments or units may be electrical, mechanical, or other forms. Units described as separate components may or may not be physically separate, and components shown as units may or may not be physical units, i.e., they may be located in one place or distributed across multiple network units. Some or all of the units can be selected to achieve the purpose of this embodiment according to actual needs.
[0138] It should also be understood that the various implementation methods provided in this application can be combined arbitrarily to achieve different technical effects.
[0139] The above provides a detailed description of the preferred embodiments of this application. However, this application is not limited to the above-described embodiments. Those skilled in the art can make various equivalent modifications or substitutions without departing from the spirit of this application. All such equivalent modifications or substitutions are included within the scope defined by the claims of this application.
Claims
1. A method for determining the number of rotations of a speed reducer, characterized in that, The reducer is equipped with a single-turn absolute encoder on both its input and output sides, and the method includes: The input and output angles of the reducer are obtained by the single-turn absolute encoder. Determine the candidate value ranges for the reduction ratio, initial deviation angle, and number of revolutions on the output side of the reducer; For each output-side rotation candidate value in the candidate value range, the input-side rotation candidate value of the reducer is determined based on the input-side angle, the output-side angle, the reduction ratio, the initial deviation angle, and the output-side rotation candidate value. Determine the reliability of each of the input-side loop number candidate values, and filter out the target reliability from the plurality of reliability values; The input-side historical rotation count and / or output-side historical rotation count of the reducer are determined based on the target reliability.
2. The method according to claim 1, characterized in that, The single-turn absolute encoder includes a first single-turn absolute encoder disposed on the input side of the reducer and a second single-turn absolute encoder disposed on the output side of the reducer. The process of obtaining the input-side angle and output-side angle of the reducer through the single-turn absolute encoder includes: Obtain the first feedback from the first single-turn absolute encoder and the second feedback from the second single-turn absolute encoder; The input-side angle is determined based on the first feedback and the first resolution of the first single-turn absolute encoder; The output side angle is determined based on the second feedback and the second resolution of the second single-turn absolute encoder.
3. The method according to claim 2, characterized in that, Including one of the following: The input-side angle is determined by the ratio of the first feedback to the first resolution, wherein the first feedback is greater than or equal to zero and less than the first resolution, and the input-side angle is greater than or equal to zero and less than 2. ; The output-side angle is determined by the ratio of the second feedback to the second resolution, wherein the second feedback is greater than or equal to zero and less than the second resolution, and the output-side angle is greater than or equal to zero and less than 2. .
4. The method according to claim 1, characterized in that, The candidate value range is determined through the following steps: The reduction ratio numerator and reduction ratio denominator of the reducer are determined according to the reduction ratio, wherein the reduction ratio is the ratio of the reduction ratio numerator to the reduction ratio denominator, and both the reduction ratio numerator and the reduction ratio denominator are positive integers; The candidate range of output-side revolutions of the reducer is determined based on the reduction ratio denominator, wherein the candidate range is greater than or equal to zero and less than the range of the reduction ratio denominator.
5. The method according to claim 1, characterized in that, The initial deviation angle is the angular position of the input side of the reducer when both the angular position and the number of revolutions on the output side of the reducer are zero.
6. The method according to claim 1, characterized in that, The step of determining the input-side rotation candidate value of the reducer based on the input-side angle, the output-side angle, the reduction ratio, the initial deviation angle, and the output-side rotation candidate value includes: Determine the cumulative rotation angle of the reducer on the output side under the candidate value of the number of revolutions on the output side and the output side angle; The cumulative rotation angle of the input side of the reducer is determined based on the cumulative rotation angle on the output side and the reduction ratio. The candidate value for the number of revolutions on the input side of the reducer is determined based on the cumulative rotation angle on the input side, the input side angle, and the initial deviation angle.
7. The method according to claim 1, characterized in that, The reliability of determining each of the input-side loop number candidate values includes: The candidate values for the input side circle number are rounded to obtain the rounded value; Determine the absolute value of the difference between the candidate value of the input side circle number and the rounded value; The reliability of the candidate input-side loop count is determined based on the absolute value of the difference.
8. The method according to claim 7, characterized in that, The step of selecting a target reliability from the plurality of reliability values includes: selecting the reliability value with the largest value from the plurality of reliability values as the target reliability value.
9. The method according to claim 7 or 8, characterized in that, The step of determining the input-side historical rotation number and / or output-side historical rotation number of the reducer based on the target reliability includes: using the rounded value of the candidate value of the input-side rotation number corresponding to the target reliability as the input-side historical rotation number, and / or using the value of the target reliability within the candidate value range as the output-side historical rotation number.
10. A joint module, characterized in that, The device includes a motor, a reducer, and a controller. The output end of the motor is connected to the reducer. A single-turn absolute encoder is provided on both the input and output sides of the reducer. The controller is connected to the single-turn absolute encoder. The controller is used to execute the method for determining the number of rotations of the reducer as described in any one of claims 1 to 9.
11. A dexterous hand, characterized in that, The device includes a motor, a reducer, and a controller. The output end of the motor is connected to the reducer. A single-turn absolute encoder is provided on both the input and output sides of the reducer. The controller is connected to the single-turn absolute encoder. The controller is used to execute the method for determining the number of rotations of the reducer as described in any one of claims 1 to 9.
12. A robot, characterized in that, Includes the joint module of claim 10, and / or the dexterous hand of claim 11.
