The present invention relates to a pitching control device of a motor vehicle and a control method of it, and more specifically, to a pitching control device of a motor vehicle for controlling pitching by a control of a torque of a motor and a control method.
In energy and environmental issues, the electric vehicle is considerably superior to the internal combustion engine vehicle, and attracts attention. However, the electric vehicle that uses a motor as a driving force has large superiority also in the following points: responsiveness from a torque command value to generated torque is excellent, which is a characteristic of motors; the generated torque can be grasped accurately by measuring a motor current; and the motor can be disposed in a distributed manner to respective wheels of tire because the motor is compact (refer to Non-patent Documents 1, 2). An attention is paid to characteristics of this motor, and researches of vehicle control unique to the electric vehicle are being done (refer to Non-patent Document 3).
Vehicle motions include a pitching motion that affects riding comfort largely. The pitching is a motion about the center of gravity of a car body that arises from occurrence of a longitudinal acceleration when the driving force and a braking force are applied to a motor vehicle while running on a straight line and simultaneous addition of the moment about the center of gravity axis (y-axis) of the car body. The present invention performs a control of the pitching motion.
As pitching control methods having been proposed up to now,
there is one method of performing a feedforward control whereby a predetermined correction torque is added to a measured pitching quantity in a direction of controlling the pitching quantity and the direction of the correction torque is changed each time its polarity variations (refer to Patent Documents 1, 2). There is also a pitching control method, which is similarly a feedforward control, of using a detailed on-spring vibration model and performing state feedback to the model (Patent Document 3)
However, hitherto there is no model of precisely analyzing the pitching motion of a vehicle, and the pitching control device using a fast response of the motor that is a characteristic of the electric vehicle dose not exist, either. Moreover, in practice, the acceleration axm by a motor torque depends not only on a torque command value but also on a road surface state. Therefore, an error of axm is large, and there was a problem that it was difficult to perform the pitching control with high accuracy. Furthermore, since a hall sensor of the motor has a low resolution, when obtaining the brake torque and a nominal acceleration, the wheel angular velocity w with low accuracy is differentiated for it.
[Formula 1]
ω·
(ωdot) There is a problem that a noise rides on the wheel angular velocity largely, which reduces accuracy of the pitching control.
The present invention was made in view of such a problem, and an object thereof is to provide the pitching control device of a motor vehicle for controlling the pitching motion by controlling the torque of driving wheels, and a control method of it. Moreover, the object is to provide a high-accuracy pitching control device by means of torque control of the motor based on a brake torque estimation method considering the slip ratio, and a control method. Moreover, the object is to provide the high-accuracy pitching control device considering a road surface situation without using a wheel angular acceleration, and a control method.
Patent Document 1: Japanese Patent Laid-Open No. 62-12305
Patent Document 2: Japanese Patent Laid-Open No. 2007-186130
Patent Documents 3: Japanese Patent Laid-Open No. 2006-60936
Non-patent Document 1: S. Sasakai and Y. Hori: “Advanced Vehicle Motion Control of Electric Vehicle,” Ph D. Thesis, The University of Tokyo (1999) (in Japanese)
Non-patent Document 2: T. Koike and Y. Hori, “Advanced Braking System based on High Speed Response of Electric Motor,” IIC-06-2 (2006)
Non-patent Document 3: H. Fujimoto, K. Fujii, and N. Takahashi: “Road Condition Estimation and Motion Control of Electric Vehicle with In-wheel Motors,” JSAE Annual Congress, pp. 25-28 (2007)
Non-patent Document 4: “Movement Dynamics of Motor Vehicle,” Basic Seminar (2006)
Non-patent Document 5: Edited by Incorporated Company, Japan Society of Mechanical Engineers, “Dynamics and Control of Vehicle System,” published by Yokendo, Co. Ltd.
Non-patent Document 6: M. Kamachi and K. Walters: “A Research of Direct Yaw-Moment Control on Slippery Road for M-Wheel Motor Vehicle,” EVS-22 Yokohama, JAPAN, Oct. 23-28, pp. 2122-2133 (2006)
Non-patent Document 7: Takaaki Uno, “Vehicle Kinematic Performance and Chassis Mechanism,” Published by Grand Prix Press
Non-patent Document 8: K. Fujii and H. Fujimoto; “Slip Ratio Control based on Wheel Control without Detection of Vehicle Speed for Electric vehicle,” VT-07-05, pp. 27-32 (2007)
Non-patent Document 9: Edited by Kayaba Industry Co., Ltd., “Suspensions of Vehicle,” Published by SANKAIDO PUBLISHING Co., Ltd.
Non-patent Document 10: Toru Suzuki and Hiroshi Fujimoto, “Proposal of Slip Ratio Estimation Method without Detection of Vehicle Speed for Electric Vehicle on Deceleration,” IEE of Japan Technical Meeting Record, 2007, pp. 77-82
The present invention is a pitching control device, in the motor vehicle that drives its driving shaft with the torque of the motor, characterized by comprising: pitch angle computing means for computing a pitch angle of the motor from a moment about the center of gravity of the motor vehicle based on loads applied to wheels of the motor vehicle at the time of standstill, loads applied to the wheels of the motor vehicle at the time of acceleration and deceleration by the motor, and variations of loads applied to the wheels of the motor vehicle by an anti-dive force working on front wheels of the motor vehicle and an anti-lift force working on rear wheels of the motor vehicle at the time of braking by a brake; motor torque computing means for computing a motor torque of the motor based on the pitch angle; and motor control means for controlling the motor using the motor torque.
Moreover, one mode of the present invention is characterized by further comprising feedback control means for compensating a difference between a pitch rate derived from the pitch angle computed by the pitch angle computing means and the pitch rate of the motor.
Moreover, one mode of the present invention is characterized by further comprising brake torque estimating means for estimating a brake torque, wherein the pitch angle computing means computes the acceleration based on the brake torque.
Moreover, one mode of the present invention is characterized in that the brake torque estimating means performs estimation considering a slip ratio.
Moreover, one mode of the present invention is characterized in that the brake torque estimating means performs estimation that further considers a time variation of the slip ratio.
Moreover, one mode of the present invention is further equipped with an acceleration sensor for measuring the acceleration of the car body of the motor vehicle, and is characterized in that the brake torque estimating means performs estimation using the acceleration.
Moreover, one mode of the present invention is the pitching control device, in a motor vehicle that drives its driving wheels by the torque of the motor, comprising: the acceleration sensor for measuring an acceleration of a car body of the motor vehicle; state feedback control means that estimates state variables including the pitch angle through a state observer using a model for computing the pitch angle from a moment about a point of the center of gravity of the motor vehicle based on the acceleration, loads applied to the wheels of the motor vehicle at the time of standstill, loads applied to the wheels of the motor vehicle at the time of acceleration and deceleration by the motor, and variations of loads applied to the wheels of the motor vehicle by the anti-dive force working on the front wheels of the motor vehicle and the anti-lift force working on the rear wheels of the motor vehicle at the time of braking by a brake and uses the estimated value of the state variables; wheel speed control means for computing the motor torque of the motor based on the slip ratio computed by the state feedback control means; and the motor control means for controlling the motor using the motor torque.
Moreover, one mode of the present invention is characterized in that the wheel speed control means determines a control gain by a pole assignment technique considering only moments of inertia of the wheels and the control gain is adjusted so that the pole may become constant to the moments of inertia of the wheels at the time of acceleration and deceleration.
Moreover, one mode of the present invention is characterized in that the pitch computing means computes the pitch angle based on Formula (A),
(where m: car body weight, h: height from the ground plane to the center of gravity, lf: distance between the center of gravity and a front wheel shaft, lr: distance between the center of gravity and a rear wheel shaft, I: moment of inertia about a y-axis of the car body, C: damper coefficient, K: spring constant, β: braking force distributed to the front wheels, φf: anti-dive force direction, and φr: anti-lift force direction).
Moreover, another mode of the present invention is a pitching control method, in the motor vehicle that drives its driving wheels by the torque of the motor, comprising: a pitch angle computation step of computing the pitch angle of the driving shaft from a moment about the center of gravity of the motor vehicle based on loads applied to the wheels of the motor vehicle at the time of standstill, loads applied to the wheels of the motor vehicle at the time of acceleration and deceleration, and variations of loads applied to the wheels of the motor vehicle by the anti-dive force working on the front wheels of the motor vehicle and the anti-lift force working on the rear wheels of the motor vehicle at the time of braking by a brake, a motor torque computation step of computing a motor torque of the motor based on the pitch angle; and a motor control step of controlling the motor using the motor torque.
Moreover, one mode of the present invention is characterized by further comprising a feedback control step of compensating a difference between the pitch rate derived from the pitch angle computed at the pitch angle computation step and the pitch rate of the motor.
Moreover, one mode of the present invention is characterized by further comprising a brake torque estimation step of estimating the brake torque, wherein the pitch angle computing means computes the acceleration based on the brake torque.
Moreover, one mode of the present invention is characterized in that the brake torque estimation step performs estimation considering the slip ratio.
Moreover, one mode of the present invention is characterized in that the brake torque estimation step performs estimation that further considers the time variation of the slip ratio.
Moreover, one mode of the present invention is characterized by further comprising an acceleration measurement step of measuring the acceleration of the car body of the motor vehicle with the acceleration sensor, wherein the brake torque estimation step performs estimation using the acceleration.
Moreover, one mode of the present invention is a pitching control method, in a vehicle that drives its driving wheels by the torque of the motor, comprising: the acceleration measurement step of measuring the acceleration of the car body of the motor vehicle with the acceleration sensor; a state feedback control step of estimating variables including the pitch angle through a state observer using a model for computing the pitch angle from a moment about a point of the center of gravity of the motor vehicle based on the acceleration, loads applied to the wheels of the motor vehicle at the time of standstill, loads applied to the wheels of the motor vehicle at the time of acceleration and deceleration by the motor, and variations of loads applied to the wheels of the motor vehicle by the anti-dive force working on the front wheels of the motor vehicle and the anti-lift force working on the rear wheels of the motor vehicle at the time of braking by a brake, and using the estimated values of the state variables; a wheel speed control step of computing the motor torque of the motor based on the slip ratio computed by the state feedback control means; and a motor control step of controlling the motor using the motor torque.
Moreover, one mode of the present invention is characterized in that the wheel speed control step determines a control gain by the pole assignment technique considering only the moments of inertia of the wheels and the control gain is adjusted so that the pole may become constant to the moments of inertia of the wheels at the time of acceleration and deceleration.
Moreover, one mode of the present invention is characterized in that the pitch angle computation step computes the pitch angle based on Formula (A),
(where m: car body weight, h: height from the ground plane to the center of gravity, lf: distance between the center of gravity and the front wheel shaft, lr: distance between the center of gravity and the rear wheel shaft, I: moment of inertia about the y-axis of the car body, C: damper coefficient, K: spring constant, β: braking force distributed to the front wheels, φf: angle between the ground plane and the anti-dive force direction, and φr: angle between the ground plane and the anti-lift force direction).
According to the present invention, it is possible to control the pitching motion by controlling the torque of the driving wheels. Moreover, in the motor vehicle that uses the motor as power, it becomes possible to perform a high-accuracy pitching control by a torque control of the motor based on a brake torque estimation method considering the slip ratio. Moreover, it becomes possible to perform the high-accuracy pitching control considering a road surface situation without using a wheel angular acceleration.
Embodiments of the present invention that are described below will be explained as they are installed to an electronic control unit of a motor vehicle (hereinafter referred to as an “ECU”) that drives its driving wheels by a torque of a motor. Although a current outputted from a power source is supplied to the motor through an inverter, the motor is electrically connected to the ECU serving as control means through the inverter. That is, the output of the motor is controlled by the inverter for controlling an output current based on the command from the ECU. The ECU is a device that includes a CPU, ROM, RAM, an input/output port, a storage device, etc., and can electrically connect to a torque measuring instrument for measuring a generated torque of the motor, a position sensor installed on the motor, an acceleration sensor for measuring an acceleration arising in the car body, etc. through an inverter.
When inputting an acceleration axb by a braking force into the nominal plant Pn(s), it outputs a motor acceleration axm that a feedforward controller CFF ideally controls based on a pitch angle command value θ* and a nominal pitch angle θn outputted from the nominal plant Pn(s). The acceleration axb by the braking force is the acceleration ax of the car body measured by the acceleration sensor from which the acceleration axm by the motor that is computed based on the current value to the motor is subtracted.
When the acceleration axm outputted from the feedforward controller CFF and the acceleration axb by the braking force are inputted into an actual plant P(s), the actual plant P(s) outputs the pitch angle θ. The pitch angle θ was differentiated.
A feedback controller CFB compensates for the motor acceleration axm based on a difference between
[Formula 4]
pitch rate θ·
(θdot) and a pitch rate θndot obtained by differentiating the nominal pitch angle θn.
Since feedback control is performed in this way, the compensation resists being influenced by a modeling error.
Hereafter, a pitching motion model will be described in detail. Since a pitching motion is a rotational motion about an axis that is vertical to a traveling direction and also vertical to a road surface (y-axis in the case of setting an x-axis to the traveling direction in a plane parallel to the road surface), A transfer function of front-rear two wheels considering the acceleration is found and a plant model is created. While doing this, a difference of the pitching effect between in-wheel driving and non-in-wheel driving will be described, and effects of anti-dive and anti-lift by the braking force will be also explained. Since in the present invention, identification based on experimental data is performed for the created pitching motion model and the pitching is controlled based on the identified model, an identification method and an experimental result are also described below.
<2a-1> Half Car Model
Pitching is a posture change of the car body, and can be approximated with a model considering only the car body (body on spring). Moreover, since it is a motion in a longitudinal direction, it can be thought in a model of the front-rear two wheels (half car model). Therefore, it can be expressed by a half car model as in
Although a vertical motion is thought in the 1-degree-of-freedom model, since the half car model considers a rotation system, a car body weight m can be replaced with a car body moment of inertia I. In addition, expressing the spring constant k and a damper coefficient c by C, K, respectively, in the half car model, the half car model can be considered equivalent to the 1-degree-of-freedom model. Therefore, a transfer function of the half car model can be expressed as by the following formula (refer to Nonpatent Document 4).
However, I[kgm2] is a moment of inertia about the y-axis of the car body, C[Ns/m] is a damper coefficient, K[N/m] is a spring constant, θ[rad] is a pitch angle, and Pf and Pr[N] are loads applied to front-rear wheels at the time of acceleration, respectively.
The pitch motion occurs when the vehicle is accelerated and decelerated. For this reason, in order to consider the acceleration, a variation of the load by the longitudinal acceleration is thought. Designating the longitudinal acceleration by ax, the loads of the respective wheels under steady motion become the following formulae (refer to Nonpatent Document 5)
However, Pfr, Pfl, Prr, and Prl[N] were loads of the wheels, respectively, Nf and Nr[N] are loads of the front-rear wheels at the time of standstill, respectively, m[kg] is a vehicle weight, h[m] is a height of a point of the center of gravity, and lf, lr[m] are distances from the point of the center of gravity to front/rear wheel shafts, respectively.
Since it is thought in the half car model, loads in the front-rear wheels are thought. At this time, the loads become the next formulae.
Pf and Pr are loads applied to front wheels and rear wheels, respectively. Here, the moment M[nm] about a point of the center gravity of
[Formula 9]
M=P
f
l
f
−P
r
l
r (9)
if Formulae (7), (8) are substituted into Formula (9), which is substituted into Formula (2), it will be expressed as follows.
Since the first term of the right-hand side of the above formula is a moment at the time of standstill, it becomes zero. Thereby, it can be expressed as the following formula.
From the above, a transfer function from the acceleration ax[m/s2] to the pitch angle θ was able to be expressed.
Pitching suppression effect at the time of start <3-1>
holds, and Fd tan φ becomes a force for controlling the pitching and Fs becomes a force actually working.
<3-2> Non-in-Wheel Type Driving
Contrary, in the case of non-in-wheel type driving (drive shaft driving), since the motor is installed on the suspension, it is not necessary to support the rotation force of the motor under the suspension. That is, since under the suspension, a couple of forces is not generated, the action point of the force is concentrated to the center of the wheel (refer to Nonpatent Document 6). Thereby, F3 can be expressed by the following formula similarly with the case of the in-wheel driving.
[Formula 13]
F
s
=F
d tan φ1−Fr (13)
Thereby, in the case of non-in-wheel motor, although a force Fd tan φ1 for controlling the pitching works, since it is φ>φl, it becomes tan φ>tan φl, and it turns out that in in-wheel motor driving, the pitching control effect is larger than that of non-in-wheel driving.
<3-3> Comparison of Pitching Effect by Simulation
For reference, a simulation in the open loop at the time of start is performed in the case of the in-wheel type driving and in the case of drive shaft driving, respectively.
As will be described in later Chapter 5, the simulation was performed based on a pitching model that was found by an identification experiment. In doing this, the acceleration is set to be in the form of a step input with ax=1.0 m/s2 at t=1.0 s, and
At the time of the start, the pitching effect in the in-wheel motor discussed in Chapter 3 can be considered. Since a force by the brake works at the time of the braking and a force by the motor does not work, an anti-dive and anti-lift geometry by the braking force as in the below is thought (refer to Nonpatent Document 7).
At the time of the braking, the braking forces work on the front and rear wheels. Designating a braking force distributed to the front wheel by β, when the total braking force working on the front and rear wheels is F, a front wheel braking force becomes βF and a rear wheel braking force becomes (1−β)F . Since the brake torque is transferred to the suspension through a brake unit, it is thought that a virtual action point of the force is on the ground plane: the anti-dive force βF tan φf works on the front wheel and the anti-lift force (1−β)F tan φr works on the rear wheel.
Modeling is conducted again considering this. The loads of the front and rear wheels are expressed by
respectively, and a moment of the force is expressed as follows because F=−max with running resistance ignored.
M=−2mhαx−(mβlf tan φf+m(1−β)lr tan φr)αx(16) [15]
A transfer function becomes
where the first term of the numerator of the right-hand side is an inertia force and the second term is a term that is appeared by the braking force working on the ground plane. Although this time the pitching control at the time of the braking is performed based on this model, they are identified based on experimental data about the model of the above formula because there are many unknown parameters.
Since the parameters of the model that was found until the preceding paragraph are unknown, it is necessary to identify them. Then, the identification experiment was conducted.
<5-1> Actual Device Specifications
For an experimental machine, a commercially available small-sized electric vehicle EV-1 (Qi(QUNO), a product of CQMOTORS) was modified and is being used.
The motor is controlled using an inverter system manufactured in cooperation with Myway Corporation. Moreover, since a resolution of a hall sensor of the motor is low, vector control is performed by carrying out linear interpolation of a position angle. A sampling period shall be 10 kHz.
<5-2> Parameter Identification
Experimental conditions are such that the acceleration ax is given in a step form and that the braking force may become constant by disposing a member for fixing a brake pedal on the reverse side of it at that time.
Moreover, for the pitch rate θdot, since there is no pitch angle sensor in this laboratory, the experiment was conducted with a yaw sensor attached to the y axis.
As the identification method, in this paper, the parameters of the transfer function are found so that outputs to the inputs of
At this time, the natural angular frequency was ωn=16.7 rad/s and the attenuation constant was C=0.23.
Moreover,
Since Formula (18) is a transfer function of acceleration input and pitch rate output and the pitch rate is a differentiated pitch angle, a transfer function of acceleration input and pitch angle output is expressed as in the following formula.
In the first embodiment, control of pitching used in this model is performed.
Denoting a driving force of the braking force by Fxb and denoting a driving force by the motor by Fxm, it is assumed that Fx can be expressed by the following formula in a driving force dimension.
[Formula 19]
F
x
=F
xb
+F
xm (20)
By dividing both sides of Formula (20) by m, from the formula of Fx=max, it can be expressed by
[Formula 20]
αx=αxb+αxm (21)
axb is an acceleration by the braking force, and axm is an acceleration by the motor. Based on this formula, a control system by a 2-degree-of-freedom control system as in the block diagram of
As simulation conditions, the pitch angle, the pitch rate, a car body speed, and the car body position until the vehicle stops shall be observed by giving the vehicle traveling at a constant speed quick braking at t=1.0 s and later. Moreover, in order to make the simulation have the modeling error, the spring coefficient and the damper coefficient of Pn(s) and P(s) were set as Cn=500 Ns/m, Kn=45500 N/m, C=500 Ns/m, and K=45000 N/m, respectively. The CFF and CFS are designed by the pole assignment technique as a PD controller and a PI controller, respectively.
<6-1> Simulation 1
First,
<6-2> Simulation 2
In order to solve the problem of the simulation 1, a simulation where the control was imposed when the car body speed V became smaller than 1.0 m/s was performed. The results are
Real machine verification was performed for the simulation result of Chapter 6. As conditions in the experiment, quick braking is applied from a constant speed on a dry road, similarly with the identification experiment in Chapter 5. At that time, the braking force was made to become constant. Acceleration axb by the braking force that serves as an input to the nominal plant shall be an output a from the acceleration sensor from which an acceleration axm by the motor that becomes an input to the actual plant is subtracted by Formula (21). For values of the closed loop poles of CFF and CFB, the same values as the case of the simulation were used. A case with the control and a case without the control at that time are compared and examined. Pieces of measured data are the acceleration ax,
[Formula 21]
pitch rate θ·,
a wheel speed Vω, and torque T.
<7-1> Experiment 1
First, an experiment about the simulation 1 of Chapter 6 was conducted. Experimental results at this time are shown in
[Formula 22]
an output pitch rate θ·
from the angular velocity sensor, a pitch angle θ found by pseudo-differentiating the pitch rate with a bypass filter, and the acceleration ax at that time in the case with the control in the case with the control and in the case without the control, and
The experimental results of
Further,
<7-2> Experiment 2
Next, real machine verification in a simulation 2 was performed. Since the experiment was conducted on the dry road, the control was started when the wheel speed reached about 3 km/h assuming that slip was minute.
Also in this case,
Moreover,
In the first embodiment, the acceleration axb by the braking force is derived from the acceleration ax of the car body measured by the acceleration sensor and the acceleration axm by the motor computed based on a current value outputted to the motor. However, since the acceleration axm by the motor is affected by a road surface state in a stricter sense, it is desirable to derive the acceleration considering the road surface state. Thereupon, in a second embodiment, the acceleration ax of the car body is derived from an equation of motion of the vehicle.
This control system computes a nominal acceleration axm from the brake torque Tb computed by a brake torque estimator, and when the nominal acceleration axm is given to the nominal plant Pn(s) it obtains a nominal motor torque Tmn that is ideally controlled by the feedforward controller C1. By applying this to the actual plant P(s) as the motor torque, if the actual plant is the same as the nominal plant, it becomes possible to suppress the pitching by this motor torque.
When there is the modeling error in the nominal plant Pn(s), a motor torque Tm such that a difference between the pitch rate that is an output from the actual plant and the nominal pitch rate that is a derivative value of the pitch angle being an output of the nominal plant Pn(s) is compensated by a feedback controller C2 is applied to the actual plant together with the nominal motor torque Tmn. Thereby, even if there is the modeling error, it becomes possible to have high controllability.
In the second Embodiment, by performing the pitching control on the first embodiment using a brake torque estimated considering the slip ratio, it is possible to perform a further high-accuracy pitching control.
Based on contents of Chapters 1 to 4, a second embodiment will be explained in detail below.
Similarly with the first embodiment, the second embodiment also performs th control based on a model where a moment of a force and a transfer function of acceleration input and pitch rate output are given by Formulae (16), (17), respectively. Since the second embodiment uses an experimental vehicle different from that of the first embodiment, unknown parameters were identified based on a below-mentioned experiment similarly with the case of the first embodiment.
<9-1> Real Machine Specifications
For the experimental machine, a commercially available small-sized electric vehicle EV-3 (COMS LONG BASIC) is modified and is being used. The use of the inverter motor is the same as the experimental vehicle EV-1 used in the first embodiment.
<9-2> Parameter Identification
The experiment was conducted under the same conditions as the case of the first embodiment.
At this time, a natural angular frequency was ω=14.3 rad/s and an attenuation constant was ζ=0.22.
Since Formula (22) is a transfer function of acceleration input and pitch rate output, and the pitch rate is a differentiated pitch angle, a transfer function of acceleration input and pitch angle output becomes Formula (22) that is integrated.
In the first embodiment described above, the acceleration that becomes an input of the plant is obtained by a sum of the acceleration by the motor and the acceleration by the braking force as shown by Formula (21). However, actually, axm is determined by the acceleration and the road surface state. Thereupon, in the present invention, a method for computing the acceleration considering the road surface state is proposed. First, an equation of motion of the vehicle will be shown below.
[Formula 24]
J
ω
{dot over (ω)}=T
m
−rF
d
−T
b (23)
[Formula 25]
m{dot over (V)}=Fd (24)
[Formula 26]
Vω=rω (25)
Variable are: the rotation speed ω[rad/s] of a motor, the car body speed V[m/s], the wheel speed V[m/s], the motor torque Tm[nm], the brake torque Tb[nm], and the driving force Fd[N]. Constants shall be: the car body weight m[kg], the tire radius r[m], the moment of inertia of the wheel rotation part Jω[Nms2]. Obtaining ax from Formula (23) will give the following formula.
In the second embodiment, as a brake torque estimation method, the following two techniques are proposed.
<10-2-1> Estimation Considering Slip Ratio
The method for estimating the brake torque considering the slip ratio will be proposed.
The slip ratio is expressed as follows.
Obtaining the brake torque Tb by eliminating Fd and V from this Formula of the slip ratio (27) and Formulae (23) to (25), it is expressed by Formula (28) when V>Vω holds, and by Formula (29) when Vω>V holds, as described below.
[Formula 30]
T
b
=T
m−{dot over (ω)}(Jω+r2m(1−λ))+r2mω{dot over (λ)} (29)
Assuming that a slip ratio fluctuation is minute and approximating it with λdot=0, Formulae (28), (29) are summarized and can be written as follows, (as Formulae (30), (31)).
<10-2-2> Estimation Using Acceleration Sensor
A method for estimating the brake torque Tb using the acceleration sensor will be shown. From Formula (23) and Formula (24), the brake torque can be found as follows.
[Formula 33]
{circumflex over (T)}
b
=T
m
−J
ω
{dot over (ω)}−rma
x (32)
11.2-Degree-of-Freedom Control
When there is the modeling error, the motor torque Tm such that a difference between the pitch rate that is an output from the actual plant and the nominal pitch rate that is a derivative value of the pitch angle being an output of the nominal plant Pn(s) is compensated by the feedback controller C2 is applied to the actual plant. Thereby, also when there is the modeling error, it becomes possible to have high controllability.
A computer simulation was performed using a brake torque estimation method and a pitching control method that have been shown by the preceding chapter. Parameters used in the simulation are: the car body weight m=480 kg; the wheel radius r=0.22 m; and the wheel rotation part moment of inertia Jω=1.0[Nms2]; the nominal plant Pn(s) is an identified model, and the actual plant P(s) is such that the spring and damper coefficients were C=2450 Ns/m and K=66000 N/m, respectively, in order to make it have the modeling error. Moreover, regarding the controller, C1 and C2 are designed by the pole assignment technique as a PD controller and a PI controller, respectively, and the values of respective closed loop poles were set to 21 rad/s and 10 rad/s, respectively.
The simulation conditions shall be such that when the vehicle is moving at a constant speed of 8.0 m/s on the high μ road, it is decreased in speed by being given a brake torque of 750 Nm, and is observed for a period until the vehicle stops. Moreover, since there was a problem that in the case where the control is always imposed, the braking distance will elongates, the control shall be started when the speed becomes small, and in this time the control shall start to be imposed when the car body speed becomes 1.0 m/s or less.
Next, the experiment was conducted using the real machine actually. Parameters used in the experiment are the car body weight m=480 kg and the wheel radius r=0.22 m, and for the parameters of the nominal plant, the identified values were used. Moreover, regarding the controllers, C1 and C2 were designed by the pole assignment technique as a PD controller and a PI controller, respectively. In this experiment, values of respective closed loop poles were set to 21 rad/s and 10 rad/s, similarly with the simulation.
As described above, since there is a problem that if the control is always imposed, the braking distance will elongates, the control shall be started when the speed becomes small. In this case, it shall be set that the vehicle is decelerated by a brake when it travels at a constant speed of about 28 km/h, and the control starts to be imposed when the car body speed becomes 4.5 km/h or less.
Moreover, although in this embodiment, the slip ratio is found by detecting the car body speed from the front wheels and the wheel speed from the rear wheels for simplification, one that is found by performing estimation of the slip ratio (refer to Nonpatent Document 8) may be used.
Below, experimental results of the pitching control that uses the brake torque estimation method considering the slip ratio and the brake torque estimation method using the acceleration sensor are shown.
Although in the experiment, the member acting as a stopper is disposed on the reverse side of the brake pedal so that the braking force may become constant through the entire experiment, exactly the same braking force is not produced because the brake pedal is pressed down by a human foot, and consequently values of peak to peak are not always the same, becoming as shown in Table 1 as reference values. If a maximum torque of the vehicle is raised, the pitch rate can be further controlled.
Next,
Until the preceding chapter, in a method for estimating the brake torque considering the slip ratio, the estimation was performed assuming that a time variation of the slip ratio λdot was sufficiently small and setting λdot as λdot=0, estimation considering a term of a variation of the slip ratio λdot is thought.
and when Vω>V holds, J(λ) becomes J(λ)=Jacc(λ) and
[Formula 35]
X({dot over (λ)})=r2mω{dot over (λ)}
Next,
Since the time variation of the slip ratio λdot of
The pitching control system, similarly with the first and second embodiments, estimates state variables including the pitch angle through the state observer using a model of computing a pitch angle θ from the moment M about the point of the center of gravity of the motor vehicle based on variations of the loads of the wheels considering the anti-dive force and the anti-lift force, and performs a state feedback control using the estimated values of the state variables. The observer vector K and the feedback vector f are designed using the pole assignment technique.
Moreover, the slip ratio control system uses a slip ratio control based on a wheel speed control, and generates an ideal motor torque Tm based on the slip ratio λ derived from the car body acceleration ax generated by the pitching control system and the wheel speed ω derived from the car body speed V.
The third embodiment will be also explained in detail below, like the second embodiment, based on the contents of Chapters 1 to 4, together with results of a simulation and an experiment conducted using a model that was identified in Chapter 9.
Equations of motions of the front and rear wheels about the respective rotating shafts become as follows.
[Formula 36]
J
ωf{dot over (ω)}f=−rFf−Tb: (33)
[Formula 37]
J
ωr{dot over (ω)}r=Tm−rFr−Tb: (34)
The mechanical brake generally works on four wheels. In this embodiment, it is assumed that brake torques Tb's of the four wheels are equal for simplification,
Moreover, an equation of motion of the car body becomes as follows.
[Formula 38]
mV=Fd (35)
However, Fd becomes Fd=2Ff+2Fr. Moreover, the running resistance shall be ignored. Moreover, the slip ratio is expressed by Formula (27).
In the third embodiment, Magic Formula was adopted as a g-λ curve showing a relation of a friction coefficient between a tire and the road surface and the slip ratio.
In the second embodiment, when obtaining the brake torque and the nominal acceleration, the wheel angular acceleration ωdot was used. However, due to an influence of the low resolution of the hall sensor of the motor, a large noise rides on the wheel angular acceleration obtained by differentiating the rotation angular velocity of the motor. Thereupon, in the third embodiment, by incorporating the slip ratio control system (refer to Nonpatent Document 8) based on the wheel speed control into an inner loop of the pitching control system, the pitching motion and the motion of the wheels are respectively separately controlled. Thereby, it is possible to perform a high-accuracy control considering the road surface state without using ωdot.
Moreover, although in the first and second embodiments, the pitching control systems of a feedforward base have been proposed, in the third embodiment, the state feedback control that uses the observer is used as the pitching control system. Thereby, it becomes stronger also to the influence of the modeling error, etc.
[Formula 39]
Fi=Dsλi (36)
Ds denotes driving stiffness, λi represents the slip ratios of the front wheels and the rear wheels λr, λf, and Fi represents the driving forces Fr, Ff. The command value of a rear wheel slip ratio can be found from this Formula (36) and Formula (35) as follows. Below, the pitching control system and the slip ratio control system that were used in the third embodiment will be explained.
From Formula (37), the rear wheel slip ratio that becomes the command value of the slip ratio control system can be found.
<16-1> Pitching Control by State Feedback
The control object is expressed as follows from Formula (17).
[Formula 41]
x=Ax+Bu (38)
[Formula 42]
y=Cx (39)
Since the above-mentioned system is observable,
[Formula 44]
A−KC
it can be said that a matrix K exists that defines a characteristic value of A−KC to an arbitrary value. Thereupon, the same dimension observer was designed. An observer gain vector found by the pole assignment becomes as follows. However, r1 and r2 are the poles of the observer.
The state feedback control is performed using the state variables estimated by the observer shown above. A feedback matrix is found by the pole assignment like the observer. The found feedback matrix becomes as follows. However, w1 and w2 are the poles of a regulator.
<16-2> Slip Ratio Control Based on Wheel Speed Control
The target wheel speed can be computed from the target slip ratio λ* obtained from the pitching control system and the car body speed. Although it is assumed that the car body speed is detectable from the sensor in this paper, the car body speed may be found by estimating the slip ratio (refer to Nonpatent Documents 8, 10). At this time, since it may be also thought that the wheel speed becomes larger than the car body speed, the case is divided into two cases: a case where the car body speed is larger (Formula (42)); and a case where the wheel speed is larger (Formula (43)).
By this, the slip ratio control is realized by using a rotation speed control including a speed loop outside a current control loop of the motor generally used.
However, since the moment of inertia of the entire car body varies depending on the fluctuation of the slip ratio, if the controller is designed only by the moments of inertia of the wheels, the pole of the controller will vary depending on a variation of the slip ratio. Thereupon, it is necessary to make a control gain variable so that the pole may be kept constant.
Summarizing Formulae (27), (33), and (35) for respective cases V>Vω and Vω>V, these will become as follows.
Formula (45) expresses the case where V>Vω holds and Formula (46) expresses the case where Vω>V holds. The control gain is tuned on-line so that the poles may become constant for these two formulae of Jbrake(λ) and Jaccel(λ).
The simulation was conducted using the above-mentioned vehicle model of Chapter 15 and the control system of Chapter 16. The simulation shall observe the vehicle running on the high μ road way (peak μ=0.9) while a brake torque of 150 Nm is given to the wheels until the vehicle stops. Since there was a problem in the first embodiment that when the pitching control is always worked, a braking distance will elongates, the slip ratio control system shall be operated always while the command value shall be set to λr=−0.04, and when the car body speed becomes 1.5 m/s or less, it shall be switched to the command value of the slip ratio obtained from the pitching control system. Moreover, the parameters were set as: Jωr=1.0 Nms2, Jωf=0.5 Nms2, r=0.22 m, and m=480 kg, and driving stiffness was set to a fixed value, Ds=15000.
First,
As shown in
Next,
An experiment was conducted using a control method hitherto shown. The experiment shall observe the vehicle until the vehicle stops by a mechanical brake during running at about 27 km/h on the high μ road (dry road). At this time, like the simulation, the slip ratio control system is always made to work while the command value is set to λr=−0.06, and from when the car body speed becomes 1.5 m/s or less, the pitching control is started. Moreover, the parameters were set as: Jωr=1.0 Nms2, r=0.22 m, and m=480 kg, and the driving stiffness Ds was set to 15000, a constant value. Furthermore, the setup shall be as follows: the pole of the discretized observer is −0.7 rad/s, the pole of the regulator is −6 rad/s. The pole of slip ratio control shall be −70 rad/s, but from a problem that the slip ratio becomes vibrational in a low speed domain, it shall be switched to −50 rad/s from the time of starting of the pitching control.
In the third embodiment, it is possible to perform the pitching control that considers the road surface state more strictly than the first and second embodiments by incorporating the slip ratio control system using the wheel speed control into an inner loop of the pitching control system. Furthermore, it was also shown from an experimental result that it is possible to install it.
Number | Date | Country | Kind |
---|---|---|---|
2007-054614 | Mar 2007 | JP | national |
2007-213184 | Aug 2007 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2008/053877 | 3/4/2008 | WO | 00 | 9/4/2009 |