CONTROL SYSTEM AND METHOD FOR FOLLOWER E-PALLET IN LEADER-FOLLOWER PLATOON ARRANGEMENT
20230133525 · 2023-05-04
Assignee
Inventors
- Hojjat Izadi (North York, CA)
- Carlos E. Arreaza (Oakville, CA)
- Mohammad-Amin Rajaie (Richmond Hill, CA)
- Mohammad H. Beheshti (Oshawa, CA)
Cpc classification
B62B5/06
PERFORMING OPERATIONS; TRANSPORTING
B65D19/42
PERFORMING OPERATIONS; TRANSPORTING
B65D2519/00781
PERFORMING OPERATIONS; TRANSPORTING
B62B5/0079
PERFORMING OPERATIONS; TRANSPORTING
International classification
B65D19/42
PERFORMING OPERATIONS; TRANSPORTING
B62B5/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A platoon of electric pallets (e-pallets) includes a follower e-pallet connected to or in wireless communication with a leader e-pallet. The platoon also includes a sensor suite, road wheels, an electric powertrain system, and a local controller. The sensor suite includes a velocity sensor configured to measure a velocity of the follower e-pallet, an angle sensor configured to measure an azimuth angle between the follower and leader e-pallets, and a length or distance sensor configured to measure a distance therebetween. The local controller executes a method to adaptively move a variable target point (VTP) on the leader pallet in response to the velocity, the azimuth angle, and the length, and to thereafter control a dynamic output state of the electric powertrain system using the VTP.
Claims
1. A platoon of electric pallets (e-pallets), comprising: a leader e-pallet; a follower e-pallet arranged aft of the leader e-pallet to form the platoon of e-pallets, wherein an azimuth angle is defined between an axis of the leader e-pallet and a leading edge of the follower e-pallet; a sensor suite, including a velocity sensor configured to measure a velocity of the follower e-pallet, an angle sensor configured to measure the azimuth angle, and a distance sensor configured to measure a distance between the leader e-pallet and the follower e-pallet, wherein follower e-pallet comprises: a set of road wheels; an electric powertrain system connected to the set of road wheels and configured to provide an output torque thereto; and a local controller connected to the follower e-pallet, wherein the local controller is configured to adaptively move a variable target point (VTP) on the leader pallet in response to the velocity, the azimuth angle, and the distance, and to thereafter control a dynamic output state of the electric powertrain system using the VTP.
2. The platoon of claim 1, wherein the local controller is configured to change a variable distance setpoint on the leader e-pallet based on the azimuth angle to maintain a linear distance between the leader e-pallet and the follower e-pallet.
3. The platoon of claim 1, wherein the local controller is configured to estimate a velocity of the leader e-pallet as an estimated velocity, define a desired velocity of the follower e-pallet using the estimated velocity, and thereafter control the dynamic output state of the electric powertrain system of the follower e-pallet using the estimated velocity.
4. The platoon of claim 1, wherein the distance sensor includes a string potentiometer.
5. The platoon of claim 1, wherein the leader e-pallet is configured to be towed by a human operator, and the leader e-pallet includes motorized drive wheels responsive to a towing force imparted by the human operator.
6. The platoon of claim 1, wherein the set of road wheels includes a pair of front drive wheels, and the electric powertrain system includes first and second electric motors respectively connected to a different one of the front drive wheels to provide the follower e-pallet with a differential steering capability.
7. The platoon of claim 1, wherein the local controller is configured to use a velocity term to provide a faster response at higher velocities of the platoon to enable the local controller, and to compensate for a relatively slow response of the tether device.
8. The platoon of claim 1, wherein the follower e-pallet includes a plurality of follower e-pallets.
9. A method for controlling a platoon of electric pallets (e-pallets) having a leader e-pallet and a follower e-pallet connected thereto by a tether device, the follower e-pallet having a set of road wheels powered via an electric powertrain system, the method comprising: measuring, via a plurality of sensors of a sensor suite, a velocity of the follower e-pallet, an azimuth angle defined between the tether device and a leading edge of the follower e-pallet, and a length sensor configured to measure a length of the tether device; adaptively moving a variable target point (VTP) on the leader pallet, via a local controller of the follower e-pallet, in response to the velocity, the azimuth angle, and the length; and controlling a dynamic output state of the electric powertrain system of the follower e-pallet using the VTP.
10. The method of claim 9, further comprising: changing a variable distance setpoint on the leader e-pallet based on the azimuth angle, via the follower controller, to thereby maintain a linear distance between the leader e-pallet and the follower e-pallet.
11. The method of claim 9, further comprising: estimating a velocity of the leader e-pallet as an estimated velocity; defining a desired velocity of the follower e-pallet using the estimated velocity; and controlling the dynamic output state of the electric powertrain system using the estimated velocity.
12. The method of claim 11, wherein the set of road wheels includes a pair of front drive wheels, and the electric powertrain system includes first and second electric motors respectively connected to a different one of the front drive wheels, and wherein controlling the dynamic output state of the electric powertrain system using the estimated velocity includes turning the follower e-pallet using differential steering in which the first and second electric motors rotate at different output speeds relative to each other.
13. The method of claim 9, wherein the length sensor includes a string potentiometer that is integral with the tether device, and wherein measuring the length of the tether device is performed using the string potentiometer.
14. The method of claim 9, further comprising using a velocity term in logic of the local controller to provide a faster response at higher velocities of the platoon, and to thereby enable the local controller to compensate for a relatively slow response of the tether device.
15. The method of claim 9, wherein the follower e-pallet includes a plurality of follower e-pallets each having a respective electric powertrain system, and wherein controlling the dynamic output state of the electric powertrain system includes simultaneously controlling a respective dynamic output state of the respective electric powertrain system of each one of the follower e-pallets.
16. A follower electric pallet (e-pallet) for use with a lead vehicle to which the follower e-pallet is connected in a platoon arrangement via a tether device, the tether device defining an azimuth angle with respect to a leading edge of the follower e-pallet, the follower e-pallet comprising: a set of road wheels; an electric powertrain system connected to the set of road wheels and configured to provide an output torque thereto to propel the follower e-pallet; and a local controller connected to the follower e-pallet, wherein the local controller is configured to receive from a sensor suite each of a measured length of the tether device, the azimuth angle, and a velocity of the follower e-pallet, and wherein the local controller is configured to: adaptively move a variable target point (VTP) on the leader e-pallet in response to the velocity, the azimuth angle, and the measured length; control a dynamic output state of the electric powertrain system using the VTP; and change a variable distance setpoint on the leader e-pallet to maintain a linear distance between the leader e-pallet and the follower e-pallet based on the azimuth angle.
17. The follower e-pallet of claim 16, wherein the local controller is configured to estimate a velocity of the leader e-pallet as an estimated velocity, define a desired velocity of the follower e-pallet using the estimated velocity, and thereafter control the dynamic output state of the electric powertrain system of the follower e-pallet using the estimated velocity.
18. The follower e-pallet of claim 16, wherein the local controller is configured to use a velocity term in control logic of the local controller to provide a faster dynamic response of the follower e-pallet at higher velocities of the platoon to enable the local controller to compensate for a relatively slow response of the tether device.
19. The follower e-pallet of claim 16, further comprising the tether device.
20. The follower e-pallet of claim 19, further comprising the sensor suite, wherein the sensor suite includes a length sensor that is integral with the tether device.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0019]
[0020]
[0021]
[0022]
[0023]
DETAILED DESCRIPTION
[0024] The present disclosure is susceptible of embodiment in many different forms. Representative examples of the disclosure are shown in the drawings and described herein in detail as non-limiting examples of the disclosed principles. To that end, elements and limitations described in the Abstract, Introduction, Summary, and Detailed Description sections, but not explicitly set forth in the claims, should not be incorporated into the claims, singly or collectively, by implication, inference, or otherwise.
[0025] For purposes of the present description, unless specifically disclaimed, use of the singular includes the plural and vice versa, the terms “and” and “or” shall be both conjunctive and disjunctive, “any” and “all” shall both mean “any and all”, and the words “including”, “containing”, “comprising”, “having”, and the like shall mean “including without limitation”. Moreover, words of approximation such as “about”, “almost”, “substantially”, “generally”, “approximately”, etc., may be used herein in the sense of “at, near, or nearly at”, or “within 0-5% of”, or “within acceptable manufacturing tolerances”, or logical combinations thereof.
[0026] Referring to the drawings, wherein like reference numbers refer to like features throughout the several views, and beginning with
[0027] The platoon 120 of
[0028] To enable the platoon 120 to function in this manner, the leader 12L and the follower(s) 12F are respectively equipped with a local controller (C.sub.L) 500 and (C.sub.F) 50. The local controller 500 receives input signals (arrow CC.sub.I*), such as when the operator 14 applies a towing force (arrow FT). In response, the local controller 500 transmits motor control signals (arrow CC.sub.O*) to one or more onboard electric traction motors to control propulsion functions of the leader 12L. The local controller 500 may regulate operation of the leader 12L using suitable closed-loop or open-loop dynamic control strategies informed by the input signals (arrow CC.sub.I*). For instance, the leader 12L may be connected to the operator 14 by the flexible tether device 25, which the operator 14 may grasp when towing the platoon 120 in the direction of arrow AA. Regardless of how the lead e-pallet 12L is powered, however, the absence of vehicle-to-vehicle (V2V) communications within the platoon 120 of
[0029] Instead, the followers 12F act on their own, i.e., locally, doing so based on input signals (arrow CC.sub.I) from a sensor suite 40S into the respective local controllers 50. The sensor suite 40S or constituent sensors thereof may be considered as part of the follower 12F or distinct therefrom in different embodiments. Aboard each one of the follower(s) 12F, the local controller 50 is mounted on or housed within a superstructure 13. The superstructure 13 may vary in its construction based on the transported load, but in general may embody a box-like container possibly including shelves, racks, bins, or other suitable structure for securely moving the load through the workspace 10. The superstructure 13 in turn is connected to or formed integrally with a base platform 20, e.g., a solid plate or planar surface of metal, plastic, and/or composite materials configured to support the collective weight of the local controller 50 and the above-described load. The base platform 20 in turn are connected to one or more road wheels 22F and 22R, e.g., via drive axles and a suspension system (not shown).
[0030] In the representative use case of
[0031] Depending on the relative velocities and ground speeds of the operator 14 and the leader 12L with respect to the floor surface 11, the tether device 25 extending to the leader 12L and grasped by the operator 14, as well as similar tether devices 25 connecting the follower(s) 12F together or to the leader 12L, may extend or contract in length, as indicated by double-headed arrow DD. At the same time, the local controller 50 of the follower(s) 12F and the local controller 500 of the leader 12L command a motor assist force (arrow FM), which is imparted by delivery of a motor drive torque to one or more of the road wheels 22F and/or 22R. Aboard the follower(s) 12F, this action is performed in response to the input signals (arrow CC.sub.I) by the transmission of motor control signals (arrow CC.sub.O) from the local controller 50, e.g., to corresponding motor control processors as appreciated in the art. The motor control signals (arrow CC.sub.O) within the scope of the present disclosure may include a desired yaw rate (ω.sub.des) and a desired velocity (V.sub.des) of the follower(s) 12F, for instance.
[0032] Referring briefly to
[0033] In order to perform the various motion control functions, the local controller 50 is programmed in software and equipped with application-specific amounts of volatile and non-volatile memory (M) and one or more processor(s) (P). The memory (M) includes or is configured as a non-transitory computer readable storage device(s) or media, and may include volatile and nonvolatile storage in read-only memory (ROM) and random-access memory (RAM), and possibly keep-alive memory (KAM) or other persistent or non-volatile memory for storing various operating parameters while the processor (P) is powered down. Other implementations of the memory (M) may include, e.g., flash memory, solid state memory, PROM (programmable read-only memory), EPROM (electrically PROM), and/or EEPROM (electrically erasable PROM), and other electric, magnetic, and/or optical memory devices capable of storing data, at least some of which is used in the performance of the present method. The processors (P) may include various microprocessors or central processing units, as well as associated hardware such as a digital clock or oscillator, input/output (I/O) circuitry, buffer circuitry, Application Specific Integrated Circuits (ASICs), systems-on-a-chip (SoCs), electronic circuits, and other requisite hardware needed to provide the programmed functionality. In the context of the present disclosure, the local controller 50 executes instructions via the processor(s) (P) to cause the local controller 50 to perform the present method.
[0034] Computer-readable non-transitory instructions or code embodying the method and executable by the local controller 50 may include one or more separate software programs, each of which may include an ordered listing of executable instructions for implementing the stated logical functions described below. Execution of the instructions by the processor (P) in the course of operating the followers 12F causes the respective local controller(s) 50 to regulate motion of the followers 12F.
[0035] The electrified powertrain system 30 of
[0036] When the electric traction motors 36A and 36B are embodied as alternating current (AC)/polyphase propulsion motors as shown, the TPIMs 34A and 34B are connected to the power supply 32 via a direct current voltage bus 33. The TPIMs 34A and 34B are also connected to the electric motors 36A and 36B, respectively, via corresponding AC voltage busses 35A and 35B. Internal switching operations of the TPIMs 34A and/or 34B in this representative configuration is used to convert a DC voltage (VDC) present on the DC voltage bus 33 into an AC voltage (VAC) on the AC voltage bus 35A and/or 35B as needed in order to electrically energize one or both of the electric motors 36A and 36B. Embodiments may also be conceived of in which the electric motors 36A and 36B are DC motors, in which case one may omit the TPIMs 34A and 34B and associated power conversion circuitry.
[0037] With respect to locomotion of the follower 12F, each road wheel 22A and 22B may be separately powered by a respective output torque, i.e., arrows TA and TB. In such a configuration, the follower 12F may employ differential steering, which in turn is accomplished by rotating the road wheels 22A and 22B via corresponding output members 37A and 37B at different torques or speeds relative to one another. When executing a left-hand turn, for instance, the local controller 50 may command the output torque (TA) from the electric motor 36A at a higher level or corresponding rotary speed than the output torque (TB) from traction motor 36B. A similar steering effect may be enjoyed using a single electric traction motor 36A or 36B using an associated electronic differential, as will be appreciated by those skilled in the art, and therefore the configuration of
[0038]
[0039]
[0040] When the leader 12L begins to turn, however, as represented by arrow BB of
[0041] E-PALLET KINEMATICS: referring briefly to
[0042] With continued reference to the representative diagram 48, the velocity (V.sub.F) of the follower 12F may be expressed mathematically as V.sub.F=√{square root over ({dot over (x)}.sup.2+{dot over (y)}.sup.2)}, with the yaw rate (ω)={dot over (θ)}. Additionally:
Ultimately, the velocities of the left and right motors, i.e., the electric traction motors 36A and 36B, are expressed as functions of the velocity (V.sub.F), the yaw rate (ω), and the distance (d) between the road wheels 22A and 22B:
The kinematics diagram 48 of
[0043] Functions of the local controller 50 in the overall control of the follower 12F will now be described with reference to
[0044]
[0045] The local controller 50 is thus configured to calculate the target length (L.sub.t) between the particular point at which the tether device 25 is connected to the leader 12L and the VTP 80, e.g., as follows:
L.sub.t=L.sub.t0.Math.cos(α.sub.L)
where α.sub.L is the measured azimuth angle of the follower 12F from the point of view of the leader 12L, i.e., the angle between the tether device 25 and a connection point thereof on the trailing edge 51 of the leader 12L, and L.sub.t0 is the nominal value of the L.sub.t that represents the distance to the VTP 80 for straight ahead driving/motion. Knowledge of the target length (L.sub.t) allows the local controller 50 to calculate the angle (γ) between the VTP 80 and the connection point of the tether device 25 on the follower 12F, relative to the longitudinal axis of the leader 12L, for instance as follows:
The local controller 50 can thereafter derive the effective distance (d.sub.eff) as a function of the above-described angle (γ), i.e.,:
The corresponding azimuth angle (α) may then be calculated using the following equation:
α=α.sub.F+α.sub.L−γ
[0046] The local controller 50 is also programmed to change a distance setpoint based on the angle (γ). This additional capability allows the local controller 50 to adapt in real time to the limited range of motion of the tether device 25. By way of an illustration:
Distance setpoint=(r.sub.c+L.sub.t).Math.(1−k.sub.γγ)
Distance error=d.sub.eff−distance setpoint
where r.sub.c is a nominal following distance setpoint and k.sub.γ is a calibration value. The local controller 50 can then control operation of the follower 12F in a closed loop to drive the distance error to zero.
[0047] Additional functionality of the local controller 50 includes the real-time estimation of the velocity of the leader 12L, which the local controller 50 then uses to define the desired velocity of the follower 12F. This allows the follower 12F to move in unison with the leader 12L, in the absence of a communication channel between the two:
V.sub.L=V.sub.F cos(α.sub.F+α.sub.L)+{dot over (d)} cos(α.sub.L)
This capability allows the platoon 120 to corner sharply in tight spaces.
[0048] Referring now to
[0049] In terms of an associated velocity commands (V.sub.F_Cmd) of the follower 12F, and with reference to
V.sub.F_cmd=V.sub.L.Math.cos(α.sub.L)=(V.sub.F cos(α.sub.F+α.sub.L)+{dot over (d)} cos(α.sub.L))cos(α.sub.L).
Calculation of the velocity commands in this manner allows the follower 12F to slow down or stop at intersections of the corridor 100 as needed to allow the leader 12L to complete its cornering. This capability allows the leader and follower to form a 90° articulation at right angle corners. The relative yaw dependent speed command thus ensures the follower 12F first corrects its own heading before speeding up.
[0050] The local controller 50 of
V.sub.cmd=k.sub.d.Math.d.sub.error+V.sub.F_cmd
r.sub.cmd=(k.sub.α+k.sub.α,v.Math.V.sub.F.sup.2)α+k.sub.α,d.Math.d.Math.sin(α)
where k.sub.α, k.sub.α,v and k.sub.α,d are calibratable gain constants. The velocity term also helps prioritize lateral motion correction over longitudinal motion correction, thereby overcoming non-holonomic constraint of the follower 12F.
[0051] The foregoing teachings may be implemented in method form, as will be appreciated by those skilled in the art. For instance, one may program the local controller 50 to execute instructions embodying a method for controlling the platoon 120 described in detail above. Such a method may include measuring, via the sensor suite 40S of
[0052] The solutions detailed above provide a number of controls and motion planning algorithms for control of the platoon 120 of lightly-tethered or wirelessly connected followers 12F constructed as e-pallets as set forth above. The platoon 120 may operate in a variety of environments often having tight turns, e.g., intersecting perpendicular hallways such as the corridor 100 of
[0053] The detailed description and the drawings or figures are supportive and descriptive of the present teachings, but the scope of the present teachings is defined solely by the claims. While some of the best modes and other embodiments for carrying out the present teachings have been described in detail, various alternative designs and embodiments exist for practicing the present teachings defined in the appended claims. Moreover, this disclosure expressly includes combinations and sub-combinations of the elements and features presented above and below.