Control method and device for automated guided vehicle, and automated guided vehicle

Abstract

The present disclosure discloses a control method and device for automated guided vehicle, and automated guided vehicle. By utilizing the coupling relation between the turntable and the chassis, a disturbance to the chassis electromechanical control subsystem is compensated by using a feedback signal in the turntable electromechanical control subsystem, or a disturbance to the turntable electromechanical control subsystem is compensated by using a feedback signal in the chassis electromechanical control subsystem, so that high-precision movement control of the turntable and the chassis is realized.

Claims

1. A control method for an automated guided vehicle, comprising: determining a first compensation voltage according to a feedback signal in a first control subsystem; and compensating for a disturbance to a second control subsystem by using the first compensation voltage, wherein the first control subsystem is one of a turntable electromechanical control subsystem and a chassis electromechanical control subsystem, and the second control subsystem is the other of the turntable electromechanical control subsystem and the chassis electromechanical control subsystem, and wherein when the first control subsystem is the turntable electromechanical control subsystem and the second control subsystem is the chassis electromechanical control subsystem, determining a first compensation voltage comprises: determining an induction torque τ.sub.g according to a feedback signal in the turntable electromechanical control subsystem combined with a moment of inertia of a load and a moment of inertia of the chassis; determining a torque τ.sub.w applied to drive wheels of the chassis by the turntable according to the induction torque τ.sub.g; and determining a compensation voltage u of each drive wheel of the chassis based on the torque τ.sub.W and a rotational angular velocity ω of the drive wheel.

2. The control method according to claim 1, wherein compensating for a disturbance to a second control subsystem comprises: compensating for an input voltage of an electromechanical module in the second control subsystem by using the first compensation voltage.

3. The control method according to claim 2, wherein the chassis has a plurality of drive wheels, and the first compensation voltage comprises a compensation voltage of each drive wheel, and wherein compensating for a disturbance to a second control subsystem comprises: compensating for an input voltage of an electromechanical module of each drive wheel in the chassis electromechanical control subsystem by using the compensation voltage of the drive wheel.

4. The control method according to claim 1, wherein the feedback signal in the turntable electromechanical control subsystem is a turntable rotational angular velocity ω.sub.g; and the induction torque τ.sub.g is directly proportional to a turntable rotational angular acceleration dω.sub.g/dt.

5. The control method according to claim 1, wherein the torque τ.sub.w is directly proportional to the induction torque τ.sub.g.

6. The control method according to claim 1, wherein the chassis has a left drive wheel and a right drive wheel, the compensation voltage u.sub.l of the left drive wheel being opposite to the compensation voltage u.sub.r of the right drive wheel.

7. The control method according to claim 1, wherein when the first control subsystem is the chassis electromechanical control subsystem and the second control subsystem is the turntable electromechanical control subsystem, determining a first compensation voltage comprises: determining an absolute angular velocity ω.sub.c of rotation of the chassis according to a feedback signal in the chassis electromechanical control subsystem; determining a torque τ.sub.c applied to the turntable by the chassis according to an absolute angular acceleration dω.sub.c/dt of rotation of the chassis; and determining a turntable compensation voltage u.sub.g according to the torque τ.sub.c and a rotational angular velocity ω.sub.g of the turntable.

8. The control method according to claim 7, wherein the chassis has a left drive wheel and a right drive wheel; wherein the feedback signal in the chassis electromechanical control subsystem comprises a right drive wheel rotational angular velocity ω.sub.r and a left drive wheel rotational angular velocity ω.sub.l in the chassis electromechanical control subsystem; and wherein the absolute angular velocity ω.sub.c is directly proportional to a difference between the right drive wheel rotational angular velocity ω.sub.r and the left drive wheel rotational angular velocity ω.sub.l.

9. The control method according to claim 7, wherein the torque τ.sub.c is directly proportional to the absolute angular acceleration dω.sub.c/dt of rotation of the chassis.

10. The control method according to claim 1, further comprising: determining a second compensation voltage according to a feedback signal in the second control subsystem; and compensating for a disturbance to the first control subsystem by using the second compensation voltage.

11. A control device for an automated guided vehicle, comprising: memory for storing computer instructions; and a processor coupled to the memory, which is configured to execute the computer instructions that cause the control device to: determine a first compensation voltage according to a feedback signal in a first control subsystem; and compensate for a disturbance to a second control subsystem by using the first compensation voltage, wherein the first control subsystem is one of a turntable electromechanical control subsystem and a chassis electromechanical control subsystem, and the second control subsystem is the other of the turntable electromechanical control subsystem and the chassis electromechanical control subsystem, and wherein when the first control subsystem is the turntable electromechanical control subsystem and the second control subsystem is the chassis electromechanical control subsystem, determine a first compensation voltage comprises: determining an induction torque τ.sub.g according to a feedback signal in the turntable electromechanical control subsystem combined with a moment of inertia of a load and a moment of inertia of the chassis; determining a torque τ.sub.w applied to drive wheels of the chassis by the turntable according to the induction torque τ.sub.g; and determining a compensation voltage u of each drive wheel of the chassis based on the torque τ.sub.w and a rotational angular velocity ω of the drive wheel.

