Information
-
Patent Grant
-
6577925
-
Patent Number
6,577,925
-
Date Filed
Wednesday, November 24, 199926 years ago
-
Date Issued
Tuesday, June 10, 200322 years ago
-
Inventors
-
Original Assignees
-
Examiners
Agents
-
CPC
-
US Classifications
Field of Search
US
- 700 117
- 700 97
- 700 103
- 700 258
- 700 213
- 198 34105
- 198 5023
-
International Classifications
-
-
Disclaimer
Terminal disclaimer
Abstract
A modular object handling system has a multi-level control architecture, which includes a system controller that coordinates the functions and/or operations of individual module controllers, that in turn control corresponding actuators, to provide a desired system function. The system controller performs the overall trajectory planning by taking the constraints of each of the module actuators into account. The system controller may compensate for deviations of objects from their planned trajectories by contemporaneously redetermining trajectories and trajectory envelopes to encode the various combinations of the system constraints and task requirements. The trajectory envelopes can denote regions around other trajectories to indicate control criteria of interest, such as control and collision boundaries. However, by predetermining the trajectories and trajectory envelopes, and comparing the current state of an object with the predetermined trajectory envelopes, the system controller can even more quickly determine the extent to which the state satisfies the criteria. Thus, this system simplifies on-line determinations to merely include a comparison between a particular object, a particular trajectory and the corresponding trajectory envelope. It is also desirable to predetermine trajectories and trajectory envelopes by explicitly representing the system constraints and/or task requirements. By explicitly representing the system constraints and/or task requirements, the trajectories and trajectory envelopes can be automatically predetermined when adding new constraints to an existing system, or upon creating a new system once the arrangement of module actuators is known.
Description
BACKGROUND OF THE INVENTION
1. Field of Invention
This invention is directed to apparatus and methods of distributed object handling.
2. Description of Related Art
A traditional media handling system can move media, such as a sheet, from one location to another location along a path, while performing one or more operations on the sheet, such as inversion, image transfer or fusing. As shown in
FIG. 1
, a traditional media handling system
100
includes a controller
110
that controls multiple actuators
130
, which perform operations on the sheet while moving the sheet along a paper path
140
.
Typically, timing signals are used to coordinate the operations and sheet movement. For example, the sheet can be fed into the path
140
at a certain time according to a timing signal. The sheet can then move through the path
140
, past various position sensors within a certain time window, and arrive at a transfer station at a specific time.
SUMMARY OF THE INVENTION
However, this traditional media handling system
100
is subject to the problem that when any temporal error in the operations beyond a certain tolerance is detected and flagged to the controller
110
, the machine containing the traditional media handling system
100
is shut down. The traditional media handling system
100
does not include any feedback control. Thus, the actuators
130
need to be precisely manufactured, which is expensive. Also, because of this lack of feedback control, the traditional media handling system
100
does not perform well when subjected to different types of media, and has problems maintaining accuracy and reliability at high speeds.
A modular object handling system can overcome these problems via a more control-centric design, which can be accomplished by adding more controls. The use of control strategies, beyond the simple timing of the traditional media handling system
100
, can also allow a wider range of objects, such as a wider range of media types, to be handled at higher speeds.
For example, a modular object handling system that includes a multi-level control architecture can provide advantages over the traditional media handling system
100
discussed above. This modular object handling system can include a system controller that coordinates the functions and/or the operations of individual module controllers, which in turn control corresponding actuators, to provide a desired system function, such as transporting objects along a path. In particular, the system controller can download an overall trajectory for each object to the module controllers. The module controllers can control their respective actuators to maintain each object on its planned trajectory while in that module.
The system controller performs the overall trajectory planning by taking the constraints of each of the module actuators into account. The trajectories planned by the system controller can then be provided as functions in distance-time space, such as cubic splines.
Deviations from an object's desired trajectory typically occur during the operation of the modular object handling system. For minor deviations, all control can be left to the individual module controllers, since they may not be concerned with other module controllers or whether the overall control criteria are satisfied. However, the system controller is concerned with satisfying the overall control criteria. Thus, the system controller may constantly monitor the location of the objects and contemporaneously redetermine the objects' trajectories using various control techniques to make up for such deviations.
However, continuously replanning trajectories by accessing complex trajectory re-determining techniques can be difficult to accomplish in real time. In fact, depending on the equipment and software involved, it may be necessary to resort to approximate determinations and heuristics to identify the effects of deviations and to replan the deviating trajectories in real time.
Thus, instead of continuously replanning the deviating trajectories, it may be desirable to use predetermined trajectories and trajectory envelopes to encode the various combinations of system constraints and task requirements. The trajectory envelopes can denote regions around other trajectories to indicate control criteria of interest, such as control and collision boundaries. By comparing the current state of an object with the predetermined trajectory envelopes, the system controller can quickly determine the extent to which the current state satisfies the control criteria.
For example, instead of continuously checking the distance between objects and redetermining the trajectories to avoid collisions, a predetermined collision envelope around the desired trajectory can be used. The predetermined collision envelopes are determined such that, as long as the objects are within their collision envelopes, the objects will not collide. A control envelope can similarly be used to determine other control criteria, such as whether the object will reach its target on time to accomplish a task requirement. This modular object handling system simplifies on-line determinations to merely include a comparison between a particular trajectory and the corresponding trajectory envelope, or between a current object position and a trajectory envelope.
It is also desirable to determine the trajectories and trajectory envelopes discussed above by explicitly representing the system constraints and task requirements. The trajectories and trajectory envelopes can be predetermined by manually encoding cubic splines to explicitly represent the system constraints and task requirements.
However, manually determining the cubic splines can be tedious and time consuming. Thus, automatically predetermining the trajectories and trajectory envelopes would be desirable. Because of the explicitly represented system constraints and task requirements, the trajectories and trajectory envelopes of an existing system configuration can be automatically predetermined upon adding new constraints that are created when the control criteria have changed. Also, because the explicitly represented system constraints and task requirements enable each of the module actuators to be described independently, the trajectories and trajectory envelopes can be predetermined once the arrangement of module actuators is known.
These and other features and advantages of this invention are described in or are apparent from the following detailed description of various exemplary embodiments of the systems and methods according to this invention.
BRIEF DESCRIPTION OF THE DRAWINGS
Various exemplary embodiments of systems and methods according to this invention will be described in detail, with reference to the following figures, wherein:
FIG. 1
is a block diagram of a traditional media handling system;
FIG. 2
is a block diagram of a modular object handling system in accordance with the invention;
FIG. 3
is a graph that shows a typical time-distance nominal trajectory;
FIG. 4
is a graph showing trajectories and trajectory envelopes for sample system and task constraints;
FIG. 5
is a flowchart outlining one exemplary embodiment of a method for using predetermined trajectories and trajectory envelopes in system level control of a multi-level modular object handling system;
FIG. 6
is a flowchart outlining in greater detail one exemplary embodiment of a method for determining if the object is within its collision envelope of step S
1200
of
FIG. 5
;
FIG. 7
is a flowchart outlining in greater detail one exemplary embodiment of a method for determining if the object is within its control envelope of step S
1300
of
FIG. 5
;
FIG. 8
is a graph showing trajectories and trajectory envelopes, as well as the system constraints and task requirements that are defined by the trajectories and trajectory envelopes; and
FIG. 9
is a flowchart outlining one exemplary embodiment of a method for predetermining trajectories and trajectory envelopes by explicitly representing the system constraints and task requirements.
DETAILED DESCRIPTION OF PREFERRED EMBODIMENTS
FIG. 2
shows a modular object handling system
200
according to this invention that has a more control-centric design than the traditional media handling system
100
. This modular object handling system
200
includes a system controller
210
, one or more module controllers
220
, one or more module actuators
230
, and a path
240
. The system controller
210
communicates with the module controllers
220
via communication links
250
to coordinate the functions and/or operations of the individual module actuators
230
to provide a desired system function, such as transporting multiple objects along the path
240
via the module actuators
230
. The system controller
210
plans a trajectory of each object along the path
240
, by taking into account a variety of system constraints and task requirements. The module controllers
220
control their respective module actuators
230
via communication links
250
to maintain each object on its planned trajectory. This control strategy can be referred to as multi-layered hierarchical control architecture.
In order to plan a trajectory while taking a variety of system constraints and requirements into account, it is helpful for the system controller
210
to be aware of certain data relating to the module controllers
220
and the module actuators
230
. For example, the system controller
210
can be aware of entrance and exit points of each of the module actuators
230
, a maximum accelerating and retarding force that can be applied to an object by each module actuator
230
, and/or a response time of each module controller
220
.
The system controller
210
downloads the planned trajectories for each object to the local module controllers
220
via the communication links
250
. In one exemplary embodiment, the system controller
210
can download time-optimal trajectories to move objects at high speeds in the shortest possible time from one point to another point along the path
240
to enhance the productivity of the modular object handling system
200
.
In the trajectories for the path
240
, the object moves along the path
240
through regions where the object is subject to the control of several module actuators
230
, the time-optimal trajectories can be implemented by each module actuator
230
either applying maximum actuation or minimum actuation with discrete switching between the two. This can be proven by considering an arbitrary modular object handling system
200
that includes n module actuators
230
. Each module actuator
230
can apply a maximum acceleration a on the object using an array A=[a
1
, . . . ,a
n
], where a
n
is the maximum acceleration of the nth module actuator
230
. The n module actuators
230
can also apply a maximum retardation r on the object using an array R=[r
1
, . . . ,r
n
], where r
n
is the maximum retardation of the nth module actuator
230
. The object enters the path
240
at some velocity v
0
and leaves the path
240
at some velocity v
n
.
Then, a desired trajectory, assuming that there are no other constraints, can be determined by first forward integrating the equations of motion of the object using the maximum accelerations for each module actuator, given the initial position and the initial velocity v
0
. Then, the equations of motion of the object are backward integrated using the maximum retardations for each module actuator given the desired final position and velocity v
n
. Next, the intersection points of the two trajectories, i.e., the switching times, are determined. In other words, the object moves forward under maximum acceleration from each module actuator
230
until the switching time, and then is retarded at maximum retardation by each module actuator
230
until that object reaches the final position and velocity.
As discussed above, the system controller
210
provides each module controller
220
with the trajectory for each object, which is usable by the module controller
220
to move the object once the object enters a region where the object is subject to control by the corresponding module actuator
230
. Communicating the distance-time trajectory via the communication links
250
to each module controller
220
can be done by supplying a sequence of points on the trajectory. However, such a representation requires significant communication bandwidth, especially if the trajectory information has to be downloaded to all the module controllers
230
via the communication links
250
, which may be several in number.
Since trajectories are communicated to several module controllers
220
via the communication links
250
in real time, it is desirable to provide a compact and efficient representation of the trajectories that do not overload the communication links
250
and that are computationally efficient. For example, the trajectories can be conceived as functions in a distance-time space. In fact, these functions can be represented as expansions of general basis functions. Basis functions can be computationally efficient, and once known, the trajectories can be reconstructed. An example of such basis functions can be polynomials, such as, for example, polynomial spline basis functions. Such a representation significantly reduces the amount of floating point numbers that the system controller
210
needs to send down to the local control modules
220
. Accordingly, high speed control is enabled without bogging down networks of the communication links
250
.
For example, the trajectories can be represented as cubic splines, wherein y(t) is position, v(t) is velocity and a(t) is acceleration of the object on the trajectory. The position, velocity and acceleration of the object on the trajectory can be represented as follows:
y
(
t
)=
a
0
+a
1
(
t−t
0
)+
a
2
(
t−t
0
)
2
+a
3
(
t−t
0
)
3
;
v
(
t
)=
a
1
+2
a
2
(
t−t
0
) +3
a
3
(
t−t
0
)
2
; and
a
(
t
)=2
a
2
+6
a
3
(
t−t
0
).
Where: a
0
, a
1
, a
2
, and a
3
are constants;
t
0
≦t≦t
1
; and
t is a specified time.
Each of these splines can be represented as a curve on the Cartesian plane from time t
0
to time t
1
, wherein either the position y, the velocity v, or the acceleration a is represented on one axis, and the time t is represented on the other axis. The shape of each of the curves is determined by the constants a
0
, a
1
, a
2
and a
3
.
Thus, once the constants a
0
, a
1
, a
2
and a
3
are known, any position y(t) can be evaluated along the curve defined by the above cubic spline. The spline v(t) representing the velocity of the object on the trajectory can then be provided by taking the derivative of the position y(t). Similarly, the spline a(t) representing the acceleration of the object on the trajectory can be provided by taking the derivative of the velocity v(t).
By selecting the initial time t
0
and the final time t
1
, each of the constants become:
Where: y
0
and y
1
are the positions of the object on the trajectory at times t
0
and t
1
, respectively; and
v
0
and v
1
are the velocities of the object on the trajectory at times t
0
and t
1
, respectively.
The above representation of the constants a
2
and a
3
can be further simplified by representing the change in position between times t
1
and t
0
, i.e., y
1
−y
0
, as l, and the total lapsed time between times t
1
and t
0
, i.e., t
1
−t
0
, as d. The constants a
2
and a
3
thus become:
The modular object handling system
200
can include a number of the module actuators
230
. In this modular object handling system
200
, the time that the object enters the first module actuator
230
is t
1−1
or t
0
. The time that the object exits the last, i.e., n
th
, module actuator
230
, is t
n
. Thus, the duration of the object in the modular object handling system
200
is t
n
−t
0
. The time that an object enters the j
th
module actuator
230
is t
j−1
, and the time that the object exits the j
th
module actuator
230
is t
j
. Thus, the time that the object is within the j
th
module actuator
230
is t
j
−t
j−1
.
For the interval t
j
−t
j−1
, which represents the time that the object is in the j
th
module actuator
230
, the constants a
0
, a
1
, a
2
and a
3
can be determined so that the above-described splines represent the overall system trajectory, i.e., the trajectory of the object within the entire modular object handling system
200
. However, if the overall system trajectory must be changed within the j
th
module actuator
230
, then new constants a
0
, a
1
, a
2
and a
3
must be determined. The new trajectory will begin at t
j−1
, and will be continuous and have continuous first derivatives with the old trajectory.
When the modular object handling system
200
is operating, multiple objects can move through the path along trajectories, which may be determined and represented as discussed above. Under these circumstances, one of the functions of the system controller
210
can be to apprehend situations where objects might collide and to avoid such collisions. The system controller
210
can detect collisions based on the relative position and velocities of the objects in the path
240
.
In one exemplary embodiment of a method for detecting and avoiding collisions according to this invention, the system controller
210
keeps track of the objects as the objects move. If the objects become too close to each other, and at the same time have non-zero relative velocities, the system controller
210
can redefine the trajectories of the objects to ensure that the objects do not collide. If the maximum acceleration that the objects can be moved at by the module actuators
230
is bounded, and the acceleration is a(t), then a(t)ε[−a
max, a
max
]. The maximum relative acceleration is therefore:
a
coll-avoid
=2
a
max
.
In accordance with this exemplary embodiment of the collision avoidance method, the system controller
210
continuously monitors the relative object spacing and relative object velocity for all objects and continuously updates the trajectory envelopes as outlined above. Whenever the system controller
210
determines that an object has moved too close to another object, the system controller
210
forces the local module controllers
220
to decrease the relative velocity of the appropriate objects by slowing down the trailing object. This is accomplished by changing the position-time reference trajectory via increasing the arrival time at the end of the appropriate module actuator
230
. Thus, the objects are always kept in a safe region of the modular object handling system
200
by the system controller
210
. If, despite repeated corrections, the objects still tend to move too close together, the system controller
210
brings all the objects to a graceful halt by gradually slowing down all of the objects.
As discussed above, the modular object handling system
200
shown in
FIG. 2
tracks the objects using feedback control using the techniques outlined above. The local module controllers
220
accept the trajectories provided by the system controller
210
and control their respective module actuators
230
to keep the objects on the desired trajectories. The local module controllers
220
can also communicate with the system controller
210
and other local module controllers
220
, if necessary, to keep the objects on their appropriate trajectories.
The module actuators
230
can perform various tasks. Each task has a corresponding description in the appropriate space-time. The overall system trajectory planning is performed by keeping the constraints imposed by the task of each of the module actuators
230
. For example, the dwell time of an object that is stationary within a module actuator
230
corresponds to a horizontal line in the distance-time trajectory. When an object is simultaneously in two module actuators
230
, this situation can be described as a trajectory that has the same slope, i.e., velocity, in the distance region specified for both module actuators
230
. The trajectory therefore operates to effectively encode the constraints involved in moving the object on the path
240
.
The communication links
250
shown in
FIG. 2
are used to communicate the trajectory information back and forth between the module controllers
220
, the system controller
210
and/or any other intermediate controller (not shown) in the modular object handling system
200
. This bidirectional flow of information allows real-time corrections to be made to the trajectories. This ensures that conflicts between the multiple objects in the path
240
are resolved. For example, if two objects begin to get too close, that situation is sensed and the trajectories are replanned appropriately either by the module controllers
220
themselves or by the system controller
210
. The new trajectories are then communicated to the appropriate module actuators
230
. The module actuators
230
in turn, change their actuation to track the new trajectory.
The modular object handling system
200
discussed above provides numerous advantages over the traditional, single controller, object handling systems
100
. For example, using active feedback control to track trajectories allows different types of objects to be handled. The control techniques discussed above can have parameters that depend on the object properties, and can be adjusted in real time depending on the object types. This can be accomplished by inputting the object properties to the modular object handling system
200
. This can alternatively be accomplished by the modular object handling system
200
selecting the object properties during operation.
For high productivity, it is desirable to move objects at higher speeds. The modular object handling system
200
uses feedback control to keep the objects on the desired trajectories. Using active sensing and feedback control helps to correct the deviations from the desired trajectories in real time, and allows the object to be moved with high accuracy.
Since the object movement is monitored in real time, any situation arising in which a collision or other disruptive event may occur is detected by the modular object handling system
200
. The trajectories are replanned accordingly to avoid the collision or other disruptive event. If the situation cannot be corrected by simply replanning the trajectories, the modular object handling system
200
can be controlled to bring the objects moving along the path
240
to a graceful halt.
Finally, using more active feedback control to handle objects reduces the required accuracy of the module actuators
230
. It is possible to handle objects with less precisely manufactured module actuators
230
since the accuracy is maintained by sensing and control. Because the cost of the system and module controllers
210
and
220
is becoming cheaper, while the cost of the precision hardware is fairly constant, the overall cost of the modular object handling system
200
will decrease over time.
During operation of the modular object handling system
200
discussed above, the trajectory provided by the system controller
210
for each object takes a subset of the constraints and requirements into account. A nominal trajectory, which can be the time-optimal trajectory discussed above, is provided to represent the normal desired behavior for a single object. As such, the nominal trajectory encodes all such relevant control criteria. The relevant control criteria can include physical constraints, such as maximum object velocities when within each module actuator
230
, and task requirements, such as reaching a target position at a target time and at a target velocity.
The above-described modular object handling system
200
can be used to move any object. For example, the modular object handling system
200
can be a modular media handling system for use with sheets, such as a transport system in an analog or digital copier, printer or other image forming device. In such an exemplary embodiment of the modular object handling system
200
, tasks performed by module actuators
230
can include moving sheets, inverting sheets, decurling sheets, transferring images and fusing. The nominal trajectory therefore encodes the control criteria of these tasks.
In another exemplary application, the modular object handling system
200
can be a flight control system in an aircraft. In this example, the system controller
210
could be ground based, and the module controllers
220
and module actuators
230
could be onboard the aircraft. Using predetermined trajectories and trajectory envelopes may be particularly beneficial in view of recent changes in the airline industry towards implementing free flight, which allows pilots to choose their own trajectories for certain routes. Thus, the collision envelopes can be used to avoid collisions with other aircraft, and the control envelopes can be used to ensure that the aircraft reaches its destination on time.
Using the modular object handling system
200
as a flight control system entails certain differences its use as a transport system in an image forming device. For example, in an image forming device, moving sheets are handled by stationary module actuators
230
. However, in a flight control system, the module actuators are onboard the object, i.e., the aircraft. Thus, the constraints of an aircraft, such as dynamics, maximum acceleration of the aircraft's engines, etc., travel with the aircraft, while the constraints of a sheet, such as the maximum acceleration of a certain module actuator
230
, depend on the location of the sheet within the image forming device.
In yet another exemplary application, the modular object handling system
200
can be an assembly line control system of a product assembly line, such as a newspaper printing press. In this example, the path
240
would be the assembly line, and the module actuators
230
would control regions along the assembly line. The nominal trajectories could be predetermined based on nominal performances of the module actuators
230
.
FIG. 3
is a graph of a typical time-distance nominal trajectory for the lead edge of a sheet when the modular object handling system
200
is a modular recording media handling system of an image forming device and the objects are sheets of recording media. As discussed above, cubic splines constitute only one possible manner of representing the time-distance trajectories.
When the modular media handling system
200
is operating, the system controller
210
communicates relevant pieces of this nominal trajectory as reference trajectories to the module controllers
220
. The system controller
210
delegates local control to the module controllers
220
. For example, if the trajectory contains entry and exit times and velocities of each module actuator
230
, then only these times and velocities have to be communicated to the corresponding module controllers
220
. The module controllers
220
can then reconstruct the necessary information for the behaviors of the sheets between each sheet's entry and exit from the respective module actuators
230
.
As discussed above, deviations from the nominal trajectory typically occur during the operation of the modular media handling system
200
. For minor deviations from the nominal trajectory, all control can be left to the module controllers
220
. The module controllers
220
do not need to be concerned with the behaviors of other module controllers
220
and other module actuators
230
, and those sheets outside of the module actuators
230
that are under the control of such other module controllers
220
and module actuators
230
. The module controllers
220
also do not need to be concerned with whether the overall control criteria are satisfied, such as whether the target time will be met, or whether sheets are about to collide.
In contrast, the system controller
210
is concerned with the behaviors of the module actuators
230
and whether the overall control criteria are satisfied. When the behaviors of one or more module actuators
230
deviate from the expected behaviors, the system controller
210
determines what is happening, the potential effects, and how to correct or compensate for these deviations. In particular, deviation from the nominal trajectory may violate the constraints and requirements described above, which could lead to sheet collision, missing the target, or violating one or more optimality criteria. Thus, if a sheet is delayed within a module actuator
230
, the system controller
210
has to determine whether subsequent sheets might collide, inform the relevant module controllers
220
involved, and possibly even generate new trajectories.
One primary duty of the system controller
210
is to determine which control criteria are violated. The system controller
210
can determine the status of various control criteria. For example, the system controller
210
could determine whether the objects are on track. This can be determined by checking whether the behavior of the module actuator
230
is sufficiently close to the nominal trajectory. If so, no further monitoring is required.
Determining the status of the control criteria, as well as identifying and reacting to the determined states, may require complex determinations, such as the various techniques discussed above, and can involve constraints from multiple module actuators
230
and sheets. Some problems, such as determining whether the target can still be reached, could even require replanning the entire trajectory from the current position, which may be difficult to accomplish in real time. Thus, since the control routines are continuously being performed, in order to respond in real time, the system controller
210
may have to resort to approximate determination and heuristics to identify the effects of deviations and to replan trajectories.
It may therefore be desirable to provide system-level control and monitoring systems and methods that replace these expensive and complex methods with simpler systems and methods for retrieving, combining and comparing trajectories and trajectory envelopes.
This can be accomplished by using predetermined trajectories and trajectory envelopes encoding various combinations of the system constraints and task requirements. Trajectory envelopes denote regions around other trajectories that indicate control criteria of interest. For example, instead of continuously checking the distance between objects to monitor the objects to avoid collisions, a predetermined collision envelope around the nominal trajectory can be used. Thus, as long as each object is within that object's collision envelope, the objects will not collide. The collision envelope can be determined in a similar manner as the safety region discussed above. However, instead of being continuously determined, the collision envelope can be determined prior to operation of the system.
In another exemplary embodiment, if an object deviates from its nominal trajectory, rather than replanning the trajectory for all module actuators
230
to determine whether the target can still be met, the modular object handling system
200
uses a control envelope. Thus, as long as an object remains within that object's control envelope, the object will still be able to reach the target. A trajectory envelope can be represented by one or more trajectories, which would, for example, denote the borders of the region of interest.
Thus, predetermined trajectory envelopes can be used to encode the control criteria of interest, together with multiple predetermined trajectories that denote control and collision boundaries. Different trajectory envelopes represent different control criteria. By comparing the current state (position, velocity, etc.) of an object with those predetermined trajectory envelopes, the system controller
210
is able to quickly determine the extent to which the state satisfies the criteria. The comparison operator depends on what the trajectory envelope encodes. For example, with a time-distance trajectory envelope, provided in a format similar to the nominal trajectory shown in
FIG. 3
, the system controller
210
only needs to test whether an object's position at the current time is to the left or right of the envelope boundary. Because those of ordinary skill in the art will be able to readily appreciate how to compare the current position of an object to the predetermined trajectory envelopes for different space-times, from the above description of a distance-time space, a detailed description of such comparisons is omitted.
The trajectories and trajectory envelopes can be determined using any appropriate known or later devised method. For example, the trajectories and trajectory envelopes can be arrived at in accordance with the determinations used to determine appropriate control and collision safety regions, such as, for example, optimal control and collision safety regions.
Regardless of how the trajectories and the trajectory envelopes are determined, predetermining the trajectories and the trajectory envelopes simplifies the control routines to merely include a comparison between the trajectories and the trajectory envelopes. This allows the system controller
210
to avoid having to determine the trajectories and the trajectory envelopes in real time during operation of the modular object handling system
210
.
FIG. 4
is a graph showing the trajectories and the trajectory envelopes for sample system and task constraints. For example, a nominal trajectory
400
is shown as approximately bisecting the distance-time plane.
FIG. 4
also shows a collision envelope
500
defined by an early collision trajectory
510
, to the left of, i.e., prior in time to, the nominal trajectory
400
, and a late collision trajectory
520
, to the right of, i.e., after in time to, the nominal trajectory
400
. The early collision trajectory
510
defines the earliest time that an object can depart from a certain point on the path
240
at a certain velocity and not collide with another object, such as the object immediately ahead of that object on the path
240
. The late collision trajectory
520
constitutes the latest time that an object can depart from a certain point on the path
240
at a certain velocity and not collide with another object, such as the object immediately behind that object on the path. This early-late collision envelope
500
can thus be used to encode a certain minimum distance between a certain object and the objects preceding and succeeding that object. As long as the object stays within that object's collision envelope
500
, and the preceding and succeeding objects do not deviate more than a minimum distance from their nominal trajectories, then the objects will not collide.
FIG. 4
also shows a control envelope
600
defined by an early control trajectory
610
, to the left of, i.e., prior in time to, the nominal trajectory
400
, and a late control trajectory
620
, to the right of, i.e., after in time to, the nominal trajectory
400
. The early control trajectory
610
constitutes the earliest time that an object can depart from a certain point on the path
240
at a certain velocity and still accomplish its task. The late control trajectory
620
constitutes the latest time that an object can depart from a certain point on the path
240
at a certain velocity and still accomplish its task. The early-late control envelope
600
can thus be used to encode a certain location at which the object must be located. As long as the object stays within that object's control envelope, then the object will be able to accomplish its task.
The above-described late control trajectory
620
constitutes the latest time that an object can depart from a certain point at a certain velocity and still accomplish its task, for an object that enters the first module actuator
230
at the same time that the object is scheduled to enter the first module actuator
230
according to the nominal trajectory
400
. In other words, the late control trajectory
620
enters the first module actuator
230
at the same time as the nominal trajectory
400
. However,
FIG. 4
also shows a latest control trajectory
630
that constitutes that latest time that an object can enter the first module actuator
230
and still accomplish its task. Thus, the latest control trajectory
630
enters the first module actuator
230
after the nominal trajectory
400
enters the first module actuator
230
.
Each of the trajectories
400
,
510
,
520
,
610
,
620
,
630
and the trajectory envelopes
500
,
600
can be represented as a sequence of tuples. For example, in a modular object handling system
200
, where the n
th
module actuator
230
is the last module actuator
230
, and the j
th
module actuator
230
is one of the module actuators
230
between the first and n
th
module actuators
230
, the sequence of tuples can be represented as t
0
, v
0
−t
1
, v
1
. . . , t
j−1
, v
j−1
−t
j
, v
j
. . . , t
n−1
, v
n−1
−t
n
, v
n
. In these tuples, t
0
and v
0
represent the time and velocity of an object entering the first module actuator
230
, t
1
and v
1
represent the time and velocity of an object exiting the first module actuator
230
, t
j−1
and v
j−1
, represent the time and velocity of an object entering the j
th
module actuator
230
, and t
j
and v
j
represent the time and velocity of an object exiting the j
th
module actuator
230
. Similarly, t
n−1
and v
n−1
, and t
n
and v
n
, represent the entry and exit times and velocities of an object relative to the n
th
, or last, module actuator
230
.
In operation, each object is provided with an appropriate main nominal trajectory as its reference trajectory. The responsibility to maintain each object within that object's main nominal trajectory is distributed among the module controllers
220
. That is, the module controllers
220
attempt to keep each object on its particular main nominal trajectory. The system controller
210
is then called repeatedly to assess the current state for all objects in a sequence and take action as necessary. In particular, the system controller
210
monitors object distances in the particular space-time, identifies collisions, delays objects to avoid collisions when feasible, and aborts the object's travel along the path
240
if the target can no longer be achieved. The significant real-time determinations are the comparisons of object positions with trajectories and other positions. This simple collision avoidance mechanism uses one trajectory envelope to identify possible collisions and other envelopes to check whether an object is still controllable. The system controller
210
can then instruct a module controller
220
locally to delay or advance a particular object by a certain amount.
The control systems and methods of this invention work particularly well if deviations are minor or uniform. In such a situation, all objects can be delayed in the same modules.
FIG. 5
is a flowchart outlining one exemplary embodiment of a method for using predetermined trajectories and trajectory envelopes in system level control of a multi-level modular object handling system. In this embodiment, the collision envelope is smaller than the control envelope, as shown in FIG.
4
.
Beginning in step S
1000
, control continues to step S
1100
, where an object is selected for analysis. Once the object is selected, control continues to step S
1200
, where a determination is made whether the object is within its predetermined collision envelope, i.e., whether the object is likely to collide with either preceding or succeeding objects. If the object is within its predetermined collision envelope, control returns to step S
1100
where another object is selected for analysis. A determination does not need to be made as to whether the object is within its control envelope, since as discussed above, the collision envelope is smaller than the control envelope. Thus, if the object is within its collision envelope, then it must also be within its control envelope. Alternatively, if the object is not within its collision envelope, control continues to step S
1300
.
In step S
1300
, a determination is made whether the object is within its control envelope, i.e., whether the object is likely to be able to accomplish its assigned task. If the object is within its control envelope, then control continues to step S
1400
. Otherwise, control jumps to step S
1500
. In step S
1400
, the object is recorded as potentially colliding. The potentially colliding record can then be used to make a subsequent selection of an appropriate predetermined collision envelope for other objects. Only then would it be necessary to compute the actual distance between the potentially colliding objects and to take action as indicated above, e.g., to delay one of the objects.
The object is potentially colliding since the object was determined in step S
1200
as being outside of its collision envelope. However, since the object is determined in step S
1300
as being within its control envelope, control then returns from step S
1400
to step S
1100
where another object is selected for analysis.
Alternatively, in step S
1500
, a determination is made whether the nominal trajectory, collision envelope and/or control envelope should be replanned. If so, control continues to step S
1600
. Otherwise, control jumps to step S
1700
. In step S
1600
, one or more of the nominal trajectory, collision envelope and/or control envelopes are replanned. This can also result in a modification of the system task requirements. Control then returns to step S
1100
, where another object is selected for analysis.
Alternatively, if it is determined that the nominal trajectory, collision envelope and/or control envelope should not be replanned, then control continues to step S
1700
where the analysis is terminated.
FIG. 6
is a flowchart outlining in greater detail one exemplary embodiment of a method for determining if the object is within its collision envelope of step S
1200
of FIG.
5
. Beginning in step S
1200
, control continues to step S
1210
, where a predetermined nominal trajectory for the object is referenced. Then, in step S
1220
, a predetermined collision envelope is referenced for the referenced predetermined nominal trajectory. Next, in step S
1230
, the actual current status, such as velocity, acceleration and/or position, of the object is referenced. Control continues to step S
1240
.
In step S
1240
, a determination is made whether the referenced actual current status of the object is within the referenced collision envelope for that time. If so, control returns to step S
1100
of FIG.
5
. If not, control returns to step S
1300
of FIG.
5
.
FIG. 7
is a flowchart outlining in greater detail one exemplary embodiment of a method for determining if the object is within its control envelope of step S
1300
of FIG.
5
. Beginning in step S
1300
, control continues to step S
1310
, where a predetermined nominal trajectory of the object is referenced. This referenced predetermined nominal trajectory can be the same nominal trajectory of step S
1200
. Next, in step S
1320
, a predetermined control envelope is referenced for the referenced predetermined nominal trajectory. Then, in step S
1330
, the actual current status, such as velocity, acceleration and/or position, of the object is referenced. This actual current status of the object can be the same object status of step S
1200
. Control then continues to step S
1340
.
In step S
1340
, a determination is made whether the referenced actual current status of the object is within the referenced control envelope for that time. If so, control returns to step S
1400
of FIG.
5
. If not, control returns to step S
1500
of FIG.
5
.
In accordance with another exemplary embodiment of the methods for using predetermined trajectories and trajectory envelopes of this invention, the control envelope could be smaller than the collision envelope. A flowchart illustrating this alternative exemplary embodiment would be similar to the flowchart of
FIG. 5
, except that steps S
1200
and S
1300
would be juxtaposed. Thus, a first determination would be made whether the object is within its control envelope. If not, then a second determination would then be made whether the object is within its collision envelope.
In other exemplary embodiments of the apparatus and methods for using predetermined trajectories and trajectory envelopes of this invention, the trajectories and trajectory envelopes are predetermined by explicitly representing the system constraints and task requirements. The trajectories and trajectory envelopes can be predetermined by manually performing determinations, such as by manually encoding cubic splines to explicitly represent the system constraints and task requirements.
Manually determining the cubic splines can also entail treating the system constraints differently from the task requirements. For example, the system constraints can be manually treated as hard constraints for all possible trajectories and trajectory envelopes. That is, all trajectories and trajectory envelopes are manually predetermined to satisfy the system constraints. In contrast, at least some of the task requirements can be manually treated as merely constituting soft limits that apply only to the normal trajectory. That is, these task requirements can be violated by certain trajectories and trajectory envelopes.
Manually determining the cubic splines can be performed when creating a new modular object handling system
200
. Manually determining the cubic splines can also be performed when modifying an existing modular object handling system
200
by changing the constraints or the arrangement of the module actuators
230
.
However, manually determining the cubic splines can be tedious and time consuming. Thus, in still other exemplary embodiments of the apparatus and method for using predetermined trajectories and trajectory envelopes of this invention, the trajectories and trajectory envelopes are automatically predetermined. In fact, explicitly representing the system constraints and task requirements lends itself to automatically predetermining the trajectories and trajectory envelopes. For example, because the system constraints and task requirements are explicitly represented, the trajectories and trajectory envelopes can be automatically predetermined upon adding new constraints created when the control criteria are changed.
The explicitly represented system constraints and task requirements enable each of the module actuators
230
to be described independently. Describing each of the module actuators
230
independently in terms of the system constraints and/or task requirements allows the trajectories and trajectory envelopes to be automatically predetermined once the arrangement of module actuators
230
is specified. Thus, the trajectories and trajectory envelopes can be automatically predetermined for various system configurations. This tendency toward automatic predetermination of trajectories and trajectory envelopes is especially apparent to one of ordinary skill in the art based upon the following description of the separately explicitly represented system constraints and task requirements for each module actuator
230
.
Generally, the system constraints and task requirements can be described in terms of physical constraints, task constraints, user preferences, optimality and robustness. Examples of physical constraints include maximum module actuator
230
actuation forces, maximum object velocities, maximum velocity differentials between the module actuators
230
, and minimum object distances. Examples of task constraints include target object positions and times, and maximum and average object velocities. Examples of user preferences include specific transport strategies and object orders. An example of optimality includes overall throughput. An example of robustness includes buffer regions for average object behavior variability.
More specifically, the system constraints include the combined constraints of all of the module actuators
230
. Each module actuator
230
is subject to a specific set of module constraints. For example, each module actuator
230
has maximum and minimum velocity limits and maximum and minimum acceleration limits. Thus, the velocities and accelerations in a trajectory are limited by the minimum and maximum velocities and accelerations of each of the module actuators
230
.
Controlling multiple module actuators
230
together also creates module constraints. Specifically, the velocities of objects moving along trajectories within different module actuators
230
that are controlled together must be equal. If not, then other controls will not be able to be applied in unison to the objects within the different module actuators
230
.
As another example, placing two module actuators
230
adjacent to each other creates module constraints. Specifically, the difference in velocities between the two adjacent module actuators
230
is limited. If not, objects may be damaged as the objects are transferred from one module actuator
230
to the adjacent module actuator
230
.
The task requirements can also be specifically described in terms of the individual module actuators
230
, such as the target criteria of a certain module actuator
230
. For example, accomplishing a certain task may require that an object exit a certain module actuator
230
at a specified velocity. Target criteria can also include a requirement that the arrivals of the objects be separated by a specified time period p when arriving at a certain module actuator
230
.
Task requirements can also take into account collision avoidance at certain module actuators
230
. For example, certain tasks may require that a minimum gap g between objects be maintained at a certain module actuator
230
to avoid collisions.
Task requirements can also require taking into account velocity and acceleration limits at certain module actuators
230
. For example, average travel velocities and maximum accelerations may be imposed on the nominal trajectory to accomplish a certain task at a certain module actuator
230
. Violating the average travel velocity or maximum acceleration may make it impossible to accomplish a certain task of that module actuator
230
.
The system constraints and task requirements can also be depicted graphically. For example,
FIG. 8
is a graph showing trajectories and trajectory envelopes, as well as the system constraints and task requirements that are defined by the trajectories and trajectory envelopes. The x-axis of
FIG. 8
represents time, and the y-axis represents the various module controllers
230
of the modular object handling system
200
. The modular object handling system
200
represented by
FIG. 8
includes
7
module actuators
230
.
As will be evident from the following description, the trajectory envelopes of
FIG. 8
are defined differently than the trajectory envelopes shown in FIG.
4
. For example, in
FIG. 4
, the trajectory envelopes
500
and
600
are defined between boundary trajectories
510
and
520
, and
610
and
620
that are disposed on opposing sides of the nominal trajectory
400
. In contrast, in
FIG. 8
, the trajectory envelopes are defined between the nominal trajectory and a boundary trajectory.
FIG. 8
shows a nominal trajectory
2000
of a leading edge of an object as well as a trajectory
2100
of a trailing edge of the object. The length of the object is shown by connecting the trajectories
2000
and
2100
, i.e., the lead and trail edges of the object, with a vertical line. Accordingly, the graph of
FIG. 8
shows that at the earliest indicated time, the nominal trajectory
2000
of the lead edge of the object exits the module
2
while the trajectory
2100
of the trail edge enters the module
2
. Similarly, at the latest indicated time, the nominal trajectory
2000
of the lead edge of the object exits the module
7
while the trajectory
2100
of the trail edge enters the module
7
.
FIG. 8
shows a robust control envelope
2200
that is defined between the nominal trajectory
2000
and a late robust control trajectory
2210
. The late robust control trajectory
2210
represents the latest time that an object can depart from a certain point on the path
240
at a certain velocity and still accomplish its task under a specified failure model, such as, for example, upon the failure of an operation of a certain module actuator
230
along the path
240
. Thus, the robust control envelope
2200
can be used to encode a certain location at which the object must be located to be able to accomplish its task under a specified failure model.
FIG. 8
also shows a control envelope
2300
that is defined between the nominal trajectory
2000
and a late control trajectory
2310
. The late control trajectory
2310
represents the latest time that an object can depart from a certain point on the path
240
at a certain velocity and still accomplish its task. Thus, the control envelope
2300
can be used to encode a certain location at which the object must be located to be able to accomplish its task.
The control envelope
2300
is different from the robust control envelope
2200
since it does not take into account a specified failure module. Thus, the late control trajectory
2310
is able to enter and exit each module at a later time than the late robust control trajectory
2210
and still accomplish its task.
However, the control envelope
2300
and robust control envelope
2200
are otherwise similar. For example, the late robust control trajectory
2210
and the late control trajectory
2310
each do not enter the first module until after the earliest time shown in FIG.
8
. The late robust control trajectory
2210
and the late control trajectory
2310
each exit module
7
at the same time as the nominal trajectory
2000
. Thus, the nominal trajectory
2000
, late robust control trajectory
2210
and late control trajectory
2310
all have the same target, but have different entry times.
Certain system constraints and task requirements can be graphically represented based upon the nominal trajectory
2000
, the late robust control trajectory
2210
and the late control trajectory
2310
. For example, robustness can be depicted as a horizontal line extending between the nominal trajectory
2000
and the late robust control trajectory
2210
. Controllability can be depicted as a horizontal line extending between the late robust control trajectory
2210
and the late control trajectory
2310
.
FIG. 8
additionally shows a nominal trajectory
2400
for a second object and a collision envelope
2500
for that second object. The collision envelope
2500
is defined between the nominal trajectory
2400
and an early collision trajectory
2510
for the second object. For example, the collision envelope
2500
for a certain time can be represented as a vertical line extending between the nominal trajectory
2400
and the early collision trajectory
2510
of the second object at that time. The early collision trajectory
2510
constitutes the earliest time that the second object can depart from a certain point on the path
240
at a certain velocity and not collide with the first object having the nominal trajectory
2000
. Thus, the collision envelope
2500
can be used to encode a certain location at which the second object must be located so as not to collide with the first object.
Other system constraints and task requirements can be graphically represented by including the nominal trajectory
2400
and the early collision trajectory
2510
of the second object. For example, repetition can be depicted as a horizontal line extending between the nominal trajectory
2000
of the first object and the nominal trajectory
2400
of the second object. Interaction can be depicted as a vertical line extending between the nominal trajectory
2400
of the second object and the trajectory of the trailing edge
2100
of the first object.
Based on the graph of
FIG. 8
, one of ordinary skill in the art will find it evident that other trajectories and trajectory envelopes can be determined by building on other trajectories. For example, all other trajectories and trajectory envelopes can be determined by using constraints that are based on the nominal trajectory.
FIG. 8
shows that the end time of the nominal trajectory
2000
is used as an end time constraint for other trajectories and trajectory envelopes. In other words, other trajectories and trajectory envelopes shown in
FIG. 8
are determined so those other trajectories and trajectory envelopes end at the same time as the nominal trajectory.
For example,
FIG. 8
shows that the late robust control trajectory
2210
and the late control trajectory
2310
are determined to end at the same time and location as the nominal trajectory
2000
of the one object. The robust control envelope
2200
and the control envelope
2300
, which are defined by the late robust control trajectory
2210
and the late control trajectory
2310
, respectively, are also therefore determined to end at the same time and location as the nominal trajectory
2000
of the one object.
The collision envelopes can similarly be determined by using constraints that are based on the nominal trajectory. For example,
FIG. 8
shows that start and end times of the nominal trajectories of the objects are used as start and end time constraints of the collision envelope
2500
and the early collision trajectory
2510
of the other object.
Specifically,
FIG. 8
shows that the early collision trajectory
2510
is determined to begin at the same time and location as the nominal trajectory
2400
of the other object. The early collision trajectory is also determined to end at the same time and location as the trajectory
2100
of the trailing edge of the first object. The collision envelope
2500
of the second object, which is defined between the early collision trajectory
2510
and the nominal trajectory
2400
of the second object, is also determined by these constraints.
FIG. 9
is a flowchart outlining one exemplary embodiment of a method for predetermining trajectories and trajectory envelopes by explicitly representing the system constraints and task requirements. In this exemplary embodiment, the trajectories and trajectory envelopes can be automatically predetermined.
Beginning in step S
3000
, control continues to step S
3100
, where the system model is specified. Specifying the system model can entail at least specifying the number of individual module actuators, the types of the specified module actuators, and the configuration of the specified module actuators. For example, the system model can be specified as 3 modules, of type
1
, configured in a serial formation. The type designation “type
1
” merely constitutes an arbitrary designation of a type of the module actuators. As discussed below each type of module has a distinctive set of module constraints and task requirements.
Once the system model is specified, control continues to step S
3200
, where the system constraints and task requirements are specified. As discussed above, the system constraints are made up of the combined constraints of all of the module actuators. Further, each type of module actuator, such as the exemplary type
1
module actuator, is subject to a distinctive set of constraints, such as maximum and minimum velocity and maximum and minimum acceleration limits, as well as constraints created by controlling multiple module actuators together and disposing the specified module actuators adjacent to each other.
Also, as discussed above, the task requirements can additionally be described in terms of the individual module actuators. For example, accomplishing a certain task may subject a module actuator, such as the exemplary type
1
module actuator, to a variety of constraints, such as, for example, target criteria, collision avoidance and velocity and acceleration limits.
Examples of the system constraints and task requirements for the exemplary type
1
module actuator include, for example, that each type
1
module actuator can have such module constraints as a length of 25.4 mm, a minimum velocity v
min
of an object traveling through that module actuator of −3.0 mm/ms, a maximum velocity v
max
of an object traveling through that module actuator of 3.0 mm/ms; a minimum acceleration a
min
of an object traveling through that module actuator of −0.02 mm/ms
2
; and a maximum acceleration a
max
of an object traveling through that module actuator
230
of 0.02 mm/ms
2
.
Each type of the module actuators can also have a variety of general task constraints that may need to be satisfied for that type of module actuator to accomplish its designated task. For example, in accordance with general task constraints of the type
1
module actuator, an object may need to have an initial velocity v
0
of 0.0 mm/ms, and an ending velocity v
n
of 0.5 mm/ms. The type
1
module actuator may also need to operate such that the object always travels at a velocity v within the module actuator that is ≧0.0 mm/ms.
Similarly, each type
1
module actuator can have nominal task constraints that may need to be satisfied to meet other criteria, such as to enable the module actuator to operate at increased efficiency. For example, the nominal task constraints can include the general task constraints, and additionally a constraint that the module actuator operates such that the velocity v of the object within the module actuator is always ≦1.0 mm/ms. Satisfying this constraint may thereby enable the module actuator to operate more quickly and reliably.
The system constraints and task requirements of the type
1
module actuators ay also require that objects within the type
1
module actuators be separated by certain constraints to satisfy task requirements and/or prevent collisions with other objects. For example, the objects may need to be separated for by a period “s” of 500 ms, and by a minimum gap “g” of 30 mm.
Once the system constraints and task requirements are specified, control continues to step S
3300
, where a nominal trajectory T
r
of an object is predetermined. The nominal trajectory T
r
can be predetermined via a constraint solver, such as a generic constraint solver or an optimizing constraint solver, that solves the system and task constraints, such as the constraints discussed above, while minimizing associated trajectory criteria. For example, the nominal trajectory T
r
can be predetermined via the constraint t
0
=0, and minimizing the constraints t
n
−t
0
, wherein t
o
is the time that the object enters the first module actuator
230
and t
n
is the time that the object exits the last module actuator
230
on the path
240
.
In predetermining the nominal trajectory T
r
, the constraints are translated to constraints on the desired trajectory, such as, for example, to constraints on the cubic splines defined by the trajectory. Constraints on entry and exit times and velocities are directly added to the cubic splines. Minimum and maximum constraints on the velocities and accelerations of entire modules can be translated to constraints on the minima and maxima of the velocity and acceleration functions defined by the cubic splines.
The set of particular task constraints depends on the trajectory's purpose.
Thus, the nominal trajectory T
r
may satisfy all task constraints since it constitutes the desired trajectory.
After the nominal trajectory T
r
is predetermined, control continues to step S
3400
, where the nominal trajectory T
p
of the previous object on the path is predetermined. The previous nominal trajectory T
p
is predetermined by shifting the nominal trajectory T
r
by −s, which, as discussed above, is the period with which objects are expected to arrive at the target position.
After the previous nominal trajectory T
p
is predetermined, control continues to step S
3500
, where the nominal trajectory T
n
of the next object on the path is predetermined. The next nominal trajectory T
n
is predetermined by shifting the nominal trajectory T
r
by +s.
After the next nominal trajectory T
n
is predetermined, control continues to S
3600
, where the collision envelope is predetermined. The collision envelope is predetermined by predetermining the early and late collision borders.
The early collision border T
e
is predetermined by solving the constraints, such as, for example, the system and general task constraints, as well as the collision constraints, such as, for example, the period “s” and the gap “g”, with the previous nominal trajectory T
p
and the next nominal trajectory T
n
. Since the set of particular task constraints depends on the trajectory's purpose, the early and late collision borders may not need to satisfy the suggested velocity and acceleration limits. The early collision border T
e
can also be predetermined via the constraints t
0
=0, and t
n
=t
n
in the nominal trajectory T
r
, minimizing t
n−1
.
The late collision border T
1
is predetermined by solving the constraints, such as, for example, the system and general task constraints, as well as the collision constraints, such as, for example, the period “s” and the gap “g”, with the previous nominal trajectory T
p
and the next nominal trajectory T
n
. The late collision border T
1
can also be predetermined via the constraints t
0
=0, and t
n
=t
n
in the nominal trajectory Tr, minimizing t
n
−t
1
, where t
1
is a time between t
0
and t
n
.
After the collision envelope is predetermined, control continues to S
3700
, where the control envelope is predetermined. The control envelope can be defined between an early control border
610
and a late control border
620
, as shown in FIG.
4
. Alternatively, the control envelope can be defined between the nominal trajectory
2000
and one of the late robust control trajectory
2210
and the late control trajectory
2310
, as shown in FIG.
8
.
In the case shown in
FIG. 8
, the late robust control trajectory
2210
, which is also referred to herein as T
c
, is predetermined by solving the constraints, such as, for example, the system and general task constraints. Since the set of particular task constraints depends on the trajectory's purpose, the control border T
c
may only satisfy the target constraints. The late robust control trajectory T
c
can also be predetermined via the constraint t
n
=t
n
in the nominal trajectory T
r
, minimizing t
n
−t
0
.
After the control envelope has been predetermined, control ends at step S
3800
.
The multilevel modular object handling systems discussed above can detect the actual current position of each object in accordance with any conceivable method or apparatus. For example, the actual position may be obtained via any type of detecting sensor. The actual position may also be estimated by a determination observer, such as a Luenberger observer, or alternatively a stochastic observer, such as a Kalman filter. The actual position may also be determined via a combination of actual sensing and estimation.
The module controllers
220
do not have to be completely subservient to the trajectories provided by the system controller
210
. For example, module controllers
220
can be kept abreast of how close an object gets to one of the boundaries of a trajectory envelope and use that information to improve its efforts in achieving a task.
The trajectories and trajectory envelopes discussed above are discussed in terms of position, velocity and/or acceleration as functions of time. However, the trajectories and trajectory envelopes are not limited to these expressions, and can include any data relating to an object.
In the various exemplary embodiments discussed in detail above, the modular object handling systems use a two-layered hierarchical architecture, i.e., a single system controller and multiple module controllers. However, the modular object handling systems and methods according to this invention can use any number of layers of control, such as, for example, at least one intermediate control layer between the system controller and the module controllers. Moreover, the modular object handling systems and methods according to this invention can include multiple system controllers.
The modular object handling systems and methods according to this invention can include both predetermined collision and control envelopes. Alternatively, the modular object handling systems and methods according to this invention can use only predetermined collision envelopes or only predetermined control envelopes. Further, the predetermined trajectories and trajectory envelopes do not have to relate to collision and control borders and regions. Instead, the trajectories and trajectory envelopes can relate to any task or constraint. For example, multiple trajectory envelopes can be provided for different object sizes.
Also, in the various exemplary embodiments discussed in detail above, the modular object handling systems are described in terms of an object entering, exiting, or being within module actuators
230
. However, the systems, trajectories and trajectory envelopes can also be described in terms of the object entering, exiting, or being within modules associated with each of the module actuators
230
. Such modules could further be described as regions of the path
240
that are under the control of the module actuators
230
.
The various controllers of the each of the multi-level modular object handling systems described above can be implemented using a programmed general purpose computer. However, the various controllers of the each of the multi-level modular object handling systems described above can also be implemented on a special purpose computer, a programmed microprocessor or microcontroller and peripheral integrated circuit elements, an ASIC or other integrated circuit, a digital signal processor, a hardwired electronic or logic circuit such as a discrete element circuit, a programmable logic device such as a PLD, PLA, FPGA or PAL, or the like. In general, any device, capable of implementing a finite state machine that is in turn capable of implementing the flowcharts shown in
FIGS. 5-7
and
9
, can be used to implement the various controllers of the each of the multi-level modular object handling systems described above.
The communication links
250
can be any known or later developed device or system for connecting the system controller
210
, module controllers
220
, and the module actuators
230
, including a direct cable connection, a connection over a wide area network or a local area network, a connection over an intranet, a connection over the Internet, or a connection over any other distributed processing network or system. In general, the communication links
250
can be any known or later developed connection system or structure usable to connect the system controller
210
, module controllers
220
, and the module actuators
230
.
While the systems and methods of this invention have been described in conjunction with the specific embodiments outlined above, it is evident that many alternatives, modifications and variations will be apparent to those skilled in the art. Accordingly, the exemplary embodiments of the systems and methods of this invention, as set forth above, are intended to be illustrative, not limiting. Various changes may be made without departing from the spirit and scope of the invention.
Claims
- 1. A method of determining trajectories for recording media object handling, comprising:specifying a system model of a media handling apparatus; specifying at least one of explicitly represented system constraints and explicitly represented task requirements of the media handling apparatus; and determining a specified trajectory in a trajectory space for a specified recording media object to accomplish a system function based on the specified system model and the specified ones of the explicitly represented system constraints and task requirements, the explicitly represented task requirements corresponding to one or more media handling apparatus tasks of: moving the recording media object through the media handling apparatus, inverting the recording media object through the media handling apparatus, decurling the recording media object, transferring an image on the recording media object, and fusing an image on the recording media object.
- 2. The method according to claim 1, wherein determining the specified trajectory includes determining a nominal trajectory.
- 3. The method according to claim 2, further including determining a nominal trajectory in a trajectory space of a recording media object that is behind the recording media object in a path based upon the specified system model and the specified ones of the explicitly represented system constraints and task requirements.
- 4. The method according to claim 2, further including determining a nominal trajectory in a trajectory space of a recording media object that is ahead of the recording media object in a path based upon the specified system model and the specified ones of the explicitly represented system constraints and task requirements.
- 5. The method according to claim 1, further including determining a trajectory envelope in a trajectory space usable with the specified trajectory to indicate at least one criterion of interest.
- 6. The method according to claim 5, wherein determining the trajectory envelope includes determining the trajectory envelope based on the specified system model and the specified ones of the explicitly represented system constraints and task requirements.
- 7. The method according to claim 5, wherein determining the trajectory envelope includes determining a control envelope.
- 8. The method according to claim 7, wherein determining the control envelope includes determining the control envelope based on constraints that relate to the specified trajectory.
- 9. The method according to claim 8, wherein determining the control envelope based on constraints that relate to the specified trajectory includes determining a control envelope that ends at the same time and location in a trajectory space as the specified trajectory.
- 10. The method according to claim 5, wherein determining the trajectory envelope includes determining a collision envelope.
- 11. The method according to claim 10, wherein determining the collision envelope includes determining the collision envelope based on constraints that relate to the specified trajectory.
- 12. The method according to claim 11, wherein determining the collision envelope based on constraints that relate to the specified trajectory includes determining a collision envelope that begins at the same time and location in a trajectory space as the specified trajectory of the recording media object.
- 13. The method according to claim 11, wherein determining the collision envelope based on constraints that relate to the specified trajectory includes determining a collision envelope that ends at the same time and location in a trajectory space as a trajectory of a trailing edge of another recording media object.
- 14. The method according to claim 1, wherein determining a specified trajectory includes predetermining a specified trajectory.
- 15. The method according to claim 1, further including determining multiple trajectory envelopes in a trajectory space usable with the specified trajectory to indicate different control criteria of interest.
- 16. An apparatus that determines trajectories of recording media objects that are movable along a path of a media handling system, the apparatus comprising:a device that determines a specified trajectory in a trajectory space for a specified recording media object to accomplish a system function of the media handling system based on a specified system model of the media handling system and at least one of at least one specified explicitly represented system constraint of the media handling system and at least one specified explicitly represented task requirement of the media handling system, the at least one specified explicitly represented task requirement corresponding to one or more media handling apparatus tasks of: moving the recording media object through the media handling apparatus, inverting the recording media object through the media handling apparatus, decurling the recording media object, transferring an image on the recording media object, and fusing an image on the recording media object.
- 17. The apparatus according to claim 16, wherein the device determines a normal trajectory in a trajectory space for the specified recording media object.
- 18. The apparatus according to claim 16, wherein the device determines a trajectory envelope in a trajectory space usable with the specified trajectory to indicate at least one control criterion of interest.
- 19. The apparatus according to claim 18, wherein the device determines the trajectory envelope based on the specified system model and the at least one of the at least one specified explicitly represented system constraints and the at least one specified explicitly represented task requirements.
- 20. The apparatus according to claim 16, wherein the device determines a nominal trajectory in a trajectory space of a recording media object that is behind the specified recording media object in the path based upon the specified system model and the at least one of the at least one specified explicitly represented system constraints and the at least one specified explicitly represented task requirements.
- 21. The apparatus according to claim 16, wherein the device determines a nominal trajectory in a trajectory space of a recording media object that is ahead of the specified recording media object in the path based upon the specified system model and the specified at least one of the at least one explicitly represented system constraints and the at least one specified explicitly represented task requirements.
- 22. The apparatus according to claim 16, wherein the device includes at least one system controller of the media handling system.
- 23. The apparatus according to claim 16, wherein the device includes at least one modular controller of the media handling system.
- 24. The apparatus according to claim 23, wherein the device includes a plurality of modular controllers of the media handling system.
US Referenced Citations (20)
Foreign Referenced Citations (5)
| Number |
Date |
Country |
| 0 940 730 |
Sep 1999 |
EP |
| 2 752 185 |
Feb 1998 |
FR |
| 1 321 054 |
Jun 1973 |
GB |
| 60-112552 |
Jun 1985 |
JP |
| 10-333746 |
Dec 1998 |
JP |