Motor speed signal processing method, device, robot and storage medium
By using the motor speed and performance parameters of the previous sampling cycle to predict the current speed, the problem of interference between the speed signal of the mobile robot motor is solved, and the precise control and stability of the motor speed are achieved.
Patent Information
- Application Number
- CN202010546786.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2020-06-16
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2040-06-16
AI Technical Summary
The motor speed signal of the mobile robot is easily disturbed by delay and noise during real-time sampling, resulting in divergence of motor speed control and affecting the accuracy of motion control.
By obtaining the motor speed of the previous sampling cycle, and predicting the current speed in combination with the motor performance parameters, the predicted speed is obtained, which is used to adjust the motor's set speed, reduce interference and improve real-time control accuracy.
In the motion control of mobile robots, the actual operating speed of the motor is obtained in real time and accurately, which reduces interference in the sampling speed signal, and improves the stability and real-timeness of motor speed control.
Smart Images

Figure CN112540630B_ABST
Abstract
Description
Technical Field
[0001] The present application belongs to the field of robotics technology, and in particular, relates to a method, device, robot and storage medium for motor speed filtering. Background Art
[0002] Mobile robots are generally driven by motors. Precise motion control of mobile robots is based on precise control of motors. During the movement of mobile robots, the motor speed may be inconsistent with the set motor speed due to changes in road conditions in the moving path, such as ups and downs in road conditions and changes in resistance. The motor control unit will control the motor to run at a speed close to the set speed, but the actual running speed of the motor will still change. Therefore, the mobile robot needs to obtain the actual running speed of the motor in real time and adjust the set speed of the motor according to the actual running speed of the motor and the path planning of the mobile robot.
[0003] However, the actual situation is that the motor speed signal obtained by real-time sampling may be interfered by delay or noise, so the sampling speed obtained by sampling the motor speed may be inconsistent with the actual speed of the motor. If the sampling speed obtained by real-time sampling of the motor speed is directly used to adjust the set speed of the motor, it may lead to the divergence of the motor speed control, and then lead to the divergence of the motion control of the mobile robot.
[0004] Generally, it is necessary to filter the sampled speed signal of the motor obtained by real-time sampling. In the prior art, a first-order or second-order low-pass filter is often used to filter the real-time sampled speed signal, but the filtering process is relatively complicated. Therefore, in the motion control of the mobile robot, it is necessary to implement a method for removing interference from the sampled speed signal of the motor. Summary of the invention
[0005] The embodiments of the present application provide a method, device, robot and storage medium for motor speed filtering, which can solve at least part of the above problems.
[0006] In a first aspect, an embodiment of the present application provides a method for processing a motor speed signal, comprising:
[0007] Get the first sampling speed of the previous sampling period;
[0008] The current speed of the motor is predicted according to the first sampling speed, the motor performance parameter and the first set speed to obtain the predicted speed; the first set speed is the set speed of the motor when the first sampling speed is obtained from the motor sampling.
[0009] It should be understood that the embodiment of the present application predicts the speed of the current sampling period by the sampling speed obtained in the previous sampling period, so the predicted speed of the current sampling period can be obtained in real time, and the predicted speed is close to the actual running speed of the motor. Because the change in the motor speed calculated according to the motor performance parameters is a linear operation, the speed signal processing method provided by the embodiment of the present application has a small amount of calculation and good real-time performance; the obtained predicted speed can be applied to the real-time control of the motor.
[0010] In a second aspect, an embodiment of the present application provides a device for processing a motor speed signal, comprising:
[0011] A first sampling speed acquisition module, used to acquire the first sampling speed of the previous sampling period;
[0012] The predicted speed acquisition module is used to predict the current speed of the motor according to the first sampling speed, motor performance parameters and a first set speed to obtain a predicted speed; the first set speed is the set speed of the motor when the first sampling speed is obtained from motor sampling.
[0013] In a third aspect, an embodiment of the present application provides a robot, comprising:
[0014] A memory, a processor, and a computer program stored in the memory and executable on the processor, wherein when the computer program is executed by the processor, the method steps described in the first aspect are implemented.
[0015] In a fourth aspect, an embodiment of the present application provides a computer-readable storage medium, including: the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the method steps described in the first aspect are implemented.
[0016] In a fifth aspect, an embodiment of the present application provides a computer program product. When the computer program product is run on an electronic device, the electronic device executes the method steps described in the first aspect above.
[0017] It can be understood that the beneficial effects of the second to fifth aspects mentioned above can be found in the relevant description of the first aspect mentioned above, and will not be repeated here. BRIEF DESCRIPTION OF THE DRAWINGS
[0018] In order to more clearly illustrate the technical solutions in the embodiments of the present application, 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 some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.
[0019] Figure 1is a schematic diagram of the system structure of a robot provided by an embodiment of the present application;
[0020] Figure 2 It is a flowchart of a method for processing a motor speed signal provided in an embodiment of the present application;
[0021] Figure 3 It is a speed curve comparison diagram of the predicted speed, the motor set speed, and the second sampling speed in one embodiment of the present application;
[0022] Figure 4 is a flow chart of a method for processing a motor speed signal provided in another embodiment of the present application;
[0023] Figure 5 is a speed curve comparison diagram of the predicted speed, the motor set speed, and the second sampling speed of another embodiment of the present application;
[0024] Figure 6 is a schematic diagram of the structure of a motor speed signal processing device provided in an embodiment of the present application;
[0025] Figure 7 It is a structural schematic diagram of the motor speed signal processing unit provided in an embodiment of the present application. DETAILED DESCRIPTION
[0026] In the following description, specific details such as specific system structures, technologies, etc. are provided for the purpose of illustration rather than limitation, so as to provide a thorough understanding of the embodiments of the present application. However, it should be clear to those skilled in the art that the present application may also be implemented in other embodiments without these specific details. In other cases, detailed descriptions of well-known systems, devices, circuits, and methods are omitted to prevent unnecessary details from obstructing the description of the present application.
[0027] It should be understood that when used in the present specification and the appended claims, the term "comprising" indicates the presence of described features, wholes, steps, operations, elements and / or components, but does not exclude the presence or addition of one or more other features, wholes, steps, operations, elements, components and / or combinations thereof.
[0028] It should also be understood that the term “and / or” used in the specification and appended claims refers to any and all possible combinations of one or more of the associated listed items, and includes these combinations.
[0029] As used in the specification and appended claims of this application, the term "if" can be interpreted as "when" or "uponce" or "in response to determining" or "in response to detecting", depending on the context. Similarly, the phrase "if it is determined" or "if [described condition or event] is detected" can be interpreted as meaning "uponce it is determined" or "in response to determining" or "uponce [described condition or event] is detected" or "in response to detecting [described condition or event]", depending on the context.
[0030] In addition, in the description of the present application specification and the appended claims, the terms "first", "second", "third", etc. are only used to distinguish the descriptions and cannot be understood as indicating or implying relative importance.
[0031] References to "one embodiment" or "some embodiments" etc. described in the specification of this application mean that one or more embodiments of the present application include specific features, structures or characteristics described in conjunction with the embodiment. Therefore, the statements "in one embodiment", "in some embodiments", "in some other embodiments", "in some other embodiments", etc. that appear in different places in this specification do not necessarily refer to the same embodiment, but mean "one or more but not all embodiments", unless otherwise specifically emphasized in other ways. The terms "including", "comprising", "having" and their variations all mean "including but not limited to", unless otherwise specifically emphasized in other ways.
[0032] In order to solve the technical problem of the present application, in the motion control of a mobile robot, the motion speed of the robot is controlled in real time, and a method with small computational complexity and high precision is provided to remove interference in the motor sampling speed signal.
[0033] The embodiment of the present application obtains the first sampling speed of the motor from the motor control unit in the previous sampling period, and predicts the actual speed of the motor in the current sampling period according to the performance parameters of the motor and the first set speed of the motor when the first sampling speed is obtained, so as to obtain the predicted speed. Since the predicted speed is a prediction of the result of adjusting the motor speed based on the motor performance, the predicted speed is close to the actual operating speed of the motor, which is equivalent to removing the interference in the second sampling speed of the current sampling period, and obtaining the actual operating speed of the motor after filtering. The predicted speed can be used to adjust the set speed of the motor. In some embodiments, the second set speed of the motor is determined by the predicted speed.
[0034] It can be understood that the embodiment of the present application predicts the speed of the current sampling period through the sampling speed obtained in the previous sampling period, so the predicted speed of the current sampling period can be obtained in real time, and the predicted speed is close to the actual running speed of the motor. Because the change in the motor speed calculated according to the motor performance parameters is a linear operation, the speed signal processing method provided by the embodiment of the present application has a small amount of calculation and good real-time performance; the obtained predicted speed can be applied to the real-time control of the motor.
[0035] Figure 1 The system structure diagram of a robot provided in an embodiment of the present application is shown. The robot comprises: a navigation control unit 110 , a motor speed signal processing unit 120 , a motor control unit 130 , and one or more motors 140 .
[0036] The navigation control unit 110 is used to navigate the robot according to the user's instructions or according to the robot's travel plan. The navigation includes but is not limited to setting motion control instructions, and the motion control instructions include the speed at which the robot moves to a target position.
[0037] The motor speed signal processing unit 120 is used to solve the motion control instruction to obtain the set speed of each motor according to the speed of the robot going to the target position set by the navigation control unit 110.
[0038] The motor control unit 130, also known as a servo driver, servo controller, or servo amplifier, is a controller used to control a servo motor. Its function is similar to that of a frequency converter on an ordinary AC motor. It is part of a servo system and is mainly used in high-precision positioning systems. Generally, the servo motor is controlled in three ways: position, speed, and torque.
[0039] The motor 140 includes but is not limited to a servo motor and a stepper motor. In some embodiments, the motor 140 is a hub motor.
[0040] The navigation control unit 110 sends a motion control instruction to the motor speed signal processing unit 120; the motor speed signal processing unit 120 sends predicted speed data to the navigation control unit.
[0041] The motor speed signal processing unit 120 sends the motor set speed to the motor control unit 130; the motor set speed is the motion speed for each motor obtained by solving the motion control instruction. In some embodiments, the motion speed of the motor is the motor speed. Generally, the speed unit is revolutions per minute (RPM).
[0042] The motor control unit 130 provides a driving current to the motor 140 according to the set speed of the motor; the motor 140 feeds back a motor speed signal to the motor control unit 130 via a sensor, such as a code disk.
[0043] In some embodiments, the navigation control unit 110 , the motor speed signal processing unit 120 , and the motor control unit 130 each have a memory, a processor, and a communication device. The navigation control unit 110 , the motor speed signal processing unit 120 , and the motor control unit 130 transmit signals through their respective communication devices and cables.
[0044] In some embodiments, at least two of the navigation control unit 110 , the motor speed signal processing unit 120 , and the motor control unit 130 may be integrated into a unit having a memory, a processor, and a communication device.
[0045] It should be understood that the robot may also include a communication unit, a visual unit, a voice unit, a positioning unit, a power unit, a service unit, etc. adapted to practical applications. Figure 1 Functional units not shown.
[0046] In some embodiments, the robot is a mobile robot.
[0047] The technical principle of the embodiment of the present application is described below:
[0048] When the actual running speed of the motor is inconsistent with the set speed of the motor, the motor control unit will adjust the speed of the motor so that the actual running speed of the motor is close to the set speed of the motor. At the same time, when the actual running speed of the motor is inconsistent with the set speed of the motor, the actual speed of the motor adjusted by the motor control unit is limited by the performance of the motor and the set speed.
[0049] For example, if the running speed of the motor at the previous moment is greater than the set speed, the motor control unit will control the motor to decelerate. During the deceleration process, if the motor's performance enables the motor to decelerate to the set speed, then after adjustment by the motor control unit, the current actual running speed of the motor should be the set speed. If the motor's performance limits the speed adjustment of the motor, after the motor control unit adjusts the deceleration, the actual speed that the motor can reach is still greater than the set speed, then the current actual running speed of the motor should be the minimum speed that the motor's deceleration performance can reach during the time period from the previous moment to the current moment.
[0050] For another example, if the running speed of the motor at the previous moment is less than the set speed, the motor control unit will control the motor to accelerate. During the acceleration process, if the performance of the motor enables it to accelerate to the set speed, then after adjustment by the motor control unit, the current actual running speed of the motor should be the set speed. If the performance of the motor limits the speed adjustment of the motor, after the motor control unit adjusts the acceleration, the actual speed that the motor can reach is still less than the set speed, then in the time period from the previous moment to the current moment, the current actual running speed of the single machine should be the maximum speed that the motor deceleration performance can reach.
[0051] Based on the above understanding of the influence of motor performance on the adjustment of motor running speed, the speed of the motor in the current sampling period should be one of the speed that the motor can achieve under the control of the motor control unit during the period from the previous sampling period to the current sampling period and the set speed. The embodiment of the present application provides a method for processing a motor speed signal.
[0052] Figure 2 The method for processing the motor speed signal provided in the embodiment of the present application is shown, which is applied to the above Figure 1 The motor speed signal processing unit 120 in the robot shown in the figure can be implemented by software and / or hardware of the motor speed signal processing unit 120. Figure 2 As shown, the method includes steps S110 to S120. The specific implementation principle of each step is as follows:
[0053] S110, obtaining a first sampling speed of a previous sampling period.
[0054] In the embodiment of the present application, the motor speed signal processing unit 120 obtains the motor sampling speed of the current sampling cycle from the motor control unit 130 at period T1 and stores it in the storage medium. In each sampling cycle, the motor speed signal processing unit 120 obtains the first sampling speed of the previous sampling cycle from the storage medium.
[0055] S120, predicting the current speed of the motor according to the first sampling speed, motor performance parameters and a first set speed to obtain a predicted speed; the first set speed is the set speed of the motor when the first sampling speed is obtained from motor sampling.
[0056] It should be understood that the period T2 in which the motor speed signal processing unit 120 sends the set speed to the motor control unit 130 may be the same as or different from the sampling period T1. If T2 and T1 are the same period, then in each sampling period, the motor speed signal processing unit 120 sends an updated set speed to the motor control unit 130, and the set speed of the motor corresponding to the previous sampling period is the motor speed set in the period of the previous set speed. If T2 and T1 are different periods, usually T2 is greater than T1, then when the first sampling speed is obtained from the motor sampling, the set speed of the motor is the motor set speed when the first sampling speed is obtained from the motor control unit 130.
[0057] In a non-limiting example, when the motor speed signal processing unit 120 obtains the motor sampling speed of the current sampling period from the motor control unit 130 with a period T1 and stores it in a storage medium, the set speed of the motor is saved in the storage medium to facilitate the search for the corresponding first set speed when obtaining the first sampling speed.
[0058] In the embodiment of the present application, the motor performance parameters include but are not limited to: acceleration performance parameters and deceleration performance parameters. The acceleration performance parameter is the maximum acceleration when the motor accelerates; the deceleration performance parameter is the maximum deceleration when the motor decelerates. On this basis, the current speed of the motor is predicted according to the first sampling speed, the motor performance parameters and the first set speed to obtain the predicted speed, including step A and step B:
[0059] Step A: Compare the first sampling speed and the first set speed to obtain a comparison result; select the motor performance parameter according to the comparison result, and determine the estimated speed according to the selected motor performance parameter and the first sampling speed.
[0060] In a non-limiting example of step A, the motor performance parameter is selected according to the comparison result, and the estimated speed is determined according to the selected motor performance parameter and the first sampling speed, including: if the comparison result is that the first sampling speed is less than the first set speed, the acceleration performance parameter is selected as the motor performance parameter, and the estimated speed is obtained according to the first sampling speed and the acceleration performance parameter of the motor; if the comparison result is that the first sampling speed is greater than the first set speed, the estimated speed is obtained according to the first sampling speed and the deceleration performance parameter of the motor.
[0061] In another non-limiting example, obtaining the estimated speed according to the first sampled speed and the acceleration performance parameter of the motor includes: obtaining the estimated speed by performing a linear operation on the first sampled speed and the acceleration performance parameter of the motor. For example, by formula V L =V fb +aacc T obtains the estimated speed, where V L To estimate the speed, V fb is the first sampling speed, a acc is the acceleration performance parameter, and T is the sampling period. The estimated speed is obtained according to the first sampling speed and the deceleration performance parameter of the motor, including: obtaining the estimated speed by performing a linear operation on the first sampling speed and the deceleration performance parameter of the motor. For example, by formula V L =V fb -a dec T obtains the estimated speed; wherein, V L To estimate the speed, V fb is the first sampling speed, a dec Deceleration performance parameter, T is the sampling period.
[0062] In another non-limiting exemplary embodiment of step A, the estimated speed is obtained according to the first sampling speed and the acceleration performance parameters of the motor, which may be obtained by the first sampling speed, a filter coefficient and the acceleration performance parameters; the estimated speed is obtained according to the first sampling speed and the deceleration performance parameters of the motor, which may be obtained by the first sampling speed, a filter coefficient and the deceleration performance parameters.
[0063] It is understandable that the filter coefficient can be debugged or the ideal value can be obtained based on experience. By setting the filter coefficient, the estimation speed can be adjusted according to the actual situation, thereby obtaining the corresponding prediction speed according to the requirements of different feedback effects.
[0064] In a non-limiting specific example of step A, obtaining the estimated speed according to the first sampling speed, the filter coefficient and the acceleration performance parameter includes:
[0065] By formula V L =V fb +ka acc T obtains the estimated speed;
[0066] Obtaining the estimated speed according to the first sampling speed, the filter coefficient and the deceleration performance parameter includes:
[0067] By formula V L =V fb -ka dec T obtains the estimated speed;
[0068] Among them, V L To estimate the speed, V fb is the first sampling speed, a acc is the acceleration performance parameter, a decDeceleration performance parameters, T is the sampling period, k is the filter coefficient.
[0069] Step B: selecting a prediction rule according to the comparison result, and predicting the current speed of the motor according to the estimated speed and the first set speed by using the selected prediction rule to obtain the predicted speed.
[0070] Based on the understanding of the principle and control effect of the motor control unit 130 controlling the motor 140, the prediction model for predicting the current speed of the motor includes but is not limited to a simple mathematical model, a probability statistical model, a neural network model and other prediction models.
[0071] In a non-limiting example of step B, a prediction rule is selected based on the comparison result, and the current speed of the motor is predicted according to the estimated speed and the first set speed by the selected prediction rule to obtain the predicted speed, including: if the first sampling speed is less than the first set speed, the predicted speed is determined according to the minimum value of the estimated speed and the first set speed; if the first sampling speed is greater than the first set speed, the predicted speed is determined according to the maximum value of the estimated speed and the first set speed.
[0072] In a non-limiting specific example, if the first sampling speed is less than the first set speed, the predicted speed V is calculated by the formula V=MIN(V L ,V S ) is calculated; if the first sampling speed is greater than the first setting speed, the formula V=MAX(V L ,V S ) is calculated. Among them, V S Set the speed for the first one.
[0073] In an embodiment of the present application, in each sampling period, after the predicted speed is obtained through the first sampling speed, the current sampling speed of the motor, that is, the second sampling speed, is saved as the first sampling speed for obtaining the predicted speed in the next sampling.
[0074] Figure 3 What is shown is a speed curve comparison diagram of the predicted speed obtained by using the motor speed signal processing method provided by an embodiment of the present application, the motor set speed, and the second sampling speed. Figure 3 The horizontal axis is the motor speed sampling period, the unit is ten milliseconds; the vertical axis is the speed, the unit is RPM.
[0075] See also Figure 3 In this embodiment, the motor setting speed is kept constant, and only the relationship between the predicted speed and the second sampling speed is observed. Figure 3It can be seen that the predicted speed obviously suppresses the peak part of the second sampling speed relative to the second sampling speed. In other words, predicting the current speed of the motor through the motor set speed, motor performance parameters and the first sampling speed is equivalent to performing a limiting filter on the second sampling speed. With reference to the above description of the embodiments of the present application, it can be considered that the predicted speed is close to the actual running speed of the motor.
[0076] It is understandable that the embodiment of the present application predicts the actual speed of the motor in the current sampling period according to the performance parameters of the motor and the first set speed of the motor when the first sampling speed is obtained, based on the first sampling speed of the motor obtained from the motor control unit in the previous sampling period, to obtain the predicted speed. Since the predicted speed is a prediction of the result of adjusting the motor speed based on the motor performance, the predicted speed is close to the actual operating speed of the motor, which is equivalent to removing the interference in the second sampling speed of the current sampling period and obtaining the actual operating speed of the motor after filtering. The predicted speed can be used to adjust the set speed of the motor. In some embodiments, the second set speed of the motor is determined by the predicted speed.
[0077] In the above Figure 2 Based on the embodiment of the method for processing the motor speed signal shown in FIG. 1 , after obtaining the predicted speed, as shown in FIG. Figure 4 As shown, it also includes:
[0078] S130: Determine a second set speed according to the predicted speed.
[0079] In an embodiment of the present application, after the motor speed signal processing unit 120 obtains the predicted speed, it also includes: determining a second set speed through the navigation control unit 110 according to the predicted speed. Specifically, the motor speed signal processing unit 120 sends the predicted speed data to the navigation control unit 110. The navigation control unit adjusts the motion control instruction according to the predicted speed, and the motion control instruction includes the speed at which the robot moves to the target position. The motor speed signal processing unit 120 solves the motion control instruction according to the motion control instruction adjusted by the navigation control unit 110 to obtain an updated set speed for each motor, that is, the second set speed. The motor speed signal processing unit 120 sends the second set speed to the motor control unit 130 in the next cycle of sending the set speed for controlling the motor 140.
[0080] In the embodiment of the present application, after the motor speed signal processing unit 120 obtains the predicted speed, it recalculates the set speed of each motor according to the motion control instruction sent by the navigation control unit 110 to obtain an updated motor set speed, i.e., a second set speed. The motor speed signal processing unit 120 sends the second set speed to the motor control unit 130 in the next cycle of sending the set speed for controlling the motor 140.
[0081] Figure 5 What is shown is a speed curve comparison diagram of the predicted speed obtained by using the motor speed signal processing method provided by another embodiment of the present application, the motor set speed, and the second sampling speed. Figure 5 The horizontal axis is the motor speed sampling period, the unit is ten milliseconds; the vertical axis is the speed, the unit is RPM.
[0082] See also Figure 5 In this embodiment, the navigation control unit 110 sets a motion control instruction according to the path planning of the robot, and the motion control instruction includes the speed of the robot to the target position. At the same time, in each sampling period T1, the navigation control unit 110 receives the predicted speed sent by the motor speed signal processing unit 120, and adjusts the speed of the robot to the target position in the motion control instruction according to the predicted speed. After receiving the speed of the robot to the target position, the speed signal processing unit 120 calculates the second set speed for the motor. Figure 5 What is shown is an example of a robot's decelerating process. It can be understood that the robot's accelerating process is similar to this and will not be described in detail.
[0083] from Figure 5 It can be seen that the predicted speed obviously suppresses the peak part of the second sampling speed relative to the second sampling speed. In other words, predicting the current speed of the motor through the motor set speed, motor performance parameters and the first sampling speed is equivalent to performing a limiting filter on the second sampling speed. Referring to the above description of the embodiments of the present application, it can be considered that the predicted speed is close to the actual running speed of the motor. In addition, from Figure 5 It can be seen that as the navigation control unit 110 adjusts the speed of the robot moving to the target position included in the motion control instruction according to the predicted speed, the predicted speed can play the role of limiting filtering the second sampling speed in most sampling periods.
[0084] It should be understood that the size of the serial numbers of the steps in the above embodiments does not mean the order of execution. The execution order of each process should be determined by its function and internal logic, and should not constitute any limitation on the implementation process of the embodiments of the present application.
[0085] Corresponding to the above Figure 2 The processing method of the motor speed signal shown in FIG. Figure 6 The present invention provides a motor speed signal processing device, including:
[0086] The first sampling speed acquisition module M110 is used to acquire the first sampling speed of the previous sampling period.
[0087] The predicted speed acquisition module M120 is used to predict the current speed of the motor according to the first sampling speed, motor performance parameters and a first set speed to obtain a predicted speed; the first set speed is the set speed of the motor when the first sampling speed is obtained from motor sampling.
[0088] It can be understood that the various implementation modes and implementation combinations in the above embodiments and their beneficial effects are also applicable to this embodiment and will not be described in detail here.
[0089] Figure 7 FIG. 1 is a schematic diagram of the structure of the motor speed signal processing unit 120 provided in an embodiment of the present application. Figure 7 As shown, the motor speed signal processing unit 120 of this embodiment includes: at least one processor D100 ( Figure 7 Only one processor, a memory D101, and a computer program D102 stored in the memory D101 and executable on the at least one processor D100 are shown, and when the processor D100 executes the computer program D102, the steps in any of the above-mentioned method embodiments are implemented. Alternatively, when the processor D100 executes the computer program D102, the functions of the modules / units in the above-mentioned device embodiments are implemented.
[0090] The motor speed signal processing unit 120 can be a computing device such as a desktop computer, a notebook, a PDA, or a cloud server. The motor speed signal processing unit 120 can include, but is not limited to, a processor D100 and a memory D101. Those skilled in the art can understand that Figure 7 This is only an example of the motor speed signal processing unit 120 and does not constitute a limitation on the motor speed signal processing unit 120 . The motor speed signal processing unit 120 may include more or fewer components than shown in the figure, or a combination of certain components, or different components, for example, it may also include input and output devices, network access devices, etc.
[0091] The processor D100 may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor or any conventional processor, etc.
[0092] In some embodiments, the memory D101 may be an internal storage unit of the motor speed signal processing unit 120, such as a hard disk or memory of the motor speed signal processing unit 120. In other embodiments, the memory D101 may also be an external storage device of the motor speed signal processing unit 120D10, such as a plug-in hard disk, a smart memory card (Smart Media Card, SMC), a secure digital (Secure Digital, SD) card, a flash card (Flash Card), etc. equipped on the motor speed signal processing unit 120. Further, the memory D101 may also include both the internal storage unit of the motor speed signal processing unit 120 and an external storage device. The memory D101 is used to store an operating system, an application program, a boot loader (BootLoader), data and other programs, such as the program code of the computer program, etc. The memory D101 may also be used to temporarily store data that has been output or is to be output.
[0093] It should be noted that the information interaction, execution process, etc. between the above-mentioned devices / units are based on the same concept as the method embodiment of the present application. Their specific functions and technical effects can be found in the method embodiment part and will not be repeated here.
[0094] The technicians in the relevant field can clearly understand that for the convenience and simplicity of description, only the division of the above-mentioned functional units and modules is used as an example for illustration. In practical applications, the above-mentioned function allocation can be completed by different functional units and modules as needed, that is, the internal structure of the device can be divided into different functional units or modules to complete all or part of the functions described above. The functional units and modules in the embodiment can be integrated in a processing unit, or each unit can exist physically separately, or two or more units can be integrated in one unit. The above-mentioned integrated unit can be implemented in the form of hardware or in the form of software functional units. In addition, the specific names of the functional units and modules are only for the convenience of distinguishing each other, and are not used to limit the scope of protection of this application. The specific working process of the units and modules in the above-mentioned system can refer to the corresponding process in the aforementioned method embodiment, which will not be repeated here.
[0095] An embodiment of the present application further provides a computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps in the above-mentioned method embodiments can be implemented.
[0096] The embodiment of the present application provides a computer program product. When the computer program product runs on the motor speed signal processing unit 120, the motor speed signal processing unit 120 can implement the steps in the above-mentioned various method embodiments when executing.
[0097] If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the present application implements all or part of the processes in the above-mentioned embodiment method, which can be completed by instructing the relevant hardware through a computer program. The computer program can be stored in a computer-readable storage medium, and the computer program can implement the steps of the above-mentioned various method embodiments when executed by the processor. Among them, the computer program includes computer program code, and the computer program code can be in source code form, object code form, executable file or some intermediate form. The computer-readable medium may at least include: any entity or device that can carry the computer program code to the camera / terminal device, recording medium, computer memory, read-only memory (ROM), random access memory (RAM), electric carrier signal, telecommunication signal and software distribution medium. For example, a USB flash drive, a mobile hard disk, a magnetic disk or an optical disk. In some jurisdictions, according to legislation and patent practice, computer-readable media cannot be electric carrier signals and telecommunication signals.
[0098] In the above embodiments, the description of each embodiment has its own emphasis. For parts that are not described or recorded in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.
[0099] Those of ordinary skill in the art will appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, or a combination of computer software and electronic hardware. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professional and technical personnel can 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.
[0100] In the embodiments provided in the present application, it should be understood that the disclosed devices / network equipment and methods can be implemented in other ways. For example, the device / network equipment embodiments described above are merely schematic. For example, the division of the modules or units is only a logical function division. There may be other division methods in actual implementation, such as multiple units or components can be combined or integrated into another system, 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 through some interfaces, indirect coupling or communication connection of devices or units, which can be electrical, mechanical or other forms.
[0101] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0102] The embodiments described above are only used to illustrate the technical solutions of the present application, rather than to limit them. Although the present application has been described in detail with reference to the aforementioned embodiments, a person skilled in the art should understand that the technical solutions described in the aforementioned embodiments may still be modified, or some of the technical features may be replaced by equivalents. Such modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present application, and should all be included in the protection scope of the present application.
Claims
1. A method for processing motor speed signal, It is characterized in that include: In each sampling period, obtaining the first sampling speed of the previous sampling period; Predicting the current speed of the motor according to the first sampling speed, the motor performance parameter and the first set speed to obtain the predicted speed, including: comparing the first sampling speed and the first set speed to obtain a comparison result; selecting the motor performance parameter according to the comparison result, and determining the estimated speed according to the selected motor performance parameter and the first sampling speed; selecting a prediction rule according to the comparison result, predicting the current speed of the motor according to the estimated speed and the first set speed by using the selected prediction rule to obtain the predicted speed; the first set speed is the set speed of the motor when the first sampling speed is obtained from the motor sampling; The motor performance parameters include acceleration performance parameters and deceleration performance parameters; the step of selecting the motor performance parameters according to the comparison result, and determining the estimated speed according to the selected motor performance parameters and the first sampling speed includes: If the comparison result is that the first sampling speed is less than the first set speed, selecting the acceleration performance parameter as the motor performance parameter, and obtaining the estimated speed according to the first sampling speed and the acceleration performance parameter of the motor; If the comparison result is that the first sampling speed is greater than the first set speed, the deceleration performance parameter is selected as the motor performance parameter, and the estimated speed is obtained according to the first sampling speed and the deceleration performance parameter of the motor.
2. The processing method according to claim 1, It is characterized in that The obtaining the estimated speed according to the first sampling speed and the acceleration performance parameter of the motor includes: Obtaining the estimated speed according to the first sampling speed, the filter coefficient and the acceleration performance parameter; The obtaining the estimated speed according to the first sampling speed and the deceleration performance parameter of the motor includes: The estimated speed is obtained according to the first sampling speed, a filter coefficient and the deceleration performance parameter.
3. The processing method according to claim 2, It is characterized in that The obtaining the estimated speed according to the first sampling speed, the filter coefficient and the acceleration performance parameter comprises: By formula V L =V fb +ka acc T obtains the estimated speed; Obtaining the estimated speed according to the first sampling speed, the filter coefficient and the deceleration performance parameter includes: By formula V L =V fb -ka dec T obtains the estimated speed; Among them, V L To estimate the speed, V fb is the first sampling speed, a acc is the acceleration performance parameter, a dec Deceleration performance parameters, T is the sampling period, k is the filter coefficient.
4. The processing method according to claim 1, It is characterized in that The step of selecting a prediction rule according to the comparison result, predicting the current speed of the motor according to the estimated speed and the first set speed by using the selected prediction rule to obtain the predicted speed includes: If the first sampling speed is less than the first set speed, determining the predicted speed according to the minimum value of the estimated speed and the first set speed; If the first sampling speed is greater than the first set speed, the predicted speed is determined according to a maximum value of the estimated speed and the first set speed.
5. The processing method according to claim 1, It is characterized in that After obtaining the predicted speed, the method further includes: A second set speed is determined according to the predicted speed.
6. A device for processing motor speed signals, It is characterized in that include: A first sampling speed acquisition module, used for acquiring the first sampling speed of the previous sampling period in each sampling period; A predicted speed acquisition module, used to predict the current speed of the motor according to the first sampling speed, the motor performance parameter and the first set speed to obtain the predicted speed; The first set speed is the set speed of the motor when the first sampling speed is obtained from motor sampling; The step of predicting the current speed of the motor according to the first sampling speed, the motor performance parameter and the first set speed to obtain the predicted speed comprises: comparing the first sampling speed and the first set speed to obtain a comparison result; selecting the motor performance parameter according to the comparison result, and determining an estimated speed according to the selected motor performance parameter and the first sampling speed; selecting a prediction rule according to the comparison result, and predicting the current speed of the motor according to the estimated speed and the first set speed by using the selected prediction rule to obtain the predicted speed; The motor performance parameters include acceleration performance parameters and deceleration performance parameters; the step of selecting the motor performance parameters according to the comparison result, and determining the estimated speed according to the selected motor performance parameters and the first sampling speed includes: If the comparison result is that the first sampling speed is less than the first set speed, selecting the acceleration performance parameter as the motor performance parameter, and obtaining the estimated speed according to the first sampling speed and the acceleration performance parameter of the motor; If the comparison result is that the first sampling speed is greater than the first set speed, the deceleration performance parameter is selected as the motor performance parameter, and the estimated speed is obtained according to the first sampling speed and the deceleration performance parameter of the motor.
7. A motor speed signal processing unit, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, It is characterized in that When the processor executes the computer program, the method according to any one of claims 1 to 5 is implemented.
8. A robot, It is characterized in that A processing unit comprising the motor speed signal as claimed in claim 7.
9. A computer-readable storage medium storing a computer program. It is characterized in that When the computer program is executed by a processor, the method according to any one of claims 1 to 5 is implemented.
