A process given method and device of a mobile robot wheel speed fastest control system

By introducing a combination of a fifth-order inertial filter, an actual differentiator, an inverting arithmetic unit, and a subtractor into the maximum wheel speed control system of a mobile robot, the process overshoot problem in AEFPI control was solved, and the system stability and control performance were improved.

CN117991625BActive Publication Date: 2026-11-10GUANGDONG POWER GRID CO LTD +1
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
CN202410169498.8
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-02-06
Publication Date
2026-11-10
Estimated Expiration
2044-02-06

AI Technical Summary

Technical Problem

Existing AEFPI control systems suffer from significant process overshoot in the maximum wheel speed control system of mobile robots, affecting the system's robustness and performance.

Method used

A process input device consisting of a fifth-order inertial filter, an actual differentiator, an inverting arithmetic unit, and a subtractor reduces process overshoot by performing inertial filtering, differentiation, and inversion on the process input signal.

Benefits of technology

It significantly reduces process overshoot, improves system stability and robustness, ensures accurate response to speed changes, and enhances control performance.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN117991625B_ABST
    Figure CN117991625B_ABST
Patent Text Reader

Abstract

The application discloses a process given method and device of a mobile robot wheel speed fastest control system. The process given signal of the mobile robot wheel speed fastest control system is acquired, and the process given signal is input into a five-order inertia filter, so that the five-order inertia filter outputs a five-order inertia filtering signal. The process given signal is input into an actual differentiator, so that the actual differentiator outputs an actual differential signal. The actual differential signal is input into an inverting operator, so that the inverting operator outputs an inverting operator signal. The five-order inertia filtering signal is input into the minuend end of a subtracter, and the inverting operator signal is input into the subtrahend end of the subtracter, so that the subtracter outputs the system given signal of the mobile robot wheel speed fastest control system. Compared with the prior art, the technical scheme of the application can reduce process overshoot and improve the performance of the mobile robot wheel speed fastest control system.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the field of robot control technology, and in particular to a process setting method and apparatus for a maximum wheel speed control system for a mobile robot. Background Technology

[0002] In industrial process control practice, engineering researchers have invented an accelerated engineering fastest proportional-integral (AEFPI) controller. AEFPI is suitable for standalone use, and its performance improvement over proportional-integral (PI) control is sufficient. AEFPI technology has already been widely adopted and applied in peak shaving and frequency regulation applications of thermal power units.

[0003] However, in practice, it has been found that AEFPI control has a large process overshoot, which is an inherent characteristic of AEFPI control. Applying AEFPI to the maximum wheel speed control system of a mobile robot will result in a large process overshoot, which will affect the robustness of the mobile robot. Usually, connecting a first-order inertial filter (FOIF) at the process setpoint has a good effect on suppressing process overshoot. However, this simple approach significantly reduces the regulation performance of AEFPI control. Summary of the Invention

[0004] The technical problem to be solved by the present invention is to provide a process input method and apparatus for a maximum wheel speed control system for a mobile robot, which can reduce process overshoot and improve the performance of the maximum wheel speed control system for a mobile robot.

[0005] To address the aforementioned technical problems, this invention provides a process input method for a mobile robot wheel speed maximum control system, comprising:

[0006] The process given signal of the maximum wheel speed control system of the mobile robot is obtained, and the process given signal is input into the fifth-order inertial filter so that the fifth-order inertial filter outputs the fifth-order inertial filter signal.

[0007] The process-given signal is input to the actual differentiator so that the actual differentiator outputs the actual differential signal;

[0008] The actual differential signal is input to the inverting arithmetic unit so that the inverting arithmetic unit outputs an inverting arithmetic unit signal;

[0009] The fifth-order inertial filter signal is input to the minuend of the subtractor, and the inverting arithmetic unit signal is input to the subtraction end of the subtractor, so that the subtractor outputs the system setpoint signal of the mobile robot wheel speed maximum control system.

[0010] In one possible implementation, the fifth-order inertial filter is as follows:

[0011]

[0012] In the formula, f FOIF (s) is the Laplace transfer function of the fifth-order inertial filter, T FOIF is the time constant of the fifth-order inertial filter, in milliseconds.

[0013] In one possible implementation, the actual differentiator is as follows:

[0014]

[0015] In the formula, f AD (S) is the Laplace transfer function of the actual differentiator, K AD The proportional gain of the actual differentiator, in dimensionless units, T. AD This is the time constant of the actual differentiator, in milliseconds.

[0016] In one possible implementation, the inverting operator is as follows:

[0017] f RO (s) = -1;

