The present invention relates to a vehicle, and relates specifically to an attitude control at the time of a turn of a transverse two-wheeled vehicle having two drive wheels arranged to oppose each other, for example.
Vehicles utilizing an attitude control of an inverted pendulum (hereinafter simply referred to as “inverted pendulum vehicle”) have been attracting attention, and are currently on the way to being put to practical use.
For example, Japanese Patent Application Publication No. JP-A-2004-276727 discloses technology of driving on two drive wheels which are coaxially arranged while detecting an attitude of the drive wheel caused by a center-of-gravity movement of a driver.
Japanese Patent Application Publication No. JP-A-2004-129435 discloses a vehicle which moves while controlling the attitude of one conventional circular-shaped drive wheel or one sphere-shaped drive wheel. Patent Document 2 also mentions various inverted pendulum vehicles.
Such vehicles maintain a stopped state or are driven while performing the attitude control based on a weight shift amount of the driver, an operated amount from a remote control or an operating device, driving instruction data input in advance, or the like.
By steering the wheel or providing a differential torque to the two drive wheels, the vehicle makes a turn.
However, compared to a general passenger car, such a one-man vehicle is small in size and narrow in interval between the left and right wheels. The proportion of the weight of an occupant is large with respect to the weight of the entire vehicle, and a center-of-gravity position of the entire vehicle rises when the occupant ensures a seated attitude.
Thus, if a turning speed is too high or a turning radius is too small when the vehicle makes a turn, the vehicle may be tilted excessively due to centrifugal force. Since a vertical load on the inner wheel side decreases, it may cause a slip of the inner wheel if not an overturn.
Since there is a limit in a turning performance in this manner, a restriction value in accordance with a limit value thereof is set to make the turn within that range.
However, when the occupant changes a seated position or the seated attitude or someone else with a different body type rides the vehicle, the limit values of the turning speed and a turning curvature (inverse of the turning radius) also change. Therefore, considering security, it has been necessary to set the restriction value corresponding to the severest condition within a range of expected condition changes, and thus it has not been possible to set a high restriction value suitable for the respective conditions.
Note that a similar problem occurs even in the case where there is absolutely no loading object or in the case of automatic driving with an arbitrary material object thereon.
Thus, an object of the present invention is to provide a transverse two-wheeled vehicle capable of increasing a turning limit value (maximum values of turning speed and turning curvature) and a restriction value thereof.
The above-described object is achieved by providing a vehicle including two drive wheels arranged in opposition to each other. The vehicle includes: a riding portion for accommodating a weight body; center-of-gravity position acquisition means for acquiring a center-of-gravity position; lateral acceleration acquisition means for acquiring a lateral acceleration which is an acceleration component parallel to an axle; movement amount determination means for determining a movement amount of the center-of-gravity position in a left-right direction in accordance with a magnitude of the acquired center-of-gravity position and lateral acceleration; and center-of-gravity movement means for causing the center-of-gravity position to move in accordance with the determined movement amount of the center-of-gravity position.
The vehicle may further include rotation speed acquisition means for acquiring a rotation speed of each of the two drive wheels, and wherein the lateral acceleration acquisition means calculates the lateral acceleration using each of the acquired rotation speeds of the two drive wheels.
The vehicle may further include an accelerometer arranged in the vehicle, wherein the lateral acceleration acquisition means calculates the lateral acceleration using a measured value of the accelerometer.
The vehicle may further include: a load sensor arranged in the riding portion; and a height sensor which measures a height of the weight body, and wherein the center-of-gravity position acquisition means acquires the center-of-gravity position from detected values of the load sensor and the height sensor.
The center-of-gravity position acquisition means may acquire the center-of-gravity position using a disturbance observer.
The vehicle may further include: a load sensor arranged in the riding portion; a height sensor which measures a height of the weight body; direct acquisition means for acquiring the center-of-gravity position from detected values of the load sensor and the height sensor; and indirect acquisition means for acquiring the center-of-gravity position using a disturbance observer, and wherein the center-of-gravity position acquisition means acquires the center-of-gravity position based on values acquired by the direct acquisition means and the indirect acquisition means.
The center-of-gravity movement means may include at least one of: vehicle body tilting means for tilting a vehicle body in the left-right direction; weight moving means for moving a weight in the left-right direction; and riding portion moving means for moving the riding portion in the left-right direction.
The center-of-gravity movement means may include two or more of the vehicle body tilting means, the weight moving means, and the riding portion moving means, and the movement amount determination means may include distribution means for distributing the determined movement amount of the center of gravity to two or more of the vehicle body tilting means, the weight moving means, and the riding portion moving means included in the center-of-gravity movement means.
The distribution means may distribute the determined amount of movement of the center of gravity based on a frequency component.
The present invention has a configuration in which the center-of-gravity position and the lateral acceleration are acquired, and in accordance with values thereof, the amount of movement of the center-of-gravity position in the left-right direction is determined. Then, the center-of-gravity position is caused to move in accordance with the determined amount of movement of the center-of-gravity position. Thus, the turning limit value and the restriction value are increased.
Hereinafter, a preferred embodiment of a vehicle of the present invention will be described in detail with reference to
When a vertical load center point of the vehicle comes outside a range between two drive wheels while making a turn, the vehicle overturns.
Herein, the vertical load center point is an intersection point of a ground and a line parallel to a resultant vector F of centrifugal force and gravitational force applied to the vehicle and passing through a center of gravity. At this time, the direction of the resultant vector F is determined by a lateral acceleration of the vehicle, and further, the lateral acceleration is determined by a turning speed and a turning curvature of the vehicle.
Thus, the position of the vertical load center point, i.e., whether the vehicle overturns, is determined by the center-of-gravity position and the lateral acceleration (the turning speed and the turning curvature) of the vehicle.
By causing the center-of-gravity position of the vehicle to move in a centripetal direction (direction toward a center of a clearance circle), a turning limit value of the vehicle is improved.
The present embodiment includes, as means to improve a turning limit of the transverse two-wheeled vehicle, (a) a turning limit estimation system which obtains the turning limit value and (b) a center-of-gravity position adjustment system which improves the turning limit value.
(a) The turning limit estimation system obtains the turning limit value by estimating the center-of-gravity position of the vehicle with high precision. Also, by estimating or measuring the lateral acceleration of the vehicle, a current driving state is obtained.
Regarding the estimation of the center-of-gravity position, a seated position, weight, or body type of a loading object (occupant, material object, or the like) are measured using measured values of a load meter and a seating height meter, and the center-of-gravity position of the vehicle (displacement from a vehicle body symmetry plane and height) is estimated (as direct estimation) from the measured values. Also, the center-of-gravity position is estimated (as indirect estimation) using a disturbance observer from a control history of a lateral vehicle body tilt control.
The lateral acceleration (magnitude of centrifugal force) is determined by a rotation meter and an acceleration sensor of each wheel.
(b) In the center-of-gravity position adjustment system, the turning limit value is increased by causing the estimated center-of-gravity position to move in the centripetal direction (direction toward the center of the clearance circle).
That is, the center of gravity is caused to move to a position where a vertical load center point S is inside the range between the two drive wheels and a stable turn is possible.
As a mechanism which moves the center of gravity, one or more of i) a vehicle body tilt mechanism, ii) a weight movement mechanism, and iii) a seat parallel movement mechanism are used.
In the case where a plurality of the center-of-gravity movement mechanisms are used, the respective mechanisms are used distinctively according to frequency characteristics and/or a center-of-gravity movement amount is distributed to the respective mechanisms according to frequency components.
Accordingly, in the present embodiment, a faster and smaller turn is made possible with the transverse two-wheeled vehicle, thereby to improve driving performance, stability, and security of a turning operation.
Note that, in this specification, some notations differ from those in the drawings for the sake of convenience. For example, of symbols within a parenthesis after a character such as in d(→Λ) and θ(••), “→” indicates a vector amount (matrix), “Λ” indicates an estimate value, and “•” and “••” indicate first order and second order time derivatives of a character preceding the parenthesis.
As shown in
The two drive wheels 11a and 11b are each driven by a drive motor 12.
On the upper portion of the drive wheels 11a and 11b (hereinafter collectively called “drive wheel 11” in the case of referring to both drive wheels 11a and 11b) and the drive motor 12, a riding portion 13 (seat) is arranged to accommodate a material object, an occupant, or the like as a weight body.
The riding portion 13 is configured of a seat portion 131 where the driver is to be seated, a backrest portion 132, and a headrest 133.
The riding portion 13 is supported by a supporting member 14 fixed to a drive motor case 121 storing the drive motor 12.
An operating device 30 is arranged on the left side of the riding portion 13. The operating device 30 is for instructing acceleration, deceleration, turn, pivot (pivot turn), stop, braking, or the like of the vehicle by an operation of the driver.
The operating device 30 in the present embodiment is fixed to the seat portion 131, but may be configured by a remote control with a wired or wireless connection. The operating device 30 may be arranged on an upper portion of an armrest.
The vehicle in the present embodiment is arranged with the operating device 30. However, in the case of a vehicle which is automatically driven in accordance with driving instruction data determined in advance, a driving instruction data acquisition portion is arranged instead of the operating device 30. The driving instruction data acquisition portion may be configured of, for example, reading means which reads the driving instruction data from various storage media such as a semiconductor memory, and/or communication control means for acquiring the driving instruction data externally by wireless communication.
Note that, although
In the present embodiment, control of acceleration/deceleration and the like is performed by an operation signal output by the operation of the operating device 30. However, for example, the driver may change a forward tilt moment or a tilt angle to the front or back with respect to the vehicle to perform an attitude control and a driving control of the vehicle in accordance with the tilt angle, as shown in Patent Document 1. Alternatively, the two procedures may be switchable.
On the lower side (undersurface side of the seat portion 131) of the riding portion 13, a load meter 51 which is not shown but described later is arranged.
On the back surface (front side of the backrest portion) of the riding portion, a seating height meter 52 which is not shown but described later is arranged.
Between the riding portion 13 and the drive wheel 11, a weight 134 which is not shown but described later is arranged. The weight 134 is configured to be movable in a left-right direction (direction parallel to an axle) by a weight drive actuator 63 described later.
A control unit 16 is arranged between the riding portion 13 and the drive wheel 11.
The control unit 16 in the present embodiment is attached to the lower surface of the seat portion 131 of the riding portion 13, but may be attached to the supporting member 14.
The control unit 16 includes a control electronic control device (ECU) 20 which performs various controls such as the driving/attitude control of the vehicle and a driving control at the time of a turn according to the present embodiment. The control ECU 20 is electrically connected with other devices such as the operating device 30, a driving/attitude control sensor 40, a center-of-gravity position measurement sensor 50, an actuator 60, and a battery.
The battery supplies electric power to the drive motor 12, the actuator 60, the control ECU 20, and the like.
The control ECU 20 is configured of a computer system including a ROM storing data and various programs such as a driving control program, an attitude control program, and a turn control process program according to the present embodiment, a RAM used as a work area, an external storage device, an interface portion, and the like.
The control ECU 20 includes a vehicle body driving control system 21 and a center-of-gravity position control system 23.
The vehicle body driving control system 21 is configured to provide a longitudinal acceleration/deceleration function of controlling the acceleration/deceleration of the vehicle in the front-back direction, and a turning function of turning the vehicle, and includes a lateral acceleration determination system 22 in order to achieve the turning function.
The vehicle body driving control system 21 performs the attitude control, and supplies a command value supplied from the operating device 30 and corresponding to the instruction regarding the front-back direction and the turn to the wheel drive actuator 61.
The lateral acceleration determination system 22 calculates a lateral acceleration a from wheel rotation angles of the two drive wheels 11a and 11b supplied from the driving/attitude control sensor 40 and/or a translational acceleration, and supplies the lateral acceleration a to the center-of-gravity position control system 23.
The center-of-gravity position control system 23 includes a disturbance observer 24 and a center-of-gravity position estimation system 25.
The disturbance observer 24 estimates (as the indirect estimation) the center-of-gravity position of the loading object (occupant or the like) by estimating a disturbance from the supplied lateral acceleration a and a measured value of a vehicle body tilt angle θ1, and supplies the estimate value to the center-of-gravity position estimation system 25.
The center-of-gravity position estimation system 25 determines the type (human, material object, or none) of the loading object from the supplied lateral acceleration and measured values of load distribution and seating height, and estimates (as the direct estimation) a center-of-gravity displacement and height of the loading object according to the type.
Also, the center-of-gravity position estimation system 25 determines the center-of-gravity position of the vehicle from the center-of-gravity displacement and height of the direct estimation and the indirect estimation.
The center-of-gravity position control system 23 determines target values of the vehicle body tilt angle, a weight position, and a riding portion position in accordance with the estimated center-of-gravity position and the magnitude of the lateral acceleration a, and supplies a corresponding command value to the actuator 60 such that actual information of the vehicle coincides with the target values.
The operating device 30 includes a controller 31, and the target value in the vehicle driving is supplied to the control ECU 20 based on the operation of the driver.
The driving/attitude control sensor 40 includes a wheel rotation meter 41 which detects a wheel rotation angle, an accelerometer 42 which detects the translational acceleration of the vehicle, and a vehicle body tilt angle meter 43 which detects the vehicle body tilt angle (roll angle) in the lateral direction.
The detected value of the driving/attitude control sensor 40 is supplied to the vehicle body drive control system 21 and the lateral acceleration determination system 22.
The center-of-gravity position measurement sensor 50 includes the load meter (or a load distribution meter) and the seating height meter (or a shape measuring instrument) used for estimating (as the direct estimation) the center-of-gravity position of the occupant (loading object).
As shown in
The load meter 51 measures the load distribution (eccentricity) on the seat, and supplies the measured value to the center-of-gravity position estimation system 25.
By the arrangement on the lower side of the riding portion 13 (lower side with respect to a seat structure), the load meter 51 is configured to be capable of measuring not only the load of the loading object arranged in the riding portion, but also the load of an material object hooked on the backrest portion 132 or the headrest 133, and the loads of all loading objects arranged in other portions.
The load meter 51 is provided above a riding portion movement mechanism described later to move together with the riding portion 13.
Note that a weight of the vehicle body (hereinafter referred to as “vehicle body weight”) and the center-of-gravity position thereof (hereinafter referred to as “vehicle body center-of-gravity position”) are fixed and determined in advance at the time of designing, and therefore are not subject to the measurement by the load meter 51.
In the present embodiment, as the load meter 51, three or more load meters capable of measuring triaxial components are arranged.
The load meter 51 simultaneously measures the load distribution and the weight, and uses them for the identification of the loading object or a target position (angle) setting of the center-of-gravity position adjustment system.
For estimating the center-of-gravity position of the loading object, setting two load meters in the lateral direction suffices. However, by arranging three or more load meters, a fail-safe function is provided (i.e., measurement is possible even if one load meter fails).
By using the load meters capable of measuring the triaxial components and further utilizing data of the lateral acceleration and a lateral vehicle body tilt angle, the estimation of the center-of-gravity displacement at the time of a turn or when the vehicle body is tilted is made possible.
As shown in
The seating height meter 52 measures the height of the loading object (seating height of the occupant) by performing a scan in a perpendicular direction (height direction) with a mobile (scanning) optical sensor. Accordingly, measurement with high precision becomes possible. The measured value is supplied to the center-of-gravity position estimation system 25.
Note that a plurality of fixed sensors may be arranged in the perpendicular direction to discretely measure the height of the loading object.
Note that the seating height meter 52 in the present embodiment is made capable of measuring the height even if the loading object is largely displaced laterally by arranging a plurality of the optical sensors in the horizontal direction, and provides a fail-safe function by using the measured value of another optical sensor even if one optical sensor fails.
Also, it is possible to estimate the shape of the loading object using the seating height meter 52 of the present embodiment and use the shape for determining the type (human, material object, or none) thereof.
Note that another measuring instrument may be used instead as long as information regarding the center-of-gravity position can be obtained.
For example, as shown in
In
The actuator 60 further includes a vehicle body tilt actuator 62 which controls the vehicle body tilt mechanism, the weight drive actuator 63 which controls the weight movement mechanism, and a riding portion movement actuator 64 which controls the seat parallel movement mechanism, in accordance with the command value supplied from the center-of-gravity position control system 23.
Note that the respective mechanisms will be described later.
A turning limit improvement control process of the vehicle as one embodiment configured as described above will be described next.
The lateral acceleration determination system 22 of the control ECU 20 acquires the wheel rotation angles of the respective drive wheels 11a and 11b from the wheel rotation meter 41 of the driving/attitude control sensor 40, and acquires the translational acceleration from the accelerometer 42. From these pieces of data, the lateral acceleration a of the vehicle body is determined and supplied to the center-of-gravity position control system 23 (step 11).
For the measurement of the lateral acceleration a, there are (1) a method of using a measured value of the wheel rotation meter 41 (angle meter) for each wheel (drive wheels 11a and 11b) and (2) a method of using a measured value of the accelerometer 42.
In this method, a lateral acceleration a(1) is calculated from the rotational speeds of the left and right drive wheels 11a and 11b.
As shown in
a
(1)
=V·ΔV/D Formula 1
V=V
M−(YG/D)ΔV
V
M=(½)(VR+VL)
ΔV=VR−VL
VR=RWωWR
VL=RWωWL Formula 2
Note that the representations of the symbols in Formula 2 are as follows.
ωWR: Right wheel angular speed
ωWL: Left wheel angular speed
RW: Tire contact radius
D: Tread
YG: Displacement of a substantial center-of-gravity position (of which a value in a previous time step is used)
In this method, a lateral acceleration a˜(2) is calculated from the value of the translational acceleration measured by the accelerometer 42.
As shown in
a˜
(2)
=a
t cos θ1+an sin θ1 Formula 3
In the present embodiment, the lateral acceleration a is determined from the lateral acceleration a(1) based on the measured value of the wheel rotation meter 41 and the lateral acceleration a˜(2) based on the measured value of the accelerometer 42.
The vehicle body driving control system 21 determines whether the drive wheel is slipping. In the case where it is determined that it is not slipping, the value a(1) based on the measured value of the wheel rotation meter 41 is used as the lateral acceleration a. In the case where it is determined that it is slipping, the value a˜(2) based on the measured value of the accelerometer 42 is used as the lateral acceleration a.
Hereinafter, a slip determination of the drive wheel of the present embodiment will be described.
First, the vehicle body driving control system 21 calculates a lateral acceleration a˜(1) in the sensor attachment position from the lateral acceleration a(1) in an occupant center-of-gravity position based on the measured value of the wheel rotation meter 41 using the following Formula 4.
Note that hSA in Formula 4 below represents the distance from the pivot center in the vehicle body tilt to the acceleration sensor.
a˜
(1)
=a
(1)+(ΔV/D)2(YG−hSA sin θ1) Formula 4
The vehicle body driving control system 21 performs a calculation of Δa=a˜(1)−a˜(2), and determines that a slip is occurring in the case where an absolute value of Δa is greater than or equal to a predetermined threshold value ε.
Note that which one of the right drive wheel 11a and the left drive wheel 11b is slipping can be determined by the following Formula 5.
a˜
(1)
−a˜
(2)≧ε, when the drive wheel 11a on the right side is slipping.
a˜
(2)
−a˜
(2)≦−ε, when the drive wheel 11b on the left side is slipping. Formula 5
After the lateral acceleration a has been obtained by the lateral acceleration determination system 22, the center-of-gravity position control system 23 measures the seated position, weight, and body type of the loading object (occupant or the like) using a measuring instrument (step 12).
Next, the center-of-gravity position estimation system 25 of the center-of-gravity position control system 23 estimates the center-of-gravity displacement and height of the loading object from obtained data (step 13: direct estimation).
First, the center-of-gravity position estimation system 25 obtains the mass of the loading object based on the load on the riding portion 13 obtained from the load meter 51.
When a loading object mass is mH, a seat mass is mS, an entire mass of the riding portion is shown as mC=mH+mS, and a gravitational acceleration is g in
F
n
=ΣF
n
(k)
=−m
C(g cos θ1+a sin θ1) Formula 6
In Formula 6, Fn(k) represents a tension load measured by a k-th load meter out of N load meters, and a vertical force Fn applied to the riding portion is obtained by taking a sum of the measured values of all of the N load meters.
Also, θ1 is the lateral vehicle body tilt angle measured by the driving/attitude control sensor 40 and a is the lateral acceleration obtained by the lateral acceleration determination system 22. By using these values, the loading object mass can be obtained at the time of a turn and at the time of a tilt.
In the present embodiment, the center-of-gravity position estimation system 25 obtains the loading object mass mH from the following Formula 7 obtained by modifying Formula 6.
m
H=(Fn/(g cos θ1+a sin θ1))=mS Formula 7
The value of the loading object mass mH is used for an overall center-of-gravity position evaluation, the type determination of the loading object, or the target position (angle) setting of the center-of-gravity position adjustment system.
Next, the center-of-gravity position estimation system 25 determines the type (human, material object, or none) of the loading object based on the height of the loading object (the seating height or the height of the material object) obtained from the seating height meter and the loading object mass mH calculated with Formula 7, and estimates a loading object center-of-gravity height hH with a method suitable for the type.
As shown in
(a) It is determined that “none” of the objects is accommodated in the case where mH<0.2 kg and ζH<0.01 m.
(b) It is determined that the loading object is a “human” in the case where mH>8 kg, ζH>0.3 m, and mH/ζH>30 kg/m.
(c) It is determined that the loading object is a “material object” in other cases (cases other than (a) and (b)).
In determination conditions described above, the threshold value of the body weight is as small as 8 kg in the determination condition (b) for a human because a child is also expected to ride the vehicle. By adding the ratio mass (weight per unit seating height shown as mH/ζH) to the determination condition for a human, the accuracy of the determination can be increased.
Note that, in order not to determine a small heavy material object (for example, mass of iron) as a human, mH/ζH<p (for example, 80 kg/m) may be added as a determination condition as an upper limit for a human.
Note that the determination conditions and determination values are examples, and may be appropriately changed and determined in accordance with the expected usage conditions.
The center-of-gravity position estimation system 25 estimates the center-of-gravity height (height from the seat portion 131) hH of the loading object in accordance with the determined type of the loading object as described below. By determining the loading object in this manner and changing an estimation method (evaluation formula) for the center-of-gravity height hH in accordance with the type, the value can be estimated more accurately.
(a) In the case where the loading object is determined as “none,” hH=0.
(b) In the case where the loading object is determined as a “material object,” the center-of-gravity height hH is obtained from the following Formula 8 using an eccentricity γ representing the degree of a downward displacement, assuming that the center of gravity is displaced downward with respect to a geometric center. The eccentricity γ is an assumed value set in advance, and γ=0.4 in the present embodiment.
h
H=((1−γ)/2)ζH Formula 8
(c) In the case where the loading object is determined as a “human,” the center-of-gravity height hH is obtained from Formula 9 with a body type of an average person as a reference.
In Formula 9, ζH,0 and hH,0 are standard values of the seating height and the center-of-gravity height, and ζH,0=0.902 m and HH,0=0.264 m in the present embodiment.
h
H=(ζH/ζH,0)hH,0 Formula 9
Note that, although a case of obtaining the type and the center-of-gravity height of the loading object in accordance with
Next, the center-of-gravity position estimation system 25 obtains a center-of-gravity displacement λH of the loading object in the lateral direction based on the load distribution on the riding portion 13 obtained from the load meter 51 and the loading object mass mH and the loading object center-of-gravity height hH which has been acquired as loading object information.
In
In Formula 10, mc, λc, hc, and ηc=hc+δS respectively represent the mass, the center-of-gravity displacement (distance from a vehicle body axis to the center of gravity), the center-of-gravity height (distance from a seat surface of the seat portion 131 to the center of gravity), and a load meter reference center-of-gravity height (distance from the installation surface of the load meter 51 to the center of gravity) of the entire riding portion, and are shown in Formula 11.
In Formula 10 and Formula 11, mH, λH, hH, ηH=hH+δS represent the mass, the center-of-gravity displacement, the center-of-gravity height, and the load meter reference center-of-gravity height of the loading object, mS, λS, hS, ηS=hS+δS represent the mass, the center-of-gravity displacement, the center-of-gravity height, and the load meter reference center-of-gravity height of the seat, δS represents the thickness of the seat portion 131 (distance from the installation surface of the load meter 51 to the seat surface of the seat portion 131), and g represents the gravitational acceleration.
F
t
=ΣF
t
(k)
=m
c(g sin θ1−a cos θ1)−mHλH(••)+Fet
T
tn=Σ(Fn(k)Y(k))=Fnλc−Ftηc+mHλH(••)(ηH−ηc)−Fet(ηet−ηc) Formula 10
mc=mH+mS
λc=(mHλH+mSλS)/mc
ηc=(mHηH+mSηS)/mc Formula 11
In Formula 10, Fn(k) and Ft(k) are the tension load and a lateral load (component in a direction perpendicular to the vehicle body symmetry plane) measured by the k-th load meter out of the N load meters, and the vertical force Ft, and a lateral force Ft applied to the riding portion are obtained by taking sums from all of the N load meters. Also, Y(k) represents the attachment position (distance from the vehicle body symmetry plane) of the k-th load meter and a moment Ttn applied to the riding portion is obtained by taking a sum of products of Y(k) and Fn(k).
In the same Formula 10, θ1 is the lateral vehicle body tilt angle measured by the driving/attitude control sensor 40, and a is the lateral acceleration obtained by the lateral acceleration determination system 22. By using these values, the center-of-gravity displacement and the center-of-gravity height can be obtained at the time of a turn and at the time of a tilt.
In Formula 10, Fet represents an external force, and corresponds to a force of an external push by a human or a force due to wind. Also, ηet is an application point height (height from the installation surface of the load meter 51) of the external force. These values are unknown. Together with the center-of-gravity displacement λH of the loading object, the two formulas of Formula 10 include three unknown quantities.
Thus, the external force Fet and the application point height ηet cannot be both obtained with accuracy, but assuming one value allows the other value to be determined. For example, assuming an expected position of an aerodynamic center (application point of air resistance) for the application point height ηet thereof enables the magnitude Fet of the air resistance to be evaluated and a value thereof to be used for the driving/attitude control.
In the present embodiment, Fet=0, assuming that the influence of the external force is small. Accordingly, the two formulas of Formula 10 can be changed into a form shown by Formula 12 below. Formula 12 is an algebraic formula, and enables a simple and stable evaluation of the loading object center-of-gravity displacement λH.
That is, the center-of-gravity position estimation system 25 obtains the center-of-gravity displacement λH of the loading object based on Formula 12 (and Formula 11) using the obtained weight mH and the center-of-gravity height hH of the loading object.
λH=(mcλc−mSλS)/mH
λc={Ftηc+FHa(ηH−ηc)+Ttn}/Fn
F
Ha
=F
t
−m
c(g sin θ1−a cos θ1) Formula 12
Along with the direct estimation (steps 12 and 13) of the center-of-gravity displacement λH and height hH of the loading object as described above, the center-of-gravity position control system 23 estimates the disturbance in a center-of-gravity position control using the disturbance observer 24, and estimates (as the indirect estimation) the center-of-gravity displacement and height of the loading object based on a disturbance estimate value thereof (steps 14 and 15).
First, the disturbance observer 24 estimates the “disturbance” from a history of a center-of-gravity position modification control (step 14).
In
In the center-of-gravity position modification control of the present embodiment, the controller of
The model is an object of the center-of-gravity position modification control when respective expected values (nominal values) of the mass and the center-of-gravity height of the loading object are mH(n) and hH(n), the center of gravity thereof is on the vehicle body axis, and the vehicle is being driven to proceed straight. That is, an amount of influence on the center-of-gravity position control system caused by three factors of the center-of-gravity displacement of the loading object, a difference from the expected value (nominal value) of a dynamic parameter (the mass, the center-of-gravity height, or the inertia moment) of the loading object, and the centrifugal force caused by a turn is assumed as a disturbance d(→), and the values of the mass, the center-of-gravity height, and the center-of-gravity displacement of the loading object are estimated based on the estimate value d(̂→) thereof.
Hereinafter, a derivation of a formula necessary for obtaining the disturbance estimate value d(̂→) will be described.
Respective symbols used in
θ1: Vehicle body tilt angle
ξB: Balancer position (displacement from a vehicle body center)
ξSL: Riding portion position (displacement form the vehicle body center)
τ1: Vehicle body tilt torque (actuator output)
SB: Weight drive force (actuator output)
SSL: Riding portion drive force (actuator output)
g: gravitational acceleration
a: lateral acceleration (value in the substantial center-of-gravity position)
m1: Vehicle body tilted portion total mass (for movable portions considering the occupant)
mB: Weight mass
mSL: Riding portion mass (considering the occupant)
l1: Vehicle body tilted portion basic center-of-gravity distance (distance from the pivot center)
lB: Weight basic center-of-gravity distance (a distance from the pivot center)
lSL: Riding portion basic center-of-gravity distance (distance from the pivot center)
J1: Vehicle body tilted portion inertia moment (value for around the pivot center and considering the occupant)
D1: Viscous friction coefficient with respect to a pivot motion of the vehicle body tilted portion
DB: Viscous friction coefficient with respect to a translational motion of the weight
DSL: Viscous friction coefficient with respect to a translational motion of the riding portion
mH: Loading object mass
λH: Loading object center-of-gravity displacement
lH: Loading object center-of-gravity distance
JH: Loading object inertia moment (value for around the pivot center)
A superscript (n) indicates that a value is the expected value (nominal value) of a parameter value regarding the occupant.
In
In Formula 13, xS(→) is a basic state, u(→) is the input, and Pu is an input application route, and these are shown by Formula 14. Also, MS, CS, and KS are parameter matrices representing dynamic characteristics of the system, and are shown in Formula 16. Note that I represents a unit matrix.
In Formula 13, d(→) represents the disturbance, and is shown in the following Formula 16 as a sum of three values of a disturbance da(→) due to centrifugal force at the time of a turn, a disturbance dλ(→) due to the center-of-gravity displacement of the loading object, and a disturbance dΔ(→) due to the difference in the dynamic parameter of the loading object.
Also, Pd is a disturbance entrance route, and is shown in the following Formula 17.
Next, by expressing Formula 13 of the dynamic model in a form of a state equation, Formula 18 is obtained.
A state variant vector x(→) and respective matrices in Formula 18 are as shown in Formula 19.
A disturbance observer for obtaining the estimate value d(̂→) for the disturbance d(→) of the controlled object model of Formula 18 is shown by the following Formula 20.
In Formula 20, u(→) is the input, x(→) is the state amount, and a superscript (k) indicates a value of a time step in discrete data, i.e., at a time t which equals kΔt (Δt being a discrete-time unit).
The disturbance observer 24 obtains the disturbance estimate value d(→) from the input u(→) and the state amount x(→) using the disturbance observer of Formula 20 developed as described above.
In Formula 20, L is a feedback gain (matrix) of the observer, and a value thereof is determined by, for example, a pole placement method in consideration of convergence time and stability of the estimate value. Generally, since shortening an estimate time (convergence time of the estimate value) causes a decrease in the stability thereof, a certain amount of time is necessary for the estimation.
The observer shown by Formula 20 is a minimum dimension observer, and is capable of estimating the disturbance with a small calculation amount (short calculation time) by directly using an observed value for the state amount x(→). Note that, in the case where a robustness of estimation calculation is prioritized even though the calculation amount is large, a perfect dimension observer using an estimated amount thereof may also be used for the state amount x(→).
Also, in the present embodiment, although all state amounts x(→) are acquired as the outputs y(→), i.e., it is expected that y(→)=x(→), an estimate value may be used for a part of the state amounts for the purpose of reducing the number of necessary sensors or the like.
The disturbance estimate value d(Λ→) estimated as described above is supplied from the disturbance observer 24 to the center-of-gravity position estimation system 25.
The center-of-gravity position estimation system 25 estimates the mass and the center-of-gravity position (the center-of-gravity displacement and height) of the loading object based on the disturbance estimate value d(̂→) (step 15).
By organizing Formula 16 described above, the disturbance d(→) can be shown as a product of a disturbance coefficient matrix Λ and a state amount vector η(→) as shown in Formula 21.
{right arrow over ({circumflex over (d)}
(k)
={right arrow over (z)}
(k)
+L{right arrow over (x)}
(k)
{right arrow over (z)}
(k)
={right arrow over (z)}
(k-1)
−Δt{right arrow over (q)}
(k)
{right arrow over (q)}
(k)
=L{D{right arrow over (z)}
(k-1)+(A+DL){right arrow over (x)}(k)+B{right arrow over (u)}(k)} Formula 21
First, the center-of-gravity position estimation system 25 obtains the disturbance coefficient matrix Λ using a least-squares method based on Formula 21 showing the details of the disturbance.
That is, the disturbance coefficient matrix Λ is obtained from the following Formula 22 using a time history (k=1 to N) of a disturbance estimate value d(k)(̂→) and a state amount vector η(k)(→) at a reference time shown as Tref=(N−1)Δt
In Formula 22, accelerations (angular accelerations) θ1(••) and ξSL(••) of the state amount vector η(→) are obtained by a difference in position (angle) or speed (angular speed) obtained by the sensor.
For the reference time Tref, a time longer than an estimated convergence time (estimated time) of the observer needs to be set.
Note that, in Formula 22, a correlation of η(→) may not be considered, i.e., the calculation may be simplified by approximating a non-diagonal component of a tensor product η(→)η(→) of the state amount vector to zero.
Next, the center-of-gravity position estimation system 25 obtains a loading object mass deviation Δ(mH) and a loading object first moment deviation Δ(mHlH) as deviations (differences from the expected values) of the dynamic parameters of the loading object from respective components of the obtained disturbance coefficient matrix Λ.
As is clear from the notation of the disturbance coefficient matrix Λ in Formula 21, the two loading object parameter deviations Δ(mH) and Δ(mHlH) correspond to a plurality of elements of the disturbance coefficient matrix Λ, and a value of the parameter deviation can be obtained from either one.
In contrast to such redundancy, a more accurate evaluation of the parameter deviation is achieved in the present embodiment by providing each element of the disturbance coefficient matrix Λ with a variance (degree of variability of the value) of the corresponding state amount as a weight. This is a result of taking into consideration that the value of the element of the disturbance coefficient matrix Λ can be evaluated more accurately as a time fluctuation (variability of the value) of the element of the state amount vector η(→) increases in the least-squares method of Formula 22.
That is, the loading object mass deviation Δ(mH) and the loading object first moment deviation Δ(mHlH) are obtained respectively from Formulas 23 and 24.
In Formulas 23 and 24, Λij represents an element in an i-th row and a j-th column of the disturbance coefficient matrix Λ, and weights W2, W3, W4, W5, and W6 for respective evaluation values based thereon are shown in Formula 25.
Note that, in these formulas, m1 represents the mass of the vehicle body tilted portion, l1 represents the basic center-of-gravity distance from the vehicle body tilted portion, mSL represents the riding portion mass, g represents the gravitational acceleration, a represents the lateral acceleration, θ1 represents the vehicle body tilt angle, ξSL represents the riding portion position, and x(−) represents a time average value of x in the reference time Tref.
Finally, the center-of-gravity position estimation system 25 obtains the mass mH, the center-of-gravity height hH, and the center-of-gravity displacement λH of the loading object according to the following Formula 26 from the obtained loading object mass deviation Δ(mH) and the loading object first moment deviation Δ(mHlH).
Note that g represents the gravitational acceleration in Formula 26.
pLow[1]=FLPF[p[1](k);f2], pLow[2]=FLPF[p[2](k);f2] Formula 26
After the estimate values of the mass and the center-of-gravity position of the loading object from the direct estimation (steps 12 and 13) and the estimate values of the same from the indirect estimation (steps 14 and 15) have been acquired by the center-of-gravity position estimation system 25 in this manner, the center-of-gravity position control system 23 determines a mass and a center-of-gravity position of the entire vehicle based on both estimate values (step 16).
First, the center-of-gravity position control system 23 determines the respective parameter values to be applied to the control by the following steps of (i) to (iv) from the direct estimate value of the measuring instrument and the indirect estimate value of the observer for the mass mH, the center-of-gravity height hH, and the center-of-gravity displacement λH of the loading object. In this manner, a more accurate estimation of the parameter value is achieved by using the estimate values of the two estimation methods distinctively or in combination.
The disturbance observer 24 cannot estimate the parameter value with high precision if a change in the state amount is large to a certain degree and there is not enough observation time. Thus, at the time of a control start (between the start of control until a set time T1) or at the time of a moderate driving, the direct estimate value is applied directly to the control and is provided to the disturbance observer 24 as a default value.
Note that, regarding a determination on whether the driving state is “moderate,” a current driving state is determined to be moderate when an inequality shown in the following Formula 27 is satisfied, for example.
In Formula 27, Wo is a threshold value set in advance, and the driving state is determined based on this value. Also, a represents the lateral acceleration, θ1 represents the vehicle body tilt angle, ξSL represents the riding portion position, g represents the gravitational acceleration, l1 represents (the nominal value of) the vehicle body tilted portion basic center-of-gravity distance, and a suffix (k) represents the time step.
In the present embodiment, regarding the two estimate values from the direct estimation and the indirect estimation, one estimate value is used as a fail determination index for the estimation system of the other.
That is, the center-of-gravity position control system 23 determines that one of the estimate values is abnormal in the case where a difference between the two estimate values is large (greater than or equal to a predetermined value). After a detailed examination, the estimation system with a higher possibility of abnormality is assumed to have failed, and the estimate value of the other is adopted.
Note that the two estimate values may be constantly used as a fail-safe determination index, independently from the other (i), (iii), and (iv).
Regarding a determination on which one of the two estimate values is abnormal, the direct estimation system using the measuring instrument is determined to be abnormal when at least one of conditions shown by the following Formula 28 and Formula 29 is satisfied, for example.
Formula 28 shows a condition for detecting an unnatural change in an output value, and Formula 29 shows a condition for detecting a non-output state. In the two formulas, p[1] represents a parameter estimate value (one of the mass, the center-of-gravity height, and the center-of-gravity displacement of the loading object) of the measuring instrument. Also, p[1]max is a threshold value of the determination condition, and an appropriate value is set in advance.
(iii) Distinctive Use According to Frequency Component
In the direct estimation (steps 12 and 13) and the indirect estimation (steps 14 and 15), there are respective evaluable upper limit frequencies.
That is, there is an upper limit frequency f1 based on performances (character frequency or responsive performance) of the respective sensors for the direct estimation using the measuring instrument, and there is an upper limit frequency f2 based on an estimate value convergence speed (estimated time) determined by the feedback gain for the indirect estimation using the observer.
In the present embodiment, as shown in
First, a frequency component which is greater than or equal to the measuring instrument measurement limit f1 in the direct estimation is not taken into consideration.
Next, for a frequency component which is greater than or equal to the stable estimation limit f2 of the observer, the estimate value of the direct estimation is adopted. For a frequency component less than or equal to the stable estimation limit f2, the two estimate values are taken into consideration to determine the value of the parameter to be used for the control.
The frequency categorization can be achieved by using two low-pass filters. In the case where the parameter estimate value of the direct estimation is p[1] and the parameter estimate value of the indirect estimation is p[2], a high frequency component pHigh of the direct estimate value and low frequency components pLow[1] and pLow[2] of the direct estimate value and the indirect estimate value can be extracted for the two estimate values p[1] and p[2] by Formula 31 and Formula 32, respectively.
m
H=ωm[1]mH,Low[1]+ωm[2]mH,Low[2]+mH,High(ωm[1]+ωm[2]=1)
λH=ωλ[1]λH,Low[1]+ωλ[2]λH,Low[2]+λH,High(ωλ[1]+ωλ[2]=1)
h
H=ωh[1]hH,Low[1]+ωh[2]hH,Low[2]+hH,High(ωh[1]+ωh[2]=1) Formula 30
In Formulas 30 and 31, FLPF[x(k);fc] is a function representing the low-pass filter, while x(k) represents a filtered variable, and fc represents a cutoff frequency. The low-pass filter FLPF can be provided by a first filter as shown by the following Formula 32, for example. Note that Ts represents a sampling period in Formula 32.
pLow[1]=FLPF[p[1](k);f2], pLow[2]=FLPF[p[2](k);f2] Formula 32
Depending on a type (the mass mH, the center-of-gravity displacement λH, or the center-of-gravity height hH) of the estimated parameter, which one of the direct estimate value and the indirect estimate value is more accurate, i.e., the reliability thereof, differs.
Thus, in the present embodiment, a weight that has been set in advance according to the reliability thereof is assigned to the low frequency component of each parameter estimate value. When the weight for the direct estimate value is ω[1] and the weight for the indirect estimate value is ω[2], the mass mH, the center-of-gravity displacement λH, and the center-of-gravity height hH of the loading object as the parameter values to be applied to the control are obtained by the following Formula 33.
An example of set values of the weights for the two estimate values shown in
Riding portion mass mH: ωm[1]=0.9 as direct estimation weight, and ωm[2]=0.1 as indirect estimation weight
Riding portion center-of-gravity displacement λH: ωλ[1]=0.5 as direct estimation weight, and ωλ[2]=0.5 as indirect estimation weight
Riding portion center-of-gravity height hH: (ωh[1]=0.3 as direct estimation weight, and ωh[2]=0.7 as indirect estimation weight
After the mass mH, the center-of-gravity displacement λH, and the center-of-gravity height hH as the dynamic parameters of the loading object have been determined, the center-of-gravity position control system 23 obtains the center-of-gravity position of the entire vehicle including the vehicle body and the loading object (occupant or the like).
First, the center-of-gravity position control system 23 obtains the center-of-gravity position of the vehicle in a state where the respective center-of-gravity position adjustment mechanisms are not operated, i.e., in a state where the vehicle body is not tilted and the weight and the riding portion are in the center (reference position), as shown in
Note that, hereinafter, the state described above is called the basic state, and the center-of-gravity position of the vehicle in this state is called a basic center-of-gravity position.
A mass m of the vehicle, and a basic center-of-gravity displacement λ and a basic center-of-gravity distance l as the basic center-of-gravity position are obtained from the following Formula 34.
In Formula 34, mH, λH, hH, and lH=hH+l0 respectively represent the mass, the center-of-gravity displacement, the center-of-gravity height, and the center-of-gravity distance of the loading object. Herein, l0 is the distance from the pivot center of the vehicle body tilt to the seat surface of the seat portion 131. Also, mCB and lCB respectively represent the mass and the center-of-gravity distance of the vehicle body. Note that the center-of-gravity displacement of the vehicle body is shown as λCB=0.
m=m
H
+m
CB
λ=mHλH/m
l=(mHlH+mCBlCB)/m Formula 34
Next, the center-of-gravity position control system 23 obtains the center-of-gravity position of the vehicle in a state where the respective center-of-gravity position adjustment mechanisms are operated, i.e., in a state where the vehicle body is tilted and the weight or the riding portion is moved from the center (reference position), as shown in
Note that, hereinafter, the state described above is called the adjusted state, and the center-of-gravity position of the vehicle in this state is called a substantial center-of-gravity position.
When the pivot center of the vehicle body tilt is a reference point, a displacement YG in an axle direction from the reference point and a displacement ZG in the perpendicular direction are obtained from the following Formula 35 based on the entire mass m, the basic center-of-gravity displacement λ, and the basic center-of-gravity distance l.
In Formula 35, θ1 represents the vehicle body tilt angle, mSL represents the mass moved by the riding portion movement mechanism, ξSL represents the riding portion position, mB represents the mass moved by the weight movement mechanism, and ξB represents the weight position.
Y
G
=l sin θ1+λ0 cos θ1
Z
G
=l cos θ1−λ0 sin θ0
λ0=λ+(mSLξSL+mBξB)/m Formula 35
After the center-of-gravity position of the vehicle has been determined based on the respective estimate values, the center-of-gravity position control system 23 sets a center-of-gravity position modification amount based on the center-of-gravity position and the lateral acceleration (step 17).
As shown in
The basic vertical load eccentricity β is a value in which λGF is nondimensionalized with D/2 representing a half tread. If −1<β<1, the basic vertical load center point exists between the two drive wheels 11.
By knowing the stability in the basic state where the respective center-of-gravity position adjustment mechanisms are not operated in this manner, whether an adjustment of the center-of-gravity position is necessary can be determined easily, and an unnecessary center-of-gravity position adjustment or offset operation (operation of a plurality of mechanisms in which effects thereof are offset) of the center-of-gravity position adjustment mechanisms can be avoided.
The basic vertical load eccentricity β, the basic vertical load center position λGF, and a lateral acceleration aBC in the basic center-of-gravity position are obtained by the following Formula 36.
In Formula 36, RW is the tire contact radius, D is the tread (distance between the two drive wheels 11a and 11b), YG is a substantial center-of-gravity displacement, λ, is the basic center-of-gravity displacement, l is the basic center-of-gravity distance, θ1 is the vehicle body tilt angle, ΔV is a wheel rotation circumferential speed difference, and g is the gravitational acceleration.
β=λGF/(D/2)
λGF=λ−(aBC/g)(1+RW)
a
BC
=a+(ΔV/D)2(YG−λ+RW sin θ1) Formula 36
Note that Formula 36 takes into consideration a change of an acceleration value due to the difference of the center-of-gravity position in the basic state and a substantial state. However, in the case where the measured value of the accelerometer is used (in the case of a slip), a correction of the acceleration is not performed, and aBC=a.
From a value of the basic vertical load eccentricity β obtained from Formula 36, the stability of the vehicle in the basic state can be determined as follows.
(a) β=0 . . . Neutral state which is the most stable state
(b) |β|>1 . . . Vehicle body overturn in which the vehicle body overturns in a direction of displacement of a basic vertical load point
(c) ⊕β|<βslip . . . One wheel slip in which the drive wheel on the far side from the basic vertical load point slips (and there is a high possibility of the vehicle spinning and overturn as a result)
The threshold value βslip in the condition (c) for the one wheel slip can be obtained from the following Formula 37.
In Formula 37, aBC is the lateral acceleration in the basic center-of-gravity position, g is the gravitational acceleration, λGF is the tire contact radius, and m is the mass of the vehicle. Also, τW* represents a drive torque of the drive wheel on the far side from the basic vertical load center point.
ΔβLow*=FLPF└Δβ0*;f1┘
ΔβHigh*=Δβ0*−ΔβLow*=ΔβB* Formula 37
In Formula 37, μ is a friction coefficient between the tire and the ground surface. An expected value set in advance is provided in the present embodiment, but a measured value of a measuring instrument, an estimate value of an observer, or the like may also be used.
As is clear from Formula 37, βslip is smaller than 1. That is, in the case where the drive torque is provided, one wheel slips before the vehicle overturns. Thus, in the present embodiment, the slip limit βslip is a stable limit.
Next, the center-of-gravity position control system 23 determines a vertical load eccentricity modification amount Δβ* based on the obtained basic vertical load eccentricity β.
The center-of-gravity position control system 23 obtains the vertical load eccentricity modification amount Δβ* from
In Formula 38, βsafe is an eccentricity restriction value, and the adjustment of the center-of-gravity position is not performed unless the basic vertical load eccentricity β exceeds this value. Accordingly, unnecessary energy consumption for a fine movement of a vertical load point can be eliminated, and a rocking behavior of the riding portion 13 and the loading object can be suppressed.
The eccentricity restriction value βsafe is set by the following Formula 39, for example.
βsafe=βslip/Csafe Formula 39
In Formula 39, Csafe is a security coefficient. By making this value greater than 1, i.e., setting βsafe to be lower than βslip, security is ensured with respect to error in measurement or estimation of the center-of-gravity position or the lateral acceleration or to high frequency fluctuation which cannot be dealt with by the respective center-of-gravity position adjustment mechanisms. In the present embodiment, this value is shown as Csafe=1.5.
Note that, within a range of a security region where |β*|<βsafe, another modification value determination method may be used instead of Formula 38. For example, as the most secure and fully-supported condition, it may be such that β*=−β (β*=0).
Next, the center-of-gravity position control system 23 allocates the calculated vertical load eccentricity modification amount Δβ* to the center-of-gravity position adjustment mechanisms (step 18).
The present embodiment includes the vehicle body tilt mechanism, the weight movement mechanism, and the riding portion movement mechanism as mechanisms for adjusting the center-of-gravity position, and the respective mechanisms have the following characteristics.
The vehicle body tilt mechanism is effective for a slow and large fluctuation in a low frequency region since the target inertia is large, and can tilt the riding portion and the occupant (riding portion) together with the vehicle. This advantageous effect can be used in adjusting the lateral acceleration sensed by the occupant.
The weight movement mechanism is effective for a fast and small fluctuation in a high frequency region since the mass of the weight is smaller than that of the vehicle.
The riding portion movement mechanism is effective for the slow and large fluctuation in the low frequency region in a similar manner to the vehicle body tilt mechanism, but the riding portion and the loading object is not tilted. Accordingly, the center-of-gravity position can be adjusted without the occupant changing an attitude.
The vertical load eccentricity modification amount Δβ* is allocated in consideration of the characteristics described above.
First, the center-of-gravity position control system 23 removes a noise component included in data of the sensor or a super high frequency component having a small influence on a vehicle body motion from the vertical load eccentricity modification amount Δβ*.
That is, as shown in the following Formula 40, the super high frequency component is removed by applying the low-pass filter to the vertical load eccentricity modification amount Δβ*, and a substantial vertical load eccentricity modification amount Δβ0* which is actually used in the center-of-gravity position adjustment mechanism is obtained.
Note that the first filter shown in Formula 32 described above is used as the low-pass filter FLPF, for example. A cutoff frequency f0 thereof is set in advance based on the sampling period of the sensor or the natural frequency of a vehicle motion control.
Next, the center-of-gravity position control system 23 extracts a super high frequency component Δβ*B to be allocated to the weight movement mechanism from the obtained substantial vertical load eccentricity modification amount Δβ0*.
As shown in
Δβ0*=FLPF└Δβ*;f0┘ Formula 41
As shown in Formula 41, the obtained high frequency component Δβ*High of the substantial vertical load eccentricity modification amount is entirely an allocated amount Δβ*B of the weight movement mechanism.
Next, the center-of-gravity position control system 23 distributes the remaining low frequency component Δβ*Low of the substantial vertical load eccentricity modification amount to the riding portion movement mechanism and the vehicle body tilt mechanism in consideration of the lateral acceleration sensed by the occupant (applied to the loading object) at the time of a turn.
First, the center-of-gravity position control system 23 obtains a balanced tilt angle φeq based on the lateral acceleration a of the vehicle.
As shown in
The balanced tilt angle φeq is obtained by the following Formula 42.
In Formula 42, a represents the lateral acceleration, g represents the gravitational acceleration, ΔV represents a left-and-right wheel rotation circumferential speed difference, D represents the tread, YG represents the substantial center-of-gravity displacement of the vehicle, λH represents the basic center-of-gravity displacement of the occupant (loading object), lH represents the basic center-of-gravity distance of the occupant (loading object), θ1 represents the vehicle body tilt angle, and ξSL represents the position of the riding portion.
Note that aH represents the lateral acceleration in the center-of-gravity position of the occupant (loading object). However, in the case where the measured value of the accelerometer is directly used (in the case of a slip), a correction of the acceleration is not performed, and aH=a.
Φeq=tan−1(aH/g)
a
H
=a−(ΔV/D)2(YGH−YG)
Y
GH
=l
H sin θ1+(λH+ξSL)cos θ1 Formula 42
For reference sake, a lateral component (component in the direction perpendicular to the vehicle body symmetry plane) aHt of the acceleration sensed by the occupant is shown by the following Formula 43.
As is clear from Formula 43, when tilting the vehicle body up to the balanced tilt angle, i.e., when θ1=φeq, the occupant no longer senses a lateral force.
a
Ht=(√(a2+g2))sin(φeq−θ1) Formula 43
Next, the center-of-gravity position control system 23 determines a target value θ1* of the vehicle body tilt angle based on the calculated balanced tilt angle φeq.
In Formula 43, the lateral acceleration aHt sensed by the occupant (applied to the loading object) is determined by the balanced tilt angle φeq (and the lateral acceleration a of the vehicle) corresponding to the magnitude of the centrifugal force applied to the occupant (loading object) and the vehicle body tilt angle θ1 equivalent to the tilt of the occupant (loading object).
Thus, by changing the vehicle body tilt angle θ1, the arbitrary lateral acceleration aHt can be provided.
In the present embodiment, the target value θ1* of the vehicle body tilt angle is determined using
Accordingly, a reduction of load on the occupant due to a large centrifugal force and recognition of a turning state by the occupant sensing a part of the centrifugal force can both be achieved.
{right arrow over (u)}={right arrow over (u)}*+K({right arrow over (x)}−{right arrow over (x)}*) Formula 44
In Formula 44, CSA and φ0 are parameters, for which values set in advance are used.
Herein, CSA is an acceleration change detection coefficient, and represents the ratio of an increases or decrease of a sensible acceleration with respect to an increase or decrease of the lateral acceleration.
Also, φ0 is a deadband upper limit value. By using this value as a threshold value for the balanced tilt angle φeq, switching of a determination method of the vehicle body tilt angle target value θ1* according to the magnitude of the balanced tilt angle φeq (lateral acceleration a) as described below is achieved.
(a) In the case where the balanced tilt angle φeq is small, i.e., the centrifugal force is small (|φeq<|φ0|), the vehicle body is not tilted (the target tilt angle is shown as θ1*=0).
Accordingly, a small rocking behavior of the attitude or a field of view of the occupant can be prevented.
Also, energy necessary for tilting the vehicle body (riding portion 13) can be saved. Particularly, it is effective for a case where the vehicle body (riding portion 13) is tilted using a slide screw actuator.
(b) In the case where the balanced tilt angle φeq is large, i.e., the centrifugal force is large (|φeq|>|φ0|), the vehicle body is tilted to some degree.
Accordingly, the load on a body of the occupant due to the centrifugal force and mental anxiety of the occupant for an overturn of the vehicle body or a fall of oneself can be reduced.
By not tilting the vehicle body to the balanced tilt angle (|θ1*|<|φeq|), the occupant can sense that the vehicle is in the turning state.
Further, by increasing a difference between the vehicle body tilt angle target value θ1* and the balanced tilt angle φeq as the balanced tilt angle (centrifugal force) increases, i.e., providing a tilt (CSA>0) smaller than a tilt of a line where θ1*=eq (having complete balance) in
Note that a vehicle body tilt angle target setting function shown in Formula 44 or
The function may also be stored as a conversion table from the balanced tilt angle φeq to the vehicle body tilt angle target value θ1* so that the vehicle body tilt angle target value θ1* is determined in accordance with the conversion table.
Further, the vehicle body tilt angle target setting function may be switched according to a preference of the occupant or the type of the loading object.
In the case of switching according to the preference of the occupant, a parameter change input device may be installed in the operating device 30 so that the parameter of the vehicle body tilt angle target setting function is changed continuously or discretely by an operation by the occupant, for example.
In the case of switching according to the type of the loading object, switching may be performed as follows based on an estimation result of the type of the loading object in step 13 (
(a) If the loading object is a “human,” Formula 44 or a function shown in
(b) If the loading object is a “material object,” the vehicle body is constantly tilted to the balanced tilt angle φeq to prevent a roll or a fall of the material object.
(c) If “none” of the objects is accommodated, the vehicle body is constantly not tilted to prevent a waste of energy.
Next, the center-of-gravity position control system 23 distributes the low frequency component ΔβLow* of the substantial vertical load eccentricity modification amount to the vehicle body tilt mechanism and the riding portion movement mechanism based on the determined target value θ1* of the vehicle body tilt angle.
A vehicle body tilt mechanism allocated amount ΔβCL* and a riding portion movement mechanism allocated amount ΔβSL* of the substantial vertical load eccentricity modification amount are respectively determined by Formula 45 and Formula 46.
Accordingly, security with respect to a vehicle body overturn provided by the vertical load eccentricity modification amount ΔβLow* and riding comfortableness of the occupant provided by the vehicle body tilt angle target value θ1* can both be ensured.
In Formulas 45 and 46, a represents the lateral acceleration, g represents the gravitational acceleration, D represents the tread, RW represents the tire contact radius, l represents the basic center-of-gravity distance of the vehicle, and λ represents the basic center-of-gravity displacement of the vehicle.
ΔβSL*=ΔβLow*−ΔβCL* Formula 46
Finally, the center-of-gravity position control system 23 performs a preventing process of an offset operation with respect to the vehicle body tilt mechanism allocated amount ΔβCL* and the riding portion movement mechanism allocated amount ΔβSL* of the substantial vertical load eccentricity modification amount.
Accordingly, an unnecessary offset operation (operation of offsetting the effects of each other) of the two mechanisms, particularly movement of the riding portion such that the vertical load center point departs from the most stable position, can be prevented.
The set values ΔβCL* and ΔβSL* of the allocated amounts of the respective mechanisms are modified only in the case where an unnecessary operation is performed in light of such respective conditions.
(a) In the case where ΔβCL*·ΔβSL*>0, the two mechanisms operate (perform the cooperative operation) to move the center of gravity (vertical load center point) in the same direction. In this case, the allocated amounts ΔβCL* and ΔβSL* of the two mechanisms both do not need to be modified.
(b) In the case where ΔβCL*·ΔβSL*<0, the two mechanisms operate (perform the offset operation) to move the center of gravity (vertical load center point) in opposite directions. This condition is further divided into the following two conditions.
(b1) In the case where ΔβLow*·ΔβCL*>0, the vehicle body tilt mechanism operates in the same direction as a direction of a target center-of-gravity movement for the entire system, but the riding portion movement mechanism operates in the opposite direction. Since this operation is meaningless, the allocated amount of the riding portion movement mechanism is modified as ΔβSL*=0 to prevent the opposite operation of the riding portion. Note that the allocated amount ΔβCL* of the vehicle body tilt mechanism does not need to be modified.
(b2) In the case where ΔβLow*·ΔβCL*<0, the vehicle body tilt mechanism operates in the opposite direction from the direction of the target center-of-gravity movement for the entire system. This operation is pointless regarding the center-of-gravity movement, but contributes to the riding comfortableness of the occupant. Thus, in this case, the allocated amounts ΔβCL* and ΔβSL* of the two mechanisms are both not modified. Note that, in the case where a reduction in energy consumption caused by the operation of each mechanism is prioritized over an improvement in riding comfortableness of the occupant, the vehicle body is not tilted, i.e., it may be modified as ΔβCL*=0.
After the allocated amounts of the substantial vertical load eccentricity modification amount for the respective mechanisms of the vehicle body tilt mechanism, the weight movement mechanism, and the riding portion movement mechanism have been determined, the center-of-gravity position control system 23 moves the respective mechanisms according to the allocated amounts, and causes the center-of-gravity position to move, thereby performing modification of the allocated amounts (steps 19 to 21).
The center-of-gravity position control system 23 adjusts the center-of-gravity position by tilting the vehicle body to the target tilt angle θ1* using the vehicle body tilt mechanism (step 19).
The vehicle body tilt angle target value θ1* is determined by the following Formula 47 based on the allocated amount ΔβCL* of the substantial vertical load eccentricity modification amount distributed to the vehicle body tilt mechanism in step 18.
In Formula 47, a is the lateral acceleration, g is the gravitational acceleration, RW is the tire contact radius, D is the tread, l is the basic center-of-gravity distance of the vehicle, and λ is the basic center-of-gravity displacement of the vehicle.
Note that the vehicle body tilt angle target value θ1* is already obtained with Formula 44 in step 18, and the previously obtained value may be used directly if there is no modification for ΔβCL* from that point.
The vehicle body tilt mechanism functions as riding portion tilting means, and causes the center of gravity of the vehicle to move by tilting a part of the vehicle body including the riding portion 13 in the lateral direction. This mechanism is suitable for causing the center of gravity to move slowly and largely since the mass (inertia) of the movable portion is large. It is also possible to adjust the degree of centrifugal force sensed by the occupant by using the fact that the riding portion and the occupant also tilt together with the vehicle body.
The vehicle body tilt mechanism of
The link mechanism 70 includes an upper portion link 71 and a lower portion link 72, and both ends of the two links 71 and 72 are respectively shaft-supported by support shafts 80a to 80d of the drive wheels 11a and 11b.
Note that drive motors 12a and 12b are attached with a supporting member for supporting the support shafts 80a to 80d by welding or the like.
In this manner, the link mechanism 70 is configured as a four link mechanism in a parallelogram with the upper portion link 71 and the lower portion link 72 respectively as the upper side and the lower side and the drive motor 12a and the drive motor 12b as two lateral sides.
A support shaft 80e is provided in the center of the upper portion link 71, and a stator 63 of the tilt motor (vehicle body tilt actuator) 62 is arranged in the center of the lower portion link 72.
On a lower side end portion of a connection link 75 arranged in an upper portion of the riding portion 13, a rotor 64 of the tilt motor 62 is fixed, and the support shaft 80e of the upper portion link 71 is fixed in the middle of the connection link 75.
In the link mechanism 70 configured in this manner, driving the tilt motor 62 causes deformation of the parallelogram of the link mechanism 70 such that the riding portion 13 is tilted along with the tilt of the connection link 75.
The vehicle body tilt mechanism shown in
A fixed shaft 91 and a slider shaft 92 are fixed to the two drive wheels 11a and 11b. A lower side end portion of a riding portion support shaft 95 of which an upper end portion is provided with the riding portion 13 is shaft-supported by a support shaft 80h in the center of the fixed shaft 91.
A slider 93 which is capable of a reciprocating motion in the horizontal direction along the slider shaft 92 is arranged in the slider shaft 92. The slider 93 and the riding portion support shaft 95 are connected by a connection shaft 94.
By the movement of the slider 93, the riding portion support shaft 95 and the riding portion 13 are tilted with the support shaft 80h as a fulcrum.
In the vehicle body tilt mechanism shown in
In this manner, the vehicle body is tilted to an arbitrary angle by the mechanism which tilts the vehicle body with one point on the center axis of the vehicle body as a center, the actuator which provides a torque τ1 around the center axis, and a sensor which measures the tilt angle of the vehicle body.
At this time, a displacement of the vertical load center point at the balanced tilt angle can be eliminated by causing the height of the pivot center to coincide with the axle and tilting the tire in accordance with the tilt of the vehicle body.
In the case where the tire is not tilted, the displacement of the vertical load center point at the balanced tilt angle can be reduced by bringing the pivot center closer to the ground.
Note that the vehicle body tilt mechanism may use other various mechanisms and drive forces. For example, a cam mechanism, a ball screw, an expansion device such as a hydraulic cylinder, or the like may be used to tilt the riding portion 13.
Simultaneously with the operation of the vehicle body tilt mechanism, the center-of-gravity position control system 23 adjusts the center-of-gravity position by moving the weight 134 to a target position ξB* using the weight movement mechanism (step 20).
The target position ξB* of the weight 134 is determined by the following Formula 48 based on the allocated amount Δβ*B of the vertical load eccentricity modification amount distributed to the weight movement mechanism in step 18.
In Formula 48, θ1 is the vehicle body tilt angle, a is the lateral acceleration, g is the gravitational acceleration, D is the tread, m is the mass of the vehicle, and mB is the mass of the weight.
The weight movement mechanism functions as weight moving means, and causes the center of gravity of the vehicle to move by moving the weight in the lateral direction. This mechanism is suitable for causing the center of gravity to move fast and little since the mass (inertia) of the movable portion is small.
The weight movement mechanism is configured to move the weight 134 arranged in the lower portion of the seat portion 131 of the riding portion 13 in the lateral direction (direction perpendicular to the vehicle body symmetry plane).
The weight movement mechanism of
In the weight movement mechanism shown in
The weight movement mechanism shown in
In this manner, a balancer is moved to an arbitrary position by the weight movable in the direction perpendicular to the vehicle body symmetry plane, the actuator which provides the drive force to the weight, and the sensor which detects the position of the weight.
Note that an excessive increase in weight caused by providing this mechanism can be eliminated by using as the weight 134 a weight object (battery, ECU, or the like) originally mounted on the vehicle body.
By increasing the arrangement height of the weight 134, an effect of a counter action on a vehicle body tilt motion caused by the weight movement (acceleration/deceleration) increases. This can also be used for the attitude control.
Simultaneously with the operations of the vehicle body tilt mechanism and the weight movement mechanism, the center-of-gravity position control system 23 adjusts the center-of-gravity position by moving the riding portion 13 to a target position ξSL* using the riding portion movement mechanism (step 21).
The target position ξSL* of the riding portion 13 is determined by the following Formula 49 based on the substantial vertical load eccentricity modification amount ΔβSL* distributed to the riding portion movement mechanism in step 18.
In Formula 49, θ1 is the vehicle body tilt angle, a is the lateral acceleration of the vehicle, g is the gravitational acceleration, D is the tread, m is the mass of the vehicle, and mSL is the mass of the riding portion.
The riding portion movement mechanism functions as riding portion moving means, and causes the center of gravity of the vehicle to move by moving the riding portion in the lateral direction. This mechanism is suitable for slowly and largely moving the center of gravity since the mass (inertia) of the movable portion is large. In the center-of-gravity movement, the riding portion and the occupant do not need to be tilted.
The riding portion movement mechanism is configured to move the riding portion 13 in the lateral direction.
In the riding portion movement mechanism of
In the riding portion movement mechanism of
In the riding portion movement mechanism of
In this manner, the riding portion is moved to an arbitrary position by the riding portion movable in the direction perpendicular to the vehicle body symmetry plane, the actuator which provides the drive force to the riding portion, and the sensor which detects the position of the riding portion.
Note that, by bringing the height of a slider portion closer to the axle, the effect of the counter action on the vehicle body tilt motion caused by the movement (acceleration/deceleration) of the riding portion can be reduced.
Using the respective center-of-gravity position adjustment mechanisms (the vehicle body tilt mechanism, the weight movement mechanism, and the riding portion movement mechanism) described above, the center-of-gravity position control system 23 performs control such that the actual vehicle body tilt angle θ1, weight position ξB, and riding portion position ξSL coincide with the targeted vehicle body tilt angle θ1*, weight position ξB*, and riding portion position ξSL*.
In the present embodiment, the center-of-gravity position control is provided by a state feedback control for all of the center-of-gravity position adjustment mechanisms.
At this time, the input u(→) (the vehicle body tilt actuator output τ1, the weight movement actuator output SB, or the riding portion movement actuator output SSL) provided from each actuator is shown by the following Formula 50.
Components of the state amount x(→) a target state amount x(→*), and a reference input u(→*) in Formula 50 are as shown in Formula 51.
In Formula 50, K is a feedback matrix which is set in advance by, for example, a gain setting method of an optimum regulator in consideration of the convergence time and stability.
Note that change speeds θ1*(•), ξB*(•), ξSL*(•) of the respective target values in the target state amount x(→*) of Formula 51 can be obtained by differences in the respective target values, but may be shown as θ1*(•)=ξB*(•)=ξSL*(•)=0, ignoring the change speeds.
Respective components of the reference input u(→*) show in Formula 51 are obtained from the following Formula 52.
In Formula 52, a represents the lateral acceleration, g represents the gravitational acceleration, mI represents the mass of the vehicle body tilt portion, ma represents the mass of the weight, mSL represents the mass of the riding portion, mH represents the mass of the loading object, and represents the center-of-gravity displacement of the loading object.
In the embodiment described above, an example of a turning limit improvement control for a one-axis two-wheeled vehicle has been described. However, according to the present invention, a method of the turning limit improvement control of the present embodiment may also be applied to a vehicle having three or more wheels.
Number | Date | Country | Kind |
---|---|---|---|
2006-201159 | Jul 2006 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2007/064489 | 7/24/2007 | WO | 00 | 11/27/2009 |