Control device and program

By calculating the rotation center axis trajectory angle of the wheel, the problem of braking force estimation delay when the wheel contacts the step in the prior art is solved, and the vehicle is quickly and accurately judged and responded when contacting the step, ensuring safe driving.

CN119095739APending Publication Date: 2024-12-06DENSO CORP
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202380035770.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Priority Date
2022-04-25
Filing Date
2023-04-21
Publication Date
2024-12-06

AI Technical Summary

Technical Problem

When the wheels come into contact with the steps, it is difficult for the existing vehicle control device to accurately detect extremely slow vehicle speed, resulting in delays in braking force estimation, which may cause the wheel to cross the wheel stopper.

Method used

By obtaining the driving force applied by the vehicle on the road surface and the acceleration along the traveling direction, the angle of the rotation center axis trajectory of the wheel relative to the road surface is calculated, and based on this angle change amount determines whether the step should be crossed, so as to achieve appropriate braking driving force control.

Benefits of technology

It can quickly and accurately determine and respond when the wheels come into contact with the steps, preventing the vehicle from crossing the steps and ensuring safe driving.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119095739A_ABST
    Figure CN119095739A_ABST
Patent Text Reader

Abstract

A control device (10) is provided with: a driving force acquisition unit (11) that acquires driving force applied to a road surface by a vehicle (100); an acceleration acquisition unit (12) that acquires the acceleration of the vehicle (100) in the direction of travel; and an angle calculation unit (13) that calculates, on the basis of the driving force and the acceleration, a trajectory angle ([theta]), which is the angle formed by the trajectory of the rotational center axis (AX) of the wheels (111, 112) of the vehicle (100) with respect to the road surface.
Need to check novelty before this filing date? Find Prior Art

Description

Citation of related applications

[0001] This application is based on Japanese patent application No. 2022-071270 filed on April 25, 2022, and claims the priority thereof. The entire contents of the patent application will be incorporated into this specification by reference. Technical Field

[0002] The present disclosure relates to a control device and a program for a vehicle. Background Art

[0003] Patent Document 1 below describes a device that can estimate the height of a step when a wheel of a vehicle contacts the step. According to the device, when the step is a wheel stopper, an appropriate braking force can be generated to stop the vehicle at a time point before the wheel crosses the step. In addition, when the step is not a wheel stopper, a necessary and appropriate driving force is generated to cross the step, and the step can be crossed while suppressing the vehicle from being ejected. Prior art literature Patent Literature

[0004] Patent Document 1: Japanese Patent Application Publication No. 2019-93761 Summary of the invention

[0005] In the device described in Patent Document 1, after the wheel contacts the step, the height of the step is estimated based on the torque value at the time when the wheel starts to move while gradually increasing the driving force. The above "time when the wheel starts to move" is determined based on the measurement value of the vehicle speed sensor.

[0006] However, it is difficult for a general vehicle speed sensor to detect an extremely slow vehicle speed, such as 1 km / h or less. Therefore, in the device described in Patent Document 1, the time when the wheel is determined to start moving may be later than the time when the wheel actually starts moving. As a result, the time when the braking force is generated may be delayed, and the wheel may cross the wheel stopper.

[0007] An object of the present disclosure is to provide a control device capable of appropriately performing control when a wheel contacts a step and a program for the control device.

[0008] The control device disclosed in the present invention is a control device for a vehicle, comprising: a driving force acquisition unit, which acquires the driving force applied by the vehicle on the road surface; an acceleration acquisition unit, which acquires the acceleration of the vehicle along the direction of travel; and an angle calculation unit, which calculates the angle formed by the trajectory of the rotation center axis of the wheels of the vehicle relative to the road surface, i.e., the trajectory angle, based on the driving force and the acceleration.

[0009] According to the control device of this structure, the angle formed by the trajectory of the rotation center axis of the wheel relative to the road surface, i.e., the trajectory angle, can be calculated. The trajectory angle varies according to the shape of the step that the wheel abuts. Therefore, for example, the height of the step can be estimated based on the calculated trajectory angle, and the braking and driving force can be appropriately controlled accordingly. BRIEF DESCRIPTION OF THE DRAWINGS

[0010] Figure 1 It is a diagram schematically showing the structure of a vehicle equipped with the control device according to the first embodiment. Figure 2 It is a diagram schematically showing the configuration of the control device according to the first embodiment. Figure 3 It is a figure which shows the state which the wheel contacts a step. Figure 4 It is a diagram for explaining the locus and locus angle of the rotation center axis. Figure 5 : is a flowchart showing the flow of processing executed by the control device of the first embodiment. Figure 6 It is a time chart showing changes in vehicle speed and the like when the control is performed by the control device according to the first embodiment. Figure 7 It is a time chart showing changes in vehicle speed and the like when the control is performed by the control device according to the first embodiment. Figure 8 It is a diagram schematically showing the configuration of a control device according to the second embodiment. Fig. 9 : is a flowchart showing the flow of processing executed by the control device of the second embodiment. Fig.10 : is a flowchart showing the flow of processing executed by the control device of the second embodiment. Fig.11 It is a diagram schematically showing the configuration of a control device according to a third embodiment. Fig.12 This is a diagram showing the correspondence between the height of the step that the wheel contacts and the calculated climbing distance. Fig.13 : is a flowchart showing the flow of processing executed by the control device of the third embodiment. DETAILED DESCRIPTION

[0011] Hereinafter, the present embodiment will be described with reference to the accompanying drawings. In order to facilitate understanding of the description, the same components are denoted by the same reference numerals as much as possible in each figure, and repeated description is omitted.

[0012] A first embodiment will be described. A control device 10 of this embodiment is mounted on a vehicle 100 and is configured as a device for controlling the vehicle 100. Before describing the control device 10, first, referring to Figure 1 The structure of vehicle 100 will be described.

[0013] The vehicle 100 is a vehicle that travels based on the driving operation of the driver. However, when the wheel contacts a step, the control device 10 may automatically perform a part of the driving operation (e.g., braking). The vehicle 100 includes a vehicle body 101, wheels 111, 112, 121, 122, a rotating electric machine 150, and a battery 160.