[0018] In the formula, f RO (s) is the Laplace transfer function of the inverting operator, and is a coefficient of -1.

[0019] The present invention also provides a process input device for a mobile robot wheel speed maximum control system, comprising: a fifth-order inertial filter, an actual differentiator, an inverting arithmetic unit, and a subtractor;

[0020] The fifth-order inertial filter is used to receive the process given signal of the mobile robot wheel speed maximum control system input from the process given signal output terminal, perform fifth-order inertial filtering on the process given signal, output a fifth-order inertial filtered signal, and input the fifth-order inertial filtered signal to the minuend of the subtractor.

[0021] The actual differentiator is used to receive the process given signal from the mobile robot wheel speed maximum control system input from the process given signal output terminal, perform actual differentiation processing on the process given signal, output the actual differential signal, and input the actual differential signal to the inverting arithmetic unit.

[0022] The inverting arithmetic unit is used to perform inversion operation on the input actual differential signal to obtain an inverted operation signal, and input the inverted operation signal to the subtraction terminal of the subtractor;

[0023] The subtractor is used to subtract the input fifth-order inertial filter signal and the inverted operation signal to output the system setpoint signal of the mobile robot wheel speed maximum control system.

[0024] In one possible implementation, the process is given an expression for the apparatus, as follows:

[0025]

[0026] In the formula, f EFCAGV (s) is the Laplace transfer function of the process feed device for the maximum speed control system of the mobile robot wheel speed, f RO (s) is the transfer function of the inverter, with coefficients of -1, f AD (S) is the Laplace transfer function of the actual differentiator, and T is the transfer function of the actual differentiator. AD K is the time constant of the actual differentiator, in milliseconds. AD f is the gain of the actual differentiator, in dimensionless form. FOIF (s) is the Laplace transfer function of the fifth-order inertial filter, T FOIF is the time constant of the fifth-order inertial filter, in milliseconds.

[0027] In one possible implementation, the fifth-order inertial filter is as follows:

[0028]

[0029] In the formula, f FOIF (s) is the Laplace transfer function of the fifth-order inertial filter, T FOIF is the time constant of the fifth-order inertial filter, in milliseconds.

[0030] In one possible implementation, the actual differentiator is as follows:

[0031]

[0032] In the formula, f AD (s) is the Laplace transfer function of the actual differentiator, K AD The proportional gain of the actual differentiator, in dimensionless units, T. AD This is the time constant of the actual differentiator, in milliseconds.

[0033] In one possible implementation, the inverting operator is as follows:

[0034] f RO (s) = -1;

[0035] In the formula, f RO (s) is the Laplace transfer function of the inverting operator, and is a coefficient of -1.

[0036] In one possible implementation, the process given signal output is connected to the input of the fifth-order inertial filter, the output of the fifth-order inertial filter is connected to the minuend of the subtractor, the process given signal output is connected to the input of the actual differentiator, the output of the actual differentiator is connected to the input of the inverting operator, and the output of the inverting operator is connected to the subtrahend of the subtractor.

[0037] The present invention also provides a maximum speed control system for the wheel speed of a mobile robot, comprising: a process input device, a feedback unit, an accelerated engineering maximum speed proportional-integral controller, and a process control system as described in any of the above claims;

[0038] The output of the process control device is connected to the first input of the feedback unit, the output of the feedback unit is connected to the accelerated engineering maximum speed proportional-integral controller, the output of the accelerated engineering maximum speed proportional-integral controller is connected to the input of the process, and the output of the process is connected to the second input of the feedback unit, forming a closed-loop feedback.

[0039] The process-setting device is used to execute the process-setting method for the mobile robot wheel speed maximum control system as described in any of the above.

[0040] In one possible implementation, the accelerated engineering speed proportional-integral controller is as follows:

[0041] f AEFPI (s)=K AEFPI [1+f AEFI (s)];

[0042]

[0043]

[0044] T AEFI =T AEFTF ;

[0045] In the formula, f AEFPI (s) is the transfer function of the accelerated engineering maximum speed proportional-integral controller AEFPI, K AEFPI This is the cascade proportional control gain, in dimensionless form, f.AEFI (s) is the transfer function of the Accelerated Engineering Fastest Integrator (AFEI), f AEFTF (s) is the transfer function of the accelerated engineering fastest tracking filter AEFTF, T AEFI T represents the time constant of the fastest integrator in accelerated engineering, expressed in milliseconds. AEFTF The time constant of the fastest tracking filter for accelerated engineering is in milliseconds; n is the order, which is dimensionless; i and l are process variables and are positive integers.

