MOTION CONTROL DEVICE FOR LEFT AND RIGHT INDEPENDENT DRIVE VEHICLE
20230398880 ยท 2023-12-14
Assignee
Inventors
Cpc classification
B60L15/20
PERFORMING OPERATIONS; TRANSPORTING
B60L3/0061
PERFORMING OPERATIONS; TRANSPORTING
International classification
B60L15/20
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A motion control device independently drives left and right wheels by calculating a wheel torque value from a difference between a reference vehicle state quantity or an operation instruction of a higher driving device and an actual vehicle state quantity regarding a motion and a posture of the vehicle, and controlling a plurality of motors based on the wheel torque value. The motion control device calculates a momentum error from a difference between a reference momentum based on wheel speed and a tire steering angle and an actual momentum based on the the motion and the posture of the vehicle, extracts a momentum error, calculates a wheel torque correction amount based on the extracted momentum error caused by the torque difference of the motor, adds the wheel torque correction amount to the wheel torque value, and outputs a wheel torque command to the plurality of motors.
Claims
1. A motion control device for a left and right independent drive vehicle, that independently drives left and right wheels by calculating a wheel torque value from a difference between a reference vehicle state quantity calculated from driver operation information or an operation instruction of a higher driving device and an actual vehicle state quantity calculated from information regarding a motion and a posture of the vehicle, and controlling a plurality of motors based on the wheel torque value, wherein the motion control device calculates a momentum error from a difference between a reference momentum calculated based on a wheel rotation speed and a tire steering angle and an actual momentum calculated based on the information regarding the motion and the posture of the vehicle, extracts a momentum error caused by a torque difference of the motor from the calculated momentum error, calculates a wheel torque correction amount based on the extracted momentum error caused by the torque difference of the motor, adds the wheel torque correction amount to the wheel torque value, and outputs a wheel torque command to the plurality of motors.
2. The motion control device for a left and right independent drive vehicle according to claim 1, wherein the actual momentum is calculated based on a longitudinal acceleration, a lateral acceleration, and a yaw rate of the vehicle.
3. The motion control device for a left and right independent drive vehicle according to claim 2, wherein the reference momentum is an estimated lateral acceleration, and the actual momentum is an actual lateral acceleration.
4. The motion control device for a left and right independent drive vehicle according to claim 3, wherein the motion control device comprises a separation unit, and the separation unit separates a disturbance component for the vehicle from a frequency characteristic related to the momentum error and extracts the momentum error caused by the torque difference of the motor.
5. The motion control device for a left and right independent drive vehicle according to claim 4, wherein the separation unit separates, from the momentum error caused by the torque difference of the motor, a behavior caused by a constant difference due to an individual difference of the motor and a behavior caused by a temporary difference due to a temperature, in accordance with the frequency characteristic.
6. The motion control device for a left and right independent drive vehicle according to claim 1, wherein the information regarding the motion and the posture of the vehicle is set to a rotational speed difference and a rotational angle difference between the motors.
7. The motion control device for a left and right independent drive vehicle according to claim 1, wherein the motion control device controls four motors to independently drive four wheels, the information regarding the motion and the posture of the vehicle is a yaw rate, a pitch rate, and a roll rate of the vehicle, and a momentum error between the four motors is calculated based on the yaw rate, the pitch rate, and the roll rate.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0010]
[0011]
[0012]
[0013]
[0014]
[0015]
[0016]
[0017]
[0018]
[0019]
[0020]
DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0021] Hereinafter, embodiments of the present invention will be described with reference to the accompanying drawings. The same components are denoted by the same reference signs, and the same description will not be repeated.
[0022] The various components of the present invention do not necessarily need to be independent, and allow one component to be configured by a plurality of members, a plurality of components to be configured by one member, a certain component to be a portion of another component, a portion of one component and a portion of another component to overlap with each other, and the like.
[0023] A motion control device for a left and right independent drive vehicle will be described with reference to
[0024]
[0025] In
[0026] Other components and power supply wirings to the respective devices are similar to those of a normal vehicle, but are not necessary in the description of the present embodiment. Thus, illustration and description thereof will be omitted. In the coordinate system used for the description, the front-rear direction of the vehicle 1 is set as an x-axis (the forward direction is positive), the left-right direction is set as a y-axis (the leftward direction is positive), and the up-down direction is set as a z-axis (the upward direction is positive).
[0027] The vehicle 1 is driven by generating a driving force for the in-wheel motor of each wheel with reference to an input of the accelerator pedal. In the present embodiment, each tire can independently generate driving torque and braking torque, and can adjust the driving torque and the braking torque in accordance with a traveling situation or the like.
[0028] The traveling direction of the vehicle is changed in a manner that the steering mechanism 6B steers the front wheel with reference to an input of the steering wheel 6A. In the present embodiment, a bi-wire system in which the steering wheel and the steering mechanism are connected by an electric wire is provided.
[0029] Braking of the vehicle is performed by generating a braking force for the in-wheel motor of each wheel with reference to an input of the brake pedal 5. In order to cope with a region in which control by each in-wheel motor is not possible, a friction brake is used or used in combination, but since the friction brake is a component unnecessary for the description of the present embodiment as described above, the description of the friction brake will be omitted.
[0030]
[0031]
[0032] The present invention is similarly applicable to both a manually driven vehicle and a vehicle driven by an automatic driving device, and an operation instruction of a higher driving device such as the automatic driving device can be used as an input of the motion control device 2 for the vehicle instead of the driver operation information.
[0033] The processing in the motion control device 2 for the vehicle is roughly divided into two parts. The first is a part for controlling the vehicle state, and the second is a part for calculating the correction amount of the wheel torque value.
[0034] In the first part for controlling the vehicle state, a reference vehicle state quantity input element 2C calculates a reference vehicle state quantity from the above-described driver operation information. An actual vehicle state quantity calculation element 2D calculates an actual vehicle state quantity from the information regarding the motion and the posture of the vehicle. Then, a vehicle state quantity error is calculated from a difference between the reference vehicle state quantity and the actual vehicle state quantity, and a vehicle state controller 2G calculates a wheel torque value and a tire steering angle which are operation quantities, based on the calculated vehicle state quantity error.
[0035] In the part for calculating the correction amount of the wheel torque value, a reference momentum input element 2A calculates a reference momentum from the above-described device information. An actual momentum calculation element 2B calculates an actual momentum from the information regarding the motion and the posture of the vehicle. Then, a momentum error is calculated from a difference between the reference momentum reference and the actual momentum. A separation unit 2E extracts a momentum error caused by a torque difference of the motor from the calculated momentum error, and a correction amount calculation unit 2F calculates a wheel torque correction amount from the extracted momentum error. Finally, the wheel torque value calculated in the first part for controlling the vehicle state is corrected by adding the wheel torque correction amount calculated in the second part for calculating the correction amount of the wheel torque value, and the corrected wheel torque value is output from the motion control device 2 as the wheel torque command. Regarding the tire steering angle command, the value calculated in the first part for controlling the vehicle state itself is output from the motion control device 2 as the tire steering angle command.
[0036] In the present embodiment, a vehicle in which the driver gets in the vehicle and performs a driving operation is used. The present invention is not limited thereto. For example, a configuration in which the input to the motion control device 2 for the vehicle is given from a higher automatic driving control device may be made. Further, in the present embodiment, the vehicle of a four-wheel in-wheel motor is used. The present invention is not limited thereto. For example, a vehicle that drives only two front wheels or only two rear wheels may be used, or a configuration in which the left and right wheels are driven by two motors mounted on the vehicle body of a vehicle instead of the in-wheel motor may be made.
[0037] A specific operation according to the present embodiment will be described below by taking, as an example, traveling in which a driving force is applied only to the rear wheels and linear acceleration is performed.
[0038] When the vehicle performs linear acceleration, the driver operates the accelerator. In the motion control device 2 for the vehicle, the reference vehicle state quantity input element 2C receives the input, calculates the reference longitudinal acceleration, sets the calculated reference longitudinal acceleration as the reference vehicle state quantity. Here, the vehicle state controller 2G calculates and outputs the wheel torque command so that the current longitudinal acceleration becomes equal to the reference longitudinal acceleration. Since the vehicle travels straight in this state, the left and right wheel torques are commanded to have the same value.
[0039]
[0040]
[0041] In a case where the wheel torque value is generated by a longitudinal acceleration command F61 to the vehicle, when there is a torque difference between the left and right motors, a lateral acceleration F62 in the positive direction is generated as in the above-described operation. At this time, the lateral acceleration is affected by a vehicle motion due to road noise, which is unevenness of the road surface, a suspension operation and deflection of each part in addition to the torque difference of the motor, and thus has a distorted shape as illustrated in
[0042]
[0043] Here, frequency characteristics of each general behavior will be described.
[0044] From the above description, by filtering the lateral acceleration in the frequency domain, it is possible to extract only the component caused by the torque difference of the motor among the lateral accelerations generated in the vehicle. Specifically, a lowpass filter is applied to extract only the component caused by the torque difference of the motor.
[0045] In the motion control device 2 for the vehicle in the present embodiment, the wheel torque correction amount is calculated by using this principle. That is, the reference momentum input element 2A calculates the estimated lateral acceleration based on the wheel rotation speed and the tire steering angle and sets the calculated lateral acceleration as the momentum reference, and the actual momentum calculation element 2B calculates the actual lateral acceleration based on the longitudinal acceleration, the lateral acceleration, and the yaw rate and sets the calculated actual lateral acceleration as the actual momentum. The difference (momentum error) from the reference momentum is calculated.
[0046] The separation unit 2E applies a lowpass filter to the difference (momentum error) to extract a momentum error caused by the torque difference of the motor. Since the momentum error as the difference is the lateral acceleration component, it is possible to separate the disturbance component for the vehicle from the difference in frequency characteristics through the lowpass filter and extract only the momentum error caused by the torque difference of the motor. Furthermore, the correction amount calculation unit 2F calculates the wheel torque correction amount from the relational expression between the lateral acceleration and the wheel torque difference used in the present embodiment. The wheel torque correction amount is added to the wheel torque value calculated by the vehicle state controller 2G and used as the output of the motion control device 2 for the vehicle as the wheel torque command. The wheel torque command is output to each of the left and right motors.
[0047] With the above operation, the wheel torque command is in a state in which the command value is corrected by the torque difference of the motor, and finally, the traction force generated in the vehicle is equal between the left and right motors. Thus, the vehicle can correctly perform the linear acceleration in response to the command of linear acceleration, without performing the turning motion. In the case of
[0048] In addition, in the calculation of the wheel torque correction amount, the influence of the vehicle motion due to the road noise which is the unevenness of the road surface, the suspension operation, and the deflection of each part is removed in addition to the torque difference of the motor, and only the torque difference between the left and right motors is correctly corrected. Therefore, it is possible to provide the motion control device for the vehicle, which is capable of suppressing application of erroneous correction and enhancing the control accuracy of the driving forces of the left and right wheels.
[0049] When the frequency domain is more finely separated in the separation unit 2E as illustrated in
[0050]
[0051] The separation unit 2E includes n bandpass filters. The bandpass filters (first to n-th bandpass filters) are installed with different passing frequency bands, and an influence of a target cause is extracted from a signal input to the separation unit 2E.
[0052] In addition, the correction amount calculation unit 2F has a configuration in which a plurality of integrators (first to n-th integrators) corresponding to the respective bandpass filters are mounted, and the correction amounts are calculated and combined to calculate the wheel torque correction amount. The calculated wheel torque correction amount is output from a lateral acceleration controller of the correction amount calculation unit 2F.
[0053] As described above, according to the motion control device 2 for the vehicle in the present embodiment, by separating the difference between the estimated value and the actual value of the vehicle momentum by the frequency, dividing the difference into the component due to a drive torque difference between the motors and the component due to the vehicle disturbance, and accurately correcting the drive torque difference between the motors, it is possible to provide the motion control device 2 for the vehicle, which is capable of accurately correcting the drive torque difference.
[0054] Simple straight acceleration has been described in the present embodiment, but the present invention is not limited thereto. For example, correction may be applied during traveling such as acceleration on an acceleration lane of an expressway, merging and accelerating to a highway, stopping of a signal on a general road (a correction amount is calculated by a behavior with braking torque), and a behavior on a climbing road. The correction amount may be calculated at all times.
MODIFICATION EXAMPLES
[0055] A case of four-wheel independent drive in which four wheels are driven by controlling four motors will be described with reference to
[0056] For example, even when the motor torque on the left side is excessive compared to the motor torque on the right side, a difference occurs in the posture change of the vehicle depending on the front and rear positions of the motor in which the motor torque is excessive. In
[0057] In the present embodiment, by calculating the momentum error regarding the four motors based on the posture change (information regarding the motion and the posture of the vehicle) and calculating the correction amount of the wheel torque value by using the above relationship, it is possible to more accurately calculate the wheel torque correction amount. Thus, by forming the motion control device 2 using this mechanism, it is possible to provide the motion control device for the vehicle, which is capable of further enhancing the control accuracy of the driving force.
[0058] In the present embodiment, it is assumed that the reference vehicle state quantity is calculated from the driver operation information. For example, the reference vehicle state quantity may be calculated from an operation instruction of a higher driving device, a so-called automatic driving device, or the like.