Calculation apparatus, control method, program and storage medium
The calculation device addresses the inaccuracy of yaw rate estimation without fixed objects by using a second yaw rate calculation based on moving body information and correction, achieving reliable yaw angle estimation.
Patent Information
- Application Number
- JP2024144192
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2024-08-26
- Publication Date
- 2024-11-15
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
Existing methods for estimating the yaw rate of a moving object are inaccurate when there are no fixed objects around the moving body.
A calculation device that calculates a second yaw rate based on a first yaw rate and information from the moving body, correcting the calculation information using a correction unit, and if the first yaw rate cannot be obtained, calculating the second yaw rate based on corrected information from the moving object.
Enables accurate estimation of the yaw angle even in situations without fixed objects by utilizing information from the moving body and correcting calculation errors, ensuring high reliability of the yaw rate estimation.
Smart Images

Figure 2024161109000001_ABST
Abstract
Description
[Technical field]
[0001] The present invention relates to a technique for estimating the yaw angle of a moving object with high accuracy. [Background technology]
[0002] Conventionally, there have been known techniques for estimating the yaw rate of a vehicle. For example, Patent Document 1 discloses a technique for estimating the yaw rate of a vehicle based on a change in the relative position of a fixed object with respect to the vehicle, and correcting a deviation of a yaw rate sensor. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2012-066777 A Summary of the Invention [Problem to be solved by the invention]
[0004] According to the method of Patent Document 1, when a fixed object exists around a moving object, the yaw rate of the vehicle can be estimated with high accuracy. On the other hand, a method for acquiring the yaw rate of the vehicle with high accuracy when a situation where no fixed object exists around a moving object continues is not disclosed.
[0005] The present invention has been made in order to solve the above-mentioned problems, and has as its main object to provide a calculation device capable of estimating a yaw angle with high accuracy. [Means for solving the problem]
[0006] The invention described in claim 1 is a calculation device comprising: a correction unit that corrects calculation information for calculating a second yaw rate of a moving body based on a first yaw rate of the moving body and information about the moving body obtained from information about the surroundings of the moving body; and a control unit that, when the first yaw rate can be acquired, sets the first yaw rate to the second yaw rate and corrects the calculation information, and, when the first yaw rate cannot be acquired, calculates the second yaw rate based on the information about the moving body and the corrected calculation information.
[0007] The invention described in claim 6 is a control method executed by a calculation device, comprising: a correction step of correcting calculation information for calculating a second yaw rate of a moving body based on a first yaw rate of the moving body and information about the moving body obtained from information about the surroundings of the moving body; and a control step of setting the first yaw rate as the second yaw rate and correcting the calculation information when the first yaw rate can be obtained, and calculating the second yaw rate based on the information about the moving body and the corrected calculation information when the first yaw rate cannot be obtained.
[0008] The invention described in claim 7 is a program executed by a computer, comprising: a correction unit that corrects calculation information for calculating a second yaw rate of a moving body based on a first yaw rate of the moving body and information about the moving body obtained from information about the surroundings of the moving body; and a control unit that, when the first yaw rate can be obtained, sets the first yaw rate to the second yaw rate and corrects the calculation information, and, when the first yaw rate cannot be obtained, calculates the second yaw rate based on the information about the moving body and the corrected calculation information. [Brief description of the drawings]
[0009] [Figure 1] FIG. 2 is a schematic diagram of an in-vehicle device. [Diagram 2] FIG. 2 is a diagram clearly showing the directions of yaw, roll, and pitch rotation relative to the vehicle. [Diagram 3] 10 is a flowchart showing an outline of an estimated yaw angle calculation process. [Figure 4] (A) is a diagram of a trapezoidal approximation based on an estimated yaw rate obtained at each measurement interval for the time transition of the true yaw rate. (B) is a diagram of a rectangular approximation based on an estimated yaw rate obtained at each measurement interval for the time transition of the true yaw rate. [Diagram 5] Graph (A) shows the relationship between the true yaw rate on the horizontal axis and the detected yaw rate on the vertical axis, and graph (B) shows the relationship between the detected yaw rate on the horizontal axis and the true yaw rate on the vertical axis. [Figure 6] FIG. 2 is a diagram illustrating a lateral force generated in a wheel. [Figure 7] (A) shows the relationship between wheel sideslip angle and lateral force on dry, wet, and frozen roads, respectively. (B) shows the relationship between slip ratio and lateral force when the wheel sideslip angle is constant. [Figure 8] (A) is a diagram showing symbols that specify the state of a vehicle in a two-wheel model when the vehicle is turning steadily at a low speed with no centrifugal force acting, and (B) is a diagram showing symbols that specify the state of a vehicle in a two-wheel model when the vehicle is turning steadily at a high speed with centrifugal force acting. [Figure 9] (A) shows the state of a vehicle traveling around a curve. (B) shows the state of a vehicle traveling on a laterally sloping road surface. (C) shows the relationship between the driving force, lateral force, and cornering force generated on the wheels when the vehicle is traveling. [Figure 10] The relationship between load and cornering force is shown. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0010] According to a preferred embodiment of the present invention, the calculation device includes a correction unit that corrects calculation information for calculating a second yaw rate of a moving body based on a first yaw rate of the moving body and information about the moving body obtained from information about the surroundings of the moving body, and a control unit that, when the first yaw rate can be acquired, sets the first yaw rate to the second yaw rate and corrects the calculation information, and, when the first yaw rate cannot be acquired, calculates the second yaw rate based on the information about the moving body and the corrected calculation information.
[0011] The calculation device includes a correction unit and a control unit. The correction unit corrects the calculation information for calculating the second yaw rate of the moving body based on the first yaw rate of the moving body and information about the moving body acquired from information about the surroundings of the moving body. When the first yaw rate can be acquired, the control unit sets the first yaw rate as the second yaw rate and corrects the calculation information. On the other hand, when the first yaw rate cannot be acquired, the control unit calculates the second yaw rate based on the information about the moving body and the corrected calculation information. In this aspect, when the first yaw rate can be calculated with high accuracy based on information about the surroundings of the moving body, the calculation device corrects the calculation information used when the first yaw rate cannot be calculated. As a result, even when the first yaw rate cannot be calculated, the calculation device can calculate a highly reliable second yaw rate by using the corrected calculation information.
[0012] In one aspect of the above-mentioned calculation device, the calculation device includes a first calculation unit that calculates a yaw rate of the moving body based on an output of an angular velocity sensor mounted on the moving body and the calculation information, a second calculation unit that calculates a yaw rate of the moving body based on a steering angle and a velocity of the moving body and the calculation information, and a third calculation unit that calculates the second yaw rate based on the yaw rate calculated by the first calculation unit and the yaw rate calculated by the second calculation unit. In this aspect, even if the calculation device cannot calculate the first yaw rate, the calculation device can suitably calculate a highly reliable second yaw rate based on two yaw rates calculated by the first and second calculation units using the calculation information by different methods.
[0013] In another aspect of the calculation device, the correction unit corrects the first conversion information required for the first calculation unit to calculate the yaw rate and the second conversion information required for the second calculation unit to calculate the yaw rate, based on the first yaw rate acquired from information about the periphery of the moving body and the speed of the moving body, as the calculation information. In this way, the calculation device updates the first and second conversion information required for the calculation of the yaw rate by the first and second calculation units when the first yaw rate can be calculated with high accuracy based on information about the periphery of the moving body, so that even when the first yaw rate cannot be calculated, the calculation device can calculate the second yaw rate with high accuracy.
[0014] In another aspect of the above-mentioned calculation device, the third calculation unit determines weighting for the yaw rate calculated by the first calculation unit and the yaw rate calculated by the second calculation unit when calculating the second yaw rate, based on at least one of the amount of change in temperature after the calculation information is corrected, the amount of change in the lateral acceleration of the moving body, and the amount of change in the roll angle of the moving body. In this aspect, the calculation device takes into account each amount of change that causes an error in the calculation information, and can calculate the second yaw rate by appropriately weighting the yaw rates calculated by the first and second calculation units according to the reliability.
[0015] In another aspect of the above-mentioned calculation device, the third calculation unit determines weighting for the yaw rate calculated by the first calculation unit and the yaw rate calculated by the second calculation unit when calculating the second yaw rate, based on at least one of the change in the vertical acceleration of the moving body after correcting the calculation information and the change in the pitch angle of the moving body, in addition to the change in the temperature, the change in the lateral acceleration, and the change in the roll angle. In this aspect, the calculation device further takes into account a change that is likely to cause an error in the calculation information in addition to a change that causes an error in the calculation information, and can calculate the second yaw rate by appropriately performing weighting according to the reliability of the yaw rates calculated by the first and second calculation units.
[0016] According to another preferred embodiment of the present invention, a control method executed by a calculation device includes a correction step of correcting calculation information for calculating a second yaw rate of the moving body based on a first yaw rate of the moving body and information about the moving body obtained from information about the surroundings of the moving body, and a control step of setting the first yaw rate as the second yaw rate and correcting the calculation information when the first yaw rate can be obtained, and calculating the second yaw rate based on information about the moving body and the corrected calculation information when the first yaw rate cannot be obtained. By executing this control method, the calculation device can calculate a highly reliable second yaw rate by using the corrected calculation information even when the first yaw rate cannot be calculated.
[0017] According to another preferred embodiment of the present invention, a program executed by a computer includes a correction unit that corrects calculation information for calculating a second yaw rate of a moving body based on a first yaw rate of the moving body and information about the moving body obtained from information about the surroundings of the moving body, and a control unit that, when the first yaw rate can be obtained, sets the first yaw rate to the second yaw rate and corrects the calculation information, and, when the first yaw rate cannot be obtained, calculates the second yaw rate based on information about the moving body and the corrected calculation information. By executing this program, the calculation device can calculate a highly reliable second yaw rate by using the corrected calculation information even when the first yaw rate cannot be calculated. Preferably, the program is stored in a storage medium. EXAMPLES
[0018] Hereinafter, preferred embodiments of the present invention will be described with reference to the drawings. In this specification, for the sake of convenience, a character with a "·" on top of any symbol is referred to as "A · ” (where “A” is an arbitrary symbol).
[0019] [Schematic configuration] 1 is a schematic diagram of an on-vehicle device 1 according to this embodiment. The on-vehicle device 1 is a device that estimates the yaw angle of the vehicle on which the on-vehicle device 1 is mounted with high accuracy, and mainly includes a sensor group 11, a storage unit 12, an input unit 14, a control unit 15, and an output unit 16. The on-vehicle device 1 is one aspect of the "calculation device" of the present invention.
[0020] The sensor group 11 mainly includes a Lidar (Light Detection and Ranging, or Laser Illuminated Detection and Ranging) 21, a vehicle speed sensor 22, an acceleration sensor 23, a gyro sensor 24, a tilt sensor 25, a temperature sensor 26, a GPS receiver 27, and a steering angle sensor 28.
[0021] The lidar 21 emits a pulsed laser to discretely measure the distance to an object existing in the outside world. The lidar 21 outputs a point cloud of measurement points indicated by a pair of the distance to the object where the pulsed laser is reflected and the emission angle of the pulsed laser. In this embodiment, the lidar 21 is used to detect landmarks installed near roads. The landmarks are, for example, features such as kilometer posts, 100m posts, delineators, traffic infrastructure facilities (e.g., signs, directional signs, traffic signals), utility poles, and street lights that are periodically arranged on the side of the road.
[0022] The vehicle speed sensor 22 measures the vehicle speed based on a pulse signal generated in accordance with the rotation of the vehicle's wheels. The acceleration sensor 23 detects the acceleration in the vehicle's traveling direction (also called the "longitudinal direction") and the acceleration in the vehicle's lateral direction (also called the "lateral direction"). Hereinafter, the acceleration in the longitudinal direction of the vehicle detected by the acceleration sensor 23 will be referred to as the "detected longitudinal acceleration" and the acceleration in the lateral direction will be referred to as the "detected lateral acceleration".
[0023] The gyro sensor 24 detects the rotational angular velocity of the angle (also simply called "yaw angle") around the axis in the vertical direction (i.e., height direction) of the vehicle. FIG. 2 is a diagram clearly showing the rotational directions of yaw, roll, and pitch with the vehicle as the reference. In this embodiment, the rotational angle around the axis of the traveling direction is expressed as "roll angle φ", the rotational angle around the axis of the lateral direction is expressed as "pitch angle θ", and the rotational angle around the axis of the vertical direction is expressed as "yaw angle Ψ". For example, roll angle φ and pitch angle θ indicate angles with the horizontal plane at 0 degrees, and yaw angle Ψ indicates an angle with a specified direction at 0 degrees. Similarly, in this embodiment, the rotational angular velocity around the axis of the traveling direction is expressed as "roll rate φ · " and the rotational angular velocity around the lateral axis is called the "pitch rate θ · ” and the rotational angular velocity around the vertical axis is called “yaw rate Ψ · " should be written.
[0024] Referring again to FIG. 1, each component of the vehicle-mounted device 1 will be described. The inclination sensor 25 detects the inclination angle in the pitch direction and the roll direction of the vehicle relative to the horizontal plane. Hereinafter, the inclination angle in the pitch direction output by the inclination sensor 25 is also called the "detected pitch angle", and the inclination angle in the roll direction is also called the "detected roll angle". The temperature sensor 26 detects the temperature around the gyro sensor 24. Hereinafter, the detected temperature output by the temperature sensor 26 is also called the "detected temperature". The GPS receiver 27 detects the absolute position of the vehicle by receiving radio waves carrying downlink data including positioning data from multiple GPS satellites. The steering angle sensor 28 detects the steering angle of the vehicle. Hereinafter, the steering angle detected by the steering angle sensor 28 is also called the "detected steering angle". The output of each sensor of the sensor group 11 is supplied to the control unit 15.
[0025] Some or all of the sensor group 11 may be sensors provided in the vehicle. In this case, the control unit 15 acquires the outputs of the sensors provided in the vehicle from the vehicle using a predetermined communication protocol such as CAN.
[0026] The storage unit 12 stores a program executed by the control unit 15 and information required for the control unit 15 to execute a predetermined process. In this embodiment, the storage unit 12 stores a map database (DB) 10 including road data and landmark information. The map DB 10 may be updated periodically. In this case, for example, the control unit 15 receives partial map information related to an area to which the vehicle position belongs from a server device that manages map information via a communication unit (not shown), and reflects the partial map information in the map DB 10. Instead of the storage unit 12 storing the map DB 10, a server device that can communicate with the vehicle-mounted device 1 may store the map DB 10. In this case, the control unit 15 acquires necessary landmark information and the like from the map DB 10 by communicating with the server device.
[0027] The input unit 14 is a button, a touch panel, a remote controller, a voice input device, etc. that is operated by the user, and the output unit 16 is, for example, a display, a speaker, etc. that performs output based on the control of the control unit 15.
[0028] The control unit 15 includes a CPU that executes a program and controls the entire vehicle-mounted device 1. In this embodiment, the control unit 15 includes a yaw angle estimation unit 17 and a calibration unit .
[0029] The yaw angle estimation unit 17 estimates a yaw angle ("estimated yaw angle Ψ") for use in other processes such as calculation of the vehicle position. E In this case, when it is possible to estimate the yaw angle based on the output of the rider 21, the yaw angle estimation unit 17 calculates the yaw angle of the vehicle measured based on the output of the rider 21 (also referred to as the measured yaw angle Ψ L ") is the estimated yaw angle Ψ E On the other hand, the yaw angle estimating unit 17 sets the measured yaw angle Ψ L If it is not possible to calculate, first, the estimated yaw angle Ψ E The estimated yaw rate Ψ · E In this case, the yaw angle estimation unit 17 calculates an estimated value of the yaw rate based on the output of the gyro sensor 24 (also referred to as the "gyro sensor base yaw rate Ψ· G ") and the estimated yaw rate based on the vehicle speed and steering angle ("steering angle-based yaw rate Ψ · S ") and these estimated values are weighted in a predetermined manner to obtain the estimated yaw rate Ψ · E Then, the yaw angle estimation unit 17 calculates the estimated yaw rate Ψ at the current processing time (also referred to as "time t"). · E and the estimated yaw angle Ψ calculated at the previous processing time (also called "time t-1"). E and the estimated yaw rate Ψ · E Based on this, the estimated yaw angle Ψ at time t is E Calculate the estimated yaw rate Ψ · E is an example of the "second yaw rate" in the present invention.
[0030] When the yaw angle can be estimated based on the output of the lidar 21, the calibration unit 18 calculates the measured yaw angle Ψ L Based on this, the yaw rate detected by the gyro sensor 24 is converted into a gyro sensor base yaw rate Ψ · G In addition, the calibration unit 18 calibrates the gyro sensitivity coefficient "A" and the gyro offset coefficient "B", which are coefficients required for converting the vehicle speed ("measured vehicle speed V") measured based on the output of the lidar 21. L ) and the measured yaw angle Ψ L Based on this, the detected steering angle detected by the steering angle sensor 28 is converted into a steering angle-based yaw rate Ψ · S In this embodiment, the steering angle sensitivity coefficient "C" and the steering angle offset coefficient "D" are calibrated as coefficients required for converting the coefficients A to D. The details of the coefficients A to D will be described later. The gyro sensitivity coefficient A and the gyro offset coefficient B are examples of the "calculation information" and the "first conversion information" in the present invention, and the steering angle sensitivity coefficient C and the steering angle offset coefficient D are examples of the "calculation information" and the "second conversion information" in the present invention.
[0031] The control unit 15 is an example of a "first calculation unit," a "second calculation unit," a "third calculation unit," a "control unit," a "correction unit," and a computer that executes a program in the present invention. Information on the distance and direction to a surrounding object detected by the lidar 21 is an example of "information on the surroundings of the moving body" in the present invention.
[0032] [Outline of estimated yaw angle calculation process] Next, the control unit 15 estimates the yaw angle Ψ E The outline of the method of calculating the measured yaw angle Ψ will be described. L If it is determined that it is possible to calculate the measured yaw angle Ψ L Estimate the yaw angle Ψ E and performs a calibration process for the coefficients A to D based on the output of the lidar 21. On the other hand, the control unit 15 calculates the measured yaw angle Ψ L If it is determined that it is not possible to calculate the gyro sensor base yaw rate Ψ, the latest calibrated coefficients A to D are used. · G and steering angle based yaw rate Ψ · S The estimated yaw angle Ψ is calculated by weighting these calculated values according to their reliability. E Estimated yaw rate Ψ required for calculation · E Calculate.
[0033] Specifically, when the control unit 15 determines that a landmark required for measuring the yaw angle by the lidar 21 is present within the measurement range of the lidar 21, the control unit 15 calculates the measured vehicle speed V based on the change in the relative position and the change in the relative direction of the landmark specified based on the output of the lidar 21. L and the measured yaw angle Ψ L The control unit 15 calculates the measured vehicle speed V L and the measured yaw angle Ψ L Calibration of coefficients A to D is performed using the measured yaw angle Ψ L The calculation feasibility determination and calibration method will be described in the section [Details of the estimated yaw angle calculation process].
[0034] On the other hand, the control unit 15 determines the measured yaw angle Ψ L If it is determined that it is not possible to calculate the gyro sensor base yaw rate Ψ at the current time t, which is the processing standard · G [t] is calculated using the yaw rate (also called the “detected yaw rate”) “ω[t]” output by the gyro sensor 24 at the current time t, the gyro sensitivity coefficient A, and the gyro offset coefficient B according to the following formula (1).
[0035]
number
[0036]
number
[0037] Next, the gyro sensor based yaw rate Ψ · G and steering angle based yaw rate Ψ · S Estimated yaw rate Ψ · E The weighting for calculating the weights will be described.
[0038] The control unit 15 determines the time "t0" when the last calibration was performed (i.e., the last measured yaw angle ΨL and measured vehicle speed V L The difference in the detected temperature (also called "temperature difference ΔT") between the time when the temperature was calculated and the current time t, the difference in the detected vertical acceleration ("vertical acceleration difference Δα x "), the difference in the detected lateral acceleration ("lateral acceleration difference Δα y "), the difference in the detected pitch angle (also referred to as "pitch angle difference Δθ"), and the difference in the detected roll angle (also referred to as "roll angle difference Δφ"). The control unit 15 then calculates the gyro sensor base yaw rate Ψ as the temperature difference ΔT increases. · G is the steering angle based yaw rate Ψ · S The accuracy is judged to be lower than the gyro sensor-based yaw rate Ψ · G The weighting for the steering angle based yaw rate Ψ · S The control unit 15 also weights the vertical acceleration difference Δα x , lateral acceleration difference Δα y , the larger the pitch angle difference Δθ or the roll angle difference Δφ, the larger the steering angle-based yaw rate Ψ · S is the gyro sensor based yaw rate Ψ · G The steering angle base yaw rate Ψ · S The weighting for the gyro sensor based yaw rate Ψ · G The weighting for
[0039] In consideration of the above, in this embodiment, as an example of a weighting method, the control unit 15 calculates the steering angle-based yaw rate Ψ based on the following equation (3): · S and gyro sensor based yaw rate Ψ · G Estimated yaw rate Ψ · E Calculate.
[0040]
number
[0041] FIG. 3 is a flowchart showing an outline of the estimated yaw angle calculation process according to this embodiment.
[0042] First, the control unit 15 detects the temperature "T" at time t using the temperature sensor 26, and calculates the vertical acceleration "α x ” and lateral acceleration “α y " is detected by the acceleration sensor 23, and the pitch angle "θ" and roll angle "φ" are detected by the inclination sensor 25 (step S101).
[0043] Next, the control unit 15 determines whether or not the vehicle speed and yaw angle can be measured by the rider 21 (step S102). L and the measured yaw angle Ψ L The control unit 15 determines whether it is possible to calculate the vehicle speed and yaw angle. Details of this determination method will be described later. Then, when it is determined that the vehicle speed and yaw angle can be measured by the rider 21 (step S102; Yes), the control unit 15 executes the processes of steps S103 to S107. On the other hand, when it is determined that the vehicle speed and yaw angle cannot be measured by the rider 21 (step S102; No), the control unit 15 executes the processes of steps S108 to S112.
[0044] First, the processes of steps S103 to S107 that are executed when the vehicle speed and yaw angle can be measured by the rider 21 will be described.
[0045] The control unit 15 calculates the measured yaw angle Ψ at the current time t from the output of the lidar 21 based on a known method. L Calculate [t] and estimate the yaw angle Ψ at the current time t. E[t] (step S103). Then, the control unit 15 sets the calculated measured yaw angle Ψ L [t] to the measured yaw rate at the current time t, "Ψ · L [t]" is calculated (step S104). · L [t] is an example of the "first yaw rate" in the present invention. Here, when the measurement interval "δt" between the current time t and the previous time t-1 is sufficiently short, the measured yaw rate Ψ · L [t] is the measured yaw angle Ψ from time t-1 to time t L It is calculated by the following formula (4), which shows the change per unit time.
[0046]
number
[0047] Then, the control unit 15 calculates the temperature T and the vertical acceleration α x , lateral acceleration α y , pitch angle θ, and roll angle φ are respectively the detected temperature "T0", the detected vertical acceleration "α x0 ", detected lateral acceleration "α y0 ", the detected gradient angle "θ0", and the detected roll angle "φ0" are stored (step S107). Then, the process returns to step S101.
[0048] Next, the processes of steps S108 to S112 that are executed when the vehicle speed and yaw angle cannot be measured by the rider 21 will be described.
[0049] The control unit 15 calculates a gyro sensor base yaw rate Ψ at time t based on the detected yaw rate ω[t] output by the gyro sensor 24 and the latest gyro sensitivity coefficient A and gyro offset coefficient B calculated in step S105, based on the formula (1). · G Next, the control unit 15 calculates the detected steering angle S[t] and the estimated vehicle speed V E [t], using the latest steering angle sensitivity coefficient C and steering angle offset coefficient D calculated in step S106, based on equation (2), · S [t] (step S109). Then, the control unit 15 calculates the temperature difference ΔT (=T−T0) and the vertical acceleration difference Δα x (=α x -α x0 ), lateral acceleration difference Δα y (=α y -α y0 The control unit 15 calculates the gyro sensor base yaw rate Ψ calculated in step S108, the pitch angle difference Δθ (= θ - θ0), and the roll angle difference Δφ (= φ - φ0) (step S110). · G [t], the steering angle-based yaw rate Ψ calculated in step S109 · S [t], the difference values ΔT and Δα calculated in step S110 x , Δα y Based on , Δθ, and Δφ, the estimated vehicle speed V at time t is calculated according to equation (3). E is calculated (step S111).
[0050] In this way, every time the control unit 15 measures the yaw angle of the rider 21 using a landmark, the control unit 15 calculates the gyro sensor base yaw rate Ψ · G and steering angle based yaw rate Ψ · S The control unit 15 calibrates the gyro sensor base yaw rate Ψ, which is calculated when the yaw angle of the rider 21 cannot be measured, by performing calibration of the gyro sensitivity coefficient A, the gyro offset coefficient B, the steering angle sensitivity coefficient C, and the steering angle offset coefficient D, which are required for calculating the yaw rate Ψ. · G and steering angle based yaw rate Ψ · S The control unit 15 can favorably maintain the reliability of the measured yaw angle Ψ L If it is not possible to calculate the estimated yaw angle Ψ E By calculating the gyro sensor base yaw rate Ψ, the error becomes large with respect to temperature change (i.e., temperature difference ΔT). · G and the change in vertical acceleration (i.e., the vertical acceleration difference Δα x ) and lateral acceleration change (i.e., lateral acceleration difference Δα y ) and steering angle-based yaw rate Ψ, which has a large error for pitch angle change (i.e., pitch angle difference Δθ) and roll angle change (i.e., roll angle difference Δφ) · S The above-mentioned shortcomings can be preferably compensated for.
[0051] After that, the control unit 15 calculates the estimated yaw angle Ψ at the preprocessing time t−1. E [t-1] and estimated yaw rate Ψ · E [t-1] and the estimated yaw rate Ψ at the current time t · E [t], the estimated yaw angle Ψ at the current time t is calculated based on the trapezoidal approximation. E [t] is calculated by the following formula (5) (step S112).
[0052]
number
[0053] FIG. 4(A) shows the estimated yaw rate Ψ obtained at each measurement interval δt against the time transition of the true yaw rate. · E In this example, the area of a trapezoidal region 70 between time t-1 and time t is regarded as the yaw angle that increased or decreased between time t-1 and time t. Here, the area of the trapezoidal region 70 corresponds to the second term of the above-mentioned equation (5). Therefore, the estimated yaw angle Ψ at the current time t E [t] is the estimated yaw angle Ψ one time before, as shown in equation (5). E This is the value obtained by adding the area of the trapezoid region 70 to [t-1].
[0054] The control unit 15 estimates the yaw angle Ψ based on a rectangular approximation instead of a trapezoidal approximation. E [t] may be calculated.
[0055] FIG. 4(B) shows the estimated yaw rate Ψ obtained at each measurement interval δt against the time transition of the true yaw rate. · E In this example, the area of a rectangular region 71 between time t-1 and time t is regarded as the yaw angle that increased or decreased between time t-1 and time t. Here, the area of the rectangular region 71 is the estimated yaw rate Ψ corresponding to the long side. · E Since it is the product of [t-1] and the measurement interval δt corresponding to the short side, the estimated yaw angle Ψ at the current time t E [t] is expressed by the following equation (6).
[0056]
number
[0057] [Details of the estimated yaw angle calculation process] (1) Coefficients A, B and gyro sensor base yaw rate Ψ · G Calculation of First, the calibration of the gyro sensitivity coefficient A and the gyro offset coefficient B will be described.
[0058] FIG. 5(A) is a graph showing the relationship between the true yaw rate and the detected yaw rate ω by the gyro sensor 24 when the horizontal axis is the true yaw rate and the vertical axis is the detected yaw rate ω by the gyro sensor 24. As shown in FIG. 5(A), since the gyro sensor generally has high linearity, the true yaw rate and the detected yaw rate ω have an almost linear relationship. Furthermore, FIG. 5(B) is obtained by switching the horizontal and vertical axes of FIG. 5(A). In FIG. 5(B), the slope of the graph is the gyro sensitivity coefficient A indicating the ratio of the change in the true yaw rate to the change in the detected yaw rate ω, and the intercept of the graph is the gyro offset coefficient B indicating the true acceleration when the detected yaw rate ω is 0. Moreover, the sensitivity corresponding to the slope of the graph shown in FIG. 5(A) is expressed as "1 / A" using the sensitivity coefficient A, and the offset corresponding to the intercept of the above-mentioned graph is expressed as "-B / A" using the sensitivity coefficient A and the offset coefficient B.
[0059] In this way, the detected yaw rate ω detected by the gyro sensor 24 has sensitivity and offset, so the true yaw rate Ψ · is expressed by using the detected yaw rate ω as follows: Psi · =Aω+B Here, the measured yaw rate Ψ calculated by the rider 21 is expressed as follows: · L can be considered as the true yaw rate, so the measured yaw rate at time t is · L [t] is Psi · L [t] = Aω[t] + B Here, x[t]=ω[t] y[t]=Ψ · L [t] Then, the above equation can be expressed by the following equation (7).
[0060]
number
[0061] (2) Coefficients C, D and steering angle-based yaw rate Ψ · S Calculation of First, basic matters regarding the derivation of the steering angle sensitivity coefficient C and the steering angle offset coefficient D will be described.
[0062] 6(A) and (B) are diagrams explaining the lateral force generated on the wheels. Generally, when a wheel tilts with respect to the vehicle's traveling direction, a difference occurs between the direction in which the wheel moves and the direction in which the wheel rotates (so-called wheel sideslip angle), and when the wheel sideslip angle occurs, a lateral force is generated on the wheel. In this case, the lateral force is calculated by multiplying the wheel sideslip angle by the cornering stiffness. In other words, the lateral force "Y" generated on the front wheels is f " and the lateral force "Y r " is the wheel slip angle of the front wheels "β f", rear wheel slip angle is "β r ", front wheel cornering stiffness "K f ", rear wheel cornering stiffness "K r ", then Y f =-K f ·β f Y r =-K r ·β r It becomes.
[0063] Furthermore, lateral force varies depending on the slipperiness and slip ratio of the road surface. Figure 7(A) shows the relationship between wheel slip angle and lateral force for dry, wet, and frozen road surfaces. In the example of Figure 7(A), the lateral force is greater for the same wheel slip angle as the road surface becomes drier and less slippery. Figure 7(B) shows the relationship between slip ratio "λ" and lateral force when the wheel slip angle is constant. In the example of Figure 7(B), when the wheel slip angle is constant, the lateral force is greater for the same slip ratio λ as the road surface becomes drier and less slippery.
[0064] When a lateral force occurs, the vehicle receives a lateral force from the road surface and begins to turn. This turning motion generates lateral velocity. The angle between the forward and lateral vehicle speeds is called the "vehicle sideslip angle β", the vehicle speed is called "V", and the angular velocity of the vehicle sideslip angle β is called "β" · " and the vehicle's yaw rate is "Ψ · " Then, the lateral acceleration α y is expressed by the following equation (8).
[0065]
number
[0066]
number
[0067]
number
[0068]
number
[0069]
number
[0070] In the case of FIG. 8(B), the front and rear wheels have wheel slip angles β f , β r In this case, the yaw rate Ψ · is the actual steering angle S in equation (12) a Based on the relationship in Figure 8(B), a -β f +β r " is expressed by the following equation (13).
[0071]
number
[0072] Therefore, the yaw rate at time t is · [t] is expressed by the following equation (14) based on the proportional relationship equation described above and equation (13).
[0073]
number
[0074]
number
[0075]
number
[0076]
number
[0077]
number
[0078]
number
[0079] In addition, the measured yaw angle Ψ L and measured vehicle speed V L During the period when it is not possible to calculate, the control unit 15 changes "V[t]" in the formula (17) to "V E [t]", "Ψ · [t]" to "Ψ · S Based on the transformed equation (2) assuming that the steering angle is 0.0 [t], the steering angle-based yaw rate Ψ · S Specifically, the control unit 15 uses the latest steering angle sensitivity coefficient C and steering angle offset coefficient D to calculate the detected steering angle S[t] and the estimated vehicle speed V E [t] based on the steering angle based yaw rate Ψ · S In this way, the control unit 15 calculates a steering angle-based yaw rate Ψ that is highly accurately approximated to the true yaw rate of the vehicle body. · S can be calculated.
[0080] (3) Setting weights Next, the temperature difference ΔT and the vertical acceleration difference Δα x, lateral acceleration difference Δα y , gyro sensor based yaw rate Ψ based on pitch angle difference Δθ and roll angle difference Δφ · G and steering angle based yaw rate Ψ · S A method for setting weights for each of the above will be described.
[0081] (3-1) Weighting for temperature difference ΔT 5A and 5B vary depending on the environmental temperature of the gyro sensor 24, it is expected that the error in the gyro sensitivity coefficient A and the gyro offset coefficient B will increase as the temperature difference ΔT between time t0 and the current time t increases. Taking the above into consideration, in this embodiment, the control unit 15 determines the gyro sensor base yaw rate Ψ using the coefficients A and B as the temperature difference ΔT increases, as shown in formula (3). · G However, the steering angle based yaw rate Ψ does not use the coefficients A and B. · S The accuracy is judged to be lower than the gyro sensor-based yaw rate Ψ · G The weighting for the steering angle based yaw rate Ψ · S In this way, even if the control unit 15 is unable to estimate the yaw angle based on the output of the rider 21, the control unit 15 can appropriately approximate the true yaw angle Ψ E can be calculated.
[0082] (3-2) Weighting for roll angle difference Δφ Fig. 9(A) shows the state of a vehicle traveling around a curve, and Fig. 9(B) shows the state of a vehicle traveling on a laterally sloping road surface. In Fig. 9(A) and (B), the direction of the arrow indicates the direction of the force, and the length of the arrow indicates the magnitude of the force.
[0083] Generally, when the centrifugal force is large when the vehicle turns, the vehicle body rolls due to the suspension mechanism of the vehicle, which causes a load transfer between the inside wheel and the outside wheel. In the example of Figure 9(A), the load on the inside wheel is smaller than the load on the outside wheel due to the load transfer from the inside wheel to the outside wheel while turning a curve. Similarly, on a road surface with a lateral incline, the load transfer occurs due to the influence of the lateral component of gravity. In the example of Figure 9(B), the load on the wheel on the valley side is larger than the load on the wheel on the mountain side due to the influence of the lateral component of gravity.
[0084] Now consider the case where the load on the wheels on one side decreases by "ΔW" and the load on the wheels on the other side increases by "ΔW".
[0085] FIG. 9(C) shows the relationship between the driving force, lateral force, and cornering force generated on the wheel when the vehicle is traveling. FIG. 10 shows the relationship between the load and the cornering force. In FIG. 10, "Cf W-ΔW " is the cornering force when the load is reduced by ΔW from "W", "Cf W " is the cornering force when the load is W, "Cf W+ΔW " indicates the cornering force when the load increases from W by ΔW.
[0086] As shown in Figure 10, the cornering force (i.e., the component of the lateral force perpendicular to the direction of travel of the wheel) draws a slight saturation curve with respect to the load, so the sum of the cornering force of the wheel that has been reduced by ΔW and the cornering force of the wheel that has been increased by ΔW is less than twice the original cornering force. In other words, the following equation (20) is established.
[0087]
number
[0088] Taking the above into consideration, the control unit 15 adjusts the steering angle-based yaw rate Ψ using the steering angle offset coefficient D as shown in the formula (3) as the roll angle difference Δφ increases. · S However, the gyro sensor based yaw rate Ψ without using the steering angle offset coefficient D · G The steering angle base yaw rate Ψ · S The weighting for the gyro sensor based yaw rate Ψ · G In this way, even if the control unit 15 is unable to estimate the yaw angle based on the output of the rider 21, the control unit 15 can estimate the yaw angle Ψ with high accuracy. E can be calculated.
[0089] (3-3) Lateral acceleration difference Δα y Weighting based on Based on equations (8) and (9), the following equation holds: mα y =2Y f +2Y r
[0090] According to the above formula, the lateral acceleration α y If changes, the lateral force Y f , Y r It can be seen that the change in Yf =-K f ·β f " and "Y r =-K r ·β r According to the relationship of ", the lateral force Y f , Y r The change in the wheel slip angle β f , β r Therefore, it can be said that at least one of the following has changed. y If the change in wheel slip angle β f , β r The steering angle offset coefficient D (see equation (16)), which changes depending on the steering angle, also changes, and the steering angle-based yaw rate Ψ · S The error becomes larger.
[0091] Taking the above into consideration, the control unit 15 calculates the lateral acceleration difference Δα as shown in equation (3). y The larger the steering angle offset coefficient D, the greater the steering angle-based yaw rate Ψ · S However, the gyro sensor based yaw rate Ψ without using the steering angle offset coefficient D · G The steering angle base yaw rate Ψ · S The weighting for the gyro sensor based yaw rate Ψ · G In this way, even if the control unit 15 is unable to estimate the yaw angle based on the output of the rider 21, the control unit 15 can estimate the yaw angle Ψ with high accuracy. E can be calculated.
[0092] (3-4) Vertical acceleration difference Δα x and weighting based on pitch angle difference Δθ In general, the vertical acceleration α xAlternatively, when the pitch angle θ changes, the driving force of the vehicle changes. In addition, the slip ratio λ changes dynamically depending on the driving state, and the slip ratio λ changes when the vehicle accelerates or decelerates. Therefore, when the driving force of the vehicle changes, it is highly likely that the slip ratio λ has changed. In addition, as shown in the relationship between the lateral force and the slip ratio λ in FIG. 7(B) described above, when the slip ratio λ changes, the lateral force changes, and as a result, the wheel slip angle β f , β r Therefore, the vertical acceleration difference Δα x Or, the larger the pitch angle difference Δθ, the larger the wheel side slip angle β f , β r The steering angle offset coefficient D (see equation (16)), which changes depending on the steering angle, also changes, and the steering angle-based yaw rate Ψ · S The error becomes larger.
[0093] Taking the above into consideration, the control unit 15 calculates the vertical acceleration difference Δα as shown in equation (3). x Or, the larger the pitch angle difference Δθ, the greater the steering angle-based yaw rate Ψ using the steering angle offset coefficient D. · S However, the gyro sensor based yaw rate Ψ without using the steering angle offset coefficient D · G The steering angle base yaw rate Ψ · S The weighting for the gyro sensor based yaw rate Ψ · G In this way, even if the control unit 15 is unable to estimate the yaw angle based on the output of the rider 21, the control unit 15 can estimate the yaw angle Ψ with high accuracy. E can be calculated.
[0094] Strictly speaking, the cornering stiffness K f , K r changes, and cornering stiffness K f , K r The change in lateral force Yf (=-K f ·β f ), Y r (=-K r ·β r ) changes. In this case, the wheel slip angle β f , β r In this way, the vertical acceleration difference Δα x Or, the wheel slip angle β changes due to the change in the slip ratio λ based on the pitch angle difference Δθ. f , β r On the other hand, the wheel slip angle β f , β r Since it cannot be said strictly speaking that the change in the vertical acceleration difference Δα x The weighting based on the pitch angle difference Δθ is based on the other temperature difference ΔT and lateral acceleration difference Δα y , which is less important than the weighting based on the roll angle difference Δφ. Therefore, for example, the control unit 15 may use the estimated yaw rate Ψ · E When calculating the vertical acceleration difference Δα x Weighting based on the pitch angle difference Δθ is applied to the other temperature difference ΔT and lateral acceleration difference Δα y For example, the control unit 15 may set the weighting based on the temperature difference ΔT, the vertical acceleration difference Δα, etc., so that the weighting based on the roll angle difference Δφ has a smaller influence than the weighting based on the roll angle difference Δφ. x , lateral acceleration difference Δα y When normalizing the difference values of the pitch angle difference Δθ and the roll angle difference Δφ, the vertical acceleration difference Δα x and the pitch angle difference Δθ, the temperature difference ΔT, the lateral acceleration difference Δα y , may be smaller than the roll angle difference Δφ.
[0095] (4) Judgment on whether or not measurements can be made using lidar Next, a specific example of a method for determining whether or not the yaw angle and the vehicle speed can be measured by the rider 21 in step S102 in FIG. 3 will be described.
[0096] For example, the control unit 15 refers to the map DB 10 to determine whether or not a landmark necessary for measuring the yaw angle and the vehicle speed by the LIDAR 21 exists. That is, the control unit 15 determines whether or not a landmark associated with a position within the measurement target range of the LIDAR 21 is registered in the map DB 10. In this case, the map DB 10 associates, for example, position information of a landmark that serves as a reference when measuring the yaw angle and the vehicle speed by the LIDAR 21 with information (e.g., shape information) necessary for identifying the landmark.
[0097] Then, if a landmark linked to a position within the measurement range of the LIDAR 21 is not registered in the map DB 10, the control unit 15 determines that the LIDAR 21 cannot measure the yaw angle and vehicle speed, and proceeds to step S108.
[0098] In this case, first, the control unit 15 specifies the measurement target range of the LIDAR 21 based on the estimated or measured position and heading direction of the vehicle, and the pre-stored measurable distance of the LIDAR 21 and the range of the laser scan angle with respect to the vehicle's traveling direction. Then, the control unit 15 determines whether or not a landmark associated with a position within the specified measurement target range of the LIDAR 21 is registered in the map DB 10. Then, if a landmark associated with a position within the measurement target range of the LIDAR 21 is not registered in the map DB 10, the control unit 15 determines that the LIDAR 21 cannot measure the yaw angle and vehicle speed.
[0099] Furthermore, even if the control unit 15 determines that a landmark linked to a position within the measurement range of the lidar 21 is registered in the map DB 10, if the control unit 15 determines that the landmark does not actually exist, it determines that the yaw angle and vehicle speed cannot be measured by the lidar 21.
[0100] In this case, for example, the control unit 15 refers to the map DB 10 and identifies the shape and position of a landmark that exists within the measurement target range of the LIDAR 21. Then, the control unit 15 performs an analogy determination between the shape and position of the landmark identified by the map DB 10 and the shape and position that constitutes the point cloud output by the LIDAR 21. Then, if there is no point cloud that indicates a shape and position similar to the shape and position of the landmark identified by the map DB 10, the control unit 15 determines that the landmark does not exist and determines that the LIDAR 21 cannot measure the yaw angle and vehicle speed.
[0101] According to these examples, the control unit 15 can accurately determine whether or not the yaw angle and the vehicle speed can be measured by the rider 21 in step S102 of FIG.
[0102] [Additional explanation of effects] Next, the effects of this embodiment will be supplementarily described.
[0103] The estimated yaw rate Ψ shown in equation (3) · E According to the calculation method of the gyro sensor base yaw rate Ψ, the error of which becomes large with respect to the temperature change (i.e., the temperature difference ΔT), the control unit 15 calculates the gyro sensor base yaw rate Ψ · G and the change in vertical and horizontal acceleration (i.e., the acceleration difference Δα x , Δα y ), the steering angle-based yaw rate Ψ, which has a large error with respect to the pitch angle change (i.e., the pitch angle difference Δθ) and the roll angle change (i.e., the roll angle difference Δφ). · S By appropriately compensating for the shortcomings of each of the above, the estimated yaw rate Ψ · E It becomes possible to calculate with high accuracy. In addition, the control unit 15 calibrates the gyro sensitivity coefficient A, the gyro offset coefficient B, the steering angle sensitivity coefficient C, and the steering angle offset coefficient D every time the control unit 15 measures the yaw angle of the rider 21 and the vehicle speed using the landmarks (see steps S105 and S106 in FIG. 2). For this reason, the gyro sensor base yaw rate Ψ · G and steering angle based yaw rate Ψ· S The reliability of the system is well maintained.
[0104] In addition, if the yaw angle of the rider 21 and the vehicle speed are measured by the landmarks within an interval of several seconds, there is no sudden change in temperature (i.e., the temperature difference ΔT is small), and if the vehicle is traveling normally, there is no sudden change in vertical acceleration (i.e., the vertical acceleration difference Δα x is small), and if the steering operation is gentle, there is no sudden change in lateral acceleration (i.e., the lateral acceleration difference Δα y is small) and it is considered that there are no sudden changes in pitch angle and roll angle on a normal road surface (i.e., the pitch angle difference Δθ and roll angle difference Δφ are also small), so it can be said that measurements by the lidar 21 may be taken at intervals of several seconds. This indicates that the positions of landmarks used for measuring the yaw angle and vehicle speed by the lidar 21 may be spaced apart to a certain extent. For example, when traveling on a highway using kilometer posts at 100 m intervals as landmarks, even if the measurable distance of the lidar 21 is 50 m, the time during which measurements cannot be taken by the lidar 21 is 1.8 seconds when traveling at 100 km / h and 3.6 seconds when traveling at 50 km / h.
[0105] [Variations] Preferred modified examples of the embodiment will be described below. The following modified examples may be applied to the embodiment in any combination.
[0106] (Variation 1) The control unit 15 calculates the gyro sensor base yaw rate Ψ in the formula (3). · G and steering angle based yaw rate Ψ · S Each difference value ΔT, Δα determines the weighting of x , Δα y , Δθ, and Δφ may be multiplied by a predetermined coefficient. x , Δα y , Δθ, Δφ are multiplied by the coefficient "w T ", "w αx ", "w αy ", "w θ ", "w φ" and estimate the yaw rate Ψ based on the following equation (21): · E may be calculated.
[0107]
number
[0108] Here, the coefficient w T , w αx , w αy , w θ , w φ A setting example will be explained.
[0109] For example, the control unit 15 may adjust the coefficient w T For example, in this case, the degree of change due to temperature of the gyro sensitivity coefficient A and the gyro offset coefficient B of the gyro sensor used as the gyro sensor 24 is measured in advance by an experiment or the like, and if the degree of change due to temperature of the gyro sensitivity coefficient A and the gyro offset coefficient B is larger than that of a normal gyro sensor, the coefficient w T For example, the control unit 15 sets the coefficient w T is made larger than the average value of the other coefficients.
[0110] In another example, when the control unit 15 determines that the road surface on which the vehicle is traveling is slippery, the control unit 15 αxis made relatively larger than the other coefficients. Generally, when the road surface is slippery, such as a wet road surface or a frozen road surface, the slip ratio λ to obtain the same driving force is larger than that on a dry road surface. Therefore, when the road surface is slippery, the longitudinal acceleration α x If there is a change in the wheel slip angle β f、 β r Therefore, in this case, the change in the vertical acceleration difference Δα x The change in the steering angle offset coefficient D for the x Steering angle-based yaw rate Ψ caused by · S Taking the above into consideration, when the control unit 15 determines that the road surface is slippery, it adjusts the coefficient w αx is set to be larger than the other coefficients. In this case, for example, when the control unit 15 detects raindrops using a raindrop sensor (not shown), when it recognizes that it is raining or snowing based on weather information received from a server device (not shown), or when it recognizes that the road surface of the traveled road is slippery based on road surface information included in the map DB 10, the control unit 15 determines that the road surface is slippery.
[0111] In still another example, the control unit 15 increases the coefficient w θ , w φ In general, the heavier the vehicle weight, the larger the change in slip ratio λ due to the change in road gradient (i.e., the pitch angle difference Δθ), and as a result, the wheel side slip angle β f、 β r Therefore, in this case, the change in the steering angle offset coefficient D with respect to the pitch angle difference Δθ becomes large, and the steering angle-based yaw rate Ψ · S Similarly, the heavier the vehicle body weight, the greater the load transfer between the wheels due to the change in roll angle, and the greater the change in lateral force. Also, the greater the change in lateral force, the greater the error effect of the wheel sideslip angle β f、 β rTherefore, in this case, the change in the steering angle offset coefficient D with respect to the roll angle difference Δφ becomes large, and the change in the steering angle-based yaw rate Ψ caused by the roll angle difference Δφ becomes large. · S The degree of error influence becomes larger.
[0112] Taking the above into consideration, the control unit 15 sets the coefficient w θ , w φ For example, the control unit 15 sets the coefficient w in accordance with the number of passengers detected based on the output of a sensor that detects whether or not the passengers are seated on the seats. θ , w φ In this case, preferably, the control unit 15 increases at least one of the coefficients w θ , w φ It is recommended to increase the initial value of .
[0113] (Variation 2) The control unit 15 calculates the steering angle-based yaw rate Ψ based on the equation (2). · S In the calculation of the steering angle, an estimated steering angle calculated based on the difference in rotation speed between the wheels may be used instead of the detected steering angle value output by the steering angle sensor 28.
[0114] In this case, the control unit 15 calculates an estimated value of the steering angle based on the output of a sensor provided for each wheel to detect the rotation speed of the wheel. In this case, the difference in rotation speed of the right front wheel with respect to the left front wheel at time t (i.e., "right front wheel rotation speed - left front wheel rotation speed") is defined as "S f [t]" and the difference in rotation speed of the right rear wheel relative to the left rear wheel at time t (i.e. "right rear wheel rotation speed - left rear wheel rotation speed") is "S r [t]", the control unit 15 calculates the steering angle S[t] of equation (2) based on the following equation. S[t]=(S f [t]+S r [t]) / 2
[0115] Even in this case, the control unit 15 calculates the steering angle from the output of the sensor that detects the rotation speed of each wheel, and calculates the steering angle-based yaw rate Ψ based on the equation (2). · S can be suitably calculated.
[0116] (Variation 3) The control unit 15 may calculate the yaw angle with high accuracy based on the output of an external sensor other than the rider 21.
[0117] In this case, when the control unit 15 can calculate the yaw angle with high accuracy based on the output of the external sensor of interest, the control unit 15 calculates the yaw angle based on the output of the external sensor as the estimated yaw angle Ψ E and performs calibration of the coefficients A to D. On the other hand, when the control unit 15 cannot calculate the yaw angle based on the output of the external sensor of interest, it sets the estimated yaw rate Ψ using the coefficients A to D based on the equation (3) in the same manner as in the embodiment. · E After calculating the estimated yaw angle Ψ E In this way, the coefficients A to D are updated in the same manner as in this embodiment using an external sensor other than the lidar 21 that can calculate the yaw angle with high accuracy, and even if the external sensor cannot be used, the estimated yaw angle Ψ with high accuracy can be calculated. E can be calculated.
[0118] (Variation 4) According to the formula (3), the control unit 15 calculates each of the difference values ΔT, Δα x , Δα y Taking into account all of , Δθ, and Δφ, the gyro sensor base yaw rate Ψ · G and steering angle based yaw rate Ψ · S However, the weighting of the gyro sensor-based yaw rate Ψ to which the present invention is applicable is determined. · G and steering angle based yaw rate Ψ · S The method of weighting is not limited to this.
[0119] In the first example, the control unit 15 calculates the vertical acceleration difference Δαx and the difference values ΔT, Δα other than the pitch angle difference Δθ y , Δφ is used to estimate the yaw rate Ψ · E In this case, for example, the control unit 15 calculates Δα x and Δθ are set to "0". (3-4) Vertical acceleration difference Δα x As explained in the section "Weighting Based on Pitch Angle Difference Δθ" x The weighting based on the pitch angle difference Δθ is based on the other temperature difference ΔT and lateral acceleration difference Δα y , which is less important than the weighting based on the roll angle difference Δφ. Therefore, even in this case, the control unit 15 · G and steering angle based yaw rate Ψ · S The control unit 15 can appropriately weight the vertical acceleration difference Δα x and the pitch angle difference Δθ are excluded to obtain the estimated yaw rate Ψ · E [t] may be calculated.
[0120] In the second example, the control unit 15 calculates the vertical acceleration difference Δα x and the difference values ΔT, Δα other than the pitch angle difference Δθ y , Δφ are used to estimate the yaw rate Ψ · E In the second example, the difference values ΔT and Δα y , Δφ, the control unit 15, for example, normalizes the target difference value (expressed as a "target difference value Δ") so that it falls within a range of approximately 0 to 1, and then weights the gyro sensor base yaw rate Ψ · G and steering angle based yaw rate Ψ · S For example, when the target difference value Δ is a temperature difference ΔT, the control unit 15 multiplies "Δ" by the steering angle-based yaw rate Ψ · SMultiply it by "1-Δ" and use the gyro sensor base yaw rate Ψ · G Take advantage of.
[0121] In this way, the control unit 15 calculates the difference values ΔT and Δα x , Δα y Even if all of Δθ, Δφ are not used, the estimated yaw rate Ψ · E can be suitably calculated. [Explanation of symbols]
[0122] 1 On-vehicle device 11 Sensor Group 12 Storage section 14 Input section 15 Control section 16 Output section 17 Yaw angle estimator 18 Calibration section
Claims
[Claim 1] a correction unit that corrects calculation information for calculating a second yaw rate of the moving body based on information about the moving body, The calculation device, wherein the correction unit corrects the calculated information when a first yaw rate can be obtained from information about the periphery of the moving object.
Citation Information
Patent Citations
Detector
JP1996136569A
Yaw rate estimating device
JP2008049828A
Angular velocity estimation device, computer program, and angular velocity estimation method
JP2011247721A
Yaw rate detection apparatus
JP2014215232A
Vehicle motion state determination device and vehicle motion control device
JP2015178325A