12. An automated guided vehicle, comprising the control device for the automated guided vehicle according to claim 11.

13. The control device according to claim 11, wherein the chassis has a plurality of drive wheels, and the first compensation voltage comprises a compensation voltage of each drive wheel, and wherein the computer instructions that cause the control device to: compensate for an input voltage of an electromechanical module of each drive wheel in the chassis electromechanical control subsystem by using the compensation voltage of the drive wheel.

14. The control device according to claim 11, wherein when the first control subsystem is the chassis electromechanical control subsystem and the second control subsystem is the turntable electromechanical control subsystem, the computer instructions that cause the control device to: determine an absolute angular velocity ω.sub.c of rotation of the chassis according to a feedback signal in the chassis electromechanical control subsystem; determine a torque τ.sub.c applied to the turntable by the chassis according to an absolute angular acceleration dω.sub.c/dt of rotation of the chassis; and determine a turntable compensation voltage u.sub.g according to the torque τ.sub.c and a rotational angular velocity ω.sub.g of the turntable.

15. A non-transitory computer-readable storage medium having stored therein computer instructions that, when executed by one or more processors of a computer system, cause the computer system to: determine a first compensation voltage according to a feedback signal in a first control subsystem; and compensate for a disturbance to a second control subsystem by using the first compensation voltage, wherein the first control subsystem is one of a turntable electromechanical control subsystem and a chassis electromechanical control subsystem, and the second control subsystem is the other of the turntable electromechanical control subsystem and the chassis electromechanical control subsystem, and wherein when the first control subsystem is the turntable electromechanical control subsystem and the second control subsystem is the chassis electromechanical control subsystem, determine a first compensation voltage comprises: determining an induction torque τ.sub.g according to a feedback signal in the turntable electromechanical control subsystem combined with a moment of inertia of a load and a moment of inertia of the chassis; determining a torque τ.sub.w applied to drive wheels of the chassis by the turntable according to the induction torque τ.sub.g; and determining a compensation voltage u of each drive wheel of the chassis based on the torque τ.sub.w and a rotational angular velocity ω of the drive wheel.

16. The storage medium according to claim 15, wherein the chassis has a plurality of drive wheels, and the first compensation voltage comprises a compensation voltage of each drive wheel, and wherein the computer instructions that cause the computer system to: compensate for an input voltage of an electromechanical module of each drive wheel in the chassis electromechanical control subsystem by using the compensation voltage of the drive wheel.

17. The storage medium according to claim 15, wherein when the first control subsystem is the chassis electromechanical control subsystem and the second control subsystem is the turntable electromechanical control subsystem, the computer instructions that cause the computer system to: determine an absolute angular velocity ω.sub.c of rotation of the chassis according to a feedback signal in the chassis electromechanical control subsystem; determine a torque τ.sub.c applied to the turntable by the chassis according to an absolute angular acceleration dω.sub.c/dt of rotation of the chassis; and determine a turntable compensation voltage u.sub.g according to the torque τ.sub.c and a rotational angular velocity ω.sub.g of the turntable.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) In order to more clearly explain the embodiments of the present disclosure or the technical solutions in the prior art, a brief introduction will be given below for the drawings required to be used in the description of the embodiments or the prior art. It is obvious that, the drawings illustrated as follows are merely some of the embodiments of the present disclosure. For a person skilled in the art, he or she may also acquire other drawings according to such drawings on the premise that no inventive effort is involved.

(2) FIG. 1 is a schematic diagram of a turntable electromechanical control subsystem;

(3) FIG. 2 is a schematic diagram of a chassis electromechanical control subsystem;

(4) FIG. 3 is a schematic diagram of the rotation of load and chassis in an AGV of the present disclosure;

(5) FIG. 4 is a schematic diagram of a control method for an AGV according to some embodiments of the present disclosure;

(6) FIG. 5 is a schematic diagram of a control method for an AGV according to other embodiments of the present disclosure;

(7) FIG. 6 is a schematic diagram of a chassis according to some embodiments of the present disclosure;

(8) FIG. 7 is a schematic diagram of a control method for an AGV according to still other embodiments of the present disclosure;

(9) FIG. 8 is a schematic diagram of a control method for an AGV according to further embodiments of the present disclosure;

(10) FIG. 9 is a schematic diagram of a control device for an AGV according to some embodiments of the present disclosure;

(11) FIG. 10 is a schematic diagram of a control device for an AGV according to other embodiments of the present disclosure;

(12) FIG. 11 is a schematic diagram of a control device for an AGV according to still other embodiments of the present disclosure;

(13) FIG. 12 is a schematic diagram of a control device for an AGV according to further embodiments of the present disclosure;