[0014] The vehicle body 101 is the main body of the vehicle 100 and is also referred to as the "vehicle body". The wheel 111 is a wheel provided at the front left portion of the vehicle body 101, and the wheel 112 is a wheel provided at the front right portion of the vehicle body 101. The wheels 111 and 112, which are front wheels, are provided as driven wheels in the present embodiment.

[0015] The wheel 121 is a wheel provided at the rear left side portion of the vehicle body 101, and the wheel 122 is a wheel provided at the rear right side portion of the vehicle body 101. The wheels 121 and 122 as rear wheels are provided as drive wheels in this embodiment. That is, the wheels 121 and 122 are rotated by the driving force of the rotary electric machine 150 described later, and the vehicle 100 travels.

[0016] Thus, the vehicle 100 of the present embodiment is configured as a so-called "rear-wheel drive" vehicle. Alternatively, the vehicle 100 may be configured as a front-wheel drive vehicle or a four-wheel drive vehicle. In the latter case, in addition to the rotary motor 150 for driving the rear wheels, a rotary motor for driving the front wheels may be provided separately.

[0017] A brake device 131 is provided in the wheel 121, and a brake device 132 is provided in the wheel 122. Both the brake devices 131 and 132 are brake devices that apply braking force to the wheels by oil pressure. Such brake devices can be provided not only in the driving wheels, but also in the wheels 111 and 112 that are driven wheels. The operation of the brake devices 131 and 132 is controlled by the brake ECU 20 described later.

[0018] The rotating electric machine 150 is a device that receives power from a battery 160 to be described later and generates a driving force for rotating the wheels 121 and 122, that is, a driving force required for the vehicle 100 to travel. The rotating electric machine 150 is a so-called "electric generator". The driving force generated by the rotating electric machine 150 is transmitted to the wheels 121 and 122 via the powertrain unit 140, respectively, so that the wheels 121 and 122 rotate. In addition, the power transmission between the battery 160 and the rotating electric machine 150 is performed via an inverter as a power converter, but in Figure 1 The inverter is omitted in the illustration.

[0019] In addition to generating a driving force for accelerating vehicle 100 , rotating electric machine 150 can also generate a braking force for decelerating vehicle 100 by regeneration.

[0020] The vehicle 100 can be braked by the rotating electric machine 150 or by the brake devices 131 and 132 as described above.

[0021] The battery 160 is a storage battery for supplying driving power to the rotating electric machine 150. In the present embodiment, a lithium ion battery is used as the battery 160. The regenerative power generated by the rotating electric machine 150 during braking is supplied to the battery 160 via an inverter (not shown) to charge the battery 160.

[0022] In the vehicle 100 , a brake ECU 20 is provided separately from the control device 10 . Both the control device 10 and the brake ECU 20 are configured as a computer system having a CPU, ROM, RAM, etc. These components can communicate bidirectionally with each other via a network provided in the vehicle 100 .

[0023] The brake ECU 20 performs processing for controlling the operation of the brake devices 131 and 132 in accordance with an instruction from the control device 10 .

[0024] In addition, the control device 10 and the brake ECU 20 may not be divided into two devices as in the present embodiment. For example, the function of the brake ECU 20 may be integrated into the control device 10. When realizing the function of the control device 10 described below, its specific device structure is not particularly limited.

[0025] Vehicle 100 is provided with a plurality of sensors for measuring various physical quantities. Figure 1 The illustration is omitted. Figure 2 As shown in part of FIG. 2 , the sensors include a wheel speed sensor 201 , an acceleration sensor 202 , a current sensor 203 and an external camera 204 .

[0026] The wheel speed sensor 201 is a sensor for measuring the rotation speed per unit time of the wheel 111, etc. The wheel speed sensor 201 is provided separately for each of the four wheels 111, 112, 121, and 122, but Figure 2 In FIG. 1 , the wheel speed sensor 201 is schematically depicted as a single block. A signal indicating the rotation speed measured by the wheel speed sensor 201 is sent to the control device 10. The control device 10 can grasp the running speed of the vehicle 100 based on the signal.

[0027] The acceleration sensor 202 is a sensor for detecting the acceleration of the vehicle 100. The acceleration sensor 202 is mounted on the vehicle body 101. The acceleration sensor 202 is configured as a 6-axis acceleration sensor capable of detecting each rotational acceleration of pitch, roll, and yaw in addition to each acceleration in the front-rear direction, left-right direction, and up-down direction of the vehicle body 101. Signals representing each acceleration detected by the acceleration sensor 202 are sent to the control device 10.

[0028] The current sensor 203 is a sensor for detecting the value of the driving current flowing through the rotating electric machine 150. A signal indicating the value of the driving current detected by the current sensor 203 is input to the control device 10. The control device 10 can determine the magnitude of the driving force generated by the rotating electric machine 150 based on the input value of the driving current.

[0029] The external camera 204 is a camera that captures the surroundings of the vehicle 100, such as a CMOS camera. The data of the image captured by the external camera 204 is input to the control device 10. The control device 10 processes the image to understand the presence and shape of obstacles (such as steps such as wheel stoppers) around the vehicle 100. In addition, as a sensor for detecting the surrounding conditions of the vehicle 100, in addition to the external camera 204 or as a substitute for the external camera 204, other sensors may be provided. As such a sensor, for example, a LIDAR sensor or a radar may be cited.

[0030] Next, refer to Figure 2 The configuration of the control device 10 will be described. The control device 10 includes a driving force acquisition unit 11, an acceleration acquisition unit 12, an angle calculation unit 13, an overrun determination unit 14, and a braking / driving force control unit 15 as block elements representing its functions.

[0031] The driving force acquisition unit 11 is a part that processes the driving force applied by the vehicle 100 (specifically, the driving wheels of the vehicle 100) to the road surface. The driving force acquisition unit 11 acquires the value of the driving current flowing through the rotating electric machine 150 through the current sensor 203 as described above, and calculates and acquires the driving force based on the magnitude of the driving current. The driving force acquisition unit 11 can also calculate the torque of the driving wheel based on the magnitude of the driving current, and convert the obtained torque into the above-mentioned driving force along the traveling direction of the vehicle 100.

[0032] The acceleration acquisition unit 12 is a part that performs processing to acquire various accelerations based on the signal from the acceleration sensor 202. The acceleration acquired by the acceleration acquisition unit 12 includes the acceleration G in the traveling direction (ie, the front-rear direction) of the vehicle 100. x and the acceleration G along the left-right direction of the vehicle 100 y . Acceleration G x Also called "longitudinal acceleration", acceleration G y It is also called “lateral acceleration.” These are acquired as numerical values ​​in units of “G” of gravitational acceleration, such as “0.5G,” for example.

[0033] The angle calculation unit 13 is a part that performs processing to calculate a track angle. The "track angle" refers to the angle formed by the track of the rotation center axis of the wheel 111 and the like with respect to the road surface.

[0034] Figure 3 The diagram schematically shows a state where the wheel 111 is located on the road surface RD. A step ST is provided on the road surface RD as a wheel stopper, and a portion of the wheel 111 is in contact with the step ST. Figure 3 Starting from the state, when the vehicle 100 is to move further to the right side (ie, the step ST side), the wheel 111 goes over the step ST.

[0035] Figure 4 The graph shown by the solid line in (A) shows the relationship between the travel distance (horizontal axis) of the vehicle 100 and the height (vertical axis) of the rotation center axis AX of the wheel 111 when the vehicle 100 moves toward the right as described above. This graph can show the trajectory of the rotation center axis AX while the vehicle 100 is traveling. Figure 4 θ shown in (A) represents the above-mentioned trajectory angle when the vehicle 100 is located at the position x11. Such a trajectory angle θ can be defined corresponding to each position of the vehicle 100.

[0036] In addition, as described above, the "track angle" refers to the angle formed by the track of the rotation center axis AX of the wheel 111, etc. relative to the road surface, but the "track of the rotation center axis AX" mentioned here refers to the track of the rotation center axis AX when the vehicle 100 is observed along its left and right directions.

[0037] The angle calculation unit 13 calculates the angle based on the driving force acquired by the driving force acquisition unit 11 and the acceleration G acquired by the acceleration acquisition unit 12. x The two are used to calculate the trajectory angle θ of the current position. The specific calculation method will be described later.

[0038] in addition, Figure 4 The trajectory of the rotation center axis AX shown in the graph of (A) reflects to some extent the shape of the step ST shown by the dashed line in the figure. The two shapes are different from each other because the wheel 111 is not a rigid body and is deformed by the collision with the step ST.

[0039] Back to Figure 2 The description will be continued. The crossing determination unit 14 is a part that performs processing to determine whether the vehicle 100 should cross a step based on the trajectory angle θ. The specific determination method will be described later.

[0040] The braking-driving force control unit 15 is a part that performs processing to adjust the braking-driving force of the vehicle 100 by controlling the operation of the rotating electric machine 150 or the brake devices 131 and 132. When the crossing determination unit 14 determines that the vehicle 100 should cross a step, the braking-driving force control unit 15 controls the braking-driving force so that the wheels 111 and the like of the vehicle 100 cross the step. In addition, when the crossing determination unit 14 determines that the vehicle 100 should not cross a step, the braking-driving force is controlled to stop the vehicle 100.

[0041] Such control of the braking and driving force is performed in the form of temporarily replacing the driver's driving operation by the control device 10. Therefore, for example, when the wheel 111 is in contact with the wheel stopper, even if the driver mistakenly steps on the accelerator pedal, it is possible to prevent the vehicle 100 from running over the wheel stopper.

[0042] Main reference Figure 5 The flow of processing executed by the control device 10 is described with reference to the flowchart of FIG. Figure 5 The series of processing shown is, for example, started from the time when the wheel 111 of the vehicle 100 contacts the step or a time just before the step, and is repeatedly executed every time a predetermined control cycle elapses.

[0043] In the first step S01 of this process, the angle calculation unit 13 calculates the trajectory angle θ at the current time point. The angle calculation unit 13 first calculates the vertical load F using the following equation (1): z . Vertical load F z The vertical load F is a force applied downward to the wheels 111 and 112 as driven wheels. z The total value of the force applied to each of the wheels 111 and 112 is calculated.

Mathematical formula 1

[0044] "m" in the first term on the right side of equation (1) is the weight of the vehicle 100. "g" is the acceleration due to gravity. "l" is the wheelbase length of the vehicle 100. "l r "G" is the length along the front-rear direction from the center of gravity of the vehicle 100 to the rotation center axis of the rear wheels (wheels 121, 122). x " is the acceleration G as mentioned above x "h" is the height from the road surface to the center of gravity of the vehicle 100. The first term on the right side of the equation (1) represents the downward component of the force applied to the wheels 111 and 112 as the dynamic load when the vehicle 100 is traveling.

[0045] The "d s " is the attenuation coefficient of the damper (not shown) of the vehicle 100. "V s ” is the travel speed along the front-rear direction of the vehicle 100. V s For example, it can be calculated based on the signal from the wheel speed sensor 201. old ” is the value of the trajectory angle θ calculated in the previous control cycle. Figure 5 When dealing with, for example, using 0 as θ old The second term on the right side of equation (1) represents the forces applied to the wheels 111 and 112 respectively as the damper expands and contracts.

[0046] The angle calculation unit 13 calculates the vertical load F as described above. z Then, the trajectory angle θ is calculated using the following equation (2).

Mathematical formula 2

[0047] The "F" on the right side of formula (2) mg ” is the driving force acquired by the driving force acquisition unit 11, that is, the driving force applied to the road surface by the driving wheels of the vehicle 100.

[0048] As described above, the angle calculation unit 13 of the present embodiment calculates the angle based on the driving force acquired by the driving force acquisition unit 11 and the acceleration G acquired by the acceleration acquisition unit 12. x These two are used to calculate the trajectory angle θ of the current position.

[0049] In step S02 after step S01, the angle change amount is calculated. The "angle change amount" refers to the change amount of the track angle when the vehicle 100 moves forward a specified distance. If the above-mentioned "predetermined distance" is set to "ds" and the "change amount of the track angle" is set to "dθ", the angle change amount is expressed as "dθ / ds". The angle change amount can be calculated using the following formula (3).

Mathematical formula 3

[0050] The denominator on the right side of the equation (3) is the travel speed in the front-rear direction of the vehicle 100. The numerator on the right side is the time differential of the trajectory angle θ.

[0051] In step S03 following step S02, it is determined whether the angle change amount dθ / ds calculated as described above exceeds the threshold value TH1. If the angle change amount dθ / ds exceeds the threshold value TH1, the process proceeds to step S04.

[0052] When the process moves to step S04 , since the value of the angle change amount dθ / ds is relatively large, it is estimated that the step is high and the step is a wheel stopper. Therefore, the crossing determination unit 14 determines that the vehicle 100 should not cross the step.

[0053] In step S05 subsequent to step S04, the braking / driving force control unit 15 performs processing for immediately stopping the vehicle 100. Thus, the vehicle 100 stops in a state substantially immediately after the wheels 111 and 112 come into contact with the step.

[0054] In step S03, when the angle change amount dθ / ds is less than the threshold value TH1, the process proceeds to step S06. In step S06, the crossing determination unit 14 determines that the vehicle 100 should cross the step. In this case, the braking-driving force control unit 15 continues to generate the driving force of the vehicle 100. Thereafter, the vehicle 100 continues to travel after crossing the step.

[0055] As described above, the crossing determination unit 14 of the present embodiment determines whether the vehicle 100 should cross the step based on the angle change dθ / ds. Specifically, when the angle change dθ / ds exceeds the threshold TH1, it is determined that the vehicle 100 should not cross the step.

[0056] In addition, as a method for determining whether to cross the step based on the height of the step, a method based on the vehicle speed measured by a vehicle speed sensor can also be used, as described in Japanese Patent Publication No. 2019-93761. However, it is difficult for the vehicle speed sensor to detect extremely slow vehicle speeds such as less than 1 km / h. Therefore, in the device described in the above patent document, the time when the wheel is determined to start moving may be later than the time when the wheel actually starts moving. As a result, there may be a delay in the time when the braking force is generated, and the wheel may cross the wheel stopper.

[0057] On the other hand, in the control device 10 of the present embodiment, based on the driving force acquired by the driving force acquisition unit 11 and the acceleration G acquired by the acceleration acquisition unit 12, x The trajectory angle θ is calculated by using the two, and whether the step should be crossed is determined based on the angle change dθ / ds which is the slope of the trajectory angle θ. x Since it can be acquired relatively accurately when the vehicle speed is low, the above-mentioned determination can be performed quickly and accurately.

[0058] In the equation (1) for calculating the trajectory angle θ, V is used as the vehicle's running speed. s However, when the vehicle speed is less than about 1km / h, even if V s The value of is calculated to be 0, and has no significant effect on the accuracy of the trajectory angle θ calculated by equation (1).

[0059] Figure 6 An example of changes in the vehicle speed and the like when the wheels 111 and 112 come into contact with a step while the vehicle 100 is traveling is shown. Figure 6 G1 of (A) shows the change of the vehicle speed calculated from the rotation speed of the wheels 121 and 122 as the rear wheels. G2 shows the change of the vehicle speed calculated from the rotation speed of the wheels 111 and 112 as the front wheels.

[0060] Figure 6 (B) G3 represents the acceleration G x The change of G4 represents the acceleration G y changes. Figure 6 The graph of (C) shows the change of the trajectory angle θ. Figure 6 The graph (D) shows the change of the driving force acquired by the driving force acquisition unit 11 . Figure 6 The time t1 shown is the time when the wheels 111 , 112 come into contact with the step serving as a wheel stopper.

[0061] exist Figure 6In the example shown, immediately after time t1, the angle change amount dθ / ds exceeds the threshold value TH1, and immediately thereafter the braking force is automatically activated ( Figure 6 Therefore, even if the driver continues to depress the accelerator pedal, the vehicle 100 does not cross the step but stops immediately after contacting the step.

[0062] Figure 7 An example is shown in which the accelerator pedal is depressed from a state where the vehicle 100 is stopped near a step serving as a wheel stopper. Figure 7 G1 of (A) shows the change of the vehicle speed calculated from the rotation speed of the wheels 121 and 122 as the rear wheels. G2 shows the change of the vehicle speed calculated from the rotation speed of the wheels 111 and 112 as the front wheels.

[0063] Figure 7 (B) G3 represents the acceleration G x The change of G4 represents the acceleration G y changes. Figure 7 The graph (D) shows the change of the driving force acquired by the driving force acquisition unit 11 . Figure 7 The graph of (E) shows changes in the operation amount (depression amount) of the accelerator pedal. Figure 7 The time t2 shown is the time when the wheels 111 and 112 come into contact with the step serving as the wheel stopper immediately after the accelerator pedal is depressed.

[0064] In this example, at time t3 immediately after time t2, the angle change amount dθ / ds exceeds the threshold value TH1, and immediately thereafter, the driving force is automatically set to 0 ( Figure 7 (D)). Since the period from time t2 to time t3 is approximately 0.3 seconds, the vehicle 100 stops approximately at the same time as the wheels 111 and 112 come into contact with the wheel stoppers. Thus, in this embodiment, immediately after the wheels 111 and 112 come into contact with the step, a determination and response to whether the step should be crossed is performed quickly and appropriately.

[0065] In addition, the above description describes an example in which the vehicle 100 is a rear-wheel drive vehicle and the front wheel is in contact with the step. In the case where the vehicle 100 is a front-wheel drive vehicle, the same processing as above can also be performed. In this case, the "cosθ" in equation (2) is replaced by old " is set to 1 and the trajectory angle θ is calculated.

[0066] The second embodiment is described. The following mainly describes the differences from the first embodiment, and the description of the points common to the first embodiment is appropriately omitted. Figure 8As shown, the control device 10 of the present embodiment further includes a contact determination unit 16 and a step determination unit 17 .

[0067] The contact determination unit 16 is a part that performs processing to determine whether the contact state is a two-wheel contact state in which the left and right wheels are in contact with the step or a single-wheel contact state in which only one of the left and right wheels is in contact with the step. The determination method will be described later.

[0068] The step determination unit 17 is a part that performs processing to determine whether there is a step near the vehicle 100. The step determination unit 17 determines whether there is a step on the side of the traveling direction of the vehicle 100 at a time point before the wheel 111 of the vehicle 100 actually contacts the step. Such determination can be performed based on an image captured by the vehicle exterior camera 204 or the like.

[0069] Fig. 9 The series of treatments shown here replaces Figure 3 The series of processing shown is executed by the control device 10 of this embodiment. Fig. 9 The steps shown are Figure 3 The same steps as shown are marked with Figure 3 Same symbols (S01 etc.).

[0070] In the first step S11, the value of the trajectory angle θ at the current time point is calculated, for example, by the same method as described so far. In step S12 after step S11, it is determined whether the calculated value of the trajectory angle θ is below a predetermined lower limit. The lower limit is pre-set as the value of the trajectory angle θ corresponding to a small step of about 1 cm. If the value of the trajectory angle θ is below the lower limit, no special processing is performed, and the process ends. Fig. 9 That is, the crossing determination unit 14 of the present embodiment does not determine whether the vehicle 100 should cross the step when the trajectory angle θ is equal to or less than a predetermined lower limit value. This can reduce the calculation load of the control device 10.

[0071] In step S12, if the value of the track angle θ exceeds the lower limit, the process proceeds to step S13. In step S13, the contact determination unit 16 determines whether the two wheels are in contact. The contact determination unit 16 determines whether the two wheels are in contact. Fig.10 This determination is made by the processing shown.

[0072] exist Fig.10 In the first step S21, the running speed V of the vehicle 100 is determined. xIs it less than 1 km / h? This determination is made based on the measured value of the wheel speed sensor 201. In addition, the speed of 1 km / h is a value near the lower limit of the vehicle speed that can be measured by the wheel speed sensor 201. Therefore, the determination made in step S21 can also be said to be based on the driving speed V x And whether a value greater than 0 is detected is determined.

[0073] At the driving speed V x If the acceleration G measured by the acceleration acquisition unit 12 is less than 1 km / h, the process proceeds to step S22. y The absolute value of the acceleration G is greater than 0.05G. y When the absolute value of is greater than 0.05G, the process proceeds to step S23. In step S23, it is determined that the vehicle is in a single-wheel contact state. That is, it is determined that only one of the wheels 111 and 112 is in contact with the step, and the other is not in contact with the step.

[0074] In step S22, at the acceleration G y When the absolute value of is less than 0.05G, the process proceeds to step S24. In step S24, it is determined that the two wheels are in contact. That is, it is determined that both wheels 111 and 112 are in contact with the step.

[0075] In step S21, at the travel speed V x If the vehicle speed is greater than 1 km / h, the process proceeds to step S25. In step S25, after calculating the difference between the differential value of the vehicle speed calculated based on the rotation speed of the left wheel 111 and the differential value of the vehicle speed calculated based on the rotation speed of the right wheel 112, it is determined whether the absolute value of the difference is greater than 0.2 G. If the absolute value of the difference is greater than 0.2 G, the process proceeds to step S23 and determines that the vehicle is in a single-wheel contact state. If the absolute value of the difference is less than 0.2 G, the process proceeds to step S24 and determines that the vehicle is in a two-wheel contact state.

[0076] Back to Fig. 9 In step S13, if it is determined that the two wheels are in contact, the process proceeds to step S01. The process after step S01 is the same as that in the first embodiment ( Figure 5 ) is the same as the processing performed in ).

[0077] In step S13, if it is determined that the vehicle is in a single-wheel contact state, the process proceeds to step S14. In step S14, the angle calculation unit 13 calculates the trajectory angle θ at the current time point. Here, by using the following equation (4) instead of equation (1), first calculate F z .

Mathematical formula 4

[0078] Next, the trajectory angle θ is calculated by using the following equation (5) instead of equation (2).

Mathematical formula 5

[0079] In step S15 after step S14, the angle change amount dθ / ds is calculated. The angle change amount dθ / ds can be calculated by the above equation (3) using the time differential of the trajectory angle θ calculated in step S14. After step S15, the process proceeds to step S03.

[0080] In step S03, when the angle change amount dθ / ds is less than the threshold value TH1, the process moves to step S16 in the present embodiment. In step S16, it is determined whether the value of the track angle θ calculated in step S14 is greater than the threshold value TH2. When the value of the track angle θ is greater than the threshold value TH2, the process moves to step S04. In other cases, the process moves to step S06. The processing performed after each move is the same as that of the first embodiment.

[0081] In this embodiment, even when the angle change dθ / ds is less than the threshold value T1, if the value of the trajectory angle θ is greater than the threshold value T2, it is determined that the step should not be crossed. This makes it possible to determine whether the step should be crossed with higher accuracy.

[0082] The angle calculation unit 13 of this embodiment changes the method of calculating the track angle θ according to the determination result (step S13) of the contact determination unit 16. By using different equations for the two-wheel contact state and the one-wheel contact state, the track angle θ can be accurately calculated.

[0083] As reference Fig.10 As described above, the contact determination unit 16 determines the contact based on the lateral acceleration of the vehicle 100, that is, the acceleration G y , it is determined whether it is the two-wheel contact state or the single-wheel contact state (step S22). In addition, the contact determination unit 16 determines whether it is the two-wheel contact state or the single-wheel contact state based on the rotation speed of each left and right wheel (step S25). The latter determination is only made when the vehicle 100 is traveling at a speed V x When the speed is above the predetermined speed, the process is performed (step S21). Thus, it is possible to accurately determine whether the state is a two-wheel contact state or a single-wheel contact state.

[0084] Fig. 9The series of processing shown may also be started from the time point when the step determination unit 17 determines that there is a step on the side of the traveling direction of the vehicle 100. In this case, the processing of step S11 may also be a processing of estimating the height of the step by a certain method (e.g., image processing). In addition, the processing of step S12 may also be a processing of determining whether the height of the step is below the lower limit value (even if lower accuracy is allowed). In the case of performing such processing, if there is a step near the vehicle 100, the crossing determination unit 14 performs the processing required to determine whether the vehicle 100 should cross the step only when it has been determined in advance by the step determination unit 17. Thereby, the calculation load of the control device 10 can be reduced.

[0085] The third embodiment is described. The following mainly describes the differences from the second embodiment, and the description of the points common to the second embodiment is appropriately omitted. Fig.11 As shown, the control device 10 of the present embodiment does not include the ride-over determination unit 14 or the braking / driving force control unit 15, but instead includes the air pressure determination unit 18 and the notification unit 19. In addition, the vehicle 100 is provided with a notification device 210.

[0086] The air pressure determination unit 18 is a part that performs processing to determine whether the air pressure of the wheel 111 and the like is sufficient based on the track angle θ. The specific determination direction will be described later.

[0087] When the air pressure determination unit 18 determines that the air pressure is insufficient, the notification unit 19 performs processing to notify the occupant of the vehicle 100 of this fact. The notification unit 19 performs this notification by operating the notification device 210. The notification device 210 is, for example, a warning lamp provided on the instrument panel.

[0088] Before explaining the method of determining the air pressure by the air pressure determination unit 18, the "overtaking distance" will be explained first.

[0089] exist Figure 4 The curve diagram (B) shows that Figure 4 (A) shows an example of a change in the trajectory angle θ when the vehicle 100 crosses the step ST. Figure 4 The "x1" shown is the position of the vehicle 100 at the time when the wheel 111 and the like come into contact with the step ST. Figure 4 The "x2" shown is the position of the vehicle 100 at the time when the wheel 111 etc. leaves the road surface. Figure 4 The position of the inflection point in the graph of (A) corresponds to Figure 4 The position corresponding to the peak in the graph of (B).

[0090] The "surmounting distance" refers to the distance from x1 to x2, that is, the distance traveled by the vehicle 100 from the time when the wheel 111 etc. contacts the step ST to the time when the wheel 111 etc. leaves the road surface. In other words, the "surmounting distance" can also be said to be the distance traveled by the vehicle 100 from the time when the trajectory angle θ starts to increase to the time when it starts to decrease.

[0091] When the vehicle 100 stops on a flat road surface RD, the above-defined overrun distance is equal to the length of the portion of the wheel 111 etc. in contact with the road surface RD in the front-rear direction ( Figure 3 Therefore, the lower the air pressure of the wheel 111, etc. becomes, Figure 3 As L becomes longer, Figure 4 Therefore, the air pressure determination unit 18 of the control device 10 of the present embodiment determines whether the air pressure is sufficient based on the distance above.

[0092] Fig.12 Shown is a graph showing the correlation between the height of the step in contact with the wheel 111, etc. (horizontal axis) and the distance of crossing (vertical axis). Among them, G11 is a graph when the air pressure of the wheel 111, etc. is the standard pressure, G12 is a graph when the air pressure of the wheel 111, etc. is the lower limit pressure (i.e., the lower limit of the air pressure range in which the vehicle 100 can travel normally), and G13 is a graph when the air pressure of the wheel 111, etc. is too low.

[0093] like Fig.12 As shown in FIG. 1 , when the step height is above a certain level (above H1), the ascending distance hardly changes with the step height, but only changes according to the air pressure of the wheel 111, etc. Specifically, there is a tendency that the ascending distance becomes longer as the air pressure of the wheel 111, etc. becomes lower. In addition, when the step height is lower than H1, such a correlation between the air pressure and the ascending distance does not hold.

[0094] Based on the above findings obtained through experiments, the present inventors have established a method for determining the air pressure by the air pressure determination unit 18. This determination method will be described below.

[0095] Fig.13 The series of treatments shown here replaces Fig. 9 The series of processing shown is executed by the control device 10 of this embodiment. Fig.13 The steps shown are Fig. 9 The same steps as shown are marked with Fig. 9 Same symbols (S11, etc.).

[0096] In the first step S10, the process of accumulating the travel speed of the vehicle 100 is started. By starting this process, the control device 10 calculates the distance traveled by the vehicle 100 after the wheel 111 etc. contacts the step. The process of step S10 is performed only for the first time after the wheel 111 etc. contacts the step. Fig.13 Execute again in the next control cycle Fig.13 When the processing of step S10 is performed, the processing of step S10 is not performed, but the processing of accumulating the running speed of the vehicle 100 is continued.

[0097] After step S10, the processing of step S11 and subsequent steps is executed. After that, if the processing of step S01 or step S14 is performed, the process moves to step S31 in the present embodiment.

[0098] In step S31, it is determined whether the value of the track angle θ calculated each time through steps S01 and S04 is at a peak value, that is, whether it is turning from increasing to decreasing. If the value of the track angle θ is at a peak value, the process proceeds to step S32. In other cases, the process ends temporarily. Fig.13 A series of processing shown.

[0099] In step S32, it is determined whether the peak value of the trajectory angle θ is greater than a predetermined threshold value. If the peak value is greater than the threshold value, the process proceeds to step S33. Otherwise, the process proceeds to step S36 described later.

[0100] In step S33, processing is performed to stop the integration of the travel speed started in step S10. The distance obtained by the integration up to this point is acquired as the above-mentioned "overtaking distance".

[0101] In step S34 after step S33, it is determined whether the calculated distance to be crossed is greater than a predetermined threshold value. The threshold value is preset as the value of the distance to be crossed calculated when the air pressure of the wheel 111, etc. is the lower limit pressure. When the distance to be crossed is greater than the threshold value, the process proceeds to step S35. In step S35, the notification unit 19 performs processing to notify the occupants of the reduced air pressure. The notification unit 19 performs the above notification by actuating the notification device 210 (specifically, lighting a warning light).

[0102] In step S36 after step S35, a process is performed to return the integrated value of the travel speed to 0. Then, the process ends. Fig.13 A series of processing shown.

[0103] In step S34, when the overtaking distance is less than the threshold value, the process proceeds to step S36 without passing through step S35. In this case, since it is estimated that the air pressure of the wheel 111 and the like is normal, the notification unit 19 does not make a notification.

[0104] As described above, the air pressure determination unit 18 of the present embodiment determines that the air pressure of the wheel 111 etc. is insufficient when the calculated ride-on distance exceeds a predetermined threshold value. This makes it possible to appropriately determine whether the air pressure is sufficient.

[0105] The air pressure determination unit 18 calculates the ride-on distance by integrating the running speed of the vehicle 100. Since an existing sensor for measuring the vehicle speed is used, there is no need to separately provide a sensor for calculating the ride-on distance.

[0106] When the peak value of the trajectory angle θ is below the predetermined lower limit (when the determination in step S32 is “No”), the air pressure determination unit 18 does not determine whether the air pressure is sufficient. In other words, when it is estimated that the height of the step is lower than the predetermined value, the air pressure determination unit 18 does not determine whether the air pressure is sufficient. This can prevent the air pressure from being insufficient when the height of the step is lower than the predetermined value. Fig.12 In the case of H1, the air pressure is also misjudged.

[0107] In the above, an example in which the vehicle 100 is an electric vehicle that runs using the driving force of the rotating electric machine 150 is described. However, the vehicle 100 may be a vehicle that runs using the driving force of an internal combustion engine, or a hybrid vehicle that runs using the driving force of both the rotating electric machine 150 and the internal combustion engine. In this case, the driving force acquisition unit 11 may acquire the driving force applied by the vehicle 100 to the road surface based on a signal from a torque sensor provided on the wheel 111 or the like.

[0108] The operation of the control device 10 as described above is realized, for example, by a program incorporated in the control device 10. The program causes the control device 10 to calculate the angle formed by the trajectory of the rotation center axis AX of the wheels 111 and the like of the vehicle 100 relative to the road surface, i.e., the trajectory angle θ, based on the driving force applied by the vehicle 100 on the road surface and the acceleration of the vehicle 100 along the traveling direction.

[0109] Above, the present embodiment has been described with reference to specific examples. However, the present disclosure is not limited to these specific examples. Even if a person skilled in the art makes appropriate design changes to these specific examples, as long as the features of the present disclosure are included, they are included in the scope of the present disclosure. The various elements and their configurations, conditions, shapes, etc. included in the above-mentioned specific examples are not limited to the illustrated cases and can be appropriately changed. As long as no technical contradictions are generated, the various elements included in the above-mentioned specific examples can be appropriately combined and changed.

[0110] The control device and control method described in the present disclosure may also be implemented by one or more special-purpose computers, which are provided by constituting a processor and a memory, and the above-mentioned processor is programmed to perform one or more functions embodied by a computer program. It is also possible that the control device and control method described in the present disclosure are implemented by a special-purpose computer, which is provided by constituting a processor including one or more special-purpose hardware logic circuits. It is also possible that the control device and control method described in the present disclosure are implemented by one or more special-purpose computers, which are composed of a combination of a processor and a memory programmed to perform one or more functions and a processor including one or more hardware logic circuits. The computer program may also be stored in a computer-readable non-temporary tangible storage medium as an instruction executed by a computer. Special-purpose hardware logic circuits and hardware logic circuits may also be implemented by digital circuits or analog circuits including multiple logic circuits.

[0111] [Note] The following supplementary notes 1 to 19 can be arbitrarily combined as long as there is no technical contradiction. [Note 1] A control device, the control device being a vehicle control device, comprising: a driving force acquisition unit, the driving force acquisition unit acquiring the driving force applied by the vehicle on the road surface; an acceleration acquisition unit, the acceleration acquisition unit acquiring the acceleration of the vehicle along the traveling direction; and An angle calculation unit calculates a trajectory angle, which is an angle formed by a trajectory of a rotation center axis of a wheel of the vehicle with respect to a road surface, based on the driving force and the acceleration. [Note 2] A control device according to Supplement 1, wherein: The vehicle further includes a crossing determination unit configured to determine whether the vehicle should cross a step based on the trajectory angle. [Note 3] A control device according to Appendix 2, wherein: The vehicle further includes a braking-driving force control unit, the braking-driving force control unit controlling the braking-driving force of the vehicle. The braking / driving force control unit controls the braking / driving force so that the vehicle crosses the step when the crossing determination unit determines that the vehicle should cross the step. When the crossing determination unit determines that the vehicle should not cross the step, the braking / driving force is controlled to stop the vehicle. [Note 4] A control device according to Appendix 2 or 3, wherein: The crossing determination unit determines whether the vehicle should cross a step based on an amount of change in the trajectory angle (ie, an angle change amount) when the vehicle moves forward a predetermined distance. [Note 5] A control device according to Supplement 4, wherein: The crossing determination unit determines that the vehicle should not cross the step when the angle change amount exceeds a predetermined threshold value. [Note 6] A control device according to any one of Notes 1 to 5, wherein: The vehicle has a rotating electric machine for generating the driving force. The driving force acquisition unit acquires the driving force based on the magnitude of the current flowing through the rotating electric machine. [Note 7] A control device according to Appendix 2, wherein: The crossing determination unit does not determine whether the vehicle should cross the step when the trajectory angle is equal to or less than a predetermined lower limit value. [Note 8] A control device according to any one of Notes 1 to 7, wherein: The invention also includes a contact determination unit for determining whether the contact state is a two-wheel contact state in which the wheels on both sides of the left and right sides are in contact with the step or a single-wheel contact state in which only the wheel on one side of the left and right sides is in contact with the step. The angle calculation unit changes a method of calculating the trajectory angle according to a determination result of the contact determination unit. [Note 9] A control device according to Supplement 8, wherein: The contact determination unit determines whether the state is the two-wheel contact state or the one-wheel contact state based on a lateral acceleration of the vehicle. [Note 10] A control device according to Supplement 8, wherein: The contact determination unit determines whether the state is the two-wheel contact state or the one-wheel contact state based on the rotation speed of each of the left and right wheels. [Note 11] A control device according to Appendix 10, wherein: The contact determination unit performs determination based on the rotation speed only when the running speed of the vehicle is equal to or higher than a predetermined speed. [Note 12] A control device according to Appendix 2, wherein: The vehicle further includes a step determination unit for determining whether there is a step near the vehicle. The crossing determination unit performs processing required for determining whether the vehicle should cross the step only when the step determination unit determines in advance that there is a step near the vehicle. [Note 13] A control device according to Supplement 1, wherein: The vehicle further includes an air pressure determination unit configured to determine whether the air pressure of the wheel is sufficient based on the trajectory angle. [Note 14] A control device according to Supplement 13, wherein: The vehicle further includes a notification unit configured to notify an occupant of the vehicle when the air pressure is insufficient. [Note 15] A control device according to Appendix 13 or 14, wherein: The air pressure determination unit determines whether the air pressure is sufficient based on a distance traveled by the vehicle, that is, a crossing distance, during a period from when the trajectory angle starts to increase to when it starts to decrease. [Note 16] A control device according to Supplement 15, wherein: The air pressure determination unit determines that the air pressure is insufficient when the climbing distance exceeds a predetermined threshold value. [Note 17] A control device according to Appendix 15 or 16, wherein: The air pressure determination unit calculates the ride-on distance by integrating the running speed of the vehicle. [Note 18] A control device according to any one of Notes 13 to 17, wherein: The air pressure determination unit does not determine whether the air pressure is sufficient when the peak value of the trajectory angle is equal to or less than a predetermined lower limit value. [Note 19] A program, wherein the program is a program for a vehicle control device, The program calculates a trajectory angle, which is an angle formed by a trajectory of a rotation center axis of a wheel of the vehicle with respect to the road surface, based on a driving force applied by the vehicle to the road surface and an acceleration of the vehicle in a traveling direction.

[0112] Above, the present embodiment has been described with reference to specific examples. However, the present disclosure is not limited to these specific examples. Even if a person skilled in the art makes appropriate design changes to these specific examples, as long as the features of the present disclosure are included, they are included in the scope of the present disclosure. The various elements and their configurations, conditions, shapes, etc. included in the above-mentioned specific examples are not limited to the illustrated cases and can be appropriately changed. As long as no technical contradictions are generated, the various elements included in the above-mentioned specific examples can be appropriately combined and changed.

Claims

1. A control device, the control device being a vehicle (100) control device (10), the control device comprising: A driving force acquisition unit (11), the driving force acquisition unit acquiring the driving force applied by the vehicle on the road surface; An acceleration acquisition unit (12), which acquires the acceleration of the vehicle along the traveling direction; as well as An angle calculation unit (13) calculates a trajectory angle (θ) which is an angle formed by a trajectory of a rotation center axis (AX) of wheels (111, 112) of the vehicle relative to a road surface based on the driving force and the acceleration.

2. The control device according to claim 1, characterized in that The vehicle further includes a crossing determination unit (14) for determining whether the vehicle should cross a step based on the trajectory angle.

3. The control device according to claim 2, characterized in that The vehicle further comprises a braking-driving force control unit (15) for controlling the braking-driving force of the vehicle. The braking / driving force control unit controls the braking / driving force so that the vehicle crosses the step when the crossing determination unit determines that the vehicle should cross the step. When the crossing determination unit determines that the vehicle should not cross the step, the braking / driving force is controlled to stop the vehicle.

4. The control device according to claim 2, characterized in that: The crossing determination unit determines whether the vehicle should cross a step based on an angle change amount, which is an amount of change in the trajectory angle when the vehicle moves forward a predetermined distance.

5. The control device according to claim 4, characterized in that The crossing determination unit determines that the vehicle should not cross the step when the angle change amount exceeds a predetermined threshold value.

6. The control device according to claim 1, characterized in that: The vehicle has a rotating electric machine (150) for generating the driving force. The driving force acquisition unit acquires the driving force based on the magnitude of the current flowing through the rotating electric machine.

7. The control device according to claim 2, characterized in that: The crossing determination unit does not determine whether the vehicle should cross a step when the trajectory angle is equal to or smaller than a predetermined lower limit value.

8. The control device according to claim 1, characterized in that: It also includes a contact determination unit (16) for determining whether the contact state is a two-wheel contact state in which the left and right wheels are in contact with the step or a single-wheel contact state in which only one of the left and right wheels is in contact with the step. The angle calculation unit changes a method of calculating the trajectory angle according to a determination result of the contact determination unit.

9. The control device according to claim 8, characterized in that The contact determination unit determines whether the state is the two-wheel contact state or the one-wheel contact state based on the lateral acceleration of the vehicle.

10. The control device according to claim 8, characterized in that The contact determination unit determines whether the state is the two-wheel contact state or the one-wheel contact state based on the rotation speed of each of the left and right wheels.

11. The control device according to claim 10, characterized in that The contact determination unit performs determination based on the rotation speed only when the running speed of the vehicle is equal to or higher than a predetermined speed.

12. The control device according to claim 2, characterized in that: The vehicle further comprises a step determination unit (17) for determining whether there is a step near the vehicle. The crossing determination unit performs processing required for determining whether the vehicle should cross the step only when the step determination unit determines in advance that there is a step near the vehicle.

13. The control device according to claim 1, characterized in that: The vehicle also includes an air pressure determination unit (18) for determining whether the air pressure of the wheel is sufficient based on the trajectory angle.

14. The control device according to claim 13, characterized in that The vehicle further includes a notification unit (19) for notifying a passenger of the vehicle when the air pressure is insufficient.

15. The control device according to claim 13, characterized in that: The air pressure determination unit determines whether the air pressure is sufficient based on a distance traveled by the vehicle, that is, a crossing distance, during a period from when the trajectory angle starts to increase to when it starts to decrease.

16. The control device according to claim 15, characterized in that The air pressure determination unit determines that the air pressure is insufficient when the climbing distance exceeds a predetermined threshold value.

17. The control device according to claim 15, characterized in that The air pressure determination unit calculates the ride-on distance by integrating the running speed of the vehicle.

18. The control device according to claim 13, characterized in that: The air pressure determination unit does not determine whether the air pressure is sufficient when the peak value of the trajectory angle is equal to or less than a predetermined lower limit value.

19. A program, the program being a program for a control device (10) of a vehicle (100), The program causes the control device to calculate the angle (θ) formed by the trajectory of the rotation center axis (AX) of the wheels (111, 112) of the vehicle relative to the road surface based on the driving force applied by the vehicle on the road surface and the acceleration of the vehicle along the travel direction.