[0046] The present invention also provides a terminal device, including a processor, a memory, and a computer program stored in the memory and configured to be executed by the processor, wherein the processor executes the computer program to implement a process given for a mobile robot wheel speed maximum control system as described in any of the preceding claims.

[0047] The present invention provides a process input method and apparatus for a maximum wheel speed control system for a mobile robot, which, compared with the prior art, has the following advantages:

[0048] By acquiring the process input signal of the mobile robot's wheel speed maximum control system, the process input signal is input into a fifth-order inertial filter, causing the fifth-order inertial filter to output a fifth-order inertial filtered signal. The fifth-order inertial filter smooths the input signal, eliminating noise and sudden fluctuations, thus obtaining a more stable and reliable output signal. This helps reduce the control system's sensitivity to interference and improves the system's stability and robustness. The process input signal is then input into an actual differentiator, causing the actual differentiator to output an actual differential signal that reflects the actual state changes of the mobile robot. The actual differential signal is then input into an inverting arithmetic unit, causing the inverting arithmetic unit to output... The output inverting arithmetic unit signal can be used for inverting adjustment of the control system; the fifth-order inertial filter signal is input to the minuend of the subtractor, and the inverting arithmetic unit signal is input to the subtraction end of the subtractor, so that the subtractor outputs the system setpoint signal of the mobile robot wheel speed maximum control system; compared with the prior art, the technical solution of the present invention performs filtering, differentiation and inversion processing on the input signal by setting a fifth-order inertial filter, an actual differentiator, an inverting arithmetic unit and a subtractor, so that the obtained system setpoint signal has better stability and robustness; it helps to ensure that the control system makes an accurate and reliable response to speed changes, reduces process overshoot and improves the control performance of the system. Attached Figure Description

[0049] Figure 1 This is a flowchart illustrating an embodiment of a process-giving method for a mobile robot wheel speed maximum control system provided by the present invention;

[0050] Figure 2This is a schematic diagram of the structure of a process input device for a mobile robot wheel speed maximum control system provided by the present invention;

[0051] Figure 3 This is a schematic diagram of an embodiment of a mobile robot wheel speed maximum control system provided by the present invention;

[0052] Figure 4 This is a schematic diagram of another embodiment of the process setting device for a mobile robot wheel speed maximum control system provided by the present invention;

[0053] Figure 5 This is a schematic diagram of another embodiment of the maximum wheel speed control system for a mobile robot provided by the present invention;

[0054] Figure 6 The simulation results are for the wheel speed control system of a mobile robot under a given unit step speed.

[0055] Figure 7 This is a schematic diagram of the structure of a mobile robot wheel speed maximum control system that only connects to a first-order inertial filter;

[0056] Figure 8 This is a schematic diagram of the simulation results of the wheel speed control system of a mobile robot with a first-order inertial filter set when the process input is a first-order inertial filter signal.

[0057] Figure 9 This is a schematic diagram of the simulation results of the wheel speed control system of a mobile robot equipped with a process input device when the process input is the system input signal. Detailed Implementation

[0058] The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are only some embodiments of the present invention, and not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of the present invention.

[0059] Example 1, see Figure 1 , Figure 1 This is a flowchart illustrating an embodiment of a process-giving method for a mobile robot wheel speed maximum control system provided by the present invention, as shown below. Figure 1 As shown, the method includes steps 101-104, as detailed below:

[0060] Step 101: Obtain the process input signal of the mobile robot wheel speed maximum control system, and input the process input signal into the fifth-order inertial filter so that the fifth-order inertial filter outputs the fifth-order inertial filter signal.

[0061] In one embodiment, in the maximum wheel speed control system of a mobile robot, the process given signal represents the target speed requirement of the user or other control system for the mobile robot; wherein, the process given signal can be a numerical value used to represent the desired linear velocity or angular velocity, and the process given signal can also be a control command used to represent commands such as forward, backward, left turn or right turn.

[0062] In one embodiment, the fifth-order inertial filter is as follows:

[0063]

[0064] In the formula, f FOIF (s) is the Laplace transfer function of the fifth-order inertial filter, T FOIF is the time constant of the fifth-order inertial filter, in milliseconds.

[0065] In one embodiment, the process given signal is input into a fifth-order inertial filter, and the process given signal is subjected to fifth-order inertial filtering based on the Laplace transfer function of the fifth-order inertial filter to obtain a fifth-order inertial filtered signal.