(14) FIG. 13 is a schematic diagram of a control device for an AGV according to still further embodiments of the present disclosure;

(15) FIG. 14 is a schematic diagram of an automated guided vehicle according to some embodiments of the present disclosure;

(16) FIG. 15 is a schematic diagram of feedforward decoupling control of the automated guided vehicle according to some embodiments of the present disclosure.

DETAILED DESCRIPTION

(17) Below, a clear and complete description will be given for the technical solution of embodiments of the present disclosure with reference to the figures of the embodiments. Obviously, merely some embodiments of the present disclosure, rather than all embodiments thereof, are given herein. The following description of at least one exemplary embodiment is in fact merely illustrative and is in no way intended as a limitation to the invention, its application or use. All other embodiments obtained by persons of ordinary skill in the art based on the embodiments of the present disclosure without creative efforts shall fall within the protection scope of the present disclosure.

(18) Unless otherwise specified, the relative arrangement, numerical expressions and numerical values of the components and steps set forth in these examples do not limit the scope of the invention.

(19) At the same time, it should be understood that the dimensions of the various parts shown in the drawings are not drawn to actual proportions for ease of description.

(20) Techniques, methods, and apparatus known to those of ordinary skill in the relevant art may not be discussed in detail, but where appropriate, these techniques, methods, and apparatuses should be considered as part of the specification.

(21) Of all the examples shown and discussed herein, any specific value should be construed as merely illustrative and not as a limitation. Thus, other examples of exemplary embodiments may have different values.

(22) Notice that, similar reference numerals and letters are denoted by the like in the accompanying drawings, and therefore, once an item is defined in a drawing, there is no need for further discussion in the accompanying drawings.

(23) FIG. 1 is a schematic diagram of a turntable electromechanical control subsystem. As shown in FIG. 1, the closed-loop control scheme of the turntable electromechanical control subsystem comprises: outputting by a subtractor 11 a difference between a given rotational angular velocity ω.sub.s and a feedback turntable rotational angular velocity ω.sub.g, performing a control process by a controller 12 according to the difference to obtain a control voltage, and providing the control voltage to the turntable electromechanical module 13, determining a turntable rotational angular velocity ω.sub.g using the control voltage, and returning the generated turntable rotational angular velocity ω.sub.g to the subtractor 11 as a feedback signal.

(24) FIG. 2 is a schematic diagram of a chassis electromechanical control subsystem. As shown in FIG. 2, the closed-loop control scheme of the chassis electromechanical control subsystem comprises: according to a given rotational angular velocity—ω.sub.s, providing by an angular velocity assignment module 20 a rotational angular velocity ω.sub.rl for a left-drive control branch, and providing a rotational angular velocity ω.sub.cr for a right-drive control branch. ω.sub.rl and ω.sub.cr are opposite to each other; in the left drive control branch, outputting by a subtractor 21 a difference between the rotational angular velocity ω.sub.rl and a feedback left drive wheel rotational angular velocity ω.sub.l, performing a control process by a controller 22 based on the difference to obtain a control voltage, and providing the control voltage to a left drive wheel electromechanical module 23, determining a left drive wheel rotational angular velocity ω.sub.l using the control voltage, and returning the determined left drive wheel rotational angular velocity ω.sub.l to the subtractor 21 as a feedback signal; in the right drive control branch, outputting by a subtractor 24 a difference between the rotational angular velocity ω.sub.cr and a feedback right drive wheel rotational angular velocity ω.sub.r, and performing by a controller 25 a control process based on the difference to obtain a control voltage, and supplying the control voltage to a right drive wheel electromechanical module 26, determining a right drive wheel rotational angular velocity ω.sub.r using the control voltage, and returning the determined right drive wheel rotational angular velocity ω.sub.l to the subtractor 24 as a feedback signal.

(25) In FIG. 1, the disturbance F.sub.d experienced by the turntable electromechanical module 13 comprises a load disturbance and a chassis disturbance. In FIG. 2, each of the disturbance F.sub.ld experienced by the left drive wheel electromechanical module 23 and the disturbance F.sub.rd experienced by the right drive wheel electromechanical module 26 comprises a turntable disturbance and a ground friction disturbance. Specifically, as shown in FIG. 3, in the AGV, the motion of the load 31 and the motion of the chassis 32 are coupled to each other based on a force relation, and the generated torques are τ and −τ, respectively. The forces in this coupling are represented as the disturbance terms F.sub.d, F.sub.id and F.sub.rd in FIGS. 1 and 2.

(26) The inventors have recognized that turntable control and chassis control are independently implemented in the related art. In this way, since the mutual coupling influence between the turntable and the chassis is ignored, it is difficult to effectively eliminate corresponding disturbance terms, and it is difficult to achieve high-precision control.

