System and method for control scheduling
View Patent ↗A system and method for controlling a device such that device operates in a smooth manner. The system may switch between control architectures or vary gain coefficients used in a control loop to control the device. As the architecture or gains are switched, the control signal may be smoothed so that the device does not experience an abrupt change in the control signal it receives. In one embodiment, the control signal may be smoothed by adding a decaying offset value to the control signal to create a smoothed control signal that is applied to the device.
1. A method of switching between modes in a multi-modular vehicle, the method comprising:
determining, in a multi-modular dynamically stabilized vehicle, whether a mode change has occurred;
determining an offset value if the mode has changed; and
adding a decaying version of the offset value to a control signal before the control signal is applied to the apparatus to create a smoothed control signal; and applying the smoothed control signal to the vehicle;
wherein the offset value is equal to a difference between a last signal applied to the apparatus and a control signal generated after the mode change.
2. The method of claim 1 , wherein the offset value is decayed by the steps of:
(a) multiplying a current offset value by a number less than one;
(b) updating the current offset to equal the result of the multiplication of step (a); and
(c) repeating steps (a) and (b).
3. The method of claim 2 , wherein step (c) is repeated until the current offset value approaches a lower threshold.
4. The method of claim 3 , wherein the lower threshold is approximately zero.
5. The method of claim 1 , further comprising a step of:
storing smoothed control signal.
6. The method of claim 5 , wherein a difference between the stored smoothed control signal and a control signal created after the apparatus has changed modes is used to determine the offset value.
7. The method of claim 6 , further comprising steps of:
determining whether an offset value is currently decaying; and
replacing the currently decaying offset value with a new offset value when the vehicle changes modes.