[0066] Specifically, the fifth-order inertial filter consists of five cascaded first-order filters. Each first-order filter comprises an integrator and a proportional gain unit, enabling smooth filtering of the input signal and removal of high-frequency noise. Each integrator is a component that accumulates the input signal, similar to integrating the signal. Each integrator multiplies the input signal by a gain coefficient and adds the result to the output value of the previous moment to obtain the output value of the current moment. The filtering algorithm of the fifth-order inertial filter is implemented through the interaction of these five integrators. It can smooth the input signal, reduce high-frequency noise or rapidly changing components, while retaining lower-frequency components.

[0067] Specifically, the given process signal is represented as a function in the Laplace transform domain, usually denoted by X(s). The transfer function of the fifth-order inertial filter is multiplied by the given process signal to obtain the fifth-order output signal. The fifth-order output signal is then inversely transformed back to the time domain to obtain the fifth-order inertial filter signal.

[0068] Step 102: Input the process given signal into the actual differentiator so that the actual differentiator outputs the actual differential signal.

[0069] In one embodiment, the actual differentiator is as follows:

[0070]

[0071] In the formula, f AD (s) is the Laplace transfer function of the actual differentiator, K AD The proportional gain of the actual differentiator, in dimensionless units, T. AD This is the time constant of the actual differentiator, in milliseconds.

[0072] Preferably, the time constant T of the actual differentiator is set. AD With the time constant T of the fifth-order inertial filter FOIF same.

[0073] In one embodiment, ideally, differentiation is the operation of taking the derivative of the input signal, i.e., calculating the rate of change of the signal. However, in practical applications, ideal differentiators are often very sensitive to high-frequency noise and may introduce high-frequency components with large amplification factors. This may lead to unstable output results or even noise amplification. A practical differentiator, on the other hand, is a filter used for signal processing that can differentiate the input signal. Compared with an ideal differentiator, a practical differentiator takes into account the limitations of the actual system and the influence of noise to improve performance and stability. Therefore, in this embodiment, a practical differentiator is used to differentiate the input process-given signal.

[0074] In one embodiment, when the process given signal is input into the actual differentiator, the process given signal is represented in the form of a Laplace transform, such as X(s), where s is a complex frequency variable. The process given signal is multiplied by the Laplace transfer function of the actual differentiator to obtain the product result. The product result is then subjected to an inverse Laplace transform to convert the signal from the Laplace domain back to the time domain, thereby obtaining the output actual differential signal.

[0075] Step 103: Input the actual differential signal into the inverting unit so that the inverting unit outputs the inverting unit signal.

[0076] In one embodiment, the inverter is as follows:

[0077] f RO (s) = -1;

[0078] In the formula, f RO (s) is the Laplace transfer function of the inverting operator, and is a coefficient of -1.

[0079] In one embodiment, an inverting operational amplifier (API) is a basic operational amplifier circuit used to invert an input signal and generate an amplified output signal. Its main characteristic is the inverting relationship between the input signal and the feedback signal. An API typically consists of an operational amplifier, two input resistors, and a feedback resistor. The input signal is connected to the inverting input of the operational amplifier through an input resistor, and the feedback signal is connected to the output of the operational amplifier through a feedback resistor. The output signal can be obtained from the output of the operational amplifier.

[0080] In one embodiment, when the actual differential signal is input into the inverting operator, the actual differential signal is represented as a function in the Laplace transform domain. The actual differential signal is connected to the inverting input terminal of the inverting operator through an input resistor, so that the inverting operator can invert the input actual differential signal. A feedback resistor is connected to the output terminal of the inverting operator, and its other end is connected back to the inverting input terminal of the inverting operator. In this way, the feedback signal can flow back to the input terminal of the inverting operator along the feedback path. According to the characteristics of the inverting operator, the magnitude of the output signal is equal to the inverted value of the input signal multiplied by the ratio of the feedback resistor to the input resistor. According to the given transfer function of the inverting operator, the Laplace transform form of its output signal is Y(s) = -X(s). The output signal Y(s) is subjected to an inverse Laplace transform to convert the signal from the Laplace domain back to the time domain, thus obtaining the inverting operator signal.

[0081] Step 104: Input the fifth-order inertial filter signal to the minuend of the subtractor, and input the inverting arithmetic unit signal to the subtraction end of the subtractor, so that the subtractor outputs the system setpoint signal of the mobile robot wheel speed maximum control system.

[0082] In one embodiment, after obtaining the fifth-order inertial filter signal, the fifth-order inertial filter signal is input to the minuend of the subtractor through the output terminal of the fifth-order inertial filter; and after obtaining the inverting operator signal, the inverting operator signal is input to the subtraction terminal of the subtractor through the output terminal of the inverting operator.

