Manufacturing plants and warehouse facilities require the coordinated movement of raw materials, subcomponents, and finished parts, often over considerable distances. Larger or relatively massive loads may be transported with the assistance of fork lifts, tractors, conveyor belts, and other power equipment. In contrast, smaller loads may be moved by hand or using manually-operated pallet trucks, wheeled dollies, or hand carts. Collectively, machine powered and manually operated lift assistance devices improve overall production efficiency, while at the same time greatly reducing load-related stresses and strains on human operators within the workplace.
Certain operations not requiring the assistance of heavy power equipment of the types described generally above may nevertheless not be suitable for manually-operated devices like hand carts and dollies. In such cases, a human operator may utilize one or more motorized electric pallets (“e-pallets”) each having a superstructure mounted on or integrally formed with a wheeled base platform. One or more electric traction motors provides a drive torque to driven road wheels of the e-pallet to help propel the e-pallet along a floor surface.
The present disclosure pertains to methods and systems for controlling motor-driven electric pallets (“e-pallets”) that are lightly tethered together or in wireless communication with one another in a leader-follower platoon arrangement. As used herein, the contemplated platoon arrangement includes one lead e-pallet or another lead vehicle (“leader”) that is serially connected to or in wireless communication with one or more trailing (“follower”) e-pallets, such that the follower e-pallets are located aft of the lead e-pallet when the platoon is in forward motion. As used herein, “lightly tethered” refers to the possible serial linking together of one or more follower e-pallets via an intervening tether device, itself having integral length and angle sensors as set forth below. As appreciated in the art, an alternative wireless or “tether-less” solution may be envisioned to accomplish the same or similar tasks, including pallet pose estimation by calculation/measuring distance, azimuth, and yaw rate using, e.g., radar, ultrasonics, lidar, one or more cameras, ultra-wide band (UWB) communications, etc. Additionally, the platoon contemplated herein is characterized by an absence of vehicle-to-vehicle (V2V) communications between the various e-pallets, such that a given e-pallet does not offload data to another e-pallet in the platoon. The lack of a V2V communications capability gives rise to the local control strategy described herein.
For illustrative simplicity, the local control strategy for implementation aboard each respective of the follower e-pallets is described below with respect to a simplified two-member platoon embodiment, e.g., one in which a single follower is tethered to leader by the tether device to use a consistent non-limiting example configuration. The leader moves autonomously, is driven by an operator, or moves in response to a manual towing force imparted by the operator. Aboard the follower, a local controller optimizes locomotion of the follower using a variable target point (VTP), a variable distance setpoint (VDSP), and velocity estimate (Vest) of the leader. This collective set of information is used in lieu of a static tracking point on the leader so to prevent, among other things, instances of jackknifing, zig-zag turns requiring larger maneuver areas, an inability of the platoon to negotiate tight turns or circuitous hallways, poor tracking performance of the followers relative to the leader, and other possible stability and range of motion issues.
In terms of the VTP, the local controller is programmed to execute computer-readable instructions, with instruction execution causing the local controller to adaptively move the VTP within a given frame of reference, in real-time, to increase the overall stability of the platoon. The VTP is also used to set a desired distance between consecutive followers in embodiments in which more than one follower is used.
The VDSP for its part is also modified in real-time by the local controller based on an angle of articulation or azimuth angle between an axis of the leader, e.g., the tether device, and a leading edge of the follower. Modification of the VDSP is performed by the local controller to adapt to a limited range of motion of the tether device. The velocity of the leader in turn is estimated by the local controller and thereafter used to define a desired velocity of the follower. In this manner, the present local control strategy enables sharper cornering of the entire platoon without an accompanying loss of stability.
In a particular embodiment, a platoon of e-pallets includes a leader e-pallet and a follower e-pallet connected to or in wireless communication with the leader e-pallet to form the platoon of e-pallets, with the followers located aft of the leader. An axis of the leader, in this instance its longitudinal center axis, is arranged at an azimuth angle with respect to the follower. The platoon also includes a sensor suite, including a velocity sensor configured to measure a velocity of the follower, an angle sensor configured to measure the azimuth angle, and a length sensor configured to measure a distance from the follower to the leader. Such a distance could be a length of a tether device in the exemplary tethered embodiment.
The follower in this configuration includes 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. The local controller is configured to adaptively move a VTP on the leader in response to the velocity, the azimuth angle, and the distance/length, and to thereafter control a dynamic output state of the electric powertrain system using the VTP.
The local controller may change a variable distance setpoint on the leader based on the azimuth angle to maintain a linear distance between the leader and follower.
In an aspect of the disclosure, the local controller may estimate a velocity of the leader as an estimated velocity, define a desired velocity of the follower using the estimated velocity, and thereafter control the dynamic output state of the electric powertrain system of the follower using the estimated velocity.
The length or distance sensor may include a string potentiometer or a wireless proximity sensor.
The leader in some implementations is configured to be towed by a human operator via another tether device, and the leader includes motorized drive wheels responsive to a towing force imparted by the human operator.
The set of road wheels may include a pair of front drive wheels. The electric powertrain system may include 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.
In a possible embodiment, 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 optional tether device.
In the various embodiments set forth above, the follower may include a plurality of followers, i.e., one behind another.
In another aspect of the present disclosure, a method for controlling the platoon of e-pallets includes measuring, via a plurality of sensors of a sensor suite, a velocity of the follower e-pallet, an azimuth angle defined between a tether device and a leading edge of the follower e-pallet, and a length sensor configured to measure a length of the tether device. The method also includes adaptively moving a 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. The method thereafter includes controlling a dynamic output state of the electric powertrain system of the follower e-pallet using the VTP.
In yet another embodiment, a follower e-pallet for use with a lead vehicle to which the follower e-pallet is connected in a platoon arrangement via a tether device includes 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. 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. The local controller is also configured to adaptively move the 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.
The above features and advantages, and other features and attendant advantages of this disclosure, will be readily apparent from the following detailed description of illustrative examples and modes for carrying out the present disclosure when taken in connection with the accompanying drawings and the appended claims. Moreover, this disclosure expressly includes combinations and sub-combinations of the elements and features presented above and below.
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.
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.
Referring to the drawings, wherein like reference numbers refer to like features throughout the several views, and beginning with
The platoon 120 of
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 (CL) 500 and (CF) 50. The local controller 500 receives input signals (arrow CCI*), such as when the operator 14 applies a towing force (arrow FT). In response, the local controller 500 transmits motor control signals (arrow CCO*) 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 CCI*). 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
Instead, the followers 12F act on their own, i.e., locally, doing so based on input signals (arrow CCI) 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).
In the representative use case of
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 CCI) by the transmission of motor control signals (arrow CCO) from the local controller 50, e.g., to corresponding motor control processors as appreciated in the art. The motor control signals (arrow CCO) within the scope of the present disclosure may include a desired yaw rate (ωdes) and a desired velocity (Vdes) of the follower(s) 12F, for instance.
Referring briefly to
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.
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.
The electrified powertrain system 30 of
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.
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
When the leader 12L begins to turn, however, as represented by arrow BB of
E-PALLET KINEMATICS: referring briefly to
With continued reference to the representative diagram 48, the velocity (VF) of the follower 12F may be expressed mathematically as VF=√{square root over ({dot over (x)}2+{dot over (y)}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 (VF), the yaw rate (ω), and the distance (d) between the road wheels 22A and 22B:
The kinematics diagram 48 of
Functions of the local controller 50 in the overall control of the follower 12F will now be described with reference to
The local controller 50 is thus configured to calculate the target length (Lt) 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
t
=L
t0·cos(αL)
where α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 Lt0 is the nominal value of the Lt that represents the distance to the VTP 80 for straight ahead driving/motion. Knowledge of the target length (Lt) 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 (deff) as a function of the above-described angle (γ), i.e.,:
The corresponding azimuth angle (α) may then be calculated using the following equation:
α=αF+αL−γ
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=(rc+Lt)·(1−kγγ)
Distance error=deff−distance setpoint
where rc is a nominal following distance setpoint and kγ 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.
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
L
=V
F cos(αF+αL)+{dot over (d)} cos(αL)
This capability allows the platoon 120 to corner sharply in tight spaces.
Referring now to
In terms of an associated velocity commands (VF_Cmd) of the follower 12F, and with reference to
V
F_cmd
=V
L·cos(αL)=(VF cos(αF+αL)+{dot over (d)} cos(αL))cos(α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.
The local controller 50 of
V
cmd
=k
d
·d
error
+V
F_cmd
r
cmd=(kα+kα,v·VF2)α+kα,d·d·sin(α)
where kα, kα,v and kα,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.
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
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
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.