CONTROL DEVICE FOR MOBILE BODY
First Claim
1. A control device for a mobile body which controls a mobile body having a base body and a moving mechanism, which moves the base body on a floor surface, such that the mobile body travels while moving the base body up and down, the control device comprising:
- up-and-down-direction inertial force parameter determining device which determines an up-and-down-direction inertial force parameter, which is a parameter that defines the time series of a desired inertial force in the up-and-down direction of the mobile body or the base body;
desired motion determining device which determines the time series of a desired motion of the mobile body by using at least the up-and-down-direction inertial force parameter such that the time series of the desired inertial force defined by the determined up-and-down-direction inertial force parameter is satisfied;
operation control device which controls the operation of the mobile body on the basis of at least the determined desired motion;
state amount deviation observing device which sequentially observes a state amount deviation indicating the degree of deviation of an actual posture of the base body from a desired posture of the base body in the determined desired motion; and
required manipulated variable determining device which sequentially determines a required manipulated variable, which defines an additional external force to be additionally applied to the mobile body so as to converge the state amount deviation to zero, according to a feedback control law on the basis of an observed value of the state amount deviation,wherein the operation control device is a device which controls the operation of the mobile body so as to additionally apply the additional external force defined by the required manipulated variable to the mobile body while causing an actual motion of the mobile body to follow the desired motion, andthe required manipulated variable determining device includes feedback gain determining device which determines a feedback gain of the feedback control law necessary for converging the state amount deviation in the future to zero at each time, at which the required manipulated variable is determined, by using the time series in a period from current time to predetermined time in the future in the time series of a desired inertial force defined by the up-and-down-direction inertial force parameter, and determines the required manipulated variable by computation according to the feedback control law from the determined feedback gain and an observed value of the state amount deviation.
1 Assignment
0 Petitions
Accused Products
Abstract
A control device for a mobile body makes it possible to smoothly correct the deviation of an actual posture of a base body of a mobile body, which travels with the base body thereof moving up and down, from a desired posture of the base body while restraining an overshoot or an undershoot from occurring. To determine a required manipulated variable according to a feedback control law in order to converge a state amount deviation related to the posture of the base body of the mobile body to zero, the feedback gain of the feedback control law is determined by using the time series in a period from current time to predetermined time in the future in the time series of a desired inertial force of the mobile body or the base body. The required manipulated variable is determined by the calculation of the feedback control law on the basis of the determined feedback gain and an observed value of the state amount deviation.
-
Citations
12 Claims
-
1. A control device for a mobile body which controls a mobile body having a base body and a moving mechanism, which moves the base body on a floor surface, such that the mobile body travels while moving the base body up and down, the control device comprising:
-
up-and-down-direction inertial force parameter determining device which determines an up-and-down-direction inertial force parameter, which is a parameter that defines the time series of a desired inertial force in the up-and-down direction of the mobile body or the base body; desired motion determining device which determines the time series of a desired motion of the mobile body by using at least the up-and-down-direction inertial force parameter such that the time series of the desired inertial force defined by the determined up-and-down-direction inertial force parameter is satisfied; operation control device which controls the operation of the mobile body on the basis of at least the determined desired motion; state amount deviation observing device which sequentially observes a state amount deviation indicating the degree of deviation of an actual posture of the base body from a desired posture of the base body in the determined desired motion; and required manipulated variable determining device which sequentially determines a required manipulated variable, which defines an additional external force to be additionally applied to the mobile body so as to converge the state amount deviation to zero, according to a feedback control law on the basis of an observed value of the state amount deviation, wherein the operation control device is a device which controls the operation of the mobile body so as to additionally apply the additional external force defined by the required manipulated variable to the mobile body while causing an actual motion of the mobile body to follow the desired motion, and the required manipulated variable determining device includes feedback gain determining device which determines a feedback gain of the feedback control law necessary for converging the state amount deviation in the future to zero at each time, at which the required manipulated variable is determined, by using the time series in a period from current time to predetermined time in the future in the time series of a desired inertial force defined by the up-and-down-direction inertial force parameter, and determines the required manipulated variable by computation according to the feedback control law from the determined feedback gain and an observed value of the state amount deviation. - View Dependent Claims (4, 7, 10)
-
-
2. A control device for a mobile body which controls a mobile body having a base body and a moving mechanism, which moves the base body on a floor surface, such that the mobile body travels while moving the base body up and down, the control device comprising:
-
up-and-down-direction inertial force parameter determining device which determines an up-and-down-direction inertial force parameter, which is a parameter that defines the time series of a desired inertial force in the up-and-down direction of the mobile body or the base body; desired motion determining device which determines the time series of a desired motion of the mobile body by using at least a dynamic model set beforehand to express the dynamics of the mobile body, the determined up-and-down-direction inertial force parameter, and the time series of a desired external force to be applied to a mobile body on the dynamic model; operation control device which controls the operation of the mobile body on the basis of at least the determined desired motion; state amount deviation observing device which sequentially observes a state amount deviation indicating the degree of deviation of an actual posture of the base body from a desired posture of the base body in the determined desired motion; and required manipulated variable determining device which sequentially determines a required manipulated variable, which defines an additional external force to be additionally applied to the mobile body so as to converge the state amount deviation to zero, according to a feedback control law on the basis of an observed value of the state amount deviation, wherein the desired motion determining device is a device which determines a model manipulation external force to be added to the desired external force on the dynamic model on the basis of the determined required manipulated variable and determines the time series of the desired motion such that the time series of a desired inertial force defined by the determined up-and-down-direction inertial force parameter is satisfied on the dynamic model while applying the external force, which has been obtained by adding the determined model manipulation external force to the desired external force, to a mobile body on the dynamic model, and the required manipulated variable determining device includes feedback gain determining device which determines a feedback gain of the feedback control law necessary for converging the state amount deviation in the future to zero at each time, at which the required manipulated variable is determined, by using the time series in a period from current time to predetermined time in the future in the time series of a desired inertial force defined by the up-and-down-direction inertial force parameter, and determines the required manipulated variable by computation according to the feedback control law from the determined feedback gain and an observed value of the state amount deviation. - View Dependent Claims (3, 5, 6, 8, 9, 11, 12)
-
Specification