[0083] In one embodiment, the subtractor is used to calculate a first difference between the fifth-order inertial filter signal and the inverting operator signal, and uses the first difference as the subtraction signal output by the subtractor, and uses the subtraction signal as the system setpoint signal for the maximum wheel speed control system of the mobile robot.

[0084] Example 2, see Figure 2 , Figure 2 This is a schematic diagram of the structure of a process input device for a mobile robot wheel speed maximum control system provided by the present invention, as shown in the figure. Figure 2As shown, the device includes a fifth-order inertial filter 201, an actual differentiator 202, an inverting arithmetic unit 203, and a subtractor 204, as detailed below:

[0085] The fifth-order inertial filter 201 is used to receive the process given signal of the mobile robot wheel speed maximum control system input from the process given signal output terminal, perform fifth-order inertial filtering on the process given signal, output a fifth-order inertial filtered signal, and input the fifth-order inertial filtered signal to the minuend terminal of the subtractor 204.

[0086] The actual differentiator 202 is used to receive the process given signal of the mobile robot wheel speed maximum control system input from the process given signal output terminal, perform actual differentiation processing on the process given signal, output the actual differential signal, and input the actual differential signal to the inverting arithmetic unit 203.

[0087] The inverting arithmetic unit 203 is used to perform inversion operation on the input actual differential signal to obtain an inverted operation signal, and input the inverted operation signal to the subtraction terminal of the subtractor 204.

[0088] The subtractor 204 is used to perform subtraction processing on the input fifth-order inertial filter signal and the inverted operation signal, and output the system setpoint signal of the mobile robot wheel speed maximum control system.

[0089] In one embodiment, the process gives an expression for the device, as shown below:

[0090]

[0091] In the formula, f EFCAGV (s) is the Laplace transfer function of the process feed device for the maximum speed control system of the mobile robot wheel speed, f RO (s) is the transfer function of the inverter, with coefficients of -1, f AD (s) is the Laplace transfer function of the actual differentiator, T AD K is the time constant of the actual differentiator, in milliseconds. AD f is the gain of the actual differentiator, in dimensionless form. FOIF (s) is the Laplace transfer function of the fifth-order inertial filter, T FOIF is the time constant of the fifth-order inertial filter, in milliseconds.

[0092] In one embodiment, the fifth-order inertial filter is as follows:

[0093]

[0094] In the formula, f FOIF(s) is the Laplace transfer function of the fifth-order inertial filter, T FOIF is the time constant of the fifth-order inertial filter, in milliseconds.

[0095] In one embodiment, the actual differentiator is as follows:

[0096]

[0097] In the formula, f AD (s) is the Laplace transfer function of the actual differentiator, K AD The proportional gain of the actual differentiator, in dimensionless units, T. AD This is the time constant of the actual differentiator, in milliseconds.

[0098] In one embodiment, the inverter is as follows:

[0099] f RO (s) = -1;

[0100] In the formula, f RO (s) is the Laplace transfer function of the inverting operator, and is a coefficient of -1.

[0101] In one embodiment, the process given signal output terminal is connected to the input terminal of the fifth-order inertial filter 201, the output terminal of the fifth-order inertial filter 201 is connected to the minuend terminal of the subtractor 204, the process given signal output terminal is connected to the input terminal of the actual differentiator 202, the output terminal of the actual differentiator 202 is connected to the input terminal of the inverting arithmetic unit 203, and the output terminal of the inverting arithmetic unit 203 is connected to the subtraction terminal of the subtractor 204. Figure 4 As shown, Figure 4 This is a schematic diagram of another embodiment of the process setting device for a mobile robot wheel speed maximum control system provided by the present invention.

[0102] Those skilled in the art will understand that, for the sake of convenience and brevity, the specific working process of the device described above can be referred to the corresponding process in the foregoing method embodiments, and will not be repeated here.

[0103] It should be noted that the above embodiment of the process-setting device for the mobile robot wheel speed maximum control system is merely illustrative. The modules described as separate components may or may not be physically separate, and the components shown as modules may or may not be physical units; that is, they may be located in one place or distributed across multiple network units. Some or all of the modules can be selected to achieve the purpose of this embodiment according to actual needs.

[0104] Example 3, see Figure 3 , Figure 3 This is a schematic diagram of an embodiment of a mobile robot wheel speed maximum control system provided by the present invention, as shown below. Figure 3 As shown, the system includes the process input device 301, feedback unit 302, acceleration-type engineering maximum speed proportional-integral controller 303, and process 304 of the mobile robot wheel speed maximum speed control system described in Embodiment 2 above, as detailed below:

