The present invention relates to a vehicle, and for example, relates to a vehicle employing an inverted pendulum for posture control.
Vehicles employing an inverted pendulum for posture control (hereafter simply termed “inverted pendulum vehicles”) have attracted attention. For example, a transportation device disclosed in Patent Document 1 has been developed.
[Patent Document 1] Japanese Patent Application Publication No. JP-A-2004-129435
A sensor unit provided in the transportation device disclosed by Patent Document 1 detects the state of balance and operation of a housing and the transportation device is placed in a stationary or moving state by controlling the operation of a rotating body by a control unit.
Posture control is performed by moving a counterweight (balancer) based on an angle of inclination of a vehicle body.
A vehicle disclosed in Patent Document 1 performs the posture control by moving the balancer in the forward-backward direction. However, a specific control method of the vehicle during an acceleration or deceleration is not disclosed therein.
During the acceleration or deceleration, an anti-torque of a drive wheel and inertial force due to the acceleration act on the vehicle body (invertedly supported body). Thus, the gravity center of the vehicle body needs to be moved in a direction of the acceleration to maintain balance of the vehicle body.
Generally, mass of the balancer is smaller than that of a vehicle body (increase in the mass of the balancer for posture control degrades fuel efficiency), and a moving range of the balancer is limited. Therefore, the amount of gravity center movement due to the movement of the balancer is relatively small. Therefore, to maintain balance of the vehicle body upon high acceleration and deceleration, the vehicle body needs to be largely inclined even when the balancer has moved. If a larger balancer is used to correspond to the acceleration or to reduce the inclination of the vehicle body, because the mass on the vehicle body increases, the rigidity of the vehicle body needs to be increased. This leads to increased weight of the vehicle as a whole, larger vehicle body, and lower fuel efficiency, and thus is not practical.
For example, without a balancer, a vehicle body has to be inclined forward by no less than 20 degrees at an acceleration of 0.4 G.
Due to such an inclination of a vehicle body, a rider has to be also inclined upon rapid acceleration or rapid deceleration and the field of vision of the rider moves through a large vertical range. Thus, riding comfort tends to be adversely affected.
It is therefore an object of the present invention to provide a vehicle employing an inverted pendulum for posture control that is comfortable to ride.
(1) In order to achieve the object, the invention according to claim 1 provides a vehicle characterized by including: a drive wheel; a vehicle body rotatably supported by a rotational axis of the drive wheel; a riding section relatively-movably disposed in the vehicle body; target acquisition means acquiring a target running state; and running control means controlling running while adjusting a gravity center of the vehicle body through rotation of the vehicle body about the rotational axis and movement of the riding section with respect to the vehicle body based on the target running state.
(2) The invention according to claim 2 provides the vehicle according to claim 1 further characterized in that the running control means includes determination means determining drive torque of the drive wheel and movement thrust force for moving the riding section based on the acquired target running state, drive means applying the drive torque determined by the determination means to the drive wheel, and riding section movement means applying the movement thrust force determined by the determination means to the riding section.
(3) The invention according to claim 3 provides the vehicle according to claim 1 characterized by further including: target inclination angle determination means determining a target inclination angle achieved through rotation of the vehicle body based on the target running state; and target position determination means determining, based on the target running state and the target inclination angle, a target position to which the riding section is moved. The running control means controls the running while adjusting the gravity center of the vehicle body through rotation of the vehicle body and movement of the riding section based on the target running state, the target inclination angle, and the target position.
(4) The invention according to claim 4 provides the vehicle according to claim 1 or 2 characterized by further including: target inclination angle determination means determining a target inclination angle achieved through rotation of the vehicle body based on the target running state; target position determination means determining, based on the target running state and the target inclination angle, a target position to which the riding section is moved; inclination angle detection means detecting an inclination angle of the vehicle body; and position detection means detecting a position of the riding section. The determination means determines: drive torque of the drive wheel based on the inclination angle of the vehicle body detected by the inclination angle detection means and the target inclination angle of the vehicle body determined by the target inclination angle determination means; and movement thrust force of the riding section based on the position of the riding section detected by the position detection means and the target position of the riding section determined by the target position determination means.
(5) The invention according to claim 5 provides the vehicle according to claim 2 characterized by further including: target inclination angle determination means determining a target inclination angle achieved through rotation of the vehicle body based on the target running state; target position determination means determining, based on the target running state and the target inclination angle, a target position to which the riding section is moved; inclination detection means detecting an inclination angle of the vehicle body; position detection means detecting a position of the riding section made by the riding section movement mechanism; feedforward output determination means determining feedforward drive torque of the drive wheel based on the target inclination angle, and feedforward movement thrust force of the riding section based on the target position of the riding section; and feedback output determination means determining feedback drive torque of the drive wheel based on a deviation between the target inclination angle determined by the target inclination angle determination means and the inclination angle of the vehicle body detected by the inclination angle detection means, and determining feedback movement thrust force of the riding section based on a deviation between the target position determined by the target position determination means and the position of the riding section detected by the inclination detection means. The determination means determines: the drive torque of the drive wheel based on a sum of the feedforward drive torque and the feedback drive torque; and the movement thrust force of the riding section based on a sum of the feedforward movement thrust force and the feedback movement thrust force.
(6) The invention according to claim 6 provides the vehicle according to any one of claims 1 to 5 characterized by further including a target acceleration acquisition means acquiring target acceleration based on an operation state of an operation member for operating the vehicle. The target acquisition means acquires the target acceleration as the target running state.
(7) The invention according to claim 7 provides the vehicle according to any one of claims 2 to 6 characterized by further including specification means specifying a sensory acceleration. The determination means determines the drive torque and the movement thrust force further based on a degree of the specified sensory acceleration.
(8) The invention according to claim 8 provides the vehicle according to claim 1 or 6 characterized by further including a balancer, and a balancer movement mechanism moving the balancer. The running control means controls the running while adjusting the gravity center of the vehicle body through the rotation of the vehicle body about the rotational axis, movement of the balancer with the balancer movement mechanism, and the movement of the riding section with respect to the vehicle body.
(9) The invention according to claim 9 provides the vehicle according to claim 8 further characterized in that the running control means controls the running while adjusting the gravity center of the vehicle body through inclination of the vehicle body and movement of the balancer when the acquired target acceleration is smaller than a predetermined threshold value, and through the inclination of the vehicle body and the movement of the riding section while the balancer is fixed at a movable limit position based on a direction of the target acceleration when the acquired target acceleration is equal to or greater than the predetermined threshold value.
(10) The invention according to claim 10 provides the vehicle according to any one of claims 1 to 9 characterized by further including mass acquisition means acquiring a mass of the riding section including a weight body on the riding section. The running control means controls the running while adjusting the gravity center of the vehicle body based on the mass of the riding section acquired by the mass acquisition means.
(11) The invention according to claim 11 provides a vehicle characterized by including: a drive wheel; a vehicle body rotatably supported by a rotational axis of the drive wheel; a riding section relatively-movably disposed in the vehicle body; target acquisition means acquiring a target running state; drive means driving the drive wheel; riding section movement means moving the riding section; and running control means controlling running while adjusting a position of a gravity center of the vehicle body by controlling at least one of drive by the drive means and movement of the riding section by the riding section movement means based on the target running state. The running control means determines drive torque of the drive wheel based on a low-frequency component of a change in the target running state, and determines movement thrust force for moving the riding section based on a high-frequency component of the change in the target running state.
(12) The invention according to claim 12 provides the vehicle according to claim 11 characterized by further including specification means specifying a sensory acceleration. The running control means determines the drive torque and the movement thrust force further based on a degree of the specified sensory acceleration.
(13) The invention according to claim 13 provides the vehicle according to claim 11 or 12 characterized by further including: target inclination angle determination means determining a target inclination angle achieved through rotation of the vehicle body based on the acquired low-frequency component of the target running state; and target position determination means determining, based on the target running state and the target inclination angle, a target position to which the riding section is moved. The running control means determines drive torque of the drive wheel based on the determined target inclination angle, and movement thrust force for moving the riding section based on the determined target position.
(14) The invention according to claim 14 provides a vehicle characterized by including: a drive wheel; a vehicle body rotatably supported by a rotational axis of the drive wheel; a riding section relatively-movably disposed in the vehicle body; target acquisition means acquiring a target running state; drive means driving the drive wheel; riding section movement means moving the riding section; vehicle speed detection means detecting a vehicle speed; and running control means controlling running while adjusting a position of a gravity center of the vehicle body by controlling at least one of drive by the drive means and movement of the riding section by the riding section movement means based on the target running state. The running control means controls at least one of the drive and the movement of the riding section so that an angle of rotation of the vehicle body increases in proportion to the vehicle speed.
(15) The invention according to claim 15 provides the vehicle according to claim 14 characterized by further including specification means specifying a sensory acceleration. The determination means determines the drive torque and the movement thrust force further based on a degree of the specified sensory acceleration.
(16) The invention according to claim 16 provides the vehicle according to claim 14 characterized by further including: target inclination angle determination means determining a target inclination angle achieved through rotation of the vehicle body based on the target running state; and target position determination means determining, based on the target running state and the target inclination angle, a target position to which the riding section is moved. The determination means determines the drive torque and the movement thrust force based on the target running state, the target inclination angle and the target position regarding the reference.
(17) The invention according to claim 17 provides a vehicle characterized by including: a drive wheel; a vehicle body rotatably supported by a rotational axis of the drive wheel; a riding section relatively-movably disposed in the vehicle body; target acquisition means acquiring a target running state; drive means driving the drive wheel; riding section movement means moving the riding section; determination means determining drive torque of the drive wheel and a movement thrust force for moving the riding section based on the acquired target running state; and running control means controlling running while adjusting a position of a gravity center of the vehicle body by controlling the drive by the drive means with the determined drive torque and controlling the movement of the riding section by the riding section movement means with the determined movement thrust force. When directions of a drive torque required for vehicle body posture control and a drive torque required for vehicle running control are different from each other, the determination means determines, based on the acquired target running state, one of the drive torques as the drive torque of the drive wheel, and determines the movement thrust force based on the other drive torque and the target running state.
(18) The invention according to claim 18 provides the vehicle according to claim 17 characterized by further including specification means specifying a sensory acceleration. The determination means determines the drive torque and the movement thrust force further based on a degree of the specified sensory acceleration.
(19) The invention according to claim 19 provides a vehicle characterized by including: a drive wheel; a vehicle body rotatably supported by a rotational axis of the drive wheel; a riding section relatively-movably disposed in the vehicle body; target acquisition means acquiring a target running state; drive means driving the drive wheel; riding section movement means moving the riding section; disturbance detection means detecting a disturbance acting on the vehicle body; and running control means controlling running while adjusting a position of a gravity center of the vehicle body by controlling, based on the target running state, at least one of drive by the drive means and movement of the riding section by the riding section movement means. The running control means determines drive torque of the drive wheel based on a high-frequency component of the disturbance, and determines movement thrust force for moving the riding section based on the acquired target running state and a low-frequency component of the detected disturbance.
(20) The invention according to claim 20 provides the vehicle according to claim 19 characterized by further including specification means specifying a sensory acceleration. The running control means further determines the drive torque and the movement thrust force based on a degree of the specified sensory acceleration.
(21) The invention according to claim 21 provides the vehicle according to claim 19 or 20 characterized by further including a balancer, and a balancer movement mechanism moving the balancer. The running control means determines the drive torque of the drive wheel based on the acquired target running state and a mid-frequency component of the detected disturbance, determines the movement thrust force for moving the riding section based on the acquired target running state and the low-frequency component of the detected disturbance, and determines balancer thrust force applied by the balancer movement mechanism based on the high-frequency component of the detected disturbance.
(22) The invention according to claim 22 provides a vehicle characterized by including: a drive wheel; a vehicle body rotatably supported by a rotational axis of the drive wheel; a riding section relatively-movably disposed in the vehicle body; target acquisition means acquiring a target running state; drive means driving the drive wheel; riding section movement means moving the riding section; running control means controlling running while adjusting a position of a gravity center of the vehicle body by controlling at least one of drive by the drive means and movement of the riding section by the riding section movement means based on the target running state; and first failure detection means detecting a failure of the drive means. When the failure of the drive means is detected, the running control means determines movement thrust force for moving the riding section based on a running acceleration of the vehicle and an inclination angle of the vehicle body, and performs posture control while adjusting the position of the gravity center of the vehicle body with the movement thrust force.
(23) The invention according to claim 23 provides the vehicle according to claim 22 characterized by further including: target inclination angle determination means determining a target inclination angle achieved through rotation of the vehicle body based on the target running state; target position determination means determining, based on the target running state and the target inclination angle, a target position to which the riding section is moved; inclination detection means detecting the inclination angle of the vehicle body; and position detection means detecting a position of the riding section made by the riding section movement mechanism. The running control means determines: drive torque for feedback control of the drive wheel based on a deviation between the target inclination angle determined by the target inclination angle determination means and the inclination angle of the vehicle body detected by the inclination angle detection means; and movement thrust force for feedback control of the riding section based on a deviation between the target position determined by the target position determination means and the position of the riding section detected by the inclination detection means, and when the failure of the drive means is detected, the target position determination means determines the target position based on running acceleration of the vehicle and an inclination angle of the vehicle body.
(24) The invention according to claim 24 provides a vehicle characterized by including: a drive wheel; a vehicle body rotatably supported by a rotational axis of the drive wheel; a riding section relatively-movably disposed in the vehicle body; target acquisition means acquiring a target running state; drive means driving the drive wheel; riding section movement means moving the riding section; running control means controlling running while adjusting a position of a gravity center of the vehicle body by controlling at least one of drive by the drive means and movement of the riding section by the riding section movement means based on the target running state; and second failure detection means detecting a failure of the riding section movement means. When the failure of the riding section movement means is detected, the running control means determines the drive torque of the drive wheel based on a position of the riding section, and performs posture control while adjusting the position of the gravity center of the vehicle body with the drive torque.
(25) The invention according to claim 25 provides the vehicle according to claim 24 characterized by further including: target inclination angle determination means determining a target inclination angle achieved through rotation of the vehicle body based on the target running state; target position determination means determining, based on the target running state and the target inclination angle, a target position to which the riding section is moved; inclination detection means detecting an inclination angle of the vehicle body; and position detection means detecting the position of the riding section made by the riding section movement mechanism. The running control means determines drive torque for feedback control of the drive wheel based on a deviation between the target inclination angle determined by the target inclination angle determination means and an inclination angle of the vehicle body detected by the inclination angle detection means, determines movement thrust force for feedback control of the riding section based on a deviation between the target position determined by the target position determination means and the position of the riding section detected by the inclination detection means, and determines the drive torque by changing a feedback control gain of the feedback based on the acquired target running state and an actual position of the riding section when the failure of the riding section movement means is detected.
(1) In the present invention as claimed in claim 1, the running is performed while adjusting the gravity center of the vehicle body not only through the inclination of the vehicle body but also through the movement of the riding section. Thus, the inclination angle of the vehicle body can be reduced. Therefore, a vehicle comfortable for a rider can be provided.
(2) In the present invention as claimed in claim 2, the drive torque of the drive wheel and the movement thrust force for moving the riding section are determined based on the target running state, and the drive torque is applied to the drive wheel and the movement thrust force is applied to the riding section. Thus, the amount of vehicle body inclination and the position of the riding section can be optimized.
(3) In the present invention as claimed in claim 3, a speed can be controlled with a constant inclination angle of the vehicle body by determining the target position of the riding section and the drive torque based on the target inclination angle of the vehicle body. Thus, the target value can be determined and the control can be performed in the aim of providing a rider a comfortable ride.
(4) In the present invention as claimed in claim 4, the inclination of the vehicle body and the position of the riding section are controlled based on the measured value and the target value. Thus, the gravity center of the vehicle body can be controlled more accurately.
(5) In the present invention as claimed in claim 5, the sum of the feedforward output and feedback output of the drive wheel and the riding section is obtained based on the target inclination angle and the target position. Thus, each state quantity is controlled highly accurately so that steady-state deviations of the state quantities can be reduced. Therefore, the running while adjusting the gravity center can be stably controlled.
(6) In the present invention as claimed in claim 6, the target acceleration as the target state is acquired based on the operation state of the operation member for operating the vehicle. Thus, the running can be performed with a small inclination angle of the vehicle body while corresponding to an acceleration request from a rider.
(7) In the present invention as claimed in claim 7, the sensory acceleration can be specified. Thus, the sensory acceleration can be quantitatively adjusted based on “preference” of the rider.
(8) In the present invention as claimed in claim 8, the balancer is moved in addition to the rotation of the vehicle body about the rotational axis and the movement of the riding section with respect to the vehicle body. Thus, the adjustment of the gravity center of the vehicle body can be controlled more in detail.
(9) In the present invention as claimed in claim 9, the gravity center of the vehicle body is adjusted through the inclination of the vehicle body and the movement of the balancer if the target acceleration is less than a predetermined threshold value. Thus, without moving the riding section and with small amount of vehicle body inclination under low acceleration, the rider can feel an appropriate acceleration.
(10) In the present invention as claimed in claim 10, the mass of the riding section including the weight body on the riding section is acquired and the running is controlled while adjusting the gravity center of the vehicle body based on the acquired mass of the riding section. Thus, the steady-state deviations of the target vehicle movement and the target posture of the vehicle body are reduced as much as possible and the appropriate control can be performed. Therefore, stability and accuracy in the posture control can be improved.
(11) In the present invention as claimed in claim 11, the drive torque of the drive wheel is determined based on the low-frequency component of the change in the target running state and the movement thrust force for moving the riding section is determined based on the high-frequency component of the change in the target running state. Thus, sudden inclination of the vehicle body is prevented and a vehicle that is comfortable to ride can be provided.
(12) In the present invention as claimed in claim 12, the sensory acceleration can be specified. Thus, the sensory acceleration can be quantitatively adjusted based on the “preference” of the rider.
(13) In the present invention as claimed in claim 13, the speed can be controlled with the constant vehicle body inclination angle by determining the target position of the riding section and the drive torque based on the target inclination angle determined by the low-frequency component of the target running state. Thus, the target value can be determined and the control can be performed in the aim of providing a rider a comfortable ride.
(14) In the present invention as claimed in claim 14, at least one of the drive and the movement of the riding section is controlled so that the rotational angle of the vehicle body increases in proportion to the vehicle speed. Thus, large change in the inclination angle of the vehicle body immediately after a rapid deceleration is prevented.
(15) In the present invention as claimed in claim 15, the sensory acceleration can be specified. Thus, the sensory acceleration can be quantitatively adjusted based on the “preference” of the rider.
(16) In the present invention as claimed in claim 16, the drive torque and the movement thrust force are determined based on the target running state, the target inclination angle, and the target position with a state in which the riding section is moved forward and the vehicle body is inclined backward as a reference. Thus, the speed can be adjusted with the constant vehicle inclination angle. As a result, the target value can be determined and the control can be performed in the aim of providing a rider a comfortable ride.
(17) In the present invention as claimed in claim 17, when the direction of the drive torque required for controlling the posture of the vehicle body and the direction of the drive torque required for controlling the running of the vehicle are different, one of the drive torques is determined as the drive torque of the drive wheel based on the acquired target running state, and the movement thrust force is determined based on the other torque and the target running state, so as to be able to correspond to reverse operating condition of the driving torques in the inverted type vehicle.
(18) In the present invention as claimed in claim 18, the sensory acceleration can be specified. Thus, the sensory acceleration can be quantitatively adjusted based on the “preference” of the rider.
(19) In the present invention as claimed in claim 19, the drive torque of the drive wheel is determined based on the high-frequency component of the disturbance, and the riding section is moved based on the acquired target running state and the low-frequency component of the detected disturbance. Thus, vibration caused by the disturbance can be reduced.
(20) In the present invention as claimed in claim 20, the sensory acceleration can be specified. Thus, the sensory acceleration can be quantitatively adjusted based on the “preference” of the rider.
(21) In the present invention as claimed in claim 21, the drive torque of the drive wheel is determined based on the acquired target running state and the mid-frequency component of the detected disturbance, the movement thrust force for moving the riding section is determined based on the acquired target running state and the low-frequency component of the detected disturbance, and the balancer thrust force applied by the balancer movement mechanism is determined based on the high-frequency component of the detected disturbance. Thus, the vibration caused by the disturbance can be prevented more accurately.
(22) In the present invention as claimed in claim 22, if the failure of the drive means is detected, the movement thrust force for moving the riding section is determined based on the running acceleration of the vehicle and the vehicle body inclination angle. The posture is controlled while adjusting the position of the gravity center of the vehicle body with the movement thrust force. Thus, the posture can be maintained with the failed drive means.
(23) In the present invention as claimed in claim 23, when the failure of the drive means is detected, the target position is determined based on the running acceleration of the vehicle and the inclination angle of the vehicle body. The movement thrust force for feedback control of the riding section is determined based on the deviation between the determined target position and the position of the riding section. Thus, the posture can be maintained with the failed drive means.
(24) In the present invention as claimed in claim 24, when the failure of the riding section movement means is detected, the drive torque of the drive wheel is determined based on the position of the riding section and, the posture is controlled while adjusting the position of the gravity center of the vehicle body with the drive torque. Thus, the running can be maintained with the failed drive means.
(25) In the present invention as claimed in claim 25, when the failure of the riding section movement means is detected, the drive torque is determined by changing the feedback control gain based on the acquired target running state and the actual position of the riding section. Thus, the running can be maintained with the failed drive means.
A vehicle according to preferred embodiments of the present invention will be described in detail below with reference to
In this embodiment, the balance (inverted state) of a vehicle body is maintained by moving the riding section including a rider relatively translationally in a longitudinal direction of the vehicle.
Specifically, referring to
As a result, the angle of inclination of the vehicle body accompanied by the acceleration/deceleration can be reduced to provide a comfortable and safe inverted type vehicle.
In a second embodiment, in determining a target vehicle body posture (a vehicle target angle of inclination, a riding section position target value), the angle of inclination of the vehicle body and a riding section movement amount are determined so as to adjust the degree of sensory acceleration. To make the driver feel a strong acceleration, for example, the riding section is moved with a suppressed vehicle body inclination. This allows the vehicle body inclination and the sensory acceleration relative to the acceleration to be adjusted according to preference of the rider.
In addition, in a third embodiment, a riding section movement mechanism and a balancer movement mechanism are used to perform a forward-backward direction running and posture control of the inverted type vehicle.
Specifically, the vehicle body inclination, the riding section position, and the balancer position are controlled according to the target running state to thereby achieve the target running state, while maintaining the balance of the vehicle body. More specifically, if the vehicle target acceleration is smaller than a predetermined value, the vehicle body balance is maintained by movement of the balancer and inclination of the vehicle body. If the vehicle target acceleration is greater than the predetermined value, on the other hand, the vehicle body balance is maintained by the inclination of the vehicle body and movement of the riding section with the balancer moved to its stroke limit.
Referring to
The drive wheels 11a, 11b are driven by drive motors 12a, 12b, respectively.
Note that, one or three or more drive wheels and drive motors may be disposed instead of coaxially disposing two each as described above.
A riding section 13 (seat) that carries a cargo, a rider, or other weight body is disposed above the drive wheels 11a, 11b (a drive wheel 11 to mean both drive wheels 11a, 11b collectively; the same holds true with other elements hereunder) and the drive motor 12.
The riding section 13 includes a seat cushion 131 on which the rider sits, a seat back 132, and a head restraint 133.
The riding section 13 is supported by a support member 14 via a movement mechanism 63. The support member 14 is fixed to a drive motor cabinet in which the drive motor 12 is accommodated.
A linear guide system or other linear movement mechanism having low resistance is, for example, used as the movement mechanism 63. The position of the riding section 13 relative to the support member 14 is to be changed through drive torque of a riding section drive motor.
The linear guide system includes a guide rail fixed to the support member 14, a slider fixed to the riding section drive motor, and a rolling body.
The guide rail includes two trackway grooves formed linearly longitudinally in right and left side surfaces of the guide rail.
The slider has a channel-shaped cross section. Two trackway grooves are formed inside two mutually opposing side surfaces of the channel shape so as to face the two trackway grooves, respectively, in the guide rail.
The rolling body is inserted between the abovementioned trackway grooves, rolling in the trackway grooves as the guide rail and the slider make linear motions relative to each other.
Additionally, the slider includes a return path formed therein, connecting both ends of the trackway grooves, so that the rolling body circulates through the trackway grooves and the return path.
The linear guide system includes a brake (clutch) that fixes the movement of the linear guide system. When the movement of the riding section is not required, such as when the vehicle is not moving, by fixing the slider onto the guide rail with the brake, the relative position between the support member 14 to which the guide rail is fixed and the riding section 13 to which the slider is fixed is maintained. When the movement is required, the brake is released, so that the distance between a reference position on the side of the support member 14 and a reference position on the side of the riding section 13 can be controlled to be a predetermined value.
An input device 30 is disposed beside the riding section 13. The input device 30 includes a joystick 31 disposed thereon.
The rider operates the joystick 31 to issue commands for acceleration, deceleration, turn, on-the-spot rotation, standstill, braking, and other operations of the vehicle.
The input device 30 according to the embodiment is fixed to the seat cushion 131. The input device 30 may instead be configured with a wired or wireless remote control, or disposed on an armrest provided additionally.
The vehicle according to the embodiment includes the input device 30 disposed therein. If the vehicle runs automatically according to predetermined travel command data, a travel command data acquisition section is disposed in place of the input device 30. The travel command data acquisition section may include, for example, data read means acquiring the travel command data from storage media of various sorts such as a semiconductor memory, or/and communication control means acquiring the travel command data externally through wireless communications.
In
A control unit 16 is disposed between the riding section 13 and the drive wheel 11.
In this embodiment, the control unit 16 is mounted on the support member 14.
The control unit 16 may be mounted on a lower surface of the seat cushion 131 of the riding section 13. In this case, the control unit is moved in the forward-backward direction with the riding section 13 by the movement mechanism 63.
The vehicle according to the embodiment includes a battery among other miscellaneous types of devices. The battery, disposed on the support member 14, supplies electric power for drive and arithmetic operations to, for example, the drive motor 12, the riding section drive motor, and a control ECU 20.
In the description given hereunder, a “drive wheel” collectively means the drive wheel 11 and parts fixed to, and rotated with the drive wheel 11; a “vehicle body” means an entire vehicle including a rider, but except the drive wheel, and a “riding section” means the riding section 13 and parts (including the rider) fixed to, and moved translationally with the riding section 13.
In this embodiment, the “riding section” is formed of the riding section 13, the input device 30, and a part of the movement mechanism 63 (linear guide). The control unit 16 or the battery may be disposed on the riding section 13 so as to be included in the “riding section”. This increases weight of the “riding section” and thus produces a greater effect from the movement of the “riding section”.
The control system includes the control ECU (electronic control unit) 20 that functions as running and posture control means, the joystick 31, a vehicle body inclination sensor 41, a drive wheel sensor 51, a drive motor 52 (same as the drive motor 12), a riding section sensor 61, a riding section motor 62 (riding section drive motor), and other devices.
The control ECU 20 includes a main control ECU 21, a drive wheel control ECU 22, and a riding section control ECU 23 and performs various types of controls including the vehicle running and posture control through, for example, a drive wheel control and a vehicle body control (inversion control).
The control ECU 20 is formed of a computer system that includes a ROM that stores therein various programs and data, such as the running and posture control process program in this embodiment, a RAM used as a work area, an external storage device, and an interface.
The main control ECU 21 is connected with the drive wheel sensor 51, the vehicle body inclination sensor 41, the riding section sensor 61, and the joystick 31 as the input device 30.
The joystick 31 supplies the main control ECU 21 with a running command (maneuvering operation amount) based on an operation performed by the rider.
With its upright position defined as a neutral position, the joystick 31 is tilted in the forward-backward direction to command acceleration or deceleration and in the lateral direction to command lateral acceleration during turning. The requested acceleration/deceleration or lateral acceleration is greater with a larger tilt angle.
The vehicle body inclination sensor 41 functions as inclination detection means detecting the angle of inclination of the vehicle body and detects an inclination state of the vehicle body in the forward-backward direction about an axle of the drive wheel 11.
The vehicle body inclination sensor 41 includes an acceleration sensor that detects acceleration and a gyro sensor that detects a vehicle body inclination angular velocity. Accuracy of the vehicle body inclination sensor 41 is enhanced by calculating a vehicle body inclination angle θ1 from a detected vehicle body inclination angular velocity as well as from a detected acceleration. Instead, either one of the sensors may be disposed in the vehicle body inclination sensor 41 and the vehicle body inclination angle or the angular velocity may be calculated from a value detected thereby.
The main control ECU 21 functions as target running state acquisition means that acquires the target running state set as a target. Further, the main control ECU 21 functions as output determination means that determines drive torque of the drive wheel and movement thrust force of the riding section according to the acquired target running state.
The main control ECU 21 functions as target posture determination means that determines a vehicle body inclination angle and a riding section position set as targets according to the target running state based on a signal from the joystick 31.
Additionally, the main control ECU 21 functions as feedforward output determination means that determines a feedforward output of each actuator (the drive motor 52 and the riding section motor 62) according to the target running state and a target posture (the target vehicle body inclination angle and the target riding section position).
Further, the main control ECU 21 functions as feedback output determination means that determines a feedback output of the drive motor 52 according to a deviation in the vehicle body inclination angle between a target value and an actually measured value and a feedback output of the riding section motor 62 according to a deviation in the riding section position between a target value and an actually measured value.
The main control ECU 21 functions with the drive wheel control ECU 22 and the drive motor 52 as drive means and, a drive wheel control system 50 is formed by further including the drive wheel sensor 51 to the drive means.
The drive wheel sensor 51 detects a drive wheel rotation angle (rotation angular velocity) that represents a rotation state of the drive wheel 11 and supplies the main control ECU 21 with the drive wheel rotation angle. The drive wheel sensor 51 of this embodiment is formed of a resolver detecting the drive wheel rotation angle. The rotation angular velocity is calculated using this drive wheel rotation angle.
The main control ECU 21 supplies the drive wheel control ECU 22 with a drive torque command value and the drive wheel control ECU 22 supplies the drive motor 52 with an input voltage (drive voltage) corresponding to the drive torque command value. The drive motor 52 functions as a drive wheel actuator that applies the drive wheel 11 the drive torque according to the input voltage.
Additionally, the main control ECU 21 forms a riding section control system 60 with the riding section control ECU 23, the riding section sensor 61, and the riding section motor 62.
The riding section sensor 61 functions as a position detector detecting a relative position of the riding section and supplies data that represents the detected riding section position (movement speed) to the main control ECU 21. The riding section sensor of this embodiment is formed of an encoder detecting the riding section position. The movement speed of the riding section is calculated from a detected value of the riding section position.
The main control ECU 21 supplies the riding section control ECU 23 with a riding section thrust force command value. The riding section control ECU 23 supplies the riding section motor 62 with an input voltage (drive voltage) corresponding to the riding section thrust force command value. The riding section motor 62 functions as a riding section actuator that applies thrust force for moving the riding section 13 translationally according to the input voltage.
Running and posture control process performed by the vehicle having the above arrangement will be described below.
The entire running and posture control process will first be outlined.
The running and posture control according to this embodiment achieves the target running state, while maintaining the balance of the vehicle body, by controlling the vehicle body inclination or the riding section position according to the running state set as the target including, for example, acceleration/deceleration and stop.
The main control ECU 21 first determines how the vehicle is moved according to an intention of the rider, specifically, the target running of the vehicle (steps 110 to 130).
The main control ECU 21 next determines a vehicle body target posture (the target vehicle body inclination angle and the target riding section position) at which the balance of the vehicle body is maintained (makes the vehicle take an inverted posture) under the determined target running (step 140).
By optimizing the vehicle body inclination amount and the riding section position as described above, the rider can feel an appropriate acceleration, while minimizing the vehicle body inclination to prevent riding comfort from being degraded.
The main control ECU 21 then determines output values of the drive motor 52 and the riding section motor 62 required for achieving the vehicle running state and the vehicle posture set as the target. In accordance with the output values, actual outputs of the drive motor 52 and the riding section motor 62 are controlled using the drive wheel control ECU 22 and the riding section control ECU 23 (steps 150 to 200).
Details of the running and posture control process will next be described.
The main control ECU 21 acquires the maneuvering operation amount (run command) of the joystick 31 operated by the rider (step 110).
The main control ECU 21 then determines a target value of vehicle acceleration (vehicle target acceleration) α* based on the acquired operation amount (step 120). A value proportional, for example, to the forward-backward operation amount of the joystick 31 is defined as the value of the vehicle target acceleration α*.
Using the determined vehicle target acceleration α*, the main control ECU 21 calculates a target value of the drive wheel angular velocity (drive wheel target angular velocity) [θω*](step 130).
Note that code [n] represents a derivative of n with respect to time. For example, the vehicle target acceleration α* is integrated with respect to time and divided by a predetermined drive wheel ground contact radius to arrive at a value as the drive wheel target angular velocity [θω*]J.
The main control ECU 21 next determines the target values of the vehicle body inclination angle and riding section position (step 140). Specifically, the target value of the vehicle body inclination angle (target vehicle body inclination angle) θ1* is determined using Expressions 1 to 3 given below according to the magnitude of the vehicle target acceleration α* determined at step 120.
Then, based on the determined target vehicle body inclination angle θ1*, the target value of the riding section position (riding section target position) λS* is determined using Expressions 4 to 6 according to the magnitude of the vehicle target acceleration α*.
θ1*=φ*−βMax+sin−1(γ sin φ*cos βMax)(α*<−αMax) (Expression 1)
θ1*=(1−CSense)φ*(−αMax≦α*≦αMax) (Expression 2)
θ1*=φ*+βMax+sin−1(γ sin φ*cos βMax)(α*>αMax) (Expression 3)
λS*=−λS,Max(α*<−αMax) (Expression 4)
λS*=l1(m1/mS){tan(φ*−θ1*)+γ(sin φ*/cos(φ*−θ1*))}(−αMax≦α*≦αMax) (Expression 5)
λS*=λS,Max(α*>αMax) (Expression 6)
In Expressions 1 to 6, φ*, βMax, and γ are as follows:
φ*=tan−α*
βMax=tan−1(mSλS,Max/m1l1)
γ=M˜RW/m1l1 or M˜=m1+mW+IW/RW2.
α* is the vehicle target acceleration (G). λS,Max is a set value representing the maximum riding section movement amount.
A threshold value αMax is the vehicle target acceleration α* when λS*=λS,Max in Expression 5, specifically, when the riding section has been moved to its stroke limit. The threshold value αMax is a preset value, but cannot be obtained analytically. The threshold value αMax is therefore determined, for example, through iterative calculation or with an approximate expression.
If the vehicle target acceleration α* falls within a range of the threshold value±αMax (−αMax≦α*≦αMax), the target vehicle body inclination angle θ1* is determined using Expression 2 and the riding section target position λS* is determined using Expression 5.
As a result, in the range of (−αMax≦α*≦αMax), the rider can feel an appropriate acceleration while maintaining the balance of the vehicle body by moving the riding section to λS* with the vehicle body inclined at θ1*.
As such, movement of a gravity center position required for achieving the vehicle target acceleration α* is accomplished in the range of the threshold value±αMax by both inclination of the vehicle body and movement of the riding section. Herein, the amounts of movement of the gravity center borne by the inclination of the vehicle body and movement of the riding section are determined by a rider acceleration sensation coefficient CSense in Expressions 2 and 5. The value of CSense is preset to fall within a range of 0≦CSense≦1.
A greater preset value CSense relative to the vehicle target acceleration α* results in a larger target vehicle body inclination angle θ1* (Expression 2) and a smaller riding section target position λS* (Expression 5).
CSense corresponds to the degree of acceleration the rider feels.
Specifically, if CSense=1, the target vehicle body inclination angle θ1*=0 (Expression 2), so that the vehicle body is not inclined at all. The rider therefore directly feels inertial force as a result of acceleration or deceleration of the vehicle.
If CSense=0, θ1*=φ*=tan−1α*, so that the vehicle body is inclined to an equilibrium inclination angle (angle between resultant force of gravity and the inertial force). As a result, the rider feels no inertial force (though downward force increases relative to the rider).
In this embodiment, CSense=p is preset as a value that makes the rider feel an optimum acceleration.
For example, if CSense=1, the movement of the gravity center position required for achieving the vehicle target acceleration α* is accomplished only by the movement of the riding section 13, and the vehicle runs with the vehicle body controlled to maintain an upstanding position.
When the riding section movement amount reaches the stroke limit±λS,Max, specifically, if the vehicle target acceleration α*<−αMax or α*>αMax, the balance is maintained by further inclining the vehicle body as shown in
Note that, if the riding section movement amount has not reached the stroke limit, the vehicle body inclination angle may, instead, be limited.
(Modified example of determination of the target vehicle body inclination angle θ* and the riding section target position λS*)
The above embodiment has been described for the case, in which the target vehicle body inclination angle θ1* and the riding section target position λS* are determined by selecting, from the relationship between the vehicle target acceleration α* and the threshold value±αMax, any one of Expressions 1 to 3 and any one of Expressions 4 to 6.
The target vehicle body inclination angle θ1* and the riding section target position λS* may, instead, be determined through a target value determination process shown in
The main control ECU 21 first calculates the target vehicle body inclination angle θ1* corresponding to the vehicle target acceleration α* using Expression 2 (step 10).
Using the determined θ1* and Expression 5, the main control ECU 21 calculates the riding section target position λS* (step 11) and determines whether the obtained λS* falls within the range of −λS,Max≦λS*≦λS,Max over which the riding section can move (step 12).
If the calculated value λS* falls within the range over which the riding section can move (step 12; Y), the main control ECU 21 determines θ1* obtained in step 10 to be the target vehicle body inclination angle and λS* obtained in step 11 to be the riding section target position, respectively (step 13), before terminating the process.
If the calculated value λS* falls outside the range over which the riding section can move (step 12; N), the main control ECU 21 determines the maximum riding section movement amount±λS,Max to be the riding section target position λS* (step 14).
The main control ECU 21 again calculates θ1* that corresponds to the vehicle target acceleration α* using Expression 1 or 3 and determines this to be the target vehicle body inclination angle θ1* (step 15), before terminating the process.
According to the target value determination process described above, the target vehicle body inclination angle θ1* and the riding section target position λS* can be determined without using the threshold value αMax for determining which expression to be used among Expressions 1 to 3 and Expressions 4 to 6.
In this embodiment, Expressions 1 to 6 that are strictly theoretical expressions are used to determine the vehicle body target posture. A simpler expression may be used instead. For example, linearized expressions of Expressions 1 to 6 may be used. Further, instead of using the expressions, a map may be prepared in advance representing a relationship between the vehicle target acceleration α* and the vehicle body target posture and the vehicle body target posture may be determined using that map.
More complicated relational expression may also be used. For example, a relational expression may be established, with which: if an absolute value of the vehicle target acceleration α* is equal to, or smaller than a predetermined threshold value, the riding section is moved without inclining the vehicle body at all; and inclination of the vehicle body starts as the absolute value exceeds the predetermined threshold.
Note that, in this embodiment, the maximum forward movement amount of the riding section from a reference position is equal to the maximum rearward movement amount of the riding section from the reference position. Instead, these movement amounts may be different from each other. For example, if the maximum rearward movement amount is greater than the maximum forward movement amount, braking performance can be improved over acceleration performance. In this case, similar control as described above can be achieved easily by correcting the threshold value αMax to correspond to each of limit values.
Returning to the running and posture control process (
Specifically, each target value is differentiated with respect to time or integrated with respect to time to calculate a drive wheel rotation angle target value θW*, a vehicle body inclination angular velocity target value [θ1*], and a riding section movement speed target value [λS*].
Next, the feedforward output of each actuator is determined (step 160). The main control ECU 21 uses the following Expression 7 to determine a feedforward output τW,FF that is estimated to be required for achieving the vehicle target acceleration α*. Note that, M˜ in Expression 7 represents gross mass of the vehicle in which a rotational inertia component of the drive wheel is incorporated.
Additionally, Expression 8 is used to determine a feedforward output SS,FF of the riding section motor 62 from each of the target values. SS,FF corresponds to riding section thrust force required to prevent the riding section from being moved by gravity so as to stay at the target position at the target vehicle body inclination angle θ1*.
τW,FF=M˜RWgα* (Expression 7)
S
S,FF
=−m
S
g sin θ1* (Expression 8)
Each state quantity can be more accurately controlled by applying the feedforward outputs obtained by Expressions 7 and 8.
Note that this method is particularly effective in decreasing steady-state deviation of the state quantity. An integral gain may, instead, be given in feedback control (step 190).
The main control ECU 21 next acquires each state quantity from each sensor (step 170). Specifically, the drive wheel rotation angle (rotation angular velocity) is acquired from the drive wheel sensor 51, the vehicle body inclination angle (inclination angular velocity) is acquired from the vehicle body inclination sensor 41, and the riding section position (movement speed) is acquired from the riding section sensor 61.
Additionally, the main control ECU 21 calculates remaining state quantities (step 180). Specifically, the drive wheel rotation angle (rotation angular velocity), the vehicle body inclination angle (inclination angular velocity), and the riding section position (movement speed) are integrated or differentiated with respect to time to calculate the remaining state quantities.
The main control ECU 21 then determines a feedback output of each actuator (step 190).
Specifically, Expression 9 is used to determine a feedback output τW,FB of the drive motor 52 and Expression 10 is used to determine a feedback output SS,FB of the riding section motor 62, based on a deviation between each target value and actual state quantity.
In Expressions 9 and 10, K** is a feedback gain and, for example, an optimum regulator value is preset for each feedback gain K**. In addition, an integral gain may be introduced to eliminate the steady-state deviation as described earlier.
τW,FB=−KW1(θW−θW*)−KW2([θW]−[θW*])−KW3(θ1−θ1*)−KW4([θ1]−[θ1*])−KW5(λS−λS*)−KW6([λS]−[λS*]) (Expression 9)
S
S,FB
=−K
S1(θW−θW*)−KS2([θW]−[θW*]KS3(θ1−θ1*)−KS4([θ1]−[θ1*])−KS5(λS−λS*)−KS6([λS]−[λS]) (Expression 10)
Some of the feedback gains may be zeroed to simplify the expressions. For example, τW,FB=−KW2([θW]−[θW*])−KW3(θ1−θ1*) may be used in place of Expression 9 and SS,FB=−KS5(λS−λS*) may be used in place of Expression 10.
Finally, the main control ECU 21 gives each element control system a command value (step 200) and returns to a main routine.
Specifically, the main control ECU 21 supplies the drive wheel control ECU 22 with a sum (τW,FF+τW,FB) of the feedforward output τW,FF determined in step 160 and the feedback output τW,FB determined in step 190 as a drive torque command value τW. Further, the main control ECU 21 supplies the riding section control ECU 23 with a sum (SS,FF+SS,FB) of the feedforward output SS,FF and the feedback output SS,FB as a riding section thrust force command value SS.
Accordingly, the drive wheel control ECU 22 supplies the drive motor 52 with an input voltage (drive voltage) corresponding to the drive torque command value τW to thereby apply the drive wheel drive torque τW.
Similarly, the riding section control ECU 23 supplies the riding section motor 62 with an input voltage (drive voltage) corresponding to the riding section thrust force command value SS to thereby move the riding section.
In the first embodiment, the rider acceleration sensation coefficient CSense is set to a preset value, thereby making a rate of sensory acceleration to vehicle acceleration (target value) constant.
By contrast, the second embodiment allows the degree of sensory acceleration to be quantitatively adjustable according to the preference of the rider. Specifically, in determining the target vehicle body posture, the vehicle body inclination angle and the riding section movement amount are determined such that the degree of sensory acceleration is adjusted according to the preference of the rider. To make the rider feel stronger acceleration, for example, the riding section 13 is moved, while suppressing the vehicle body inclination. This is achieved by making the rider acceleration sensation coefficient CSense variable in Expression 2.
By varying the rider acceleration sensation coefficient CSense as described above, various types of requirements by various types of riders can be met, while ensuring stability in posture control, so that an even more comfortable inverted type vehicle can be provided.
Referring to
The control mode input device 32 includes a switch for selecting a control mode. The following two control modes are available: a smooth mode in which the vehicle body inclination is suppressed with greater sensory acceleration; and an active mode in which the vehicle body inclination is large with suppressed sensory acceleration.
The control mode selected by the rider is supplied to a main control ECU 2121 from the control mode input device 32.
As shown in
In the active mode, on the other hand, by setting CSense to a value close to 0, for example 0.25, suppressed sensory acceleration is provided with large vehicle body inclination (while the forward-backward movement width of the riding section becomes small).
Though the second embodiment provides the two different control modes, more modes (for example, three modes including CSense=0.5, or five modes further including CSense=1 and 0) may further be provided.
Further, the coefficient CSense may be varied according to a numeric value (required vehicle body inclination degree) input by the rider. In this case, the control mode input device 32 includes a dial type analog input device or a touch panel type digital input device.
Running and posture control process performed in the second embodiment having above arrangement will be described below with reference to a flowchart of
In the running and posture control in the second embodiment, the main control ECU 21 first determines, as in the first embodiment, how the vehicle is moved according to the intention of the rider, specifically, the running target of the vehicle (steps 110 through 130).
The main control ECU 21 then acquires a control mode signal (step 131) and determines the rider acceleration sensation coefficient (step 132). Specifically, the main control ECU 21 recognizes the control mode specified by the driver through the control mode input device 32 and sets a value corresponding to the specified control mode for the rider acceleration sensation coefficient CSense (see
The main control ECU 21 next determines the target vehicle body inclination angle θ1* and the riding section target position λS* (step 140). In the second embodiment, the vehicle body target posture is determined using the vehicle target acceleration α* and the set rider acceleration sensation coefficient CSense. Specifically, Expressions 1 to 3 are used to determine the target vehicle body inclination angle θ1* and expressions 4 to 6 are used to determine the riding section target position λS*.
In the second embodiment, as in the first embodiment, the target value determination process described with reference to
Similarly as in the first embodiment, the main control ECU 21 hereafter determines the output values of the drive motor 52 and the riding section motor 62 for achieving the vehicle running state and vehicle body posture set as targets; then, according to the values determined, controls the actual outputs of the drive motor 52 and the riding section motor 62 using the drive wheel control ECU 22 and the riding section control ECU 23 (steps 150 to 200) before returning to the main routine.
According to the second embodiment, whether to accelerate or decelerate while inclining the vehicle body or moving the seat can be quantitatively adjusted to suit the “preference” of the rider.
The “preference” varies depending on the mood or situation at the specific moment. Thus, adjustments should be successively made according to follow the variation. In addition, it is difficult to have the rider adjust parameters of a complicated control system and, moreover, during sudden acceleration or deceleration, the seat or the vehicle body needs to be largely inclined against requirements of the rider in order to achieve stability of the vehicle body posture control. In view of these problems, this embodiment allows the riding comfort to be adjusted easily by changing only one parameter, so as to achieve the control in which consecutive adjustments can be made and stability during heavy acceleration or deceleration is ensured.
A third embodiment will be described below.
The first and second embodiments have been described for the case, in which the movement of the gravity center position relative to the vehicle target acceleration α* is accomplished through inclination of the vehicle body and movement of the riding section. In the third embodiment, a balancer as a weight body different from the riding section is moved in the forward-backward direction to perform the running and posture control of the inverted type vehicle in the forward-backward direction.
Specifically, the target running state is achieved while maintaining the balance of the vehicle body by controlling the vehicle body inclination, the riding section position, and the balancer position according to the target running state, including acceleration/deceleration and stop.
Although omitted in the description of the third embodiment, the rider acceleration sensation coefficient CSense may be variable according to the sensory acceleration the rider prefers as in the second embodiment.
Referring to
The balancer sensor 71 supplies the main control ECU 21 with data representing a balancer position. The main control ECU 21 supplies the balancer control ECU 24 with a balancer thrust force command value. The balancer control ECU 24 supplies the balancer drive actuator 62 with an input voltage (drive voltage) corresponding to the balancer thrust force command value.
The third embodiment otherwise has the same arrangements as the first embodiment described with reference to
The balancer movement mechanism functions as weight body movement means and forms a part of the vehicle body. The balancer movement mechanism moves the balancer 134 as a weight body in the forward-backward direction to move the gravity center of the vehicle body.
The balancer 134 is disposed between the riding section 13 and the drive wheel 11. The balancer 134 can be moved in the forward-backward direction (a direction perpendicular to a vehicle body central axis and the axle) by the balancer drive actuator 62.
The balancer movement mechanism of
As another embodiment, the balancer movement mechanisms shown in
In the balancer movement mechanism of
In the balancer movement mechanism of
As still another example of the balancer movement mechanism, an extendable actuator may be used to move the balancer 134.
Two extendable actuators may, for example, be used. Each of the two extendable actuators has a first end fixed to either a forward or rearward portion of the vehicle and a second end on which the balancer 134 is fixed. One of the two extendable actuators is extended, while the other is contracted, to thereby move the balancer 134 linearly.
The balancer 134 in
Codes used in
(a) State Quantities
θW: Drive wheel rotation angle [rad]
θ1: Vehicle body inclination angle (with reference to the vertical axis) [rad]
λ2: Balancer position (with reference to the vehicle body central point) [m]
λS: Riding section position (with reference to the vehicle body central point) [m]
(b) Inputs
τW: Drive torque (total of two wheels) [Nm]
SB: Balancer thrust force [N]
SS: Riding section thrust force [N]
(c) Physical Constants
g: Gravitational acceleration [m/s2]
(d) Parameters
mW: Drive wheel mass (total of two wheels) [kg]
RW: Drive wheel ground contact radius [m]
IW: Drive wheel inertia moment (total of two wheels) [kgm2]
DW: Viscous damping coefficient relative to drive wheel rotation [Ns/rad]
m1: Vehicle body mass (including riding section and balancer) [kg]
l1: Vehicle body gravity center distance (from axle) [m]
I1: Vehicle body inertia moment (about gravity center) [kgm2]
D1: Viscous damping coefficient relative to vehicle body inclination [Ns/rad]
m2: Balancer mass [kg]
l2: Balancer reference gravity center distance (from axle) [m]
I2: Balancer inertia moment (about gravity center) [kgm2]
D2: Viscous damping coefficient relative to balancer translation [Ns/m]
mS: Riding section mass [kg]
lS: Riding section reference gravity center distance (from axle) [m]
IS: Riding section inertia moment (about gravity center) [kgm2]
DS: Viscous damping coefficient relative to riding section translation [Ns/m]
Running and posture control process performed in the third embodiment having above arrangement will be described below.
The running and posture control process in the third embodiment is substantially similar to that in the first embodiment described with reference to
In the running and posture control process according to the third embodiment, the main control ECU 21 first determines, as in the first embodiment, how the vehicle is moved according to the intention of the rider, specifically, determines the running target of the vehicle (steps 110 through 130).
The main control ECU 21 then determines the target vehicle body inclination angle θ1*, the riding section target position λS*, and a balancer target position λ2* as a target value of each state quantity (step 140).
Specifically, according to the magnitude of the vehicle target acceleration α* determined in step 120, the target vehicle body inclination angle θ1* is determined using Expressions 1 to 13 given below according to the magnitude of the vehicle target acceleration α*, the riding section target position λS* is determined using Expressions 14 to 18 given below, and the balancer target position λ2* is determined using Expressions 19 to 21.
θ1*=φ*−βS,Max+sin−1(γ sin φ*cos βS,Max)(α*<−αS,Max) (Expression 11)
θ1*=(1−CSense)φ*(−αS,Max≦α*≦αS,Max) (Expression 12)
θ1*=φ*+βS,Max+sin−1(γ sin φ*cos βS,Max)(α*>αS,Max) (Expression 13)
λS*=−λS,Max(α*<−αS,Max) (Expression 14)
λS*=l1(m1/mS)[tan(φ*−θ1*)+γ(sin φ*/cos(φ*−θ1*))]+(m2/mS)λ2,Max(−αS,Max≦α*<−α2,Max) (Expression 15)
λS*=0(−α2,Max≦α*≦α2,Max) (Expression 16)
λS*=l1(m1/ms)[tan(φ*−θ1*)+γ(sin φ*/cos(φ*−θ1*))]−(m2/ms)λ2,Max(α2,Max<α*≦αS,Max) (Expression 17)
λS*=λS,Max(α*>αS,Max) (Expression 18)
λ2*=−λ2,Max(α*<−α2,Max) (Expression 19)
λ2*=l1(m1/m2)[tan(φ*−θ1*)+γ(sin φ*/cos(φ*-θ1*))](−α2,Max≦α*≦α2,Max) (Expression 20)
λ2*=λ2,Max(α*>α2,Max) (Expression 21)
In Expressions 11 and 13, βS,Max is as follows:
βS,Max=tan−1((mSλS,Max+m2λ2,Max)/m1l1).
Further, λ2,Max is a set value representing the maximum balancer movement amount.
Other codes appearing in Expressions 11 to 21 are the same as those in Expressions 1 to 6 of the first embodiment.
A threshold value α2,Max is the vehicle target acceleration α* when λ2*=λ2,Max in Expression 20 specifically, when the balancer has been moved to its stroke limit. Meanwhile, a threshold value αS,Max is the vehicle target acceleration α* when λS*=λS,Max in Expression 17, specifically, when the riding section has been moved to its stroke limit.
As in the first embodiment, the threshold values α2,Max and αS,Max are preset values, but cannot be obtained analytically. These threshold values are therefore determined, for example, through iterative calculation or by an approximate expression.
If the vehicle target acceleration α* falls within a range of the threshold value±α2,Max (−α2,Max≦α*≦α2,Max), the movement of the gravity center position required for achieving the vehicle target acceleration α* is accomplished by the movement of the balancer and the inclination of the vehicle body with the riding section target position λS*=0 (Expression 16).
Specifically, the balancer target position λ2* is determined using Expression 20 and the target vehicle body inclination angle θ1* is determined using Expression 12.
If the vehicle target acceleration α* falls within a range of the threshold value±α2,Max and the threshold value±αS,Max (−αS,Max≦α*≦−α2,Max or α2,Max≦α*≦αS,Max), further movement of the gravity center position required for achieving the vehicle target acceleration α* is accomplished by the movement of the riding section and the inclination of the vehicle body with the balancer fixed at the balancer target position λ2*=±λ2,Max (Expression 19, Expression 21) according to the direction of the target acceleration (whether + or −).
Specifically, if the vehicle target acceleration α* is + (acceleration), the balancer position λ* is fixed at a + limit value and, if the vehicle target acceleration α* is − (deceleration), the balancer position λ* is fixed at a − limit value.
Specifically, the riding section target position λS* is determined using Expressions 15 and 17 and the target vehicle body inclination angle θ1* is determined using Expression 12.
If the vehicle target acceleration α* falls outside the range of the threshold value±αS,Max (α*<−αS,Max or αS,Max<α*), further movement of the gravity center position required for achieving the vehicle target acceleration α* is accomplished by the inclination of the vehicle body with the balancer fixed at the balancer target position λ2*=±λ2,Max, which is the stroke limit (Expression 19, Expression 21) and the riding section fixed at the riding section target position λS*=±λS,Max, which is the stroke limit (Expression 14, Expression 18).
Specifically, the target vehicle body inclination angle θ1* is determined using Expressions 11 and 13.
As such, in the third embodiment, balance is maintained by moving only the balancer and not the riding section during light acceleration and, when the balancer movement amount reaches the limit, the riding section is also moved to maintain balance.
This allows the rider to feel appropriate acceleration with a small vehicle body inclination and without moving the riding section during light acceleration.
(Modified example of determination of the target vehicle body inclination angle θ1*, the balancer target position λ2*, and the riding section target position λS*)
The above embodiment has been described for the case, in which each target value (the target vehicle body inclination angle θ1*, the balancer target position λ2*, or the riding section target position λS*) is determined by selecting any of Expressions 11 to 13, Expressions 14 to 18, and Expressions 19 to 21 from the relationship between the vehicle target acceleration α* and the threshold value±α2,Max or the threshold value±αS,Max.
Each target value may instead be determined through target value determination process shown in
The main control ECU 21 first calculates the target vehicle body inclination angle θ1* corresponding to the vehicle target acceleration α* using Expression 12 (step 30).
The main control ECU 21 then calculates the balancer target position λ2* using the determined θ1* and Expression 20 (step 31) and determines whether the calculated value λ2* falls within a range of −λ2,Max≦λ2*≦λ2,Max* over which the balancer can move (step 32).
If the calculated value λ2* falls within the range over which the balancer can move (step 32; Y), the main control ECU 21 determines (step 33) θ1* calculated in step 30 to be the target vehicle body inclination angle and λ2* calculated in step 31 to be the balancer target position, before terminating the process.
If, on the other hand, the calculated value λ2* falls outside the range over which the balancer can move (step 32; N), the main control ECU 21 determines the maximum balancer movement amount±λ2,Max to be the balancer target position λ2* (step 34).
The main control ECU 21 then calculates the riding section target position λS* using θ1* determined in step 30 and Expression 15 or 17 (step 361) and determines whether the calculated value λS* falls within a range of −λS,Max≦λS*≦λS,Max over which the riding section can move (step 36).
If the calculated value λS* falls within the range over which the riding section can move (step 36; Y), the main control ECU 21 determines (step 37) θ1* calculated in step 30 to be the target vehicle body inclination angle and λS* calculated in step 35 to be the riding section target position, respectively, before terminating the process.
If, on the other hand, the calculated value λS* falls outside the range over which the riding section can move (step 36; N), the main control ECU 21 determines the maximum riding section movement amount±λS,Max to be the riding section target position λS* (step 38).
The main control ECU 21 again calculates θ1* that corresponds to the vehicle target acceleration α* using Expression 11 or 13 and determines this to be the target vehicle body inclination angle θ1* (step 39), before terminating the process.
According to the target value determination process described above, the target vehicle body inclination angle θ1*, the balancer target position λ2*, and the riding section target position λS* can be determined without using the threshold values α2,Max, αS,Max for determining which expression to be used selected from among Expressions 11 to 13, Expressions 14 to 18, and Expressions 19 to 21.
In this embodiment, Expressions 11 to 21 that are strictly theoretical expressions are used to determine the vehicle body target posture. A simpler expression may be used instead. For example, linearized expressions of Expressions 11 to 21 may be used. Further, instead of using the expressions, a map may be prepared in advance representing a relationship between the vehicle target acceleration α* and the vehicle body target posture and the vehicle body target posture may be determined using that map.
A more complicated relational expression may also be used instead. For example, a relational expression may be established, with which: if an absolute value of the vehicle target acceleration α* is equal to, or smaller than a predetermined threshold value, the riding section is moved without inclining the vehicle body at all; and inclining of the vehicle body starts as the absolute value exceeds the predetermined threshold.
Note that, in this embodiment, the maximum forward movement amount relative to a reference position in the riding section or the balancer is equal to the maximum rearward movement amount relative to the reference position in the riding section or the balancer. Instead, these movement amounts may be different from each other. For example, by making the maximum rearward movement amount greater, braking performance can be improved over acceleration performance. In this case, similar control can be achieved easily by correcting the threshold value αMax to correspond to each of limit values.
Returning to the running and posture control process (
Specifically, each target value is differentiated with respect to time or integrated with respect to time to calculate the drive wheel rotation angle target value θW*, the vehicle body inclination angular velocity target value [θ1*], a balancer movement speed target value [λ2*], and the riding section movement speed target value [λS*].
Next, the feedforward output of each actuator is determined (step 160). The main control ECU 21 uses, as in the first embodiment, Expressions 7 and 8 to determine feedforward outputs τW,FF and SS,FF of the drive motor 52 and the riding section motor 62. Further, the main control ECU 21 determines a feedforward output SB,FF of the balancer motor 72 using Expression 22.
Similarly to the feedforward output SS,FF of the riding section motor 62, SB,FF corresponds to balancer thrust force required to keep the balancer at the target position with the target vehicle body inclination angle θ1*.
S
B,FF
=−m
2
g sin θ1* (Expression 22)
Each state quantity can be even more accurately controlled by applying the feedforward outputs as given in Expressions 7, 8, and 22.
Note that, as in the first embodiment, an integral gain may, instead, be given in the feedback control (step 190).
The main control ECU 21 next acquires each state quantity from each sensor (step 170). Specifically, the drive wheel rotation angle (rotation angular velocity) is acquired from the drive wheel sensor 51, the vehicle body inclination angle (inclination angular velocity) is acquired from the vehicle body inclination sensor 41, the riding section position (movement speed) is acquired from the riding section sensor 61, and the balancer position (movement speed) is acquired from the balancer sensor 71.
Additionally, the main control ECU 21 calculates remaining state quantities (step 180). Specifically, the drive wheel rotation angle (rotation angular velocity), the vehicle body inclination angle (inclination angular velocity), the riding section position (movement speed), and the balancer position (movement speed) are integrated or differentiated with respect to time to calculate the remaining state quantities.
The main control ECU 21 then determines a feedback output of each actuator (step 190).
Specifically, Expression 23 is used to determine a feedback output τW,FB of the drive motor 52, Expression 24 is used to determine a feedback output SS,FB of the riding section motor 62, and Expression 25 is used to determine a feedback output SB,FB of the balancer motor 72 based on a deviation between each target value and actual state quantity.
In Expressions 23 to 25, K** is a feedback gain and, for example, an optimum regulator value is preset for each feedback gain K**. In addition, an integral gain may be introduced to eliminate the steady-state deviation as described earlier.
τW,FB=−KW1(θW−θW*)−KW2([θW]−[θW*])−KW3(θ1−θ1*)−KW4([θ1]−[θ1*])−KW5(λS−λS*)−KW6([λS]−[λS*])−KW7(λ2−λ2*)−KW8([λ2]−[λ2*]) (Expression 23)
S
S,FB
=−K
B1(θW−θW*)−KS2([θW]−[θW*])−KS3(θ1−θ1*)−KS4([θ1]−[θ1*])−KS5(λS−λS*)−KS6([λS]−[λS*])−KS7(λ2−λ2*)−KS8([λ2]−[λ2*]) (Expression 24)
S
B,FB
=−K
B1(θW−θW*)−KB2([θW]−[θW*])−KB3(θ1−θ1*)−KB4([θ1]−[θ1*])−KB5(λS−λS*)−KB6([λS]−[λS*])−KB7(λ2−λ2*)−KB8([λ2]−[λ2*]) (Expression 25)
Some of the feedback gains may be zeroed to simplify the expressions. For example, τW,FB=−KW2 ([θW]−[θW*])−KW3(θ1−θ1*) may be used in place of Expression 23, SS,FB=−KS5(λS−λS*) may be used in place of Expression 24, and SB,FB=−KB7(λ2−λ2*) may be used in place of Expression 25.
Finally, the main control ECU 21 gives each element control system a command value (step 200) and returns to the main routine.
Specifically, the main control ECU 21 supplies the drive wheel control ECU 22 with a sum (τW,FF+τW,FB) of the feedforward output τW,FF determined in step 160 and the feedback output τW,FB determined in step 190 as a drive torque command value τW. Further, the riding section control ECU 23 with a sum (SS,FF+SS,FB) of the feedforward output SS,FF and the feedback output SS,FB as a riding section thrust force command value SS, and the balancer control ECU 24 with a sum (SB,FF+SB,FB) of the feedforward output SB,FF and the feedback output SB,FB as a balancer thrust force command value S2.
Accordingly, the drive wheel control ECU 22 supplies the drive motor 52 with an input voltage (drive voltage) corresponding to the drive torque command value τW to thereby give the drive wheel drive torque τW.
Similarly, the balancer control ECU 24 supplies the balancer motor 72 with an input voltage (drive voltage) corresponding to the balancer thrust force command value S2 to thereby move the balancer.
Further, the riding section control ECU 23 supplies the riding section motor 62 with an input voltage (drive voltage) corresponding to the riding section thrust force command value SS to thereby move the riding section.
In each of the above-described embodiments and modified examples thereof, a value set from the mass of the riding section 13 itself and that of the rider and an article expected in advance to be loaded therein is used for the mass mS of the riding section 13 including the weight body (such as the rider or the article to be loaded).
By contrast, variations in the mass of the riding section 13 may be taken into consideration based on, for example, a deviation in the weight body (such as the rider) on the riding section 13. Specifically, a measuring instrument or an observer is employed to acquire an actual value for the riding section mass 13 required for determining the target value and the actual value is applied to each of the expressions for determining the target values.
By inserting the actual value in each of the expressions as described above, even more accurate posture control can be performed.
Methods of acquiring the actual riding section mass value include: (a) using values of measurements taken by a load meter disposed on the riding section; and (b) estimating the value using observers based on each actuator output and each state quantity. Each of these methods will be described below.
In this modified example, a load meter is disposed on the riding section 13. Vertical loading WS (a component perpendicular to the seat cushion 131) is measured and supplied to the main control ECU 21.
Then, according to Expression 26 given below, the riding section mass mS including, for example, the rider is calculated.
In Expression 26, mS,0 is a non-variable portion of the riding section mass (mass not dependent on the rider; mass of the riding section 13 alone, such as the seat) and g is gravitational acceleration.
m
S
=m
S,0+(WS/g cos θ1) (Expression 26)
This modified example includes the load meter that measures the vertical load. Instead, a load meter capable of measuring also a horizontal component may be used. In this case, the riding section mass can be determined without using the value of the vehicle body inclination angle.
The main control ECU 21 applies a low pass filter to the value of the riding section mass mS calculated using Expression 26 to thereby remove an RF component. This prevents vibration of the vehicle body or the seat caused by noise.
Also for the vehicle body weight m1, a deviation from a standard value (a value previously set based on assumption) of the riding section mass is added.
Additionally, in this modified example, an effect of variations in the riding section weight is considered for the vehicle body weight m1. The effect may as well be taken into consideration for the vehicle body gravity center distance l1 or the inertia moment I1.
The effect may also be taken into consideration for, for example, the feedback gain, in addition to the parameters (mS, m1, l1, and I1) directly affected by variations in the riding section weight, and the feedback gain may be corrected using Expression 27 given below.
In Expression 27, the code ˜ denotes the standard value.
K
S5=(mS/m˜S)K˜S5 (Expression 27)
The modified example 1 has been described for the case, in which the value of the riding section mass mS (and the vehicle body mass m1) is calculated using Expression 26 with the measurement taken by the load meter. In the modified example 2, the value of the riding section mass mS is estimated using an observer based on, for example, the movement state λS of the riding section or the balancer thrust force SB.
The main control ECU 21 uses a riding section movement model of Expression 28 given below to estimate the riding section mass mS, where g denotes gravitational acceleration and CS denotes a viscous friction coefficient relative to seat movement. Further, acceleration [[x]] of each state quantity x is obtained by differentiating the speed [x].
In Expression 28, for example, the greater the thrust force SS required for moving the seat, the greater riding section mass mS is estimated.
m
S=(SS−DS[λS])/([[λS]]+λS[[θ1]]+a cos θ1−g sin θ1) (Expression 28)
Dry friction is not considered in the riding section movement model of Expression 28. The riding section mass mS may nonetheless be estimated by using a detailed model in which dry friction is strictly considered or a plurality of models including, for example, that of the vehicle body inclination.
Additionally, the observer can be stabilized and vibration caused by noise can be prevented by applying a low pass filter to the estimated value of the riding section mass mS given by Expression 28 to thereby remove the high-frequency component.
Note that, when the loop of running and posture control process is entered for the first time, the standard value is given to the riding section mass (as a default value of the observer).
The modified example 2 estimates the riding section weight mS using the observer based on the dynamic model. A simpler method may be used instead. For example, instead of using Expression 28, a map may be stored in memory in advance representing results of measurements taken of a relationship between the minimal thrust force required for moving the riding section 13 and the riding section weight mS relative thereto, so that the estimation can be made using the map.
According to the foregoing modified examples 1 and 2, a value that is even closer to the actual value compared with a previously assumed set value, is estimated for the mass mS of the riding section 13 (including, for example, the rider). Steady-state deviation relative to the targeted vehicle motion and vehicle body posture can be reduced as much as possible, which allows an appropriate control to be performed. This improves stability and accuracy in posture control.
Fourth through ninth embodiments will be described below.
Note that, for each embodiment and each modified example of the second and third embodiments, and the fourth through ninth embodiments, the vehicle should most preferably be provided with all the components in these embodiments and modifications, in addition to the first embodiment. The vehicle may, however, be implemented by applying at least one embodiment or modified example to the first embodiment.
In the fourth embodiment, either the vehicle body inclination or the riding section movement is selectively used according to a frequency component of the vehicle target acceleration α*. Specifically, in determining the target vehicle body posture, a low-frequency component of the vehicle target acceleration α* is borne by the vehicle body inclination and a high-frequency component thereof is borne by the riding section movement. Thus, sudden vehicle body inclination can be prevented to improve riding comfort.
Acceleration or deceleration accompanying inclining of the vehicle body involves sudden inclination of the vehicle body during sudden acceleration or deceleration, which degrades the riding comfort. That is, although the inclination of the vehicle body provides the rider a sense of unity with the vehicle, sudden inclination may make the rider feel uncomfortable.
In addition, a forward or backward inclination of the vehicle body occurring upon quick and slight acceleration or deceleration also degrades the riding comfort.
In the fourth embodiment, therefore, the vehicle target acceleration α* corresponding to the running target inputted by the rider is divided into a low-frequency component and a high-frequency component with a frequency-filter; the low-frequency component is borne by the vehicle body inclination and the high-frequency component is borne by the riding section movement, thereby preventing sudden vehicle body inclination upon sudden acceleration or deceleration.
As shown in
The value of the predetermined frequency fc1 is set at a frequency at which the rider feels no unpleasantness due to vehicle body inclination, and is, for example, 1 Hz.
Referring to
Referring to
Thus, by moving the riding section 13 forwardly without inclining the vehicle body immediately after the sudden acceleration command and inclining the vehicle body forwardly slowly thereafter as described above, a comfortable ride under sudden acceleration is achieved.
Running and posture control according to the fourth embodiment will be described below.
A control system in the fourth embodiment is the same as that in the first embodiment described with reference to
In the running and posture control in the fourth embodiment, the main control ECU 21 first determines, as in the first embodiment, how the vehicle is moved according to the intention of the rider, specifically, the running target of the vehicle (steps 110 through 130).
The main control ECU 21 then calculates a low-frequency component α1* of the vehicle target acceleration α* (step 141). Specifically, using a low pass filter expressed by Expression 29 given below, the low-frequency component α1*, which is a portion of the vehicle target acceleration α*borne by the vehicle body inclination, is calculated.
α1*=ξα*+(1−ξ)α1*(k-1) (Expression 29)
In Expression 29, α1* is a present value of the vehicle target acceleration (at the current time step) and α1*(k-1) is a value of the low-frequency component of the vehicle target acceleration at a time Δt ago.
If Δt is a control operation cycle and TC(=1/fC1) is a time constant of the low-pass filter, ξ=Δt/TC. Specifically, if the value of ξ is small, the change in the low-frequency component α1* becomes small, so that the change in inclination of the vehicle body based on the low-frequency component α1* is moderate. Note that the time constant of the low-pass filter TC or a cutoff frequency fC1 may be variable based on the preference of the rider.
The above-cited Expression 29 corresponds to a first-order finite impulse type low-pass filter. Another type or a filter of a higher order may, instead, be used.
The main control ECU 21 then determines the vehicle body inclination angle θ1 from the low-frequency component α1* of the vehicle target acceleration α* (step 142).
Specifically, the main control ECU 21 determines the vehicle body inclination angle θ1* from the low-frequency component α1* of the vehicle target acceleration α* using Expressions 30 to 32 given below, in place of Expressions 1 to 3 in the first embodiment (step 142).
In Expression 31, φ1*=tan−1α1* where α1* is the low-frequency component of the vehicle target acceleration α* calculated in step 141. The other codes are the same as those used in Expressions 1 to 3.
θ1*=φ*−βMax+sin−1(γ sin φ*cos βMax)(α*<−αMax) (Expression 30)
θ1*=(1−CSense)φ1*(−αMax≦α*≦αMax) (Expression 31)
θ1*=φ*+βMax+sin−1(γ sin φ*cos βMax)(α*>αMax) (Expression 32)
Note that the riding section 13 cannot be moved if the vehicle target acceleration α* exceeds the acceleration αMax that corresponds to the riding section stroke limit. Thus, stable vehicle body posture control is achieved through the vehicle body inclination, regardless of the frequency of the vehicle target acceleration α*.
The limit may, however, be ignored because time through which the high-frequency component exceeds the limit is brief. In this case, Expression 31 applies at any cases regardless of the vehicle target acceleration α*.
The main control ECU 21 then determines the riding section target position λS* (step 143).
Specifically, the main control ECU 21 determines, as in the first embodiment, the riding section target position λS* from the vehicle target acceleration α* and the target vehicle body inclination angle θ1* using Expressions 4 to 6.
In the first and third embodiments, modified examples of the technique for determining the target vehicle body inclination angle θ1* and the riding section target position λS* have been described with reference to the target value determination processes of
Specifically, the main control ECU 21 calculates the target vehicle body inclination angle θ1* corresponding to the vehicle target acceleration α* using the expression used when −αMax≦α*≦αMax (Expression 31 in the fourth embodiment).
Then, the obtained θ1* and Expression 5 are used to calculate the riding section target position λS*. If λS* falls within the range of −λS,Max≦λS*≦λS,Max over which the riding section can move, the obtained θ1* is determined as the target vehicle body inclination angle and λS* is determined as the riding section target position.
If, on the other hand, the calculated value λS* falls outside the range over which the riding section can move, the maximum riding section movement amount±λS,Max is determined to be the riding section target position λS*; then, using Expression 1 or 3, θ1* corresponding to the vehicle target acceleration α* is again calculated and is determined as the target vehicle body inclination angle θ1*.
After determining the target vehicle body inclination angle θ1* and the riding section target position λS*, the main control ECU 21 determines, as in the first embodiment, the output values of the drive motor 52 and the riding section motor 62 required for achieving the vehicle running state and vehicle body posture set as targets. The main control ECU 21 then uses the drive wheel control ECU 22 and the riding section control ECU 23 to control the actual outputs from the drive motor 52 and the riding section motor 62 according to the output values (steps 150 through 200), before returning to the main routine.
The following effects can be gained with the fourth embodiment.
(1) The vehicle body does not incline suddenly upon sudden acceleration or deceleration, thus providing a comfortable ride.
(2) The vehicle body does not rock forwardly or rearwardly by quick and slight acceleration/deceleration.
(3) Although the riding section, instead, suddenly moves this does not cause the field of view of the rider to move vertically. Moreover, the riding section moves in the direction of acceleration in which the rider requires. As a result, the rider can more intensely feel, for example, a startup acceleration, and a deceleration immediately after a braking operation.
As a modified example of the fourth embodiment, for example, if a movable speed (or acceleration) of the riding section movement is lower than a movable speed (or acceleration) of the vehicle body inclination, the low-frequency component may be borne by the riding section movement and the high-frequency component may be bone by the vehicle body inclination.
The posture control can be even further stabilized by corresponding to the dynamic structure of the vehicle and performance of each system element as above.
A fifth embodiment will be described below.
In the fifth embodiment, if the vehicle speed upon determining the target vehicle body posture is high, the riding section 13 is moved forwardly with the vehicle body inclined rearwardly in advance, thereby preventing the vehicle body posture from changing largely immediately after the sudden deceleration.
With the inverted vehicle that is decelerated while moving the gravity center rearwardly by inclining the vehicle body rearwardly, the vehicle body is suddenly inclined rearwardly largely upon sudden braking. Thus, the riding comfort for the rider is degraded and the braking operation performed by the rider may even be affected due to a sudden vertical movement of the field of view of the rider.
As the vehicle running speed increases, on the other hand, sudden braking, specifically, a large deceleration is more likely to be requested by the rider.
In the fifth embodiment, therefore, in determining the target vehicle body posture (the target vehicle body inclination angle θ1* and the riding section target position λS*) corresponding to the vehicle target acceleration α*, the riding section 13 is moved forwardly with the vehicle body inclined rearwardly as the vehicle speed increases, thereby preparing for the sudden braking operation performed by the rider.
Referring to
Referring to
If a braking command is received in this condition, braking is performed with the target vehicle body posture (the target vehicle body inclination angle θ1* and the riding section target position λS*) determined in the same manner as in the first embodiment. If sudden braking is commanded in this condition, as shown in
Running and posture control according to the fifth embodiment will be described below.
Note that a control system according to the fifth embodiment is arranged in the same manner as that in the first embodiment described with reference to
In the running and posture control in the fifth embodiment, the main control ECU 21 first determines, as in the first embodiment, how the vehicle is moved according to the intention of the rider, specifically, the running target of the vehicle (steps 110 through 130).
The main control ECU 21 next acquires the drive wheel rotation angular velocity (step 144). Specifically, the main control ECU 21 acquires the value of the drive wheel rotation angular velocity [θW] used in a control operation in preceding time step.
The value of the drive wheel rotation angular velocity [θW] may be acquired in advance from the drive wheel sensor 51.
The main control ECU 21 then determines the target vehicle body inclination angle θ1* (step 145). Specifically, the target vehicle body inclination angle θ1* is determined from the vehicle target acceleration α* and the drive wheel rotation angular velocity [θW] using Expressions 33 to 35.
θ1*=φ*−βMax+sin−1(γ sin φ*cos βMax)(α*<−αMax) (Expression 33)
θ1*(1−CSense)φ*−ψ(−αMax≦α*≦αMax) (Expression 34)
θ1*=φ*+βMax+sin−1(γ sin φ*cos βMax)(α*>αMax) (Expression 35)
Expressions 33 and 35 are the same as Expressions 1 and 3 of the first embodiment.
In Expression 34, the vehicle body is inclined rearwardly by subtracting ψ from the target vehicle body inclination angle θ1*− of Expression 2.
Herein, ψ is determined using Expressions 36 and 37 given below, where ψ˜ is the amount of decrease in the vehicle body inclination angle according to the vehicle speed.
ψ=max(0,ψ˜+(1−CSense)φ*)(α*<0) (Expression 36)
ψ=ψ˜(α*≧0) (Expression 37)
ψ˜ is expressed by Expression 38. ψ0 and V0 are reference parameters (set values) and the vehicle body inclination angle is decreased by ψ0 at a vehicle speed V0.
Other codes used in Expressions 33 to 38 are the same as those used in Expressions 1 to 3 of the first embodiment.
ψ˜=ψ0(RW[θW]/V0) (Expression 38)
The main control ECU 21 then determines the riding section target position λS* (step 146).
Specifically, the main control ECU 21 determines, as in the first embodiment, the riding section target position λS* from the vehicle target acceleration α* and the target vehicle body inclination angle θ1* using Expressions 4 to 6.
In
If the vehicle target acceleration α* falls within a range of the threshold value±αMax (−αMax≦α*≦αMax), the target vehicle body inclination angle θ1* is determined using Expression 34 and the riding section target position λS* is determined using Expression 5. If running at a constant speed with no acceleration or deceleration (α*=0), as shown in
At this time, the higher the vehicle speed (the greater the drive wheel rotation angular velocity [θW]) the target vehicle body inclination angle ψ˜ is more decreased, so that the vehicle body inclines more largely rearwardly.
In the fifth embodiment, the amount of decrease in the target vehicle body inclination angle is given in proportion to the running speed. The amount of decrease in the target vehicle body inclination angle may instead be given nonlinearly. (A map showing correspondence between the running speed and the amount of decrease in the target vehicle body inclination angle may be used.) For example, the target vehicle body inclination angle may be decreased at a predetermined speed or higher.
After determining the target vehicle body inclination angle θ1* and the riding section target position λS*, the main control ECU 21 determines, as in the first embodiment, the output values of the drive motor 52 and the riding section motor 62 required for achieving the vehicle running state and vehicle body posture set as targets. The main control ECU 21 then uses the drive wheel control ECU 22 and the riding section control ECU 23 to control the actual outputs from the drive motor 52 and the riding section motor 62 according to the output values (steps 150 through 200), before returning to the main routine.
The following effects can be gained with the fifth embodiment.
(1) During high-speed running, the vehicle body is inclined in advance in preparation for possible sudden braking so that the vehicle body does not suddenly incline largely rearwardly upon sudden braking. Thus, safe and comfortable ride is offered.
(2) Although the riding section 13, instead, suddenly moves rearwardly, the field of view of the rider does not move vertically. Moreover, the riding section 13 moves in the same direction of braking deceleration in which the rider requires. As a result, the rider can feel more intensely a deceleration feel immediately after the braking operation.
(3) During high-speed running, the vehicle body is inclined rearwardly to thereby raise the sight of the rider, thus bringing attention of the rider toward a remote distance.
As a modified example of the fifth embodiment, for example, if a movable speed (or acceleration) of the riding section movement is lower than a movable speed (or acceleration) of the vehicle body inclination, the riding section 13 may be moved rearwardly in advance to be prepared for sudden braking.
The posture control can be even further stabilized by corresponding to the dynamic structure of the vehicle and performance of each system element as above.
A sixth embodiment will be described below.
In the sixth embodiment, either the drive motor 52 or riding section movement is selectively used depending on the vehicle body posture and the direction of vehicle running. Specifically, the riding section 13 is moved when direction of the drive torque required for vehicle body posture control differs from that of the drive torque required for vehicle running control to eliminate reverse operations.
Referring to
Specifically, acceleration/deceleration (running control) of the vehicle (drive wheel) and vehicle body inclination (posture control) are accomplished through action and reaction of the drive motor 52. Thus, the vehicle body cannot be inclined forwardly while accelerating and the vehicle body cannot be inclined rearwardly while decelerating.
For example, to incline the vehicle body forwardly when accelerating from a standstill state, to achieve the forwardly inclined posture, the drive wheel needs to be temporarily moved rearwardly (the lower right part in
Similarly, to incline the vehicle body rearwardly when decelerating from a running state, to achieve the rearwardly inclined posture, the drive wheel needs to be temporarily moved forwardly (the lower left part in
In the sixth embodiment, therefore, the following (i) and (ii) are implemented to reduce reverse operation of the drive wheel.
(i) In determining the target vehicle body posture according to the vehicle target acceleration α*, the target vehicle body inclination angle acceleration is limited according to the vehicle target acceleration α*, and the rest of the posture control is borne by movement of the riding section.
(ii) In feedback controls of the vehicle running and the vehicle body posture, the feedback gain of either one of feedback controls is limited according to deviation in the drive wheel rotation angular velocity and deviation in the vehicle body inclination angular velocity.
Note that either of (i) and (ii) may be implemented.
Running and posture control according to the sixth embodiment will be described below.
Note that a control system according to the sixth embodiment is arranged in the same manner as that in the first embodiment described with reference to
In the running and posture control in the sixth embodiment, the main control ECU 21 first determines, as in the first embodiment, how the vehicle is moved according to the intention of the rider, specifically, the running target of the vehicle (steps 110 through 130).
The main control ECU 21 next acquires state quantities of vehicle body inclination and riding section movement (step 140a). Specifically, the main control ECU 21 acquires values of the vehicle body inclination angle θ1, the vehicle body inclination angular velocity [θ1], and the riding section positionin λS in the preceding time step.
Note that each of these values may be acquired from the drive wheel sensor 51 in advance.
The main control ECU 21 then determines the limit value of the target vehicle body inclination angle (step 140b).
From the vehicle target acceleration α* and each of the state quantities (θ1, [θ1], and λS) obtained in step 140a, using Expressions 39 or 40 given below, an upper limit value θ1,Max* or a lower limit value θ1,Max* in of the target vehicle body inclination angle is determined.
Specifically, when (a) α*≧αsh, the upper limit value θ1,Max* is set using Expression 39 to thereby limiting the forward inclination of the vehicle body and; when (b) α*<αsh, the lower limit value θ1,Min* is set using Expression 40 to thereby limiting the rearward inclination of the vehicle body.
Upper limit value θ1,Max*=θ1*(k-1)+Δt[θ1] (Expression 39)
Lower limit value θ1,Min*=θ1*(k-1)+Δt[θ1] (Expression 40)
In Expressions 39 and 40, θ1*(k-1) is a target value of the vehicle body inclination angle at a time Δt ago. αsh is a control compatibility limit vehicle acceleration and expressed by Expression 41 given below.
CLimit is a limit strength (set value is 0 or more and 1 or less), representing the degree of reducing reverse operation.
As shown in Expression 41, consideration of the vehicle body inclination angle θ1 or the riding section positionin λS permits an appropriate examination of feasibility of control compatibility with only the drive torque even during vehicle body inclination or riding section movement.
αsh=CLimit tan−1((m1l1 sin θ1+mSλS cos θ1)/(M˜RW+m1l1)) (Expression 41)
The main control ECU 21 then determines the target vehicle body inclination angle θ1* (step 140c). Specifically, from the vehicle target acceleration α*, and the limit value (the upper limit value θ1,Max* or the lower limit value θ1,Min*) of the vehicle body inclination angle determined in step 140b, Expressions 42 to 44 given below are used to determine the target vehicle body inclination angle θ1*.
In Expression 43, θ˜1* is determined using Expression 45 when (a) α*≧αsh and using Expression 46 when (b) α*<αsh.
θ1*=φ*−βMax+sin−1(γ sin φ*cos βMax)(α*<−αMax) (Expression 42)
θ1*=θ˜1*(−αMax≦α*≦αMax) (Expression 43)
θ1*=φ*+βMax+sin−1(γ sin φ*cos βMax)(α*>αMax) (Expression 44)
θ˜1*=min((1−CSense)φ*,θ1,Max*) (Expression 45)
θ˜1*=max((1−CSense)φ*,θ1,Min*) (Expression 46)
The main control ECU 21 then determines the riding section target position λS* (step 140d).
Specifically, the main control ECU 21 determines, as in the first embodiment, the riding section target position λS* from the vehicle target acceleration α* and the target vehicle body inclination angle θ1* using Expressions 4 to 6.
After determining the target vehicle body inclination angle θ1* and the riding section target position λS*, the main control ECU 21 sets remaining target values, determines feedforward outputs, and acquires and calculates each of the state quantities as in the first embodiment (steps 150 to 180).
The main control ECU 21 next changes a part of the feedback gains (step 181). Specifically, based on the deviation in the drive wheel rotation angular velocity ([θW]−[θW*]) and the deviation in the vehicle body inclination angular velocity ([θ1]−[θ1*]), Expression 47 is used to change the feedback gain KW2 relating to the drive wheel rotation angular velocity and Expression 48 is used to change the feedback gain KW4 relating to the vehicle body inclination angular velocity.
K
W2=(1+ζ)KW2,0 (Expression 47)
K
W4=(1−ζ)KW4,0 (Expression 48)
In Expressions 47 and 48, KW2,0 and KW4,0 are feedback gain reference values. ζ is a feedback gain correction coefficient and expressed by Expression 49 given below. cζ is a correction degree proportional coefficient, representing the degree of correct the feedback gain correction.
In Expression 49, as to the deviation (a difference between an actual state value and a target value) in the drive wheel rotation angular velocity and the deviation in the vehicle body inclination angular velocity, if both are positive or both are negative, the feedback gain of the drive wheel rotation angular velocity is made larger or the feedback gain of the vehicle body inclination angular velocity is made smaller according to the magnitude of the deviation, thereby relatively strengthening the drive wheel rotation control to weaken reverse operation of the drive wheel.
ζ=cζmax(([θW]−[θW*])([θ1]−[θ1*]),0) (Expression 49)
The main control ECU 21 next determines, as in the first embodiment, feedback outputs (step 190) and, using the drive wheel control ECU 22 and the riding section control ECU 23, controls the actual outputs from the drive motor 52 and the riding section motor 62 based on the determined feedforward outputs and feedback outputs (step 200), before returning to the main routine.
The following effect can be gained with the sixth embodiment.
(1) “Reverse operation” of the drive wheel during acceleration from a stationary state or braking from a running state under a constant speed can be reduced to improve maneuverability for the rider.
Note that, each of the correction degree proportional coefficients cζ for the correction of the two gains in the sixth embodiment may set to be different values.
Additionally, either one of the gains may be increased or decreased with the other correction coefficient zeroed. If the gain in the drive wheel rotation angular velocity is negative, in particular, only the gain in the vehicle body inclination angular velocity may be made smaller without correcting the drive wheel rotation angular velocity. Further, a positive gain in the drive wheel rotation angular velocity may be reversed to be negative, or vice versa.
In addition, other nonlinear functions may be employed for the two deviations. For example, the correction coefficient may be given only if the two deviations increase to a certain degree.
Similar corrections may be made for other feedback gains. For example, the feedback gain of the vehicle body inclination angle may be reduced. Additionally, the vehicle body inclination gain of the riding section motor 62 may be increased, while reducing the vehicle body inclination gain of the drive motor 52.
On the other hand, by reducing the drive wheel gain while increasing the vehicle body inclination gain, the vehicle body posture may be controlled more stably, at the expense of certain degree of the drive wheel control.
A seventh embodiment will be described below.
In the seventh embodiment, either the drive motor 52 or riding section movement is selectively used according to the frequency component of disturbance. Specifically, in feedback control, vibration caused by disturbance is prevented by making a low-frequency component of deviation borne by the riding section movement and a high-frequency component of the deviation borne by the drive motor 52.
Vibration at high frequency, which can affect riding comfort, may occur when the vehicle body posture is controlled with the movement of the riding section 13. This is attributable to the fact that the vehicle body posture control through the riding section movement involves “lag” and is thus not suitable for precise control.
Additionally, a balanced state may be achieved at a posture different from a target posture. That is, a state may be retained in which the vehicle body, for example, has inclined more than the target angle, and the riding section 13 has moved in an opposite direction thereof. This is caused as the posture control by the drive motor 52 is canceled by the posture control by the riding section movement.
In the seventh embodiment, therefore, the deviation between the actual state value and the target value of the vehicle body inclination angle is divided into a low-frequency component and a high-frequency component by a frequency filter. The low-frequency component is borne by the riding section movement and the high-frequency component is borne by the drive motor 52.
This allows the vibration at high frequency to be borne only with the vehicle body inclination appropriate therefor. Further, frequency bands borne by the vehicle body inclination and the riding section movement are shifted. Thus, the vehicle body inclination and the riding section movement are prevented from interfering with each other to form a false balanced state.
As shown in
The value of the predetermined frequency fc2 is set at a frequency at which the posture can be controlled through the riding section movement to a certain degree. A predetermined value, for example, 5 Hz is preset. Generally, a value larger than the frequency fc1 that serves as the threshold value in the fourth embodiment is set for this value.
Running and posture control according to the seventh embodiment will be described below.
Note that a control system according to the seventh embodiment is arranged in the same manner as that in the first embodiment described with reference to
In the running and posture control in the seventh embodiment, the main control ECU 21 determines the target state quantity, acquires the state quantity, and determines the feedforward output, as in the first embodiment (steps 110 to 180).
The main control ECU 21 then calculates low-frequency and high-frequency components of each deviation (step 191).
Specifically, the main control ECU 21 divides the deviation in the vehicle body inclination angle between the actual state value and the target value (θ1−θ1*) into a low-frequency component and a high-frequency component using Expression 50 (a low-pass filter) and Expression 51 (serving as a high-pass filter).
Similarly, the main control ECU 21 divides the deviation in the vehicle body inclination angular velocity between the actual state value and the target value ([θ1]−[θ1*]) into a low-frequency component and a high-frequency component using Expression 52 and Expression 53.
Note that, in the seventh embodiment, a first-order finite impulse type low-pass filter is used. Another type or a filter of a higher order may, instead, be used.
(θ1−θ1*)L=ξ(θ1−θ1*)+(1−ξ)(θ1−θ1*)L(k-1) (Expression 50)
(θ1−θ1*)H=(θ1−θ1*)−(θ1−θ1*)L (Expression 51)
([θ1]−[θ1*])L=ξ([θ1]−[θ1*])+(1−ξ)([θ1]−[θ1*])L(k-1) (Expression 52)
([θ1]−[θ1*])H=([θ1]−[θ1*])−([θ1]−[θ1*])L (Expression 53)
In Expressions 50 to 53, ξ=Δt/TE and (x)L(k-1) is a value of the low-frequency component at a time Δt ago. At is the control operation cycle. TE(=1/fC2) is the time constant of the filter.
The main control ECU 21 then determines a feedback output of each actuator (step 192). Specifically, Expression 54 is used to determine the feedback output of the drive motor 52 and Expression 55 is used to determine the feedback output of the riding section motor 62 based on the deviation between the state value and the target value in each state quantity.
τW,FB=−KW1(θW−θW*)−KW2([θW]−[θW*])−KW3(θ1−θ1*)−KW4([θ1]−[θ1*])H (Expression 54)
S
S,FB
=−K
S3(θ1−θ1*)L−KS4([θ1]−[θ1*])L−KS5(λS−λS*)−KS6([λS]−[λS*]) (Expression 55)
In the seventh embodiment, feedback gains KW5, KW6, KS1, and KS2 are zeroed in order to clarify roles of the drive motor 52 and the riding section motor 62. A value may nonetheless be assigned for each of the gains. Additionally, in that case, a value may be assigned for the deviation of the corresponding state quantity through frequency decomposition.
Finally, the main control ECU 21 uses, as in the first embodiment, the drive wheel control ECU 22 and the riding section control ECU 23 to control the actual outputs from the drive motor 52 and the riding section motor 62 based on the determined feedforward outputs and feedback outputs (step 200), before returning to the main routine.
The following effects can be gained with the seventh embodiment.
(1) Vibration of the vehicle body and the riding section 13 is prevented to improve the riding comfort.
(2) A balanced state is not achieved at a posture different from the target posture.
If, in the seventh embodiment, precise control of the drive wheel is difficult due to backlash in drive wheel gears or minor deformation of a drive tire, the low-frequency component may be borne by the drive motor 52 and the high-frequency component may be borne by the riding section movement.
An eighth embodiment will be described below.
The eighth embodiment is the vehicle incorporating the balancer of the third embodiment and employing the technique of the seventh embodiment. Either the riding section movement, the drive motor 52, or the balancer is selectively used according to the frequency component of disturbance.
Specifically, in feedback control, a low-frequency component of the deviation is borne by the riding section movement, a mid-frequency component is borne by the drive motor 52, and a high-frequency component is borne by the balancer movement. Vibration of the vehicle relative to the disturbance is thereby prevented and the rider feels no vibration.
Use of the riding section movement or the drive motor 52 for vehicle body posture control may generate vibration at high frequency, which causes the rider to feel unpleasant. This is because of inertia acting upon the riding section movement or the drive motor 52 is large, and thus the riding section movement or the drive motor 52 are not suitable for precise control.
In the eighth embodiment, therefore, the deviation (θ1−θ1*) in the vehicle body inclination angle between the actual state value θ1 and the target value θ1* is divided into the low-frequency component, the mid-frequency component, and the high-frequency component by a frequency filter. The low-frequency component is borne by the riding section movement, the mid-frequency component is borne by the drive motor 52, and the high-frequency component is borne by the balancer movement.
As shown in
The values of the predetermined frequency fc21 and fc22 are set at frequencies at which the posture can be controlled through the riding section movement and by the drive motor to a certain degree. Predetermined values, for example, 1 Hz and 5 Hz are preset.
Running and posture control according to the eighth embodiment will be described below.
Note that a control system according to the eighth embodiment is arranged in the same manner as that in the third embodiment described with reference to
In the running and posture control in the eighth embodiment, the main control ECU 21 determines the target state quantity, acquires the state quantity, and determines the feedforward output, as in the third embodiment (steps 110 to 180).
The main control ECU 21 next calculates the low-, mid-, and high-frequency components of each deviation (step 191).
Specifically, the main control ECU 21 decomposes the deviation in the vehicle inclination angle between an actual state value and a target value (θ1−θ1*) into the low-frequency component (Expression 56), the high-frequency component (Expression 57), and the mid-frequency component (Expression 58) using frequency filters of Expressions 56 to 58.
Further, the main control ECU 21 decomposes the deviation in the vehicle body inclination angular velocity between the actual state value and the target value ([θ1]−[θ1*]) into a low-frequency component (Expression 59), a high-frequency component (Expression 60), and a mid-frequency component (Expression 61) using frequency filters of Expressions 59 to 61.
Note that, in the eighth embodiment, a first-order finite impulse type low-pass filter is used. Another type or a filter of a higher order may, instead, be used.
In the expressions, ξL=Δt/TC1 and ξH=Δt/TC2 and (x)L(k-1) is a value of the low-frequency component at a time Δt ago. (x)H(k-1) is a value of the high-frequency component. Δt is the control operation cycle. TC1, (=1/fc21) and TC2(=1/fc22) are the time constants of the respective filters.
(θ1−θ1*)L=ξL(θ1−θ1*)+(1−ξL)(θ1−θ1*)L(k-1) (Expression 56)
(θ1−θ1*)H=(θ1−θ1*)−(θ1−θ1*)(k-1)+(1−ξH)(θ1−θ1*)H(k-1) (Expression 57)
(θ1−θ1*)M=(θ1−θ1*)−(θ1−θ1*)L−(θ1−θ1*)H (Expression 58)
([θ1]−[θ1*])L=ξL([θ1]−[θ1*])+(1−ξL)([θ1]−[θ1*])L(k-1) (Expression 59)
([θ1]−[θ1*])H=([θ1]−[θ1*])−([θ1]−[θ1*])(k-1)+(1−ξH)([θ1]−[θ1*])H(k-1) (Expression 60)
([θ1]−[θ1*])M=([θ1]−[θ1*])−([θ1]−[θ1*])L−([θ1]−[θ1*])H (Expression 61)
The main control ECU 21 then determines a feedback output of each actuator (step 192). Specifically, Expression 62 is used to determine the feedback output of the drive motor, Expression 63 is used to determine the feedback output of the riding section motor 62, and Expression 64 is used to determine the feedback output of the balancer motor 72 based on the deviation in each state quantity between the actual state value and the target value.
τW,FB=−KW1(θW−θW*)−KW2([θW]−[θW*])−KW3(θ1−θ1*)M−KW4([θ1]−[θ1*])M (Expression 62)
S
S,FB
=−K
S3(θ1−θ1*)L−KS4([θ1]−[θ1*])L−KS5(λS−λS*)−KS6([λS]−[λS*]) (Expression 63)
S
B,FB
=−K
B3(θ1−θ1*)H−KB4([θ1]−[θ1*])H−KB7(λ2−λ2*)−KB8([λ2]−[λ2*]) (Expression 64)
Finally, the main control ECU 21 uses, as in the third embodiment, the drive wheel control ECU 22 and the riding section control ECU 23 to control the actual outputs from the drive motor 52 and the riding section motor 62 based on the determined feedforward outputs and feedback outputs (step 200), before returning to the main routine.
The following effects can be gained according to the eighth embodiment.
(1) Vibration of the vehicle body and the riding section 13 is largely reduced for improving riding comfort.
(2) A balanced state is not achieved with a posture different from the target posture.
If, in the eighth embodiment, precise control of the drive wheel is difficult due to backlash in drive wheel gears or minor deformation of the drive tire, the low-frequency component may be borne by the drive motor 52 and the mid-frequency component may be borne by the riding section movement.
A ninth embodiment will be described below.
The ninth embodiment relates to control performed with a failed actuator. In the embodiment, if either the drive motor 52 or the riding section motor 62 fail, the inverted control of the vehicle body is maintained using only the operational motor by changing the control (changing the state target value and control gain).
If the drive motor 52 fails during posture control using the drive motor 52 without using the riding section movement or the balancer, the posture of the vehicle body cannot be controlled, so that the inverted state of the vehicle body can no longer be maintained.
Meanwhile, the riding section motor 62 failure during posture control including the riding section movement makes the control to bring the riding section 13 into the target position difficult and the inverted state of the vehicle body can no longer be maintained.
In the ninth embodiment, therefore, if the drive motor 52 fails, the riding section 13 is appropriately moved according to the actual vehicle running acceleration and the vehicle body inclination angle to thereby maintaining the inverted state. If, on the other hand, the riding motor 62 fails, the vehicle body is inclined appropriately according to the actual riding section position to thereby maintain the inverted state and control vehicle running.
Running and posture control according to the ninth embodiment will be described below.
Note that a control system according to the ninth embodiment is arranged in the same manner as that in the first embodiment described with reference to
The main control ECU 21 determines a failure state of each actuator (step 300). Specifically, the failure state is detected by acquiring a fault indicating signal from each of the actuator control ECUs 22 to 24 or based on an estimation made from input/output relations by the observer.
For example, the main control ECU 21 estimates a value of drive torque outputted from the drive motor 52 based on, for example, a change in the drive wheel rotation state or the vehicle body inclination state and, if a difference between the estimated value and the command value issued to the drive motor 52 exceeds a predetermined threshold value, determines that the drive motor 52 is in a failure state.
Similarly, the main control ECU 21 estimates a value of movement thrust force outputted from the riding section motor 62 based on, for example, a riding section movement state and, if a difference between the estimated value and the command value issued to the riding section motor 62 exceeds a predetermined threshold value, determines that the riding section motor 62 is in a failure state.
From the result of the failure state determination, the main control ECU 21 determines whether the riding section motor 62 has failed (step 310) and whether the drive motor 52 has failed (step 320) and, if both are operational (step 310; N, step 320; N), performs the normal control (step 330).
In the normal control, the running and posture control is performed according to any one of the first through eighth embodiments or a combination thereof.
Meanwhile, if the drive motor 52 is determined to be faulty (step 320; Y), the main control ECU 21 performs a control under drive motor failure (step 340) and, if the riding section motor 62 is determined to be faulty (step 310; Y), the main control ECU 21 performs a control under riding section motor failure (step 350).
Upon detecting the drive motor 52 failure, the main control ECU 21 first acquires an actual acceleration α of the vehicle and the actual vehicle body inclination angle θ1 (step 341).
The actual acceleration α is, for example, acquired through any one of the following: acquisition from the acceleration sensor, calculation based on the rotation angle or the rotation angular velocity obtained from the drive wheel sensor 51, estimation by the observer, and use of braking performance specifications of an emergency brake system.
The main control ECU 21 next determines the target value of the riding section position (step 343). Specifically, Expressions 65 to 67 are used to determine the target value of the riding section position (riding section target position) λS* from the acquired vehicle acceleration α and the acquired vehicle body inclination angle θ1.
In Expression 66, φ=tan−1α.
λS*=−λS,Max(α<−αMax) (Expression 65)
λS*=l1(m1/mS)[tan(φ−θ1)+γ(sin φ/cos(φ−θ1))](−αMax≦α≦αMax) (Expression 66)
λS*=λS,Max(α>αMax) (Expression 67)
If the drive motor 52 is faulty, accurate control of the vehicle acceleration and vehicle body inclination angle is difficult and, even though the target value α* of the vehicle acceleration or the target value θ1* of the vehicle body inclination angle cannot achieved, the vehicle body posture needs to be controlled stably to a certain degree by using only the riding section movement.
Accordingly, as expressed by Expressions 65 to 67, the riding section target position λS* is determined in accordance with the actual vehicle acceleration α and the actual vehicle body inclination angle θ1 and the riding section 13 is moved to the target position to thereby retain the inverted state.
For the vehicle body inclination angle, the posture control may be maintained by giving a target value corresponding to the case in which the drive motor fails.
The main control ECU 21 then calculates remaining target values (step 343). Specifically, the riding section target position λS* is differentiated with respect to time to calculate the target value [λS*] of the riding section movement speed.
In addition, the main control ECU 21 determines the feedforward output of the riding section motor 62 (step 344). Specifically, Expression 68 is used to determine the feedforward output SS,FF of the riding section motor 62 from the riding section target position λS*. The feedforward output SS,FF is the riding section thrust force required for keeping the riding section 13 at the target position at the actual vehicle body inclination angle θ1.
S
S,FF
=−m
S
g sin θ1 (Expression 68)
The main control ECU 21 next acquires each state quantity from the sensor (step 345). Specifically, the drive wheel rotation angle (rotation angular velocity) is acquired from the drive wheel sensor 51, the vehicle body inclination angle (inclination angular velocity) is acquired from the vehicle body inclination sensor, and the riding section position (movement speed) is acquired from the riding section sensor.
Additionally, the main control ECU 21 calculates remaining state quantities (step 346). Specifically, the drive wheel rotation angle (rotation angular velocity), the vehicle body inclination angle (inclination angular velocity), and the riding section position (movement speed) are integrated or differentiated with respect to time to calculate the remaining state quantities.
The main control ECU 21 determines the feedback output of the riding section motor 62 (step 347).
Expression 69 is used to determine the feedback output of the riding section motor 62 based on the deviation between each target value and actual state quantity.
The vehicle body posture control may be strengthened by making values of the feedback gains KS3, KS4 greater than those during the normal control. KS3=KS4=0 may be made true by ignoring the vehicle body inclination angle.
S
S,FB
=−K
S3(θ1−θ1*)−KS4([θ1]−[θ1*])−KS5(λS−λS*)−KS6([λS]−[λS*]) (Expression 69)
The main control ECU 21 gives the riding section control system a command value (step 348) and returns to the main routine.
Specifically, the main control ECU 21 gives the riding section control ECU 23 a sum of the feedforward output and the feedback output as the command value (riding section thrust force command value) SS.
The riding section control ECU 23 supplies an input voltage (drive voltage) corresponding to the riding section thrust force command value SS to thereby move the riding section 13.
Thus the posture is controlled through movement of the riding section 13. In this case, in which the drive motor 52 is faulty, the posture control under gradual deceleration of the vehicle and after a stop is performed only through the movement of the riding section 13.
When the riding section motor 62 is faulty, the running and posture control can be performed using the drive motor 52. When the failure is detected, the main control ECU 21 acquires the maneuvering operation amount operated by the rider, specifically, the amount of operation of the joystick 31 operated by the rider (step 351).
The main control ECU 21 then determines the vehicle target acceleration α* based on the acquired maneuvering operation amount (step 352). Note that the vehicle control may be automatically shifted into an emergency stop mode, in which a predetermined deceleration target value is automatically assigned.
The main control ECU 21 calculates the target value of the drive wheel angular velocity (drive wheel target angular velocity) [θω*] (step 353). Specifically, the drive wheel target angular velocity [θω*] is calculated from the target value of deceleration. For example, the target value of deceleration is integrated with respect to time and divided by a predetermined drive wheel ground contact radius to arrive at a value as the target value of the drive wheel rotation angular velocity.
The main control ECU 21 then determines a target value of the vehicle body inclination angle (step 354). Specifically, Expression 70 is used to determine the target vehicle body inclination angle θ1* from the vehicle target acceleration α* and the actual riding section target position λS*.
In Expression 70, β=tan−1(mSλS/m1l1).
As such, the vehicle body is inclined to the target value θ1* as appropriately according to the actual riding section position λS* to maintain the inverted state, thereby responding to the failure of the riding section motor 62.
The posture control may be maintained even more strongly by giving the riding section position a target value.
θ1*=φ*−β+sin−1(γ sin φ*cos β) (Expression 70)
The main control ECU 21 next calculates remaining target values (step 355).
Each target value is differentiated with respect to time or integrated with respect to time to calculate the drive wheel rotation angle target value θW* and the vehicle body inclination angular velocity target value [θ1*].
The main control ECU 21 next determines the feedforward output of the drive motor 52 (step 356). Specifically, Expression 7 (see the first embodiment) is used to determine the feedforward output τW,FF of the drive motor 52 from the vehicle target acceleration α*.
The main control ECU 21 then acquires each state quantity from the sensor (step 357). Specifically, the drive wheel rotation angle (rotation angular velocity) is acquired from the drive wheel sensor 51, the vehicle body inclination angle (inclination angular velocity) is acquired from the vehicle body inclination sensor, and the riding section position (movement speed) is acquired from the riding section sensor.
Additionally, remaining state quantities are calculated (step 358). The drive wheel rotation angle (rotation angular velocity) and the vehicle body inclination angle (inclination angular velocity) are integrated or differentiated with respect to time to calculate the remaining state quantities.
The main control ECU 21 next determines the feedback output of the drive motor 52 (step 359). Specifically, Expression 71 is used to determine the feedback output τW,FB of the drive motor 52 based on the deviation between each target value and actual state quantity.
Note that, in Expression 71, the feedback gains KW5 and KW6 may be given to add a term of (−KW5λS−KW6[λS]) to thereby return the riding section back to a neutral position.
τW,FB=−KW1(θW−θW*)−KW2([θW]−[θW*])−KW3(θ1−θ1*)−KW4([θ1]−[θ1*]) (Expression 71)
Finally, the main control ECU 21 gives the drive wheel control system a command value (step 360) and returns to the main routine.
Specifically, the main control ECU 21 supplies the drive wheel control ECU 22 a sum of the feedforward output τW,FF determined and the feedback output τW,FB determined (ιW,FF+τW,FB) as the drive torque command value τW.
The drive wheel control ECU 22 supplies an input voltage (drive voltage) corresponding to the drive torque command value τW to thereby give the drive wheel the drive torque τW. Thus, the posture and running are controlled by the drive motor 52.
As described above, according to the ninth embodiment, even if the drive motor 52 or the riding section motor 62 fails, the posture control of the vehicle body can be maintained and safety of the rider can be sufficiently ensured.
Although this embodiment is provided with capability of the control when the drive motor 52 fails and that when the riding section motor 62 fails, only with either one of the capabilities may be provided.
Number | Date | Country | Kind |
---|---|---|---|
2007 171519 | Jun 2007 | JP | national |
2007 210532 | Aug 2007 | JP | national |
2007 210533 | Aug 2007 | JP | national |
2007 210534 | Aug 2007 | JP | national |
2007 210535 | Aug 2007 | JP | national |
2007 210536 | Aug 2007 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2008/056551 | 4/2/2008 | WO | 00 | 3/2/2010 |