(27) A control method for an AGV is provided according to some embodiments of the present disclosure, comprising: determining a first compensation voltage according to a feedback signal in a first control subsystem; compensating for a disturbance to a second control subsystem by using the first compensation voltage; wherein the first control subsystem is one of a turntable electromechanical control subsystem and a chassis electromechanical control subsystem, and the second control subsystem is the other of the turntable electromechanical control subsystem and the chassis electromechanical control subsystem.

(28) The above control method may further comprise: determining a second compensation voltage according to a feedback signal in a second control subsystem; compensating for a disturbance to the first control subsystem by using the second compensation voltage.

(29) A scheme of compensating for a disturbance to the chassis electromechanical control subsystem using a feedback signal in the turntable electromechanical control subsystem and a scheme of compensating for a disturbance to the turntable electromechanical control subsystem using a feedback signal in the chassis electromechanical control subsystem will be described below with reference to FIGS. 4-6 and 7-8, respectively.

(30) FIG. 4 is a schematic diagram of a control method for an AGV according to some embodiments of the present disclosure. The method of this embodiment comprises steps 401-402.

(31) At step 401, a chassis compensation voltage is determined according to a feedback signal in a turntable electromechanical control subsystem.

(32) At step 402, a disturbance to the chassis electromechanical control subsystem is compensated by using the chassis compensation voltage.

(33) In some embodiments, an input voltage of an electromechanical module in the chassis electromechanical control subsystem is compensated by using the chassis compensation voltage. In a case where the chassis has a plurality of drive wheels, the input voltage of the electromechanical module of each drive wheel in the chassis electromechanical control subsystem is compensated by using the compensation voltage of the drive wheel. That is, the rotational angular velocity of each of the drive wheels is controlled separately.

(34) In some embodiments, in the case where the chassis has a left drive wheel and a right drive wheel, the chassis compensation voltage comprises a compensation voltage of the left drive wheel and a compensation voltage of the right drive wheel. Optionally, the above step of a disturbance to the chassis electromechanical control subsystem is compensated by using the chassis compensation voltage may comprise: compensating for an input voltage of the left drive wheel electromechanical module in the chassis electromechanical control subsystem by using a compensation voltage of the left drive wheel; compensating for an input voltage of the right drive wheel electromechanical module in the chassis electromechanical control subsystem by using a compensation voltage of the right drive wheel. That is, the rotational angular velocities of left and right drive wheels are controlled separately.

(35) Based on the control method for an automated guided vehicle provided in the above embodiment of the present disclosure, through utilizing the coupling relation between the turntable and the chassis, a disturbance to the chassis electromechanical control subsystem is compensated by using a feedback signal in the turntable electromechanical control subsystem, so that high-precision movement control of the turntable and the chassis is realized.

(36) FIG. 5 is a schematic diagram of a control method for an AGV according to other embodiments of the present disclosure. In some embodiments, the step of a chassis compensation voltage is determined based on a feedback signal in the turntable electromechanical control subsystem may comprise steps 501-503.

(37) At step 501, an induction torque τ.sub.g is determined according to a feedback signal in the turntable electromechanical control subsystem.

(38) In some embodiments, the feedback signal in the turntable electromechanical control subsystem is a rotational angular velocity ω.sub.g of the turntable.

(39) Optionally, the induction torque τ.sub.g is directly proportional to a rotational angular acceleration dω.sub.g/dt of the turntable. For example, the induction torque τ.sub.g can be calculated using the following formula (1):

(40) $\begin{matrix} τ_{g} = \frac{J_{g} J_{c}}{J_{g} + J_{c}} \frac{d ω_{g}}{dt} & (1) \end{matrix}$

(41) where J.sub.g is the moment of inertia of the load and J.sub.c is the moment of inertia of the chassis.

(42) At step 502, a torque τ.sub.w applied to a chassis drive wheel by the turntable is determined according to the induction torque τ.sub.g.

(43) In some embodiments, the torque τ.sub.w is directly proportional to the induction torque τ.sub.g. For example, the torque τ.sub.w can be calculated using the following formula (2):

(44) $\begin{matrix} τ_{w} = - \frac{τ_{g}}{l_{c 1}} r_{w} & (2) \end{matrix}$

(45) where, r.sub.w is a wheel radius and l.sub.cl is the length of one side of the chassis, as shown in FIG. 6 l.sub.cl=l.sub.bl.

(46) At step 503, a compensation voltage u of each drive wheel of the chassis is determined based on the torque τ.sub.w and a rotational angular velocity ω of the drive wheel. For example, in a case where the chassis has, for example, a left drive wheel and a right drive wheel, a compensation voltage u.sub.l of the left drive wheel is determined according to the torque τ.sub.w and the rotational angular velocity ω of the left drive wheel, and a compensation voltage u.sub.r of the right drive wheel is determined according to the torque τ.sub.w and the rotational angular velocity ω.sub.r of the right drive wheel.