[0105] The process input device 301 is connected to the first input terminal of the feedback unit 302, the output terminal of the feedback unit 302 is connected to the accelerated engineering maximum speed proportional-integral controller 303, the output terminal of the accelerated engineering maximum speed proportional-integral controller 303 is connected to the input terminal of the process 304, and the output terminal of the process 304 is connected to the second input terminal of the feedback unit 302, forming a closed-loop feedback. Figure 5 As shown, Figure 5 This is a schematic diagram of another embodiment of a maximum wheel speed control system for a mobile robot.

[0106] In one embodiment, the process setting device 301 is used to execute the process setting method of the mobile robot wheel speed maximum control system described in Embodiment 1 above.

[0107] In one embodiment, the process gives an expression for the device, as shown below:

[0108]

[0109] In the formula, f EFCAGV (s) is the Laplace transfer function of the process feed device for the maximum speed control system of the mobile robot wheel speed, f RO (s) is the transfer function of the inverter, with coefficients of -1, f AD (s) is the Laplace transfer function of the actual differentiator, T AD K is the time constant of the actual differentiator, in milliseconds. AD f is the gain of the actual differentiator, in dimensionless form. FOIF (s) is the Laplace transfer function of the fifth-order inertial filter, T FOIF is the time constant of the fifth-order inertial filter, in milliseconds.

[0110] In one embodiment, the accelerated engineering maximum speed proportional-integral controller 303 is as follows:

[0111] f AEFPI (s)=K AEFPI [1+f AEFI (s)];

[0112]

[0113]

[0114] T AEFI =T AEFTF ;

[0115] In the formula, f AEFPI (s) is the transfer function of the accelerated engineering maximum speed proportional-integral controller AEFPI, K AEFPI This is the cascade proportional control gain, in dimensionless form, f. AEFI (s) is the transfer function of the Accelerated Engineering Fastest Integrator (AFEI), f AEFTF (s) is the transfer function of the accelerated engineering fastest tracking filter AEFTF, T AEFI T represents the time constant of the fastest integrator in accelerated engineering, expressed in milliseconds. AEFTF The time constant of the fastest tracking filter for accelerated engineering is in milliseconds; n is the order, which is dimensionless; i and l are process variables and are positive integers.

[0116] In one embodiment, process 304 is a servo motor, wherein the expression of the process is as follows:

[0117]

[0118] In the formula, f P (s) is the transfer function of the process, and s is the Laplace operator.

[0119] In one embodiment, when the open-loop system phase of process 304 is equal to -135°, the open-loop system gain is equal to 0.5. The optimal parameters of the accelerated engineering maximum speed proportional-integral controller are searched, and the parameters of the accelerated engineering maximum speed proportional-integral controller are obtained as: T AEFI =141ms, K AEFPI =3.528.

[0120] The beneficial effects of the engineering fastest control system provided in this embodiment are illustrated by the following example:

[0121] Before adopting the mobile robot wheel speed maximum control system provided in this embodiment, the simulation results obtained with a process given as a unit step were as follows: Figure 6 As shown, Figure 6 The simulation results are for the wheel speed control system of a mobile robot under a given unit step speed. Figure 6 As shown, the process overshoot is 55% and the settling time is 620ms. The settling time refers to the time it takes for the process to reach a deviation of less than 5%.

[0122] In comparison, before adopting the mobile robot wheel speed maximum control system provided in this embodiment, only a first-order inertial filter was connected to the output terminal of the process given signal. This first-order inertial filter performed first-order inertial filtering on the process given signal to obtain the mobile robot wheel speed control process given signal, such as... Figure 7 As shown, Figure 7 This is a schematic diagram of the structure of a mobile robot wheel speed maximum control system that uses only a first-order inertial filter.

[0123] The first-order inertial filter is as follows:

[0124]

[0125] Among them, f FIF (s) is the Laplace transfer function of the first-order inertial filter; T FIF is the time constant of the first-order inertial filter, in milliseconds.

[0126] When setting parameter T FIF =90ms, the simulation results obtained, Figure 8 As shown, Figure 8 This is a schematic diagram of the simulation results of the wheel speed control system of a mobile robot with a first-order inertial filter set when the process input is a first-order inertial filter signal. Figure 8 As shown, the process overshoot is 13.0% and the settling time is 499ms.

[0127] The mobile robot wheel speed control system provided in this embodiment incorporates the process setting device 301 described in Embodiment 2 above, used to execute the process setting method of the mobile robot wheel speed maximum control system described in Embodiment 1 above; by setting relevant parameters T FOIF =T AD =90ms, K AD =0.2, the simulation results are as follows Figure 9 As shown, Figure 9 This is a schematic diagram of the simulation results of the wheel speed control system of a mobile robot equipped with a process input device when the process input is the system input signal. Figure 8 As shown, the process overshoot is 1.5% and the settling time is 311ms.

