1. Technical Field
The present invention relates to a state feedback control apparatus, a state feedback controller, and a state feedback control method for state-feedback controlling a control object. The present invention is applied to a damping force control apparatus for suppressing and controlling a vibration of a suspension apparatus of a vehicle by controlling a damping force for example.
2. Related Art
A state feedback control apparatus for state-feedback controlling a control object is practically utilized. For example, state feedback control is often used for damping force control of a suspension apparatus of a vehicle.
Nonlinear H-infinity state feedback control is sometimes used for the damping force control of the suspension apparatus of the vehicle. For example, Japanese Patent Application Publication No. 2000-148208 discloses a damping force control apparatus for obtaining a variable damping coefficient representing a variable amount of a damping force based on a control input calculated by a state feedback controller designed by applying a nonlinear H-infinity control theory to a system represented by a state space model of a vibration system including a variable damping type suspension apparatus (the control object).
In the case where a control object is state-feedback controlled, a system is required to be controllable as a premise thereof. That is, a controllable matrix of a state space model (a state space representation) representing the system is required to have full rank. However, there may be the case where the system cannot be designed to be controllable. Particularly, in the case where the number of a motion equation serving as a basis in designing of the state space model of the control object is less than the number of a control input calculated by a state feedback controller, the system represented by the state space model becomes uncontrollable.
For example, considering a situation that a two wheel model of a vehicle is a control object, and a state space model of the control object is designed on a basis of a motion equation in the vertical (up and down) direction of an sprung member (above-spring member) obtained from the control object. In this case, the number of the motion equation serving as a basis in designing the model is one (only the vertical motion equation of the sprung member). Meanwhile, the number of the control input calculated by the state feedback controller is two (variable damping coefficients of dampers used in left and right suspension apparatuses). Since the number of the motion equation is less than the number of the control input, the system represented by the designed state space model becomes uncontrollable.
Further, considering another situation that a four wheel model of the vehicle is the control object, and a state space model of the control object is designed on a basis of motion equations relating to heave motion (vertical motion), pitch motion, and roll motion of the sprung member obtained from the control object. In this case, the number of the motion equation serving as a basis in designing the model is three (a heave motion equation, a pitch motion equation, and a roll motion equation). Meanwhile, the number of the control input is four (variable damping coefficients of dampers used in suspension apparatuses respectively attached to front left and right portions of the sprung member and rear left and right portions of the sprung member). In this case as well, since the number of the motion equation is less than the number of the control input, the system becomes uncontrollable.
When the system is uncontrollable, a state quantity cannot be controlled by the control input. Thus, the control object cannot be state-feedback controlled. In this case, conventionally, the state space model is reviewed and the model is redesigned such that the system becomes controllable. However, in the case where the model is redesigned, new parameters are required to be identified, and the redesigned model becomes complicated. Therefore, there is a problem that a lot of time is required for redesigning the model. Another method of obtaining controllability is that a pseudo error is set into the model. According to this method, the model can be designed within a relatively short time since it is only necessary to add the error into the model. However, the error is conventionally added into the input and output sides of the model (such as an input matrix or an output matrix). Thus, there is a problem that the error greatly influences an output. Further, according to the conventional method, the error is added into a plurality of points of the model. Since the error is added into a plurality of points of the model, a magnitude of error elements are larger due to buildup of the error, and deviation between the designed model and the model of the control object is increased. Therefore, highly precise state-feedback control of the control object cannot be performed.
The present invention has been accomplished in order to solve the above problems, and its object is to provide a state feedback control apparatus and a state feedback control method capable of highly precisely state-feedback controlling a control object by a simple model correction even when a system represented by a state space model is uncontrollable, and a state feedback controller used in such state feedback control apparatus and method.
An aspect of the present invention is a state feedback control apparatus for state-feedback controlling a control object, including a state feedback controller for calculating a control input of a system based on a state quantity of the system represented by a corrected state space model, the corrected state space model being formed so as to represent a controllable system by adding an error matrix Δ to a state matrix of a state space model of the control object representing an uncontrollable system, and control means for controlling the control object based on the control input calculated by the state feedback controller.
According to the above invention, the control object is controlled based on the control input calculated by the state feedback controller in the system represented by the corrected state space model. The corrected state space model is designed so as to represent the controllable system by adding the error matrix Δ to the state matrix of the state space model of the control object which represents the uncontrollable system. In this corrected state space model, the state matrix to be multiplied by the state quantity is finely corrected by an addition of the error matrix Δ. By this fine correction, rank deficiency of the controllable matrix of the corrected state space model is prevented. Thereby, the system represented by the corrected state space model becomes controllable.
According to the present invention, even in the case where the state space model of the control object is designed as the model representing the uncontrollable system, the control object can be state-feedback controlled based on the control input calculated by the state feedback controller in the system represented by the corrected state space model corrected such that the system becomes controllable by an introduction of the error matrix Δ. Further, a basic structure of the corrected state space model is the same as the state space model of the control object except that the error matrix Δ is only added into the state space model. Therefore, there is no need for time required for redesigning the model. Further, since the error matrix Δ is added to the state matrix which is less influential on the output of the model, the error matrix Δ does not greatly influence the output. In addition, since only one error matrix Δ is added into the state space model, the buildup of the error is not generated. Therefore, the deviation between the corrected state space model and the state space model of the actual control object is decreased, and thereby highly precise state-feedback control of the control object can be performed. Since an error examination point is one point, time required for examining the error can be shortened. Since the present invention has many advantages described above, even in the case where the state space model is uncontrollable, highly precise state-feedback control of the control object can be performed by the simple model correction.
In the present invention, as long as the system represented by the corrected state space model becomes controllable, the error matrix Δ may be a matrix having a positive error element or a negative error element. The error matrix Δ may be designed such that an element or elements influencing a calculation of a rank of the controllable matrix of the corrected state space model is/are changed. In this case, the error matrix Δ may be designed such that elements in a row of the controllable matrix are not the same with the elements in another row of the controllable matrix. According to the configuration described above, the rank deficiency due to the fact that the elements in the row of the controllable matrix are the same with the elements in another row of the controllable matrix is prevented.
The present invention can be applied to the case where the number of the motion equation of the control object is less than the number of the control input calculated by the state feedback controller. For example, the present invention can be applied to the case where the damping force of the right suspension apparatus of the vehicle and the damping force of the left suspension apparatus of the vehicle are controlled at the same time based on one motion equation when vibrations of the suspension apparatuses are controlled by controlling damping forces of the suspension apparatuses by state feedback. The present invention can also be applied to the case where the damping forces of the four suspension apparatuses attached to the front left and right portions of the sprung member and the rear left and right portions of the sprung member are controlled at the same time based on the heave motion equation, the pitch motion equation, and the roll motion equation.
In the present invention, the state feedback controller may calculate the control input by applying H-infinity state feedback control to a generalized plant designed based on the system represented by the corrected state space model. In this case, the H-infinity state feedback control may be linear H-infinity state feedback control or nonlinear H-infinity state feedback control. According the configuration described above, the control object is state-feedback controlled based on the control input calculated by the state feedback controller (H-infinity state feedback controller) designed such that H-infinity norm ∥G∥∞ of the generalized plant (L2 gain from a disturbance w to an output z of the system in a case of the nonlinear H-infinity state feedback control) becomes less than a predetermined positive constant γ. Thus, disturbance suppression and robust stabilization are improved.
Elements in the error matrix Δ may include zero element. However, all the elements must not be the zero elements. In the case where a value of a non-zero element, which is an element other than the zero element (that is, an error element) is large, an influence of the error on the system is larger than that in the case where the value is small. Therefore, the value of the non-zero element in the error matrix Δ may be as a small value as possible. However, when the value of the non-zero element in the error matrix Δ is very small, the error matrix Δ is regarded as a zero matrix, and the system represented by the corrected state space model becomes substantially uncontrollable. Therefore, it is preferable that the value of the non-zero element in the error matrix Δ is appropriately small. In this case, a magnitude of the non-zero element in the error matrix Δ may be 1/10 to 1/100 of a magnitude of a non-zero element in the state matrix. According to this configuration, the system can obtain sufficient controllability and a influence rate of the error on the system is sufficiently reduced. In addition, the non-zero element in the error matrix Δ and the non-zero element in the state matrix are different from each other in terms of the number of digits. Thus, when the error matrix Δ is added to the state matrix, an addition element is prevented from being zero due to a setoff. The addition element is used for a calculation of the elements of the controllable matrix of the corrected state space model. Thus, since the addition element is not zero, the rank deficiency is not easily generated in the controllable matrix.
Elements in the error matrix Δ, an element which does not influence a calculation of a rank of a controllable matrix of the corrected state space model may be set to zero element. According to this configuration, the influence of the error matrix Δ on the system is more reduced by setting the value of the element unnecessary for a rank calculation of the controllable matrix of the corrected state space model to zero. Therefore, an amount of the deviation between the corrected state space model and the state space model of the actual control object is further decreased.
The control object may include a suspension apparatus provided with a damper and a spring interposed between an sprung member and an unsprung member (below-spring member) of a vehicle, and the control means may control a damping force for damping a vibration of the suspension apparatus. According to this configuration, the vibration of the suspension apparatus is suppressed by controlling the damping force of the suspension apparatus. Therefore, riding quality of the vehicle is improved.
One of other aspects of the present invention is a state feedback controller for calculating a control input of a system based on a state quantity of the system represented by a state space model, wherein the state feedback controller calculates the control input based on a state quantity of the system represented by a corrected state space model which is formed so as to represent a controllable system by adding an error matrix Δ to a state matrix of a state space model representing an uncontrollable system. In this case, the state feedback controller may calculate the control input by applying H-infinity state feedback control to a generalized plant designed based on the system represented by the corrected state space model. A magnitude of a non-zero element of the error matrix Δ may be 1/10 to 1/100 of a magnitude of a non-zero element of the state matrix. Elements in the error matrix Δ, an element which does not influence a calculation of a rank of a controllable matrix of the corrected state space model may be set to a zero element. According to the present invention of such a state feedback controller, the same operations and effects as the invention of the above state feedback control apparatus are also obtained.
One of other aspects of the present invention is a state feedback control method for state-feedback controlling a control object, including a control input calculating step for calculating a control input of a system based on a state quantity of the system represented by a corrected state space model, the corrected state space model being formed so as to represent a controllable system by adding an error matrix Δ to a state matrix of a state space model of the control object representing an uncontrollable system, and a control step for controlling the control object based on the control input calculated in the control input calculating step. In this case, the control input may be calculated by applying H-infinity state feedback control to a generalized plant designed based on the system represented by the corrected state space model in the control input calculating step. According to the present invention of such a method, the same operations and effects as the invention of the above state feedback control apparatus are also obtained.
Hereinafter, an embodiment of the present invention will be described.
A state space model (a state space representation) of a control object is described for example as in the following equation (eq. 1) with using a control input u, an output z, and a state quantity x.
wherein: {dot over (x)}=dx/dt
It should be noted that the equation (eq. 1) shows a model of a linear time-invariant system.
In the above equation (eq. 1), A, B, C, D denote system coefficient matrices of the state space model. The matrix A is called a state matrix (or a system matrix), the matrix B is called an input matrix, the matrix C is called an output matrix, and the matrix D is called a transfer matrix.
A necessary and sufficient condition for determining that the system represented by the state space model is controllable is that a controllable matrix Uc(n×nm) of the state space model has full rank (rankUc=n). The controllable matrix Uc of the state space model shown as the equation (eq. 1) is represented as in the following equation (eq. 2).
U
c
=[BAB . . . A
n-1
B],(n×nm) (eq. 2)
The state matrix A and the input matrix B are for example represented as in the following equation (eq. 3).
In this case, the controllable matrix Uc is represented as in the following equation (eq. 4).
A rank of the controllable matrix Uc represented by the equation (eq. 4) is 1(rank Uc=1). Since full rank is 2(Full Rank=2), the controllable matrix Uc does not have full rank. Therefore, in the case where the state matrix A and the input matrix B of the state space model are represented by the above equation (eq. 3), the system represented by that state space model is uncontrollable.
The following equation (eq. 5) is a corrected state space model obtained by correcting the state space model by adding an error matrix Δ to the state matrix A of the state space model shown in the equation (eq. 1).
As understood from the equation (eq. 5), the state matrix to be multiplied by the state quantity x in the state equation is corrected by the error matrix Δ. The corrected matrix A+Δ is called a corrected state matrix in the present specification.
The error matrix Δ has the same form as the state matrix A. In the case where the state matrix A is a 2-by-2 matrix, the error matrix Δ is for example represented as in the following equation (eq. 6).
When the state matrix A and the input matrix B are represented as in the above equation (eq. 3), a controllable matrix Uc* of the corrected state space model is represented as in the following equation (eq. 7) with using the corrected state matrix A+Δ and the input matrix B.
In the above equation (eq. 7), when Δ12 is a non-zero element (an element which is not zero), a rank of the controllable matrix Uc* is 2(rankUc*=2). That is, the controllable matrix Uc* has full rank, and thereby the system represented by the corrected state space model becomes controllable. In such a way, controllability of the then-uncontrollable system is recovered by correcting the state matrix A by the error matrix Δ.
However, even if the error matrix Δ is added to the state matrix, sometimes the controllable matrix Uc* does not have full rank. For example, in the case where Δ12 is zero in the above example, even when other elements are non-zero, first row elements of the controllable matrix Uc* are all zero. Thus, the rank is 1(rankUc* is =1). In this case, the system becomes uncontrollable. Therefore, there is a need for setting the elements of the error matrix Δ such that the system represented by the corrected state space model becomes controllable. That is, there is a need for setting the elements of the error matrix Δ such that the controllable matrix Uc* of the corrected state space model has full rank.
The non-zero elements in the elements of the error matrix Δ may have so small values so as to have the different number of digits from non-zero elements of the state matrix A. If absolute values of the elements of the error matrix Δ are in a similar range to absolute values of the elements of the state matrix A, there is a possibility that rank deficiency is generated in the controllable matrix Uc* of the corrected state space model, thereby the controllable matrix Uc* does not have full rank. For example, in the case where the state matrix A and the input matrix B are represented as in the following equation (eq. 8) and the error matrix Δ is represented as in the above equation (eq. 6), the controllable matrix Uc* is represented as in the following equation (eq. 9).
wherein: a11, a12, a21, a22≠0
When a value of Δ12 is equal to “−a12” in the equation (eq. 9), the first row elements are all zero, and the rank deficiency is generated in the controllable matrix Uc*. Therefore, the controllable matrix Uc* does not have full rank.
Meanwhile, when a magnitude of the elements of the state matrix A and a magnitude of the elements of the error matrix Δ are different from each other in terms of the number of digits, the additional elements in the controllable matrix Uc* do not become zero due to a setoff by an addition. Therefore, the rank deficiency generated by including a lot of zero elements in the elements of the controllable matrix Uc* is prevented.
When the non-zero elements of the error matrix Δ have too small values, the error matrix Δ approximates a zero matrix. Thus, substantial controllability cannot be given to the system. Therefore, it is preferable that the non-zero elements of the error matrix Δ have appropriately small values. In this case, when the non-zero elements of the error matrix Δ have a magnitude of about 1/10 to 1/100 of the non-zero elements of the state matrix A, the controllability of the system represented by the corrected state space model is not deteriorated, and an influence of the error due to an addition of the error matrix Δ is sufficiently suppressed.
Hereinafter, a mode in which the present invention is applied to damping force control of suspension apparatuses of a vehicle will be described.
The suspension apparatuses SPR, SPL are provided with suspension springs 10R, 10L, and dampers 20R, 20L. The suspension springs 10R, 10L and the dampers 20R, 20L are interposed between a sprung member HA and unsprung members LAR, LAL of the vehicle, one ends (lower ends) thereof are connected to the unsprung members LAR, LAL, and the other ends (upper ends) thereof are connected to the sprung member HA. The suspension springs 10R, 10L absorb (buffer) relative vibrations between the unsprung members LAR, LAL and the sprung member HA. The dampers 20R, 20L are arranged in parallel to the suspension springs 10R, 10L, and damp the vibration by generating resistance to a vibration of the sprung member HA relative to the unsprung members LAR, LAL. It should be noted that knuckles coupled to the wheels, lower arms with one ends coupled to the knuckles, and the like correspond to the unsprung members LAR, LAL. The sprung member HA is supported by the suspension springs 10R, 10L and the dampers 20R, 20L. A vehicle body is included in the sprung member HA.
The dampers 20R, 20L are provided with cylinders 21R, 21L, pistons 22R, 22L, and piston rods 23R, 23L. The cylinders 21R, 21L are hollow members in which a viscous fluid such as oil is filled. Lower ends of the cylinders 21R, 21L are connected to the lower arms serving as the unsprung members LAR, LAL. The pistons 22R, 22L are arranged in the cylinders 21R, 21L. The pistons 22R, 22L are movable in the axial direction inside the cylinders 21R, 21L. The piston rods 23R, 23L are bar shape members. The piston rods 23R, 23L are connected to the pistons 22R, 22L at one ends, and extend upward in the axial direction of the cylinders 21R, 21L to protrude outward from upper ends of the cylinders 21R, 21L. The piston rods 23R, 23L connect to the vehicle body serving as the sprung member HA at the other ends.
As shown in the figure, upper chambers R1R, R1L, and lower chambers R2R, R2L are separately formed in the cylinders 21R, 21L by the pistons 22R, 22L arranged inside the cylinders 21R, 21L. Communication passages 24R, 24L are formed in the pistons 22R, 22L. The upper chambers R1R, R1L communicate with the lower chambers R2R, R2L via the communication passages 24R, 24L.
In the dampers 20R, 20L with the above structure, when the sprung member HA is vibrated in the vertical direction (up and down direction) relative to the unsprung members LAR, LAL upon the vehicle traveling over an uneven portion of a road surface or the like, the pistons 22R, 22L connected to the sprung member HA via the piston rods 23R, 23L are relatively displaced in the axial direction in the cylinders 21R, 21L connected to the unsprung members LAR, LAL. In accordance with the relative displacement, the viscous fluid flow through the communication passages 24R, 24L. When the viscous fluid flow through the communication passages 24R, 24L, resistance forces generated. The resistance forces act as damping forces against the vibration in the vertical direction. Thereby, the vibration of the sprung member HA relative to the unsprung members LAR, LAL is damped. It should be noted that a magnitude of the damping forces is increased more as vibration speeds of the pistons 22R, 22L relative to the cylinders 21R, 21L (these speeds are corresponding to sprung-unsprung relative speeds described later) are increased more.
Variable throttle mechanisms 30R, 30L are attached to the suspension apparatuses SPR, SPL. The variable throttle mechanisms 30R, 30L have valves 31R, 31L, and actuators 32R, 32L. The valves 31R, 31L are provided in the communication passages 24R, 24L. A path sectional area of the communication passages 24R, 24L, or the number of the communication passages 24R, 24L are changed by actuating the valves 31R, 31L. That is, an opening degree OP of the communication passages 24R, 24L is changed by actuating the valves 31R, 31L. The valves 31R, 31L are for example formed by rotary valves built into the communication passages 24R, 24L. By means of changing the rotational angle of the rotary valve, the path sectional area of the communication passages 24R, 24L or the number of the connection passages 24R, 24L can be changed. The actuators 32R, 32L are connected to the valves 31R, 31L. In accordance with the actuation of the actuators 32R, 32L, the valves 31R, 31L are actuated. In the case where the valves 31R, 31L are the rotary valves as described above, the actuators 32R, 32L may be a motors for rotating the rotary valves.
When the Opening degree OP is changed as a result of the valves 31R, 31L being operated by the actuators 32R, 32L, the magnitude of the resistance which acts on the viscous fluid flowing through the communication passages 24R, 24L changes. The resistance forces serves as the damping forces against the vibration as described above. Therefore, when the opening degree OP is changed, the damping force characteristics of the dampers 20R, 20L change. It should be noted that the damping force characteristics refers to a characteristic which determines change in the magnitude of the damping forces with speeds of the pistons 22R, 22L in relation to the cylinders 21R, 21L (that is, the sprung-unsprung relative speeds). In the case where the damping forces are proportional to the speeds, the damping force characteristics are represented by damping coefficients.
In the present embodiment, the opening degree OP is set stepwise. Therefore, changing of the opening degree OP results in a stepwise change in the damping force characteristics of the dampers 20R, 20L. The damping force characteristics are represented by the set step numbers of the set opening degree OP. That is, the damping force characteristics are expressed in the form of step numbers in accordance with the set step numbers of the opening degree OP such as first, second, . . . . In this case, each step number representing a damping force characteristics can be set such that the greater the numeral representing the step numbers, the greater the damping forces. The set step numbers representing the damping force characteristics is changed through operation of the variable throttle mechanisms 30R, 30L as described above.
Next, the electric control apparatus EL will be described. The electric control apparatus EL includes a sprung acceleration sensor 41, a right side unsprung acceleration sensor 42R, a left side unsprung acceleration sensor 42L, a right side stroke sensor 43R, a left side stroke sensor 43L, and a micro computer 50.
The sprung acceleration sensor 41 is attached to the vehicle body, detects a sprung member acceleration d2y/dt2 serving as acceleration in the vertical direction of the sprung member HA in relation to an absolute space, and outputs a signal representing the detected sprung acceleration d2y/dt2. The right side unsprung acceleration sensor 42R is attached to the right side unsprung member LAR, detects a right side unsprung acceleration d2rR/dt2 serving as an acceleration in the vertical direction of the right side unsprung member LAR in relation to the absolute space, and outputs a signal representing the detected right side unsprung acceleration d2rR/dt2. The left side unsprung acceleration sensor 42L is attached to the left side unsprung member LAL, detects a left side unsprung acceleration d2rL/dt2 serving as an acceleration in the vertical direction of the left side unsprung member LAL in relation to the absolute space, and outputs a signal representing the detected left side unsprung acceleration d2rL/dt2.
The right side stroke sensor 43R is attached between the sprung member HA and the right side unsprug member LAR, detects a sprung-right side unsprung relative displacement rR−y, and outputs a signal representing the detected sprung-right side unsprung relative displacement rR−y. The sprung-right side unsprung relative displacement rR−y is a difference between a sprung member displacement y serving as a displacement in the vertical direction of the sprung member HA from a reference position and a right side unsprung member displacement rR serving as a displacement in the vertical direction of the right side unsprung member LAR from a reference position. It should be noted the displacement rR−y is equal to a displacement of the right side piston 22R relative to the right side cylinder 21R in the right side damper 20R (right side stroke amount). The left side stroke sensor 43L is attached between the sprung member HA and the left side unsprung member LAL, detects a sprung-left side unsprung relative displacement rL−y, and outputs a signal representing the detected sprung-left side unsprung relative displacement rL−y. The sprung-left side unsprung relative displacement rL−y is a difference between the sprung displacement y and a left side unsprung displacement rL serving as a displacement in the vertical direction of the left side unsprung member LAL from a reference position. It should be noted that the displacement rL−y is equal to a displacement of the left side piston 22L relative to the left side cylinder 21L in the left side damper 20L (left side stroke amount).
Each of the sprung acceleration sensor 41 and the unsprung acceleration sensors 42R, 42L detects upward acceleration as positive acceleration, and downward acceleration as negative acceleration. Each of the stroke sensors 43R, 43L detects relative displacement, for the case where upward displacement of the sprung member HA from the reference position is detected as positive displacement, downward displacement of the sprung member HA from the reference position is detected as negative displacement, upward displacement of each of the unsprung members LAR, LAL from the reference position is detected as positive displacement, and downward displacement of each of the unsprung members LAR, LAL is detected as negative displacement.
The micro computer 50 is electrically connected to the sprung acceleration sensor 41, the unsprung acceleration sensors 42R, 42L, and the stroke sensors 43R, 43L. The micro computer 50 determines a right side requested step number DreqR representing a target step number corresponding to a target damping force characteristic of the right side damper 20R, and a left side requested step number DreqL representing a target step number of a target damping force characteristic of the left side damper 20L on the basis of the signals output from the sensors. The micro computer 50 respectively output a command signal corresponding to the determined right side requested step number DreqR to the right side actuator 32R, and a command signal in corresponding to the determined left side requested step number DreqL to the left side actuator 32L. Both the actuators 32R, 32L are actuated based on the above command signals. As a result, the right side valve 31R and the left side valve 31L are actuated. In such a way, the micro computer 50 variously controls the damping force characteristics of the right side damper 20R and the left side damper 20L by controlling the right side variable throttle mechanism 30R and the left side variable throttle mechanism 30L to control the damping forces of the right side suspension apparatus SPR and the left side suspension apparatus SPL at the same time.
As can be understood from
In the suspension control apparatus 1 formed as described above, when a detected value of the sprung acceleration sensor 41 exceeds a predetermined threshold value (that is, when there is a need for vibration suppression control of the suspension apparatuses SPR, SPL), the nonlinear H-infinity controller 51 of the micro computer 50 executes a variable damping coefficient calculation processing, the requested damping force calculation section 52 executes a requested damping force calculation processing, and the requested step number determination section 53 executes a requested step number determination processing respectively repeatedly every predetermined short time.
The nonlinear H-infinity controller 51 calculates the variable damping coefficients CvR, CvL as the control input u by executing the variable damping coefficient calculation processing shown in a flowchart of
Next, in S106, the nonlinear H-infinity controller 51 calculates the right side variable damping coefficient CvR and the left side variable damping coefficient CvL based on the nonlinear H-infinity control theory. The variable damping coefficients CvR, CvL represent the variable amount of the damping coefficient which is varied by controlling. In this case, although detailed description will be given later, the nonlinear H-infinity controller 51 calculates the control input u that is the variable damping coefficients CvR, CvL, such that L2 gain (L2 gain from a disturbance w to an evaluation output z) of a system (a generalized plant) represented by the corrected state space model in which the control input u is represented by the variable damping coefficients CvR, CVL becomes less than a positive constant γ. After calculating the variable damping coefficients CvR, CVL in S106, the nonlinear H-infinity controller 51 outputs the variable damping coefficients CvR, CVL in S108. After that, the nonlinear H-infinity controller 51 advances to S110 and finishes this processing. The nonlinear H-infinity controller 51 has functions corresponding to the state feedback controller of the present invention. A step of executing the variable damping coefficient calculation processing shown in
After determining the requested step numbers DreqR, DreqL in S304, the requested step number determination section 53 advances to S306 and outputs command signals corresponding to the requested step numbers DreqR, DreqL to the actuators 32R, 32L. After that, the requested step number determination section 53 advances to S308 and finishes this processing. Upon receiving the command signals, the actuators 32R, 32L act based on the command signals. As a result, the valves 31R, 31L are actuated, and the variable throttle mechanisms 30R, 30L are controlled such that the step numbers representing the damping force characteristics of the dampers 20R, 20L become the requested step numbers DreqR, DreqL. In such a way, the damping forces of the suspension apparatuses SPR, SPL are controlled at the same time.
As understood from the above description, the requested damping force calculation section 52 and the requested step number determination section 53 control the damping forces of the suspension apparatuses SPR, SPL based on the variable damping coefficients CvR, CvL calculated by the nonlinear H-infinity controller 51 serving as the state feedback controller. By the above described damping force control, the vibrations of the suspension apparatuses SPR and SPL are controlled. The requested damping force calculation section 52 and the requested step number determination section 53 correspond to control means of the present invention. A step of executing the requested damping force calculation processing shown in
The variable damping coefficients CvR, CvL are calculated by the nonlinear H-infinity controller 51. Whether a riding quality of the vehicle is good or bad is determined by a manner in which an ideal variable damping coefficients CvR, CvL are calculated in accordance with the traveling state of the vehicle and the damping forces are controlled on the basis of the calculated variable damping coefficients. In the present embodiment, the variable damping coefficients CvR, CvL are calculated as the control input u on the basis of the nonlinear H-infinity state feedback control to the system. A calculation method of the variable damping coefficients CvR, CvL by using the nonlinear H-infinity state feedback control in the present embodiment will be briefly described below.
Firstly, a nonlinear H-infinity state feedback control theory will be described.
wherein: {dot over (x)}=dx/dt
In a special case where the state space model is represented by a form shown in the following equation (eq. 11), the state space model is called a bilinear system.
A nonlinear H-infinity state feedback control problem, that is, a control target in the nonlinear H-infinity state feedback control, is to design the state feedback controller K of the system such an influence of the disturbance w of the closed loop system S is prevented from appearing in the evaluation output z to a possible extent. This problem is equal to designing the state feedback controller K (=u=K(x)) such that the L2 gain (∥S∥L2) from the disturbance w to the evaluation output z of the closed loop system S becomes less than a given positive constant γ, that is, the following equation (eq. 12) is satisfied.
A necessary and sufficient condition to solve the nonlinear H-infinity state feedback control problem is that a positive definite function V(x) and a positive constant c satisfying a Hamilton-Jacobi partial differential inequality shown in an equation (eq. 13) exist.
In this case, one of the state feedback controller K (=u=K(x)) is given by the following equation (eq. 14).
It is said that solving the Hamilton-Jacobi partial differential inequality is almost impossible. Therefore, the state feedback controller K cannot be solved analytically. However, in the case where the state space model is the bilinear system, if a positive definite symmetric matrix P satisfying a Riccati inequality shown in the following equation (eq. 15) is existing, it is known that the nonlinear H-infinity state feedback control problem can be approximately solved. This Riccati inequality can be solved analytically.
In this case, one of the state feedback controller K (=u=K(x)) is given by the following equation (eq. 16).
u=−D
122
−1{(1+m(x)xTC11TC11x)D122−TB2T(x)P+C12}x (eq. 16)
In the equation (eq. 15) and the equation (eq. 16), C11 is a matrix to be multiplied by the state quantity x in an output equation representing an output obtained by a frequency weight Ws acting on the evaluation output, and C12 is a matrix to be multiplied by the state quantity x in an output equation representing an output obtained by a frequency weight Wu acting on the control input. D122 is a matrix to be multiplied by the control input u in the output equation representing the output obtained by the frequency weight Wu acting on the control input. In addition, m(x) is an arbitrary positive definite scalar function influencing a constrained condition of a nonlinear weight to be multiplied by the frequency weights Ws, Wu. In the case where the nonlinear weight does not act as a weight, m(x) can be set to 0.
Therefore, in the case where the state space model is the bilinear system, the state feedback controller K can be designed by solving the Riccati inequality. Thus, the control object can be state-feedback by the control input u calculated by the designed state feedback controller K.
In the two wheel model shown in
Mÿ=K
R(rR−y)+KL(rL−y)+CsR({dot over (r)}R−{dot over (y)})+CsL({dot over (r)}L−{dot over (y)})+CvR({dot over (r)}R−{dot over (y)})+CvL({dot over (r)}L−{dot over (y)}) (eq. 17)
wherein:
ÿ=d2y/dt2, {dot over (y)}=dy/dt, {dot over (r)}R=drR/dt, {dot over (r)}=drL/dt
Based on the equation (eq. 17), a state space model of the two wheel model is designed as shown in
{dot over (x)}
p
=A
p
x
p
+B
p1
w+B
p2(xp)u (eq. 18)
wherein:
wherein: xp denotes state quantity, w denotes disturbance, u denotes control input.
An output equation is described as in the following equation (eq. 19).
z
p
=C
p1
x
p
+D
p12
u (eq. 19)
In the case where an evaluation output zp is set to the sprung-right side unsprung relative displacement rR−y and the sprung-left side unsprung relative displacement rL−y, zp, Cp1, and Dp12 are represented as follows.
Notably, the evaluation output zp may be set to the sprung acceleration d2y/dt2 or the sprung speed dy/dt. A term in relation to the disturbance w may be added to the output equation so that the output equation is rewritten as “zp=Cp1xp+Dp11w+Dp12u”.
With the equation (eq. 18) and the equation (eq. 19), the state space model of the control object shown in
The state space model shown in the equation (eq. 20) is the bilinear system.
A necessary and sufficient condition to obtain controllability of the system represented by the state space model of the equation (eq. 20) is that the controllable matrix Uc of this state space model has full rank. The controllable matrix Uc is represented as in the following equation (eq. 21).
U
c
=[B
p2(xp)ApBp2(xp)Ap2Bp2(xp)] (eq. 21)
In the case where a state matrix Ap and an input matrix Bp2(xp) are represented by the above equation (eq. 18), the controllable matrix Uc is represented as in the following equation (eq. 22).
wherein:
As understood from the equation (eq. 22), the controllable matrix Uc is represented as a 3-by-6 matrix. Therefore, full rank of the controllable matrix Uc is 3(Full rank=3). First row elements and second row elements in the controllable matrix Uc are all the same. Thus, the rank deficiency is generated, and the rank of the controllable matrix Uc becomes 2(rankUc=2). That is, the controllable matrix Uc does not have full rank. Therefore, the system represented by the state space model shown in the equation (eq. 20) is uncontrollable.
The reason for that the controllable matrix Uc does not have full rank is that the number of motion equation serving as a basis in designing of the model is one, nevertheless the number of the control input u is two (the right side variable damping coefficient CvR and the left side variable damping coefficient CVL). That is, the number of the motion equation is less than the number of the control input u.
In the present embodiment, a corrected state space model obtained by correcting the state space model of the control object shown in the equation (eq. 20) is proposed. This corrected state space model is described as in the following equation (eq. 23).
As understood from the equation (eq. 23), the state quantity xp of the state equation is multiplied by a corrected state matrix (Ap+Δ) obtained by adding the error matrix Δ to the state matrix Ap of the state space model of the equation (eq. 20). The error matrix Δ is a preliminarily designed matrix, and gives an error (perturbation) to the state matrix Ap. That is, the corrected state space model shown in the equation (eq. 23) is a model obtained by correcting the state space model by adding the error matrix Δ to the state matrix Ap of the state space model representing the uncontrollable system shown in the equation (eq. 20).
A necessary and sufficient condition for obtaining controllability of the system represented by the corrected state space model is that the controllable matrix Uc* of the corrected state space model has full rank. The controllable matrix Uc* of the corrected state space model is represented as in the following equation (eq. 24).
U
c
*=[B
p2(xp)(Ap+Δ)Bp2(xp)(Ap+Δ)2Bp2(xp)] (eq. 24)
In order to avoid a complicated calculation, the state matrix Ap and the input matrix Bp2(xp) represented by the equation (eq. 18) are respectively described as in the following equations (eq. 25) and (eq. 26).
wherein:
The error matrix Δ is for example represented as in the following equation (eq. 27).
As understood from the equation (eq. 27), a non-zero element 0.1a33 of the error matrix Δ has a magnitude of 1/10 of a non-zero element a33 of the state matrix Ap. In the case where the state matrix Ap, the input matrix Bp2(xp), and the error matrix Δ are respectively represented as in the equation (eq. 25), the equation (eq. 26), and the equation (eq. 27), the following equations (eq. 28) and (eq. 29) are established. The controllable matrix Uc* is represented as in the following equation (eq. 30).
wherein: γ=−a31−a32+a332
As understood from the equation (eq. 30), elements in fifth and sixth columns in a first row of the controllable matrix Uc* are different from elements in fifth and sixth columns in a second row. Therefore, the rank deficiency due to the fact that the first row elements and the second row elements are all the same elements is prevented, and the rank of the controllable matrix Uc* becomes 3(rankUc*=3). That is, the controllable matrix Uc* has full rank, and the system represented by the corrected state space model becomes controllable. Therefore, a state feedback control system of the corrected state space model can be designed.
The error matrix Δ is designed such that the controllable matrix Uc* of the corrected state space model has full rank as in the above example. A design example of such an error matrix Δ will be considered. For example, the corrected state matrix Ap+Δ is represented by the following equation (eq. 31) and the input matrix Bp2(xp) is represented by the following equation (eq. 32).
The following equations (eq. 33) and (eq. 34) are established.
The controllable matrix Uc* is represented by the following equation (eq. 35).
In this case, when the following equality (eq. 36) is established, the first row elements and the second row elements of the controllable matrix Uc* shown in the equation (eq. 35) are the same. Therefore, the rank deficiency is generated, and the controllable matrix Uc* does not have full rank.
The above equation (eq. 36) can be represented as in the following equation (eq. 37).
a
11
a
13
a
23
+a
12
a
23
2
=a
13
2
a
21
+a
13
a
22
a
23 (eq. 37)
The error matrix Δ can be designed such that the rank deficiency is not generated in the controllable matrix Uc* by determining the corrected state matrix (Δp+Δ) so that the above equation (eq. 37) is not established and by subtracting the state matrix Ap from the determined corrected state matrix (Δp+Δ). For example, in the corrected state matrix (Δp+Δ) represented by the above equation (eq. 28), elements relating to the equation (eq. 36) which influence the rank of the controllable matrix Uc*(a11, a12, a13, a21, a22, a23) are set as shown in the following equation (eq. 38).
In the case where the elements are set as in the above equation (eq. 38), a left side value of the equation (eq. 37) becomes −0.1a33, and a right side value becomes zero. Therefore, the equation (eq. 37) is not established. Thus, the rank deficiency is not generated but the controllable matrix Uc* has full rank.
The above design example is one example of designing the error matrix Δ in the case where the input matrix Bp2(xp) is represented as in the equation (eq. 32). There is sometimes the case where the input matrix Bp2(xp) is represented by a form other than the above equation (eq. 32). In that case, the error matrix Δ is individually designed such that the rank deficiency is not generated in the controllable matrix Uc*.
As understood from
wherein:
{dot over (x)}w=dxw/dt
The equation (eq. 40) can be modified as in the following equation (eq. 41).
The frequency weight Wu varied by the frequency acts on the control input u. A state space model of the frequency weight Wu is represented as in the following equation (eq. 42) with using a state quantity xu, an output zu, and constant matrices Au, Bu, Cu, Du.
wherein:
{dot over (x)}u=dxu/dt
From the equations (eq. 39) to (eq. 42), the state space model representing the generalized plant is described as in the following equation (eq. 43). This state space model includes is corrected model corrected by the error matrix Δ. Therefore, the generalized plant is controllable.
wherein:
The state space model represented as in the above equation (eq. 43) is the bilinear system. Therefore, when a positive definite symmetric matrix P satisfying the Riccati inequality shown in the following equation (eq. 44) exists in relation to the preliminarily set positive constant γ, the closed loop system S of
At this time, one of the state feedback controller K (=K(x)) is represented as shown in the following equation (eq. 45).
K(x)=u=−D122−T(D122−TB2T(x)P+C12)x (eq. 45)
The equation (eq. 45) is described as in an equation (eq. 47) under a condition represented by an equation (eq. 46).
C
12
=o, D
122
=I (eq. 46)
K(x)=u=−B2T(x)Px (eq. 47)
The control input u is calculated by the state feedback controller K (=K(x)) designed as in the above equation (eq. 47) as one example, that is, the state feedback controller K (=K(x)) designed such that the L2 gain of the closed loop system S becomes less than the positive constant γ. By the calculated control input u, the right side variable damping coefficient CvR and the left side variable damping coefficient CvL are obtained. In the present embodiment, the damping force characteristic of the right side damper 20R and the damping force characteristic of the left side damper 20L are controlled on the basis of the right side variable damping coefficient CvR and the left side variable damping coefficient CvL obtained as described above. By controlling the damping force as described in the present embodiment, the vibrations of the right suspension apparatus SPR and the left suspension apparatus SPL are controlled.
According to the above present embodiment, the micro computer 50 as the state feedback control apparatus is provided with the state feedback controller K (the nonlinear H-infinity controller 51) for calculating the control input of the system based on the state quantity of the system represented by the corrected state space model, and the control means (the requested damping force calculation section 52, the requested step number determination section 53) for controlling the vibrations of the suspension apparatuses SPR, SPL by controlling the damping forces of the suspension apparatuses SPR, SPL (the dampers 20R, 20L) based on the control input calculated by the state feedback controller K.
The above corrected state space model is obtained by correcting the state space model by adding the error matrix Δ to the state matrix of the state space model of the suspension apparatuses SPR, SPL represented as the uncontrollable system. The error matrix Δ is designed such that the controllable matrix of the corrected state space model has full rank by adding the error matrix Δ to the state matrix. Therefore, the system represented by the corrected state space model (or the generalized plant) becomes controllable, and the control object can be state-feedback controlled.
A basic structure of the corrected state space model is the same as the original state space model of the control object except that the error matrix Δ is only added. Therefore, there is no need for redesigning time of the model. Further, since the error matrix Δ is added to the state matrix which is less influential on the output of the model, the error matrix Δ does not greatly influence the output. In addition, since only one error matrix Δ is added into the corrected state space model, buildup of the error is not generated. Therefore, deviation between the corrected state space model and the state space model of the actual control object is small, to thereby highly precisely state-feedback control is achieved. Since an error examination point is one point, time required for examining the error can be shortened. That is, according to the present embodiment, the control object can be highly precisely state-feedback controlled by a simple model correction.
The error matrix Δ is set such that the elements of the state matrix influencing the rank of the controllable matrix Uc* of the corrected state space model are changed. Therefore, the error is added to the elements serving as a cause of the rank deficiency. By such an element correction, the corrected state space model can be made controllable.
The nonlinear H-infinity controller 51 calculates the control input by applying the nonlinear H-infinity state feedback control to the generalized plant G designed based on the system represented by the corrected state space model. Thereby, the suspension apparatuses SPR, SPL can be state-feedback controlled such that disturbance suppression and robust stabilization are improved.
As understood from the equation (eq. 27), the magnitude of the non-zero element of the error matrix Δ is 1/10 of the magnitude of the non-zero element of the state matrix Ap. Therefore, the system represented by the corrected state space model can sufficiently obtain the controllability, and an influence rate of the error on the system is sufficiently reduced. In addition, the non-zero element of the error matrix Δ and the non-zero element of the state matrix are different from each other in terms of the number of digits. Thus, when the error is added to the state matrix Ap, an addition element is prevented from being zero due to the setoff. This addition element is used for an element calculation of the controllable matrix Uc*. Thus, since the addition element is not zero, the rank deficiency is not easily generated in the controllable matrix Uc*.
Further, according to the present embodiment, the elements in the error matrix Δ not influencing the rank of the controllable matrix Uc* of the corrected state space model are set to zero. By setting the elements not relating to the rank deficiency of the controllable matrix Uc* to zero in such a way, the influence of the error matrix Δ on the system can be reduced, and the deviation between the corrected state space model and the original state space model of the control object can be more decreased.
In the present embodiment, the control object is consisted of the vibration system including the sprung member of the vehicle, the unsprung members, and the suspension apparatuses SPR, SPL having the dampers and the springs interposed between the sprung member and the unsprung members. The above vibration system is controlled by controlling the damping forces of the suspension apparatuses SPR, SPL by the micro computer 50. Thereby, the riding quality of the vehicle is improved.
From the above embodiment, the following inventions can be proposed.
(1) A corrected state space model formed so as to represent a controllable system by adding an error matrix Δ to a state matrix of a state space model of a control object representing an uncontrollable system.
(2) A designing method of a state feedback controller for calculating a control input based on a state quantity of the system represented by a state space model, wherein the state feedback controller is designed by applying H-infinity control to a generalized plant designed based on a system represented by a corrected state space model formed so as to represent a controllable system by adding an error matrix Δ to a state matrix of a state space model of a control object representing an uncontrollable system.
(3) In the invention (1) or (2), a magnitude of a non-zero element of the error matrix Δ is 1/10 to 1/100 of a magnitude of a non-zero element of the state matrix.
The present invention is not limited to the above embodiment. For example, the two wheel model of the vehicle is taken as an example in the above embodiment, and the state feedback control apparatus capable of obtaining two control inputs from one motion equation is disclosed. The present invention can be applied to control other than such state feedback control. For example, with using three motion equations relating to heave motion, pitch motion, and roll motion of an sprung member of the vehicle derived from a four wheel model of a vehicle, a corrected state space model can be formed so as to represent a controllable system by correcting a state space model representing an uncontrollable system. In this case, control inputs are set to variable damping coefficients of dampers respectively provided in four suspension apparatuses attached to front left and right portions and rear left and right portions of the sprung member. An error matrix Δ is added to a state matrix of the uncontrollable state space model which represents the four wheel model to design the corrected state space model which is controllable. Four control inputs are calculated from a state feedback controller obtained by applying the H-infinity control or the like to a generalized plant designed based on a system represented by the corrected state space model, and damping forces of the four suspension apparatuses can also be controlled based on the calculated inputs. In this case, the three motion equations serving as bases in designing of the state space model are for example represented by the following equation (eq. 48), and a control input u is represented by the following equation (eq. 49).
wherein:
M: a mass of the sprung member;
x: a vertical displacement of the sprung member;
Ffr: a vertical force acting on the right front side of the sprung member;
Ffl: a vertical force acting on the left front side of the sprung member;
Frr: a vertical force acting on the right rear side of the sprung member;
Frl: a vertical force acting on the left rear side of the sprung member;
Ir: roll inertia moment;
Ip: pitch inertia moment;
L: a wheelbase;
θr: a roll angle;
θp: a pitch angle;
Tf: a tread (front side); and
Tr: a tread (rear side).
wherein:
Cvfr: a variable damping coefficient of a right side front damper;
Cvfl: a variable damping coefficient of a left side front damper;
Cvrr: a variable damping coefficient of a right side rear damper; and
Cvrl: a variable damping coefficient of a left side rear damper.
In the above embodiment, the error matrix Δ is added to the state matrix Ap as the additive error as shown in
CSM=Ap+ApΔ (eq. 50)
wherein: CSM denotes the corrected state matrix.
In this case, the error matrix is represented by ApΔ.
Although the present invention is described taking the damping force control of the suspension apparatuses of the vehicle as an example in the above embodiment, the present invention can be applied to other state feedback control. Although the present invention is described taking the nonlinear H-infinity state feedback control as an example in the present embodiment, the present invention may be applied to linear H-infinity state feedback control. Further, the present invention is applied to the control which is not H-infinity control. The present invention can be modified as long as the invention does not depart from the scope of the invention.
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2009/053306 | 2/18/2009 | WO | 00 | 11/2/2011 |