(47) Optionally, this calculation can be performed using the following formula (3) and formula (4):
u.sub.r=−R.sub.rτ.sub.w+K.sub.rω.sub.r (3)
u.sub.l=−R.sub.lτ.sub.w+K.sub.lω.sub.l (4)

(48) wherein R.sub.r and R.sub.l are resistance parameters, and K.sub.r and K.sub.l are voltage parameters.

(49) In some embodiments, the torque τ.sub.w of the left and right drive wheels are opposite to each other, the rotational angular velocity ω.sub.l of the left drive wheel and the rotational angular velocity ω.sub.r of the right drive wheel are opposite to each other, and therefore, the compensation voltage u.sub.l of the left drive wheel and the compensation voltage u.sub.r of the right drive wheel are opposite to each other.

(50) FIG. 7 is a schematic diagram of a control method for an AGV according to still other embodiments of the present disclosure. The method of this embodiment comprises steps 701-702.

(51) At step 701, a turntable compensation voltage is determined according to a feedback signal in a chassis electromechanical control subsystem;

(52) At step 702, a disturbance to the turntable electromechanical control subsystem is compensated by using the turntable compensation voltage.

(53) In some embodiments, a disturbance to the turntable electromechanical control subsystem is compensated by using the turntable compensation voltage may comprise: compensating for an input voltage of a turntable electromechanical module in the turntable electromechanical control subsystem by using the turntable compensation voltage. That is, compensation control to the turntable electromechanical control subsystem can be performed by using a feedback signal in the chassis electromechanical control subsystem.

(54) FIG. 8 is a schematic diagram of a control method for an AGV according to further embodiments of the present disclosure. In some embodiments, the step of a turntable compensation voltage is determined based on a feedback signal in the chassis electromechanical control subsystem may comprise steps 801-803.

(55) At step 801, an absolute angular velocity ω.sub.c of rotation of the chassis is determined according to a feedback signal in the chassis electromechanical control subsystem.

(56) In some embodiments, the feedback signal in the chassis electromechanical control subsystem comprises a right drive wheel rotational angular velocity ω.sub.r and a left drive wheel rotational angular velocity ω.sub.l in the chassis electromechanical control subsystem.

(57) Optionally, the absolute angular velocity ω.sub.c is directly proportional to a difference between the right drive wheel rotational angular velocity ω.sub.r and the left drive wheel rotational angular velocity ω.sub.l. For example, the absolute angular velocity ω.sub.c can be calculated by the following formula (5):

(58) $\begin{matrix} ω_{c} = \frac{r_{w} ω_{r} - r_{w} ω_{l}}{l_{c 1}} & (5) \end{matrix}$

(59) At step 802, a torque τ.sub.c applied to the turntable by the chassis is determined according to an absolute angular acceleration dω.sub.c/dt of rotation of the chassis.

(60) Optionally, the torque τ.sub.c is directly proportional to the absolute angular acceleration dω.sub.c/dt of rotation of the chassis. For example, the torque τ.sub.c can be calculated using the following formula (6):

(61) $\begin{matrix} τ_{c} = J_{g} \frac{d ω_{c}}{dt} & (6) \end{matrix}$

(62) At step 803, a turntable compensation voltage u.sub.g is determined according to the torque τ.sub.c and a rotational angular velocity ω.sub.g of the turntable.

(63) Optionally, this calculation can be performed using the following formula (7):
u.sub.g=−R.sub.gτ.sub.w+K.sub.gω.sub.g (7)

(64) wherein R.sub.g is the resistance parameter and K.sub.g is the voltage parameter.

(65) Furthermore, the scheme of compensating for a disturbance to the chassis electromechanical control subsystem using a feedback signal in the turntable electromechanical control subsystem can be combined with the scheme of compensating for a disturbance to the turntable electromechanical control subsystem using a feedback signal in the chassis electromechanical control subsystem to control the automated guided vehicle. For example, steps 401-402 can be executed in addition to the execution of steps 701-702, so that high-precision movement control of the turntable and the chassis is realized.

(66) A control device for an AGV is further provided according to some embodiments of the present disclosure, comprising:

(67) a first compensation voltage determination module for determining a first compensation voltage according to a feedback signal in a first control subsystem; and

(68) a first disturbance compensation module for compensating for a disturbance to a second control subsystem by using the first compensation voltage;

(69) wherein the first control subsystem is one of a turntable electromechanical control subsystem and a chassis electromechanical control subsystem, and the second control subsystem is the other of the turntable electromechanical control subsystem and the chassis electromechanical control subsystem.

(70) The above control device may further comprise:

(71) a second compensation voltage determination module for determining a second compensation voltage according to a feedback signal in a second control subsystem; and

(72) a second disturbance compensation module for compensating for a disturbance to a first control subsystem by using the second compensation voltage.

(73) The above control device will be described in detail below with reference to FIGS. 9-12.

(74) FIGS. 9-10 illustrate the use of a feedback signal in the turntable electromechanical control subsystem to compensate for a disturbance to the chassis electromechanical control subsystem. In this case, the first compensation voltage determination module is a chassis compensation voltage determination module 91, and the first disturbance compensation module is a chassis disturbance compensation module 92.