[0128] As can be seen, the maximum wheel speed control system for mobile robots provided in this embodiment can significantly reduce process overshoot, significantly reduce settling time, and effectively eliminate process oscillation problems. Compared with simply connecting a first-order inertial filter to the process setpoint output of the maximum wheel speed control system for mobile robots, it significantly improves the performance of the maximum wheel speed control system for mobile robots.

[0129] Based on the above-described embodiments of the process setting method for the maximum wheel speed control system of a mobile robot, another embodiment of the present invention provides a process setting terminal device for the maximum wheel speed control system of a mobile robot. The process setting terminal device for the maximum wheel speed control system of a mobile robot includes a processor, a memory, and a computer program stored in the memory and configured to be executed by the processor. When the processor executes the computer program, it implements the process setting method for the maximum wheel speed control system of a mobile robot according to any embodiment of the present invention.

[0130] For example, in this embodiment, the computer program can be divided into one or more modules, which are stored in the memory and executed by the processor to complete the present invention. The one or more modules can be a series of computer program instruction segments capable of performing specific functions, which describe the execution process of the computer program in a given terminal device of the mobile robot wheel speed control system.

[0131] The process-provided terminal device for the mobile robot wheel speed maximum control system can be a computing device such as a desktop computer, laptop, handheld computer, or cloud server. The process-provided terminal device for the mobile robot wheel speed maximum control system may include, but is not limited to, processors and memory.

[0132] The processor can be a Central Processing Unit (CPU), or other general-purpose processors, digital signal processors (DSPs), application-specific integrated circuits (ASICs), field-programmable gate arrays (FPGAs), or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor can be a microprocessor or any conventional processor. This processor is the control center of the process-defined terminal device of the mobile robot wheel speed control system, connecting various parts of the process-defined terminal device of the entire mobile robot wheel speed control system through various interfaces and lines.

[0133] The memory can be used to store the computer programs and / or modules. The processor, by running or executing the computer programs and / or modules stored in the memory and calling data stored in the memory, realizes various functions of the mobile robot wheel speed control system given to the terminal device. The memory may mainly include a program storage area and a data storage area. The program storage area may store the operating system, at least one application program required for a function, etc.; the data storage area may store data created based on the use of the mobile phone, etc. In addition, the memory may include high-speed random access memory, and may also include non-volatile memory, such as hard disk, memory, plug-in hard disk, smart media card (SMC), secure digital card (SD), flash card, at least one disk storage device, flash memory device, or other volatile solid-state storage device.

[0134] In summary, the present invention provides a process input method and apparatus for a mobile robot wheel speed maximum control system. This method acquires the process input signal for the mobile robot wheel speed maximum control system, inputs the process input signal into a fifth-order inertial filter to output a fifth-order inertial filter signal, inputs the process input signal into an actual differentiator to output an actual differential signal, inputs the actual differential signal into an inverting arithmetic unit to output an inverting arithmetic unit signal, inputs the fifth-order inertial filter signal into the minuend of a subtractor, and inputs the inverting arithmetic unit signal into the subtraction terminal of the subtractor to output the system input signal for the mobile robot wheel speed maximum control system. Compared with existing technologies, the technical solution of the present invention can reduce process overshoot and improve the performance of the mobile robot wheel speed maximum control system.

[0135] The above description is only a preferred embodiment of the present invention. It should be noted that for those skilled in the art, several improvements and substitutions can be made without departing from the technical principles of the present invention, and these improvements and substitutions should also be considered within the scope of protection of the present invention.

Claims

1. A process input method for a maximum wheel speed control system for a mobile robot, characterized in that, include: The process given signal of the maximum wheel speed control system of the mobile robot is obtained, and the process given signal is input into the fifth-order inertial filter so that the fifth-order inertial filter outputs the fifth-order inertial filter signal. The process-given signal is input to the actual differentiator so that the actual differentiator outputs the actual differential signal; The actual differential signal is input to the inverting arithmetic unit so that the inverting arithmetic unit outputs an inverting arithmetic unit signal; The fifth-order inertial filter signal is input to the minuend of the subtractor, and the inverting arithmetic unit signal is input to the subtraction end of the subtractor, so that the subtractor outputs the system setpoint signal of the mobile robot wheel speed maximum control system.

2. The process input method for a mobile robot wheel speed maximum control system as described in claim 1, characterized in that, The fifth-order inertial filter is as follows: ; In the formula, Let Laplace's transfer function be the fifth-order inertial filter. is the time constant of the fifth-order inertial filter, in milliseconds.

3. The process input method for a mobile robot wheel speed maximum control system as described in claim 1, characterized in that, The actual differentiator is shown below: ; In the formula, Let Laplace's transfer function be the actual differentiator. This represents the proportional gain of the actual differentiator, in dimensionless units. This is the time constant of the actual differentiator, in milliseconds.

4. The process input method for a mobile robot wheel speed maximum control system as described in claim 1, characterized in that, The inverting arithmetic unit is as follows: ; In the formula, is the Laplace transfer function of the inverting operator, and is a coefficient of -1.

5. A process input device for a mobile robot wheel speed maximum control system, characterized in that, include: Fifth-order inertial filter, practical differentiator, inverting arithmetic unit, and subtractor; The fifth-order inertial filter is used to receive the process given signal of the mobile robot wheel speed maximum control system input from the process given signal output terminal, perform fifth-order inertial filtering on the process given signal, output a fifth-order inertial filtered signal, and input the fifth-order inertial filtered signal to the minuend of the subtractor. The actual differentiator is used to receive the process given signal from the mobile robot wheel speed maximum control system input from the process given signal output terminal, perform actual differentiation processing on the process given signal, output the actual differential signal, and input the actual differential signal to the inverting arithmetic unit. The inverting arithmetic unit is used to perform inversion operation on the input actual differential signal to obtain an inverted operation signal, and input the inverted operation signal to the subtraction terminal of the subtractor; The subtractor is used to subtract the input fifth-order inertial filter signal and the inverted operation signal to output the system setpoint signal of the mobile robot wheel speed maximum control system.

6. The process input device for a mobile robot wheel speed maximum control system as described in claim 5, characterized in that, The process is given by an expression for the apparatus, as shown below: ; In the formula, The Laplace transfer function of the process given by the maximum wheel speed control system for a mobile robot is given. This is the transfer function of the inverter, with a coefficient of -1. Let Laplace's transfer function be the actual differentiator. The time constant of the actual differentiator is expressed in milliseconds. This represents the gain of the actual differentiator, in dimensionless units. Let Laplace's transfer function be the fifth-order inertial filter. is the time constant of the fifth-order inertial filter, in milliseconds.

7. The process input device for a mobile robot wheel speed maximum control system as described in claim 5, characterized in that, The process given signal output terminal is connected to the input terminal of the fifth-order inertial filter, the output terminal of the fifth-order inertial filter is connected to the minuend terminal of the subtractor, the process given signal output terminal is connected to the input terminal of the actual differentiator, the output terminal of the actual differentiator is connected to the input terminal of the inverting arithmetic unit, and the output terminal of the inverting arithmetic unit is connected to the subtrahend terminal of the subtractor.

8. A maximum wheel speed control system for a mobile robot, characterized in that, include: The process input device, feedback unit, accelerated engineering maximum speed proportional-integral controller, and process of the mobile robot wheel speed maximum speed control system as described in any one of claims 5-7; The output of the process control device is connected to the first input of the feedback unit, the output of the feedback unit is connected to the accelerated engineering maximum speed proportional-integral controller, the output of the accelerated engineering maximum speed proportional-integral controller is connected to the input of the process, and the output of the process is connected to the second input of the feedback unit, forming a closed-loop feedback. The process setting device is used to execute the process setting method of the mobile robot wheel speed maximum control system as described in any one of claims 1-4.

9. The maximum wheel speed control system for a mobile robot as described in claim 8, characterized in that, The accelerated engineering maximum speed proportional-integral controller is as follows: In the formula, The transfer function of the fastest proportional-integral controller AEFPI for accelerated engineering is given. This refers to the cascade proportional control gain, in dimensionless units. The transfer function of the fastest integrator AFEI for accelerated engineering is given. The transfer function of the fastest tracking filter AEFTF for accelerated engineering is given. The time constant of the fastest integrator for accelerated engineering is given in milliseconds. The time constant of the fastest tracking filter for accelerated engineering is in milliseconds, and n is the order, which is dimensionless. and It is a process variable and is a positive integer.

10. A terminal device, characterized in that, The system includes a processor, a memory, and a computer program stored in the memory and configured to be executed by the processor, wherein the processor, when executing the computer program, implements a process given for a mobile robot wheel speed maximum control system as described in any one of claims 1 to 4.

Citation Information

Patent Citations

  • Steepest tracking differential method and system based on first-order inertial filtering

    CN116165879A

  • Apparatus for controlling servo

    KR1020180028846A