(75) FIGS. 11-12 illustrate the use of a feedback signal in the chassis electromechanical control subsystem to compensate for a disturbance to the turntable electromechanical control subsystem. In this case, the first compensation voltage determination module is a turntable compensation voltage determination module 93, and the first disturbance compensation module is a turntable disturbance compensation module 94.

(76) The control device may further compensate for a disturbance to the chassis electromechanical control subsystem using a feedback signal in the turntable electromechanical control subsystem in addition to compensating for a disturbance to the turntable electromechanical control subsystem using a feedback signal in the chassis electromechanical control subsystem. In this case, if the first compensation voltage determination module is a chassis compensation voltage determination module 91, the first disturbance compensation module is a chassis disturbance compensation module 92, the second compensation voltage determination module is a turntable compensation voltage determination module 93, and the second disturbance compensation module is a turntable disturbance compensation module 94; or if the first compensation voltage determination module is a turntable compensation voltage determination module 93, and the first disturbance compensation module is a turntable disturbance compensation module 94, the second compensation voltage determination module is a chassis compensation voltage determination module 91, and the second disturbance compensation module is a chassis disturbance compensation module 92.

(77) FIG. 9 is a schematic diagram of a control device for an AGV according to some embodiments of the present disclosure. As shown in FIG. 9, the control device for an automated guided vehicle may comprise a chassis compensation voltage determination module 91 and a chassis disturbance compensation module 92.

(78) The chassis compensation voltage determination module 91 is used for determining a chassis compensation voltage based on a feedback signal in a turntable electromechanical control subsystem.

(79) The chassis disturbance compensation module 92 is used for compensating for a disturbance to the chassis electromechanical control subsystem using the chassis compensation voltage.

(80) In some embodiments, the chassis disturbance compensation module 92 is used for compensating for an input voltage of an electromechanical module in the chassis electromechanical control subsystem by using the chassis compensation voltage. In a case where the chassis has a plurality of drive wheels, the input voltage of the electromechanical module of each drive wheel in the chassis electromechanical control subsystem is compensated by using the compensation voltage of the drive wheel.

(81) In some embodiments, in the case where the chassis has a left drive wheel and a right drive wheel, the chassis compensation voltage comprises a compensation voltage of the left drive wheel and a compensation voltage of the right drive wheel.

(82) Based on the control device for an automated guided vehicle provided in the above embodiment of the present disclosure, through utilizing the coupling relation between the turntable and the chassis, a disturbance to the chassis electromechanical control subsystem is compensated by using a feedback signal in the turntable electromechanical control subsystem, so that high-precision movement control of the turntable and the chassis is realized.

(83) FIG. 10 is a schematic diagram of a control device for an AGV according to other embodiments of the present disclosure. Compared with the embodiment shown in FIG. 9, in FIG. 10, in the case where the chassis has, for example, a left drive wheel and a right drive wheel, the chassis disturbance compensation module 92 comprises a left drive compensation unit 921 and a right drive compensation unit 922.

(84) The left drive compensation unit 921 is used for compensating for an input voltage of a left drive wheel electromechanical module in the chassis electromechanical control subsystem by using a compensation voltage of the left drive wheel.

(85) The right drive compensation unit 922 is used for compensating for an input voltage of a right drive wheel electromechanical module in the chassis electromechanical control subsystem by using a compensation voltage of the right drive wheel.

(86) Further, in the embodiment shown in FIG. 10, the chassis compensation voltage determination module 91 comprises an induction torque determination unit 911, a turntable torque determination unit 912, and a compensation voltage determination unit 913.

(87) The induction torque determination unit 911 is used for determining an induction torque τ.sub.g according to a feedback signal in the turntable electromechanical control subsystem.

(88) In some embodiments, the feedback signal in the turntable electromechanical control subsystem is a turntable rotational angular velocity ω.sub.g.

(89) The induction torque τ.sub.g is directly proportional to a turntable rotational angular acceleration dω.sub.g/dt. For example, the calculation can be performed using the above formula (1).

(90) The turntable torque determination unit 912 is used for determining a torque τ.sub.w applied to drive wheels of the chassis by the turntable according to the induction torque τ.sub.g.

(91) In some embodiments, the torque τ.sub.w is directly proportional to the induction torque τ.sub.g. For example, the calculation can be performed using the above formula (2).

(92) The compensation voltage determination unit 913 is used for determining a compensation voltage u of each drive wheel of the chassis based on the torque τ.sub.w and a rotational angular velocity of the drive wheel. In a case where the chassis has, for example, a left drive wheel and a right drive wheel, a compensation voltage u.sub.l of the left drive wheel is determined according to the torque τ.sub.w and the rotational angular velocity ω.sub.l of the left drive wheel, and a compensation voltage u.sub.r of the right drive wheel is determined according to the torque τ.sub.w and the rotational angular velocity ω.sub.r of the right drive wheel.

(93) For example, the left-drive compensation voltage u.sub.l and the right-drive compensation voltage u.sub.r can be calculated using the above formulas (3) and (4).

(94) FIG. 11 is a schematic diagram of a control device for an AGV according to still other embodiments of the present disclosure. The AGV control apparatus comprises or further comprises, on the basis of the embodiment shown in FIG. 9 or FIG. 10, a turntable compensation voltage determination module 93 and a turntable disturbance compensation module 94.

(95) The turntable compensation voltage determination module 93 is used for determining a turntable compensation voltage according to a feedback signal in a chassis electromechanical control subsystem.

(96) The turntable disturbance compensation module 94 is used for compensating for a disturbance to the turntable electromechanical control subsystem by using the turntable compensation voltage.

(97) In some embodiments, the turntable disturbance compensation module 94 specifically compensates for an input voltage of a turntable electromechanical module in the turntable electromechanical control subsystem using the turntable compensation voltage.

(98) FIG. 12 is a schematic diagram of a control device for an AGV according to further embodiments of the present disclosure. Compared with the embodiment shown in FIG. 11, in FIG. 12, the turntable compensation voltage determination module 93 comprises an absolute angular velocity determination unit 931, a chassis torque determination unit 932, and a turntable compensation voltage determination unit 933.

(99) The absolute angular velocity determination unit 931 is used to determine an absolute angular velocity ω.sub.c of rotation of the chassis according to a feedback signal in the chassis electromechanical control subsystem.

(100) In some embodiments, the feedback signal in the chassis electromechanical control subsystem comprises a right drive wheel rotational angular velocity ω.sub.r and a left drive wheel rotational angular velocity ω.sub.l in the chassis electromechanical control subsystem.

(101) Optionally, the absolute angular velocity ω.sub.c is directly proportional to a difference between the right drive wheel rotational angular velocity ω.sub.r and the left drive wheel rotational angular velocity ω.sub.l. For example, the absolute angular velocity ω.sub.c can be calculated using the above formula (5).

(102) The chassis torque determination unit 932 is used to determine a torque τ.sub.c applied to the turntable by the chassis according to an absolute angular acceleration dω.sub.c/dt of rotation of the chassis.

(103) Optionally, the torque τ.sub.c is directly proportional to the absolute angular acceleration dω.sub.c/dt of rotation of the chassis. For example, the torque τ.sub.c can be calculated using the above formula (6).

(104) The turntable compensation voltage determination unit 933 is used to determine a turntable compensation voltage u.sub.g according to the torque τ.sub.c and a rotational angular velocity ω.sub.g of the turntable.

(105) For example, the turntable compensation voltage u.sub.g can be calculated using the above formula (7).

(106) The modules and units of the various embodiments described above can be implemented by a processor of a control device for an AGV to perform corresponding operations.

(107) FIG. 13 is a schematic diagram of a control device for an AGV according to still further embodiments of the present disclosure. As shown in FIG. 13, the AGV control device comprises memory 1301 and a processor 1302.

(108) The memory 1301 is used to store computer instructions. The processor 1302 is coupled to the memory 1301, and is configured to carry out a method involved in any one of the embodiments of FIGS. 4, 5, 7, 8 based on computer instructions stored in the memory.

(109) As shown in FIG. 13, the delivery robot control device further comprises a communication interface 1303 for performing information interaction with other devices. The device further comprises a bus 1304, wherein the processor 1302, the communication interface 1303, and the memory 1301 communicate with each other via the bus 1304.

(110) The memory 1301 may comprise a high speed RAM memory, and may also comprise a non-volatile memory such as at least one disk storage device. The memory 1301 can also be a memory array. The memory 1301 may also be partitioned into blocks, which may be combined into virtual volumes according to a certain rule.

(111) In addition, the processor 1302 may be a central processing unit (CPU), or may be an Application Specific Integrated Circuit (ASIC) or one or more integrated circuits configured to implement the embodiments of the present disclosure.

(112) FIG. 14 is a schematic diagram of an automated guided vehicle according to some embodiments of the present disclosure. As shown in FIG. 14, the automated guided vehicle 1401 comprises a control device 1402, wherein the control device 1402 is the control device for an AGV according to any one of the embodiments of FIGS. 9-13.

(113) Furthermore, the present disclosure also relates to a computer readable storage medium, such as a non-volatile storage medium, the computer readable storage medium storing computer instructions, which when executed by a processor implement the method involved in any one of the embodiments of FIGS. 4, 5, 7, 8.

(114) The AGV feedforward decoupling control of the present disclosure will be specifically described below with a specific example.

(115) As shown in FIG. 15, an induction torque determination unit 911 determines an induction torque τ.sub.g according to a feedback signal ω.sub.g in a turntable electromechanical control subsystem; a turntable acting torque determination unit 912 determines a torque w applied to a chassis drive wheel by a turntable according to the induction torque τ.sub.g; a compensation voltage determination unit 913 is used to determine a left-drive compensation voltage u.sub.l according to the torque τ.sub.w and a rotational angular velocity ω.sub.l of a left drive wheel, and determine a compensation voltage u.sub.r of the right drive wheel according to the torque τ.sub.w and a rotational angular velocity ω.sub.r of a right drive wheel. In a left drive control branch, the left drive compensation voltage u.sub.l is added to a voltage value output by a controller, and the obtained sum is supplied to a left drive wheel electromechanical module to control the rotational angular velocity ω.sub.l of the left drive wheel. In a right drive control branch, the right drive compensation voltage u.sub.r is added to a voltage value output by a controller, and the obtained sum is supplied to a right drive wheel electromechanical module to control the rotational angular velocity ω.sub.r of the right drive wheel.

(116) In addition, an absolute angular velocity determination unit 931 determines an absolute angular velocity ω.sub.c of rotation of the chassis according to a feedback signal in the chassis electromechanical control subsystem. The feedback signal in the chassis electromechanical control subsystem comprises a right drive wheel rotational angular velocity ω.sub.r and a left drive wheel rotational angular velocity ω.sub.l in the chassis electromechanical control subsystem. A chassis torque determination unit 932 determines a torque τ.sub.c applied to the turntable by the chassis according to an absolute angular acceleration dω.sub.c/dt of rotation of the chassis. A turntable compensation voltage determination unit 933 determines a turntable compensation voltage u.sub.g according to the torque τ.sub.c and a rotational angular velocity ω.sub.g of the turntable. The turntable compensation voltage u.sub.g is added to a voltage value output by a controller, and the obtained sum is supplied to a turntable electromechanical module to control the turntable rotational angular velocity ω.sub.g.

(117) The present disclosure couples the force exertion in the turntable electromechanical control subsystem to the force exertion in the chassis electromechanical control subsystem, and introduces a feedback amount from one subsystem to the other subsystem. By compensating an actual force disturbance in each subsystem, the high-precision control of the motion of the turntable and the motion of the chassis is realized.

(118) One skilled in the art should understand that, the embodiments of the present disclosure may be provided as a method, a system, or a computer program product. Therefore, embodiments of the present disclosure can take the form of an entirely hardware embodiment, an entirely software embodiment or an embodiment containing both hardware and software elements. Moreover, the present disclosure may take the form of a computer program product embodied on one or more computer-usable non-transitory storage media (comprising but not limited to disk storage, CD-ROM, optical memory, etc.) having computer-usable program code embodied therein.

(119) The present disclosure is described with reference to flowcharts and/or block diagrams of methods, apparatuses (systems) and computer program products according to embodiments of the present disclosure. It should be understood that each process and/or block in the flowcharts and/or block diagrams, and combinations of the processes and/or blocks in the flowcharts and/or block diagrams may be implemented by computer program instructions. The computer program instructions may be provided to a processor of a general purpose computer, a special purpose computer, an embedded processor, or other programmable data processing device to generate a machine such that the instructions executed by a processor of a computer or other programmable data processing device to generate means implementing the functions specified in one or more flows of the flowcharts and/or one or more blocks of the block diagrams.

(120) The computer program instructions may also be stored in a computer readable memory device capable of directing a computer or other programmable data processing device to operate in a specific manner such that the instructions stored in the computer readable memory device produce an article of manufacture comprising instruction means implementing the functions specified in one or more flows of the flowcharts and/or one or more blocks of the block diagrams.

(121) These computer program instructions can also be loaded onto a computer or other programmable device to perform a series of operation steps on the computer or other programmable device to generate a computer-implemented process such that the instructions executed on the computer or other programmable device provide steps implementing the functions specified in one or more flows of the flowcharts and/or one or more blocks of the block diagrams.

(122) The above description of this invention is given for illustration and description but is not exhaustive and is not intended to limit the present invention to the form disclosed herein. Various modifications and variations are apparent for a person of ordinary skill in the art. Embodiments are selected and described for a better illustration of the principle and practical application of the present disclosure, so that those skilled in the art can understand the present disclosure and envisage various embodiments with various modifications suited to specific usages.

Control method and device for automated guided vehicle, and automated guided vehicle

Assignee

Inventors

Cpc classification

Classification Explorer

G05D2201/0216

PHYSICS

Classification Explorer

B60W2520/30

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B60W2520/28

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B60W30/18

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

G05D1/0088

PHYSICS

Classification Explorer

B60W50/00

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

G05D1/0223

PHYSICS

Classification Explorer

B60W2556/00

PERFORMING OPERATIONS; TRANSPORTING

International classification

Classification Explorer

B60W50/00

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B60W30/18

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

G05D1/02

PHYSICS

Classification Explorer

G05D1/00

PHYSICS

Abstract

Claims

Description