WO2007088859A1 - Road surface condition determination device, route search device, position setting method, road surface condition determination method, route search method, position setting method, program, and recording medium - Google Patents

Road surface condition determination device, route search device, position setting method, road surface condition determination method, route search method, position setting method, program, and recording medium Download PDF

Info

Publication number
WO2007088859A1
WO2007088859A1 PCT/JP2007/051516 JP2007051516W WO2007088859A1 WO 2007088859 A1 WO2007088859 A1 WO 2007088859A1 JP 2007051516 W JP2007051516 W JP 2007051516W WO 2007088859 A1 WO2007088859 A1 WO 2007088859A1
Authority
WO
WIPO (PCT)
Prior art keywords
speed
road surface
condition
moving body
information
Prior art date
Application number
PCT/JP2007/051516
Other languages
French (fr)
Japanese (ja)
Inventor
Toshiharu Baba
Original Assignee
Pioneer Corporation
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Pioneer Corporation filed Critical Pioneer Corporation
Priority to JP2007556871A priority Critical patent/JP4734349B2/en
Publication of WO2007088859A1 publication Critical patent/WO2007088859A1/en

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06Road conditions
    • GPHYSICS
    • G09EDUCATION; CRYPTOGRAPHY; DISPLAY; ADVERTISING; SEALS
    • G09BEDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS
    • G09B29/00Maps; Plans; Charts; Diagrams, e.g. route diagram
    • G09B29/10Map spot or coordinate position indicators; Map reading aids
    • G09B29/102Map spot or coordinate position indicators; Map reading aids using electrical means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2556/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • B60W2556/50External transmission of data to or from the vehicle for navigation systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06Road conditions
    • B60W40/068Road friction coefficient
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention

Definitions

  • Road surface condition determination device Road surface condition determination device, route search device, position setting device, road surface condition determination method, route search method, position setting method, program, and recording medium
  • the present invention automatically determines a road surface condition on which a moving object is traveling, and uses the determination result of the road surface condition to determine a route and position of the moving object.
  • the present invention relates to a device, a position setting device, a road surface condition determination method, a route search method, a position setting method, a program, and a recording medium.
  • a visible image (camera) type As a technology for judging the road surface condition while a moving body such as a vehicle is running, a visible image (camera) type, an on-road / under-road antenna type, a radio wave radiation type, a radiant energy reception type on the road surface or in the sky Various methods are disclosed.
  • a navigation device is also disclosed that determines the road surface condition by detecting the operation of a device whose usage status changes according to weather conditions, such as a wiper or fog lamp, without adding a new detection device (for example, See Patent Document 1 below.)
  • Patent Document 1 Japanese Patent Application Laid-Open No. 2003-161628
  • the determination device includes temperature information acquisition means for acquiring information related to the outside temperature around the moving body,
  • a first speed calculating means for calculating a speed of 1 a speed information acquiring means for acquiring information on the speed of the moving body from a sensor mounted on the moving body, and the information on the speed.
  • a judging means for judging the situation.
  • the road surface condition determination device according to any one of claims 1 to 6 and the mobile body by the road surface condition determination device travel. And a search means for searching for a route to the destination based on the determination result of the road surface condition and the regional characteristics to which the destination belongs.
  • a position setting device is based on the road surface condition determination device according to any one of claims 1 to 6 and the GPS signal.
  • a first positioning means for positioning the position a second positioning means for positioning the position of the moving body using the second speed, a positioning result of the first positioning means, and a positioning result of the second positioning means.
  • setting means for setting the position of the moving body using the above-mentioned setting means, based on the determination result of the condition of the road surface on which the moving object is traveling by the road surface condition determining device. The ratio of using the positioning result of the first positioning means and the positioning result of the second positioning means is determined.
  • the road surface condition determination method includes an air temperature information acquisition step of acquiring information on the outside air temperature around the moving body, a reception step of receiving a GPS signal, and the GP S signal.
  • a determination step of determining the state of the road surface on which the mobile body travels!
  • the route search method which is effective for the invention of claim 10 relates to the outside air temperature around the moving body.
  • the position setting method according to the invention of claim 11 uses an air temperature information acquisition step of acquiring information on the outside air temperature around the moving body, a reception step of receiving a GPS signal, and information on the GPS signal.
  • the first step of determining the position of the moving body based on the GPS signal, and the second speed is a first speed of the moving body based on the GPS signal, and the second speed.
  • Second positioning process for positioning the position of the moving object and determination of the determination process A determination step for determining a ratio of the positioning result of the first positioning step and the positioning result of the second positioning step used for setting the position of the moving body based on the results, and the first positioning according to the ratio And a setting step of setting the position of the moving body using the result of the step and the result of the second positioning step.
  • a program according to claim 12 is characterized by causing a computer to execute the method according to any one of claims 9 to L1.
  • the recording medium according to claim 13 records the program according to claim 12.
  • FIG. 1 is a block diagram showing a functional configuration of a road surface condition judging device according to an embodiment of the present invention.
  • FIG. 2 is a flowchart showing the contents of processing of the road surface condition judging device.
  • FIG. 3 is a block diagram showing a functional configuration of the route search apparatus according to the present embodiment of the present invention.
  • FIG. 4 is a flowchart showing the contents of processing of the route search device.
  • FIG. 5 is a block diagram showing a functional configuration of the position setting device according to the present embodiment of the present invention.
  • FIG. 6 is a flowchart showing the contents of processing of the position setting device.
  • FIG. 7 is a block diagram showing a hardware configuration of a navigation apparatus that is effective in the present embodiment.
  • FIG. 8 is a flowchart (part 1) showing the processing contents of the navigation device.
  • FIG. 9 is a flowchart (part 2) showing the contents of the processing of the navigation device.
  • FIG. 10 is a flowchart (part 3) showing the contents of the processing of the navigation device.
  • FIG. 11 is a flowchart (part 4) showing the contents of the processing of the navigation device.
  • FIG. 12 is an explanatory diagram showing a configuration of a ring buffer that stores a vehicle speed pulse speed VPn [m / 100 ms].
  • FIG. 13 is an explanatory diagram showing a configuration of a ring buffer that stores a change amount (vehicle speed pulse acceleration) AVPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs].
  • FIG 14 is an explanatory view showing a configuration of a Ringuba Ffa storing the acceleration sensor acceleration ⁇ VAn [m / s 2 / 100ms].
  • FIG. 15 is an explanatory diagram showing a configuration of a ring buffer that stores a road surface inclination angle ⁇ Pn [rad.].
  • FIG. 16 is an explanatory diagram showing the correspondence between the vertical component sin ⁇ Pn and the road surface inclination angle ⁇ Pn [rad.].
  • Figure 17 shows the amount of change in road slope angle ⁇ Pn [rad.] (Road slope angular velocity) ⁇ ⁇ Pn [ra d. It is explanatory drawing which shows the structure of the ring buffer which stores Zs].
  • FIG. 18 is an explanatory diagram showing a configuration of a ring buffer that stores a horizontal (X) direction component of a GPS speed VGGn [kmZh].
  • FIG. 19 is an explanatory diagram showing a configuration of a ring buffer that stores a vertical (y) direction component of a GPS speed VGGn [km / h].
  • FIG. 20 is an explanatory diagram showing the configuration of a ring buffer that stores GPS speed VGn [mZs].
  • FIG. 21 is an explanatory diagram (part 1) showing a method of calculating the road surface inclination angle ⁇ Gn [rad.].
  • FIG. 22 is an explanatory diagram (part 2) showing a method of calculating the road surface inclination angle ⁇ Gn [rad.].
  • FIG. 23 is an explanatory diagram showing an example of a drive type selection screen.
  • FIG. 24 is an explanatory diagram showing an example of a wheel type selection screen.
  • FIG. 25 is an explanatory diagram showing an example of a selection screen for whether or not a tire chain is mounted. Explanation of symbols
  • FIG. 1 is a block diagram showing a functional configuration of the road surface condition judging device according to the present embodiment of the present invention.
  • the road surface condition determination device 100 includes an air temperature information acquisition unit 101, a reception unit 102, a first speed calculation unit 103, a speed information acquisition unit 104, and a second speed calculation unit 105. Part 106.
  • the temperature information acquisition unit 101 acquires information about the outside temperature around the moving body.
  • the information on the outside air temperature is the outside air temperature around the moving body.
  • the temperature difference between the inside and the outside of the moving body may be used.
  • This information on the outside air temperature is a criterion for determining whether or not the road surface on which the moving body is traveling is frozen or snowy.
  • the temperature information acquisition unit 101 outputs information about the acquired outside temperature to the determination unit 106.
  • the receiving unit 102 receives a GPS signal.
  • GPS signals are radio waves transmitted from four GPS satellites arranged in six circular tracks at an altitude of about 20,000 km. By receiving multiple GPS signals and detecting errors between GPS signals, information such as latitude, longitude, and altitude can be determined with an accuracy of several tens of meters.
  • the receiving unit 102 outputs the received GPS signal to the first speed calculating unit 103.
  • the first speed calculation unit 103 calculates the speed of the moving body using the information of the GPS signal input from the reception unit 102. As described above, the latitude, longitude and altitude of the moving object are obtained by using the GPS signal. The first speed calculation unit 103 records changes of the latitude, longitude, and altitude information according to time, and calculates the speed of the moving object. Hereinafter, the speed calculated using the GPS signal is the first speed. The first speed calculation unit 103 outputs the calculated first speed to the determination unit 106.
  • the speed information acquisition unit 104 acquires information about the speed of the sensor force mobile body mounted on the mobile body.
  • the sensor is a detecting means having a function of detecting the operation (rotation) of the wheel of the moving body.
  • a sensor that detects vehicle speed pulses may be used.
  • a vehicle speed pulse is a signal obtained by detecting the rotation of a wheel of a moving object by a sensor.
  • the speed information acquisition unit 104 outputs information about the acquired speed of the moving body to the second speed calculation unit 105.
  • the second speed calculation unit 105 calculates the speed of the moving object using the information on the speed of the moving object acquired by the speed information acquisition unit 104.
  • the speed of the moving object is changed according to the change in the frequency of the vehicle speed pulse. Is calculated.
  • the speed calculated by detecting the movement of the wheels of the moving object is called the second speed.
  • Second speed calculation unit 105 outputs the calculated second speed to determination unit 106.
  • the determination unit 106 includes information on the outside air temperature input from the air temperature information acquisition unit 101, the first speed input from the first speed calculation unit 103, and the first speed input from the second speed calculation unit 105. Based on the speed of 2, determine the road surface where the moving body is traveling.
  • the judgment unit 106 judges whether or not it is in a frozen state or a snowy state, whether the road surface is level, whether it is an uphill force, a downhill, In some cases, the road surface is like how much the slope is.
  • the determination unit 106 classifies each input parameter and determines the optimum road surface condition.
  • FIG. 2 is a flowchart showing the contents of the processing of the road surface condition judging device.
  • the temperature information acquisition unit 101 acquires information about the outside temperature (step S201).
  • step S201 Simultaneously with the process of step S201, the GPS signal is acquired by the receiving unit 102 (step S202), and the first speed calculation unit 103 calculates the first speed (step S203). At the same time as the processing of step S202 and step S203, information on the speed is acquired from the sensor mounted on the moving body (step S204), and the second speed calculation unit 105 calculates the second speed ( Step S205).
  • step S201 When the processing of step S201, step S203, and step S205 is completed, the determination unit 106 next performs information on the outside air temperature acquired in step S201 and the first and second values calculated in steps S203 and S305.
  • the road surface condition is judged based on the speed of the road (step S206).
  • step S2 07 it is determined whether or not the power to end the processing of the road surface condition determination device 100 is determined.
  • step S207: No the process returns to step S201, and the processes from step S201 to step S206 are repeated.
  • step S207: Yes the series of processes is ended as it is.
  • the acceleration of the first speed or the second speed is used as a parameter. May be used.
  • the first speed calculation unit 103 and the second speed calculation unit 105 should have a function for calculating acceleration.
  • a recording means for recording the speed every minute time and a recording means for recording the change in speed every minute time are required.
  • a recording means for example, a ring buffer or the like is preferably used for recording by a FIFO (First-In First-Out) method.
  • a means for calculating the road surface inclination angle using the horizontal speed and the vertical speed of the first speed calculated by the first speed calculation unit 103, and the second speed calculation unit 105 Means for calculating the slope angle of the road surface using the measured second speed, and the road surface slope angle calculated by the first speed force and the road speed slope angle calculated by the second speed force It can be used as a parameter to judge.
  • the road surface condition determination apparatus 100 may be provided with a functional unit that acquires drive method information.
  • the drive system information is added to the information on whether the drive system power of the moving body is SFF, FR, MR, RR, or 4WD, and the information such as how much the tire type is and the chain is installed. Including.
  • driving method information is added to one of the parameters used as criteria for judging the road surface condition in the judgment unit 106, the road surface condition can be judged with higher accuracy.
  • FIG. 3 is a block diagram showing a functional configuration of the route search apparatus according to this embodiment of the present invention.
  • the route search device 300 includes a road surface condition determination device 100 and a search unit 301.
  • the search unit 301 searches for a route to the destination based on the determination result of the road surface on which the moving body is traveling by the road surface state determination device 100 and the regional characteristics to which the destination belongs!
  • the regional characteristics to which the destination belongs are regional climatic feature information such as snow areas and ice areas.
  • the regional information is preferably information set for each season, and the current regional information may be acquired by referring to date information provided by a clock function provided in the mobile unit.
  • the area information may be received from the wireless communication network and sequentially updated to the latest area information.
  • FIG. 4 is a flowchart showing the contents of the processing of the route search device.
  • the route search apparatus 300 starts route search triggered by the setting of the destination by the user.
  • the road surface condition determination apparatus 100 performs processing from step S201 to step S206 (see FIG. 2) (step S401).
  • step S401 the road surface condition that the moving body is currently running is determined.
  • step S402 the regional characteristics of the destination are acquired.
  • the search unit 301 searches for a route to the destination based on the road surface condition determination result acquired in step S401 and the regional characteristics acquired in step S402 (step S403).
  • step S404 it is determined whether or not to end the process of the route search device 300.
  • step S404: No If the route search is to be continued (step S404: No), the process returns to step S401, and the processes from step S401 to step S403 are repeated.
  • step S404: Yes the series of processing is ended as it is.
  • the route search device 300 uses the determination result by the road surface condition determination device 100, and when the road surface is frozen or snowy, Corresponding to the information, it is possible to search for a safer route and provide it to the user.
  • FIG. 5 is a block diagram showing a functional configuration of the position setting apparatus according to this embodiment of the present invention.
  • the position setting device includes a road surface condition determination device 100, a first positioning unit 501, a second positioning unit 502, and a setting unit 503.
  • the first positioning unit 501 measures the position of the moving body based on the GPS signal received by the receiving unit 102 of the road surface condition judging device 100.
  • the first positioning unit 501 outputs the positioning result to the setting unit 503.
  • the second positioning unit 502 measures the position of the moving body using the second speed calculated by the second speed calculating unit 105 of the road surface condition judging device 100. As described above, the second speed is a speed calculated based on the operation of the wheels of the moving body. Second positioning section 502 outputs the positioning result to setting section 503.
  • Setting section 503 sets the position of the moving body using the positioning result of first positioning section 501 and the positioning result of second positioning section 502. In order to set the position, the setting unit 503 determines the positioning result of the first positioning unit 501 and the second positioning unit based on the determination result of the road surface condition where the moving body is traveling by the road surface condition determination device 100. Determine the ratio for reflecting 502 positioning results.
  • FIG. 6 is a flowchart showing the contents of the processing of the position setting device.
  • processing from step S 201 to step S 206 is performed by the road surface condition determination device 100 (step S 601).
  • the road surface condition that the moving body is currently driving is determined.
  • the first positioning unit 501 performs the first positioning based on the GPS signal acquired by the receiving unit 102 of the road surface condition determination device 100 (step S602), and at the same time, the second speed calculating unit 105 Second positioning is performed using the second speed calculated in (Step S603).
  • step S602 and step S603 are completed, the use ratio between the first positioning in step S602 and the second positioning in step S603 is determined based on the road surface condition determination result in step S601 (step S603). S604). Subsequently, the setting unit 503 also sets the position of the moving body for the positioning result force according to the utilization ratio determined in step S604 (step S605).
  • step S606 it is determined whether or not to end the processing of the position setting device 500.
  • step S606: No When continuing the position setting (step S606: No), return to the process of step S601 and Steps S601 to S605 are repeated.
  • step S606: Yes the series of processing is ended as it is.
  • the position setting device 500 uses the positioning result of the first positioning and the positioning result of the second positioning means in order to set the position accurately. Depending on the current road conditions, the ratio to be reflected is changed. Therefore, it is possible to provide the user with the most accurate position information obtained under the current road surface condition.
  • FIG. 7 is a block diagram showing a hardware configuration of a navigation device that is useful in the present embodiment.
  • the navigation device 700 includes a travel / stop determination unit 701, an outside air temperature determination unit 702, an outside air temperature acquisition unit 703, a GPS speed acquisition unit 704, and a first road surface inclination angle calculation.
  • the determination unit 717 includes a warning notification presence / absence flag determination unit 718, a driver notification determination unit 719, a route guidance priority determination unit 720, and a hybrid navigation weighting determination unit 721.
  • the traveling / stop determination unit 701 determines whether the moving body on which the navigation device 700 is mounted is traveling or stopped.
  • the travel 'stop determination unit 701 detects a vehicle speed pulse from the moving body in order to determine the travel' stop.
  • a vehicle speed pulse is a signal obtained by detecting the rotation of a wheel of a moving object by a sensor. Therefore, the frequency of the vehicle speed pulse increases according to the moving speed VPPn [km Zh] of the moving body, and is not detected if it stops.
  • the outside air temperature determination unit 702 determines the outside temperature of the mobile body, that is, the state of the outdoor temperature, which is information about the outside air temperature of the mobile body acquired by the outside air temperature acquisition unit 703.
  • the outside temperature acquisition unit 703 Obtain information about the outside temperature of the moving object.
  • the information related to the outside air temperature includes the outdoor temperature and the temperature difference between the inside and outside of the moving body. In the present embodiment, the outside air temperature acquisition unit 703 acquires the temperature Toutn [° C.] outside the moving
  • FIG. 8 to 11 are flowcharts showing the contents of the processing of the navigation device.
  • the travel / stop determination unit 701 and the vehicle speed pulse speed calculation unit 707 determine whether or not the vehicle speed pulse speed VPPn ⁇ 0 [kmZh] (step S801).
  • the vehicle speed pulse speed VPn [] in which the current vehicle speed pulse number force is also calculated at every sampling period T (eg, 100 ms) from the vehicle speed sensor of the vehicle connected to the navigation device 700.
  • T e.g. 100 ms
  • mZl00ms] is stored as the latest data in the ring buffer 1202 (see Fig. 12) with 20 samples.
  • the sampling period T is assumed to be 100 ms.
  • FIG. 12 is an explanatory diagram showing the configuration of the ring buffer that stores the vehicle speed pulse speed VPn [mZ 100 ms].
  • a chart 1200 in FIG. 12 represents the ring buffer 1202 and the data stored in the ring buffer 1202.
  • the latest data (latest vehicle speed pulse speed VPn [mZl00ms]) 1201 is stored as the latest data in the ring buffer 1202 with 20 samples, and the data string in the ring buffer 1202 is shifted by one data at a time.
  • the 20th data (20th vehicle speed pulse speed VPn—19 [mZl00ms]) becomes the 21st data (21st vehicle speed pulse speed VPn—20 [m / 100ms]) 1203, and the ring-offer 1202 I'm out of force. Therefore, a ring buffer with 20 samples is realized.
  • the first data (the first vehicle speed pulse speed VPn [mZ 100ms]) to the tenth data (the tenth vehicle speed pulse speed VPn—9 [mZ 10 Oms] of the ring buffer 1202 )
  • Sampling number 10 Vehicle speed pulse speed VP [m / 100ms]
  • the vehicle speed pulse speed VPn [m at the current sampling time nT Zs] is calculated.
  • the vehicle speed pulse speed VPPn [kmZh] is calculated by multiplying the vehicle speed pulse speed VPn [mZs] by (3600Z1000) and performing unit conversion. This vehicle speed pulse speed VPPn [km / h] is used to determine whether the vehicle is “running Z stopped”.
  • step S802 the outside air temperature sensor force of the vehicle connected to the navigation device 700 by the outside air temperature acquisition unit 703 and the outside air temperature determination unit 702.
  • the current outside air temperature Toutn acquired at every sampling interval T. It is determined whether or not [° C] is “outside temperature Toutn ⁇ 10 ° C” (step S802). This judgment is used to judge whether the road surface is frozen or snowy. In recent years, outside temperature sensors are standard equipment on almost all vehicles because they are used for vehicle upgrades. If “outside temperature Toutn ⁇ 10 ° C” (step S802: Yes), the process proceeds to step S803. On the other hand, if the “outside temperature Tout n ⁇ 10 ° C” is not satisfied (step S802: No), the process proceeds to step S841.
  • the standard deviation ⁇ ⁇ of [mZs 2 ] is calculated (step S803). Specifically, first, the first data (the first vehicle speed pulse speed VPn [mZl00ms]) to the tenth data (the tenth vehicle speed pulse speed VPn) of the ring buffer 1202 shown in FIG.
  • the difference between the vehicle speed pulse speed VPn—10 [m Zs] one second before and the current vehicle speed pulse speed VPn [mZs] is obtained, and the sampling time is nT.
  • a change amount (vehicle speed pulse acceleration) AVPn [mZs] of the vehicle speed pulse speed VPn [mZs] is calculated.
  • the calculated change amount of the vehicle speed pulse speed VPn [m / s] (vehicle speed pulse acceleration) AVPn [m / s 2 ] is stored in the ring buffer 1302 (see FIG. 13).
  • FIG. 13 is an explanatory diagram showing a configuration of a ring buffer that stores a change amount (vehicle speed pulse acceleration) ⁇ VPn [m / s 2 ] of the vehicle speed pulse speed VPn [m / s].
  • a chart 1300 in FIG. 13 represents data stored in the ring buffer 1302 and the ring buffer 1302.
  • the latest calculated data (change in the latest vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ⁇ VPn [mZs 2 ]) 1301 is the latest data in the ring buffer 1302 with 50 samplings.
  • the 50th data (the 50th vehicle speed pulse speed VPn—49 [m / s] change (vehicle speed pulse acceleration) ⁇ VPn — 49 [m / s 2 ]) is the 51st data (51st vehicle speed pulse speed VPn—50 [mZs] change (vehicle speed pulse acceleration) ⁇ VPn— 50 [mZs 2 ]) 130 3 Is out of the data string of the ring buffer 1302. Therefore, a ring buffer with 50 samplings is realized.
  • the standard deviation ex Pn of the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ⁇ VPn [m / s 2 ] is calculated. .
  • the standard deviation a Pn at the current sampling time ⁇ can be obtained by the following equation (3) obtained by substituting equation (1) into equation (2).
  • the vehicle speed pulse speed calculation unit 707, the acceleration calculation unit 70 8 and the second road surface inclination angle calculation unit 709 perform acceleration sensor acceleration A VAn [mZs 2] and vehicle speed pulse speed VPn [ mZs] change amount (vehicle speed pulse acceleration) ⁇ VPn [m / s 2 ] is used to calculate the road surface inclination angle ⁇ Pn [rad.] (step S804).
  • the acceleration sensor acceleration A VAn [m Zs 2 calculated at each sampling period T from the output of a single-axis acceleration sensor in the vehicle direction (vehicle longitudinal direction) connected to the navigation device 700.
  • ZlOOms] is stored in the ring buffer 1402 (see Figure 14).
  • FIG. 14 is an explanatory diagram showing the configuration of a ring buffer that stores acceleration sensor acceleration A VAn [mZs 2 ZlOOms].
  • a chart 1400 in FIG. 14 represents the ring buffer 1402 and the data stored in the ring buffer 1402.
  • the latest data (latest acceleration sensor acceleration ⁇ VAn [m / sV 1 OOms]) calculated every sampling cycle T interval 1401 is stored as the latest data in the ring buffer 1402 with 10 samplings.
  • the 10th data (10th acceleration sensor acceleration ⁇ VAn-9 [m / sVlOOms]) is shifted by 1 data at a time and the 11th data (11th acceleration) Sensor acceleration A VAn— 10 [mZs 2 Zl00ms]) 1403, which is out of the data string of the ring buffer 1402. Therefore, a ring buffer with 10 samplings is realized. Then, the first data of the ring buffer 1402 (the first acceleration sensor acceleration ⁇ VAn [mZs 2 Acceleration sensor acceleration AVAn [mZs 2 ] is obtained by adding the acceleration sensor acceleration ⁇ VA [m / s 2 / 100ms] of 10 samples from Z 100 ms]).
  • the calculated acceleration sensor acceleration AVAn the [m Zs 2] in step S803 the change amount of the calculated vehicle speed pulse rate VPn [MZS] (speed pulse acceleration) AVPn [mZs 2] Is used to further calculate the road slope angle ⁇ Pn [rad.].
  • the method for calculating the road surface inclination angle ⁇ Pn [rad.] Will be described later.
  • the calculated road inclination angle ⁇ Pn [rad.] Is stored in the ring buffer 1502 (see Fig. 15).
  • FIG. 15 is an explanatory diagram showing the configuration of a ring buffer that stores the road surface inclination angle ⁇ Pn [rad.].
  • a chart 1500 in FIG. 15 represents the data stored in the ring buffer 1502 and the ring buffer 1502.
  • ⁇ Pn [rad.] Is calculated from the change amount of the vehicle speed pulse speed VPn [m / s] stored in the ring buffer 1302 at every sampling period T according to a known technique (vehicle speed pulse acceleration). ) AVPn and [MZS 2], and aVAn [mZs 2] acceleration sensor acceleration calculated by the ring buffer 1402, the gravitational acceleration calculated by the road surface slope angle theta Pn stored in the ring buffer 1502 [ra d.] g [mZs 2 ] component (horizontal component on the road surface) Using gsin 0 P n [mZs 2 ] and the following equation (4), the vertical direction component of the road surface inclination angle ⁇ Pn [rad.] Find sin ⁇ Pn.
  • FIG. 16 is an explanatory diagram showing a correspondence relationship between the vertical direction component sin ⁇ Pn and the road surface inclination angle ⁇ Pn [rad.].
  • ⁇ Pn the road surface inclination angle
  • the second road surface inclination angle calculation unit 709 and the second standard deviation calculation unit 715 then change the road surface inclination angle ⁇ Pn [rad.] (Road surface inclination angular velocity) ⁇ ⁇ Pn [rad Zs] standard deviation j8 ⁇ Pn is calculated (step S805). Specifically, first, the first data (the first road surface inclination angle ⁇ Pn [rad.]) To the tenth data (the tenth road surface inclination angle) of the ring buffer 1502 shown in FIG. 0 Pn—9 [rad.]) The number of samplings of 10 road surface inclination angles ⁇ P [rad.] Data is added and averaged.
  • the road slope angle ⁇ Pn [rad.] At the current sampling time nT and the 11th data (11th road slope angle ⁇ Pn-10 [rad.]) To 20th data ( Number of samplings of 20th road slope angle ⁇ Pn-19 [rad.]) When 10 road slope angles ⁇ P [rad.] Data are added and averaged, the sampling time (n— 10) The road surface inclination angle at T 0 The difference from 0 Pn-lO [rad.] Is obtained.
  • 8 ⁇ Pn at the current sampling time nT can be obtained by the following equation (8) obtained by substituting equation (6) into equation (7) above.
  • FIG. 17 is an explanatory diagram showing the configuration of a ring buffer that stores the amount of change in road surface inclination angle ⁇ Pn [rad.] (Road surface inclination angular velocity) ⁇ Pn [rad. Zs].
  • a chart 1700 in FIG. 17 represents data stored in the ring buffer 1702 and the ring buffer 1702.
  • the latest calculated data (change in the latest road slope angle ⁇ Pn [rad.] (Road slope angular velocity) ⁇ ⁇ Pn [rad. Zs]) 1701 is stored in the ring buffer 1702 with 50 samples.
  • the data sequence in the ring buffer 1702 is shifted by one data, and the 50th data (the 50th road surface inclination angle ⁇ Pn-49 [rad.] Change amount (the road surface inclination) Angular velocity) ⁇ ⁇ Pn-49 [rad. Zs]) is the 51st data (51st road slope angle ⁇ Pn-50 [rad.] Change amount (road slope angular velocity) ⁇ ⁇ Pn— 50 [ rad.
  • the GPS speed acquisition unit 704 and the first road surface inclination angle calculation unit 705 perform the horizontal (X) direction component and the vertical (y) direction component of the GPS speed VGGn [kmZh].
  • the road surface inclination angle ⁇ Gn [rad.] Is calculated by (Step S806).
  • the GPS reception function unit provided in the navigation device 700 can perform GPS reception processing (radio wave reception processing, satellite capture processing, positioning data generation processing, etc.) and self-contained navigation processing simultaneously with a single CPU. .
  • the horizontal (X) direction velocity VGGxn [kmZh] at the current sampling time nT calculated for each sampling period T is calculated by the ring buffer 1802 (see Fig. 18) at the current sampling time nT.
  • the vertical (y) speed VGGyn [km / h] is stored in the ring buffer 1902 (see Fig. 19).
  • FIG. 18 is an explanatory diagram showing the configuration of the ring buffer that stores the horizontal (X) direction component of the GPS speed VGGn [kmZh].
  • the chart 1800 in FIG. 18 represents the data stored in the ring buffer 1802 and the ring buffer 1802.
  • FIG. 19 is an explanatory diagram showing the configuration of the ring buffer that stores the vertical (y) direction component of the GPS speed VGGn [kmZh].
  • a chart 1900 in FIG. 19 represents the ring buffer 1902 and the data stored in the ring buffer 1902.
  • the ring buffer 1802 in Figure 1800 when the latest data (latest GPS velocity VGG n [kmZh] horizontal (X) direction velocity VGGxn [kmZh]) 1801 is stored, the data in ring buffer 1802 is stored.
  • the 10th data (the 10th GPS speed VGGn—9 [km / h] horizontal (x) speed VGGxn—9 [km / h]) is shifted by 1 data from the column and the 11th data. (11th GPS speed VGGn—horizontal (x) direction speed V GGxn—10 [kmZh] at 10 [km / h]), and deviates from the data string in the ring buffer 1802. Therefore, a ring buffer with 10 samples is realized.
  • the ring buffer 1902 in Chart 1900 when the latest data (vertical (y) speed VGGyn [kmZh] of the latest GPS speed VGGn [kmZh]) 1901 is stored, the ring is stored.
  • the 10th data (the 10th GPS speed VGGn—9 [km / h] vertical (y) speed VGGyn—9 [km / h]) is shifted one by one from the data sequence in buffer 1902.
  • the eleventh data (the eleventh GPS speed VGGn—10 [km / h] vertical (y) direction speed VGGyn—10 [kmZh]), which is out of the ring buffer 1902 data string. Therefore, a ring buffer with 10 samples is realized.
  • the first data (the first GPS speed VGGn [km / h] horizontal (X) direction speed VGGxn [kmZh]) to the tenth data (10th data) GPS3 ⁇ 4itVGGn- 9 [km / h] horizontal (x) direction velocity VGGxn—9 [km / h])
  • Number of sampling 10 GPS speed VGG [km / h] horizontal (x) direction velocity VGGx [km / h]
  • Data is added and averaged to calculate the horizontal (X) speed VGGxn [kmZh] at the current sampling time nT.
  • the road surface inclination angle ⁇ Gn [rad.] Is calculated using the horizontal (x) direction velocity VGGx n [kmZh] and the vertical (y) direction velocity VGGyn [kmZh] calculated as described above. Note that GPS positioning data is generated (updated) at 1-second intervals, and is also performed when no positioning is performed.
  • the GPS speed acquisition unit 704 and the acceleration calculation unit 708 calculate the change amount (GPS acceleration) ⁇ VGn [mZs 2 ] of the GPS speed VGn [mZs] (steps). S807). Specifically, the GPS speed VVGn [mZs] obtained by multiplying the GPS speed VGGn [kmZh] obtained at every sampling period T interval at the current sampling time nT by (1000Z3600) and converting the unit, Store in buffer 2002 (see Figure 20).
  • FIG. 20 is an explanatory diagram showing the configuration of the ring buffer that stores the GPS speed VGn [mZs].
  • the chart 2000 in FIG. 20 represents the ring nota 2002 and the data stored in the ring nota 2002.
  • the data of the ring buffer 2002 is deleted.
  • the 20th data (20th GPS speed VG n—19 [mZs]) is 21st data (21st GPS speed VGn—20 [mZs]). 2 003, which is out of the data string of the ring buffer 2002. Therefore, a ring knoffer with 20 samplings can be realized.
  • the first data of ring buffer 2002 (first GPS speed VGn [mZs s]) to 10th data (10th GPS speed VGn—9 [mZs]) Sampling number 10 GPS speeds VG [mZs] Data is added and averaged to obtain the current sampling time nT GPS speed VGn [mZs] and the 11th data (11th GPS speed) Degree VGn—10 [mZs]) to 20th data (20th GPS speed VGn—19 [mZ s]) Sampling number 10 GPS speeds VG [m / s] data are added and averaged When processed, the difference from the GPS speed VGn-10 [m / s] at the sampling time (n-10) T one second before the current time is obtained.
  • the difference between the GPS speed VGn—10 [mZs] 1 second before and the current GPS speed VGn [mZs] is obtained, and the change in the GPS speed VGn [mZs] at the sampling time nT (GPS Acceleration) ⁇ VGn [mZs 2 ] is calculated.
  • the GPS speed VGGn [kmZh] is calculated by speed synthesis of the horizontal (x) direction speed VGGxn [kmZh] and the vertical (y) direction speed VGGyn [kmZh] obtained and calculated in step S806. ing.
  • FIG. 21 and FIG. 22 are explanatory diagrams showing a method of calculating the road surface inclination angle ⁇ Gn [rad.].
  • the road slope angle ⁇ Gn [rad.] Is calculated using a known technique. Specifically, the GPS velocity VGGn [kmZh] as shown in Fig. 21 and Fig. 22 and the horizontal (X) of the GPS velocity VGGn [kmZh] obtained and calculated at every sampling interval T in step S806.
  • the road surface inclination angle determination unit 710 determines whether or not 0 [rad.] ⁇ road surface inclination angle ⁇ Pn (step S808).
  • step S808 when 0 [rad.] ⁇ road surface inclination angle ⁇ Pn is not satisfied (step S808: No), the process proceeds to step S856 of the downhill road surface condition.
  • step S808 If the road surface inclination angle ⁇ Pn [rad.] Calculated in step S804 is 0 [rad.] ⁇ road surface inclination angle ⁇ Pn (step S808: Yes), then the vehicle speed comparison / determination unit Based on 711, it is determined whether or not 4.0 [kmZh] ⁇ (VPPn—VGGn) (step S809). In step S809, the vehicle speed pulse speed VPPn [km / h] acquired and calculated in step S801 is compared with the GPS speed VGGn [kmZh] acquired and calculated in step S807, and the magnitude of the speed difference is determined.
  • step S809: Yes Will satisfy the first freezing snow condition on the uphill road surface, and the process proceeds to step S810.
  • step S809: No the process proceeds to step S825.
  • step S809 If it is determined in step S809 that "4.0 [km / h] ⁇ (VPPn—VGGn)" is not satisfied (step S809: No), the vehicle speed comparison determination unit 711 then executes 2. It is determined whether or not 0 [km Zh] ⁇ (VPPn-VGGn) (step S825). In step S825, the vehicle speed pulse speed VPPn [kmZh] obtained and calculated in step S801 is compared with the GPS speed VGGn [kmZh] obtained and calculated in step S807 to determine the magnitude of the speed difference. . Specifically, for example, the speed difference parameter in step S809 is halved.
  • step S825 Yes
  • step S825 No
  • the process proceeds to step S842.
  • step S808 determines whether or not 3.0 [km / h] ⁇ (VGGn-VP Pn) (step S856).
  • step S856 the vehicle speed pulse speed VPPn [kmZh] obtained and calculated in step S801 is compared with the GPS speed VGGn [kmZh] obtained and calculated in step S807 to determine the magnitude of the speed difference.
  • step S856 if the downhill road surface on which the vehicle is traveling is frozen or snowy, the GPS speed VGGn [kmZh] is more accurate than the vehicle speed pulse speed VPPn [kmZh]. Data can be obtained. This is because when the vehicle speed pulse speed is VPPn [kmZh], the drive wheels of the vehicle slide down. Furthermore, when the brake system is operated (braking), the drive wheels slide down with little rotation. In addition, even if the vehicle is equipped with an ABS device, the ABS will move down (the drive wheel speed is low) and the vehicle will slide down.
  • the speed difference is "3.0 [km / h] ⁇ (VGGn-VPPn)" (step S856: Yes)
  • the first freezing snow condition on the downhill road surface is satisfied, and step S857 Transition to processing.
  • step S856: No the process proceeds to step S872.
  • step S856 If it is determined in step S856 that "3.0 [kmZh] ⁇ (VGGn—VPPn)" is not satisfied (step S856: No), the vehicle speed comparison determination unit 711 then selects 1.5 [ It is determined whether km Zh] ⁇ (VGGn—VPPn) (step S872). In step S 872, the vehicle speed pulse speed VPPn [kmZh] obtained and calculated in step S801 is compared with the GPS speed VGGn [kmZh] obtained and calculated in step S807 to determine the magnitude of the speed difference. .
  • step S872 the parameter of the speed difference in step S856 is set to 1/2, for example. This is because the slope angle ⁇ Pn [rad.] Of the downhill road during traveling is a gentle downhill road surface that is gentler than step S856 or is almost flat! This is to determine whether the downhill road surface is frozen or snowy. is there .
  • the speed difference is “1.5 [kmZh] ⁇ (VGGn—VPPn)” (step S 872: Yes)
  • step S873 Move on to processing.
  • step S872 when “1.5 [kmZh] ⁇ (VGGn—VPPn)” is not satisfied (step S872: No), the process proceeds to step S890.
  • step S809 it is determined that the speed difference between the vehicle speed pulse speed VPPn [kmZh] and the GPS speed V GGn [kmZh] is 4.0 [kmZh] ⁇ (VPPn—VGGn). If it is determined (step S809: Yes), the vehicle acceleration comparison / determination unit 712 subsequently determines whether or not 0.4 [m / s 2 ] ⁇ (AVPn- ⁇ VGn) (step S810). .
  • step S810 the change amount (vehicle speed pulse acceleration) AVPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs] obtained and calculated in step S803 and the GPS speed VGn [mZs] obtained and calculated in step S807 are calculated.
  • Change (GPS acceleration) ⁇ VGn [mZs 2 ] is compared to determine the magnitude of the speed change (acceleration) difference.
  • step S810 when the climbing road surface is frozen or snowy, the change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) is more effective than GPS AVPn [mZs 2 ].
  • Change in speed VGn [m / s] (GPS acceleration) ⁇ VGn [m / s 2 ] is more accurate for the actual movement of the vehicle. it can. This is because the amount of change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) AVPn [mZs 2 ] travels while the drive wheels of the vehicle run irregularly.
  • operating the accelerator system increases the speed while increasing irregular idling of the drive wheels.
  • step S810: Yes the difference (acceleration) is “0.4 [m / s 2 ] ⁇ (AVPn-AVGn)”
  • step S810: No the difference (acceleration) is “0.4 [m / s 2 ] ⁇ (AVPn-AVGn)”
  • step S810 when it is determined in step S810 that “0.4 [m / s 2 ] ⁇ (AVPn- ⁇ VGn)" is not satisfied (step S810: No), or in step S825, “2.0 [km / h] ⁇ (VPPn—VGGn) ”(step S825: Yes), the vehicle acceleration comparison / determination unit 712 then selects 0.2 [m / s 2 ] ⁇ (AVPn- ⁇ It is determined whether or not (VGn) (step S826).
  • step S826 the change amount (vehicle speed pulse acceleration) ⁇ VPn [m / s 2 ] of the vehicle speed pulse velocity VPn [m / s] obtained and calculated in step S803 and obtained and calculated in step S807.
  • GPS speed VGn [mZs] change (GPS acceleration) ⁇ VGn [m / s 2 ] is compared to determine the speed change (acceleration) difference.
  • the parameter of the speed change amount (acceleration) difference in step S810 is set to, for example, half. This is to determine whether the climbing road surface slope angle ⁇ Pn [rad.] Is lower than that of step S810 or whether the climbing road surface is almost flat or frozen.
  • step S826 Yes
  • step S827 the process proceeds to step S827.
  • step S826: No the process proceeds to step S842.
  • step S856 when it is determined in step S856 that "3.0 [kmZh] ⁇ (VGGn—VPPn)" (step S856: Yes), the vehicle acceleration comparison determination unit 712 then sets It is determined whether or not 3 [m / s 2 ] ⁇ (AVGn- ⁇ VPn) (step S857).
  • step S857 the change in the vehicle speed pulse speed VPn [mZs] obtained and calculated in step S803 (vehicle speed pulse acceleration) AVPn [mZv] and the change in the GPS speed VGn [mZs] obtained and calculated in step S807 Compare the amount (GPS acceleration) ⁇ VGn [mZs 2 ] to determine the magnitude of the speed change (acceleration) difference.
  • step S857 processing is performed when the determination result in step S856 is “3.0 [km / h] ⁇ (VGGn ⁇ VP Pn)” (step S856: Yes).
  • the GPS speed VGn [m / s] is greater than the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ⁇ VPn [mZs 2 ]. ] (GPS acceleration) ⁇ VGn [mZs 2 ] can obtain an accurate speed change (acceleration) that matches the actual driving behavior of the vehicle.
  • vehicle speed pulse speed VPn [mZs] vehicle speed pulse acceleration
  • AVPn [mZs 2 ] vehicle speed pulse acceleration
  • the drive wheels slide down with irregular and almost no rotation.
  • the number of vehicle speed pulses generated is smaller at irregular time intervals than when driving on a normal (dry / wet) road surface.
  • step S857 Yes
  • step S858 the second freezing-snow condition on the downhill road surface
  • step S873 determines that 0.15 [m / s 2 ] ⁇ (AVGn- ⁇ VPn) It is determined whether or not there is a certain force (step S873).
  • step S873 the change amount (vehicle speed pulse acceleration) AVPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs] obtained and calculated in step S803, and the GPS speed VGn obtained and calculated in step S807. Compare the change in [mZs] (GPS acceleration) ⁇ VGn [mZs 2 ] to determine the magnitude of the speed change (acceleration) difference.
  • step S873 the parameter of the speed change (acceleration) difference in step S857 is reduced to, for example, one half. This is to determine whether the downhill road surface inclination angle ⁇ Pn [rad.] Force step S857 during driving is freezing or snowy on a downhill road surface that is gentler or more powerful than the step S857.
  • the speed change (acceleration) difference is “0.15 [m / s 2 ] ⁇ (AVGn-AVPn)” (step S873: Yes)
  • step S873: No the process proceeds to step S890.
  • step S810 determines whether or not 1.8 ⁇ standard deviation ⁇ (step S811).
  • step S811 the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ⁇ VPn [m / s 2 ] calculated by the ring buffer 1302 with 50 samples in step S803 a Pn Determine the size of.
  • step S811 if the running uphill road surface is frozen or snowy, the amount of change in vehicle speed pulse speed VPn [mZs] described in step S810 (vehicle speed pulse acceleration) AVPn [mZs In the case of 2 ], the vehicle travels while the drive wheels of the vehicle run irregularly.
  • operating the accelerator system stepping on the accelerator
  • the calculated change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ⁇ VPn [m / s 2 ] is the change in GPS speed VGn [m / s] (G PS acceleration) ⁇ VGn [mZs 2 ] Irregularly larger than].
  • the standard deviation ⁇ ⁇ of the variation (vehicle speed pulse acceleration) A VPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs] obtained and calculated in step S803 is “1.8 ⁇ standard deviation ⁇ If “ ⁇ ” (step S811: Yes), the third freezing snow condition on the uphill road surface is satisfied, and the process proceeds to step S812. On the other hand, if “1.8 ⁇ standard deviation ⁇ ⁇ ” is not satisfied (step S811: ⁇ ), the process proceeds to step S827.
  • step S811 If it is determined in step S811 that “1.8 ⁇ standard deviation ⁇ ⁇ ” is not satisfied (step S811: No), or in step S826, “0.2 [m / s 2 ] ⁇ ( ⁇ VPn - ⁇ VGn) ”(step S826: Yes), the first standard deviation determination unit 714 then determines whether or not 1.35 ⁇ standard deviation ⁇ ⁇ ( Step S827). In this step S827, the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) A VPn [m / s 2 ] calculated by the ring buffer 1302 with 50 samples in step S803 a Pn Determine the size of.
  • VPn [mZs] vehicle speed pulse acceleration
  • step S827 the parameter of the standard deviation ⁇ Pn of the change amount (vehicle speed pulse acceleration) ⁇ VPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs] in step S811 is set to, for example, 3/4. This is because the slope angle ⁇ Pn [rad.] Of the climbing road surface during traveling is gentler than the step S811 or closer to the flat surface! In order to determine whether the climbing road surface is frozen or snowy.
  • step S 827: Yes Satisfies the third freezing / snow accumulation condition on the slightly uphill / flat road surface, and proceeds to the processing of step S828, while if it is not “1. 35 ⁇ standard deviation ⁇ ⁇ ” (step S827: No), then step S842 Move on to processing.
  • step S857 [0123] in step S857, "0 3 [mZs 2] ⁇ ( ⁇ VGn- ⁇ VPn). " If it is determined that (step S857: Yes), in turn, the first standard deviation determination unit 714 , 1.6 ⁇ standard It is determined whether or not the quasi deviation ⁇ ⁇ is satisfied (step S858). In this step S858, the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ⁇ VPn [mZs 2 ] calculated by the ring buffer 1302 with 50 samples in step S803 is the magnitude of the standard deviation a Pn Judging.
  • step S858: Yes the third icy snowfall condition on the downhill road surface is satisfied, and the process proceeds to step S859.
  • step S858: No the process proceeds to step S874.
  • step S858 If it is determined by step S858 that “1.6 ⁇ standard deviation ⁇ Pn” is not satisfied (step S858: No), or by step S873, “0.15 [m / s 2 ] ⁇ ( ⁇ VGn — ⁇ VP n) ”(step S873: Yes), the first standard deviation determination unit 714 subsequently determines whether 1.2 ⁇ standard deviation ⁇ ⁇ ( Step S874).
  • Step S874 the change amount (vehicle speed pulse acceleration) A VPn [m / s 2 ] of the vehicle speed pulse speed VPn [mZs] calculated by the ring buffer 1302 with 50 samples in step S803 a Pn Determine the size of.
  • step S874 the parameter of the standard deviation ⁇ Pn of the change amount (vehicle speed pulse acceleration) ⁇ VPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs] in step S858 is set to 3/4, for example. The This is to determine whether the downhill road slope angle ⁇ Pn [rad.] During traveling is a gentle downhill road surface that is gentler than step S858 or near flat! is there.
  • Step S874 Yes
  • the third freezing condition on a flat road surface • Snow conditions are met, and the process proceeds to step S875, while if it is not “1.2 ⁇ standard deviation ⁇ ⁇ ” (step S874: No), step Move on to S890 processing.
  • step S811 If it is determined in step S811 that the standard deviation ⁇ ⁇ is “1.8 ⁇ standard deviation ⁇ ⁇ ” (step S811: Yes), the road surface slope comparison and determination unit 706 subsequently performs ⁇ / It is determined whether or not 3 6 [rad.] ⁇ ( ⁇ Pn ⁇ ⁇ Gn) (step S812). In this step S812, the road surface inclination angle ⁇ Pn [calculated by the amount of change in the acceleration sensor acceleration ⁇ VAn [mZs 2 ] and the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ⁇ VPn [mZs 2 ] in step S804.
  • step S812 when the running uphill road surface is frozen or snowy, the road slope angle ⁇ Gn [rad.] Is more accurate than the road slope angle ⁇ Pn [rad.
  • the road surface inclination angle can be obtained. This is because the amount of change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) A VPn [mZs 2 ] as described in steps S810 and S811 when calculating the road surface inclination angle ⁇ Pn [rad. It is for receiving.
  • Step S812: Yes satisfies the fourth freezing snow condition on the uphill road surface, and proceeds to the process of Step S813.
  • step S812: No if “ ⁇ / 36 [rad.] ⁇ ( ⁇ Pn- ⁇ Gn)” is not satisfied (step S812: No), the process proceeds to step S828.
  • step S812 when it is determined in step S812 that “Z36 [rad.] ⁇ ( ⁇ Pn— ⁇ Gn)” is not satisfied (step S812: No), or in step S827, “1. If it is determined that the difference is a Pnj (step S827: Yes), then whether or not ⁇ / 72 [rad.] ⁇ ( ⁇ ⁇ - ⁇ Gn) is determined by the road surface slope comparison determination unit 706 (Step S828).
  • step S828 the road surface inclination angle ⁇ calculated by the acceleration sensor acceleration ⁇ VA n [mZs 2 ] and the change amount of the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) AVPn [m Zs 2 ] in step S804.
  • Pn [rad.] And the road slope angle calculated in step S806 from the GPS velocity V GGn [km / h] horizontal (x) direction velocity VGGxn [kmZh] and vertical (y) direction velocity VGGyn [kmZh] Compare with ⁇ Gn [rad.] To determine the magnitude of the road slope angle difference.
  • step S828 the parameter of the road surface inclination angle difference in step S812 is set to 1/2, for example. This is because the slope angle ⁇ Pn [rad.] Of the climbing road surface during traveling is gentler than the step S812 or near flat, and it is judged whether the climbing road surface is frozen or snowy. For example, if the road surface inclination angle difference between the road surface inclination angle ⁇ Pn [rad.] And the road surface inclination angle ⁇ Gn [rad.] Is Z72 [rad.] ⁇ ( ⁇ ⁇ — ⁇ Gn) ”(step S8 28: If Yes), the conditions are met slightly uphill / fourth freezing / snow coverage on flat road surface, and the process proceeds to step S829. On the other hand, if “ ⁇ / 72 [rad.] ⁇ ( ⁇ ( ⁇ — ⁇ Gn)” is not satisfied (step S828: No), the process proceeds to step S842.
  • step S858 If it is determined in step S858 that "1.6 ⁇ standard deviation ⁇ Pn" (step S858: Yes), the road surface slope comparison determination unit 706 subsequently performs w Z45 [rad.] It is determined whether or not ⁇ ( ⁇ Gn- ⁇ ⁇ ) (step S859).
  • step S859 the mosquito ⁇ degree sensor acceleration ⁇ VAn [mZs 2] with stearyl-up S804, variation in the vehicle speed pulse rate VPn [MZS] road surface inclination calculated by the (vehicle speed pulse acceleration) AVPn [mZs 2] The angle ⁇ P n [rad.], And the GPS velocity VGGn [kmZh] horizontal (x) direction velocity VGGx n [km / h] and vertical (y) direction velocity VGGyn [kmZh] calculated in step S806.
  • the road surface inclination angle ⁇ Gn [rad.] Is compared to determine the magnitude of the road surface inclination angle difference.
  • step S859 when the downhill road surface is frozen or snowy, the road surface inclination angle ⁇ Gn [rad.] Is more accurate than the road surface inclination angle ⁇ Pn [rad. It is possible to obtain the inside road slope angle. This is because the amount of change in vehicle speed pulse speed VPn [mZs] as described in steps S857 and S858 (vehicle speed This is because it is affected by (Luth acceleration) ⁇ VPn [mZs 2 ].
  • step S859: Yes when the road surface inclination angle difference between the road surface inclination angle 0 Gn [rad.] And the road surface inclination angle ⁇ Pn [rad.] Is “ ⁇ Z45 [ra d.] ⁇ ( ⁇ Gn- ⁇ ⁇ )” ( In step S859: Yes), the fourth freezing / snow accumulation condition on the downhill road surface is satisfied, and the process proceeds to step S860. On the other hand, if it is not “ ⁇ / 45 [rad.] ⁇ ( ⁇ Gn- ⁇ Pn)” (step S859: No), the process proceeds to step S875.
  • step S859 determines whether or not "Z45 [rad.] ⁇ ( ⁇ Gn— ⁇ ⁇ )" (step S859: No), or by step S874, "1.2 ⁇ standard deviation ⁇ ⁇ " (Step S874: Yes)
  • the road surface slope comparison / determination unit 700 determines whether or not ⁇ / 90 [rad.] ⁇ ( ⁇ Gn— ⁇ Pn). (Step S8 75). In this step S875, it is calculated in step S804 based on the amount of change in the vehicle speed sensor acceleration AVAn [m / s 2 ] and the vehicle speed pulse speed VPn [m / s] (vehicle speed pulse acceleration) ⁇ VPn [m / s 2 ].
  • step S806 Calculated in step S806 using the horizontal (X) direction velocity VGGxn [kmZh] and the vertical (y) direction velocity VGGyn [k mZh] in step S806.
  • the road surface inclination angle ⁇ Gn [rad.] Is compared to determine the magnitude of the road surface inclination angle difference.
  • step S875 the parameter of the road surface inclination angle difference in step S859 is set to 1/2, for example. This is to determine whether the downhill road surface inclination angle ⁇ Pn [rad.] During traveling is a gentle downhill road surface that is gentler than step S859 or a downhill road surface that is almost flat or snowy.
  • step S8 75 If Yes), slightly downhill 'Fourth freezing on flat road' snow condition is satisfied, and the process proceeds to step S876.
  • step S 875 if “ ⁇ / 90 [rad.] ⁇ ( ⁇ Gn— ⁇ Pn)” is not satisfied (step S 875: No), the process proceeds to step S 890.
  • step S812 If it is determined in step S812 that "Z36 [rad.] ⁇ ( ⁇ Pn— ⁇ Gn)" (step S812: Yes), the second standard deviation determination unit 716 then 1. It is determined whether or not 8 ⁇ standard deviation j8 ⁇ Pn (step S813). In this step S813, the road slope calculated by the ring buffer 1702 with 50 samples in step S805 is obtained. Change in angle ⁇ Pn [rad.] (Road slope angular velocity) ⁇ ⁇ Determine the magnitude of Pn [rad. Zs] standard deviation ⁇ ⁇ .
  • step S813 if the running uphill road surface is frozen or snowy, a specific calculation is omitted, but the amount of change in road slope angle ⁇ Gn [rad.] (Road slope angular velocity) ⁇ ⁇ G
  • the amount of change in road inclination angle ⁇ Pn [rad.] (road inclination angular velocity) ⁇ ⁇ Pn [rad. Zs] is irregularly larger than n [rad. Zs]. This is because the amount of change in road inclination angle ⁇ Pn [rad.] (Road inclination angle velocity) ⁇ Pn [rad.
  • step S810 When calculating vehicle speed pulse speed VPn [m / s] as described in steps S810 and S811 ] (Vehicle speed pulse acceleration) ⁇ VPn [m / s 2 ].
  • the amount of change in the road slope angle ⁇ Pn [rad.] Calculated in step S805 road slope angular velocity
  • ⁇ ⁇ Pn [rad. Zs] standard deviation ⁇ ⁇ is “1.8 ⁇ standard deviation
  • step S813: Yes the fifth freezing snow condition on the uphill road surface is satisfied, and the process proceeds to step S814.
  • step S813: No) the process proceeds to step S829.
  • step S813 If it is determined by step S813 that “1. 8 ⁇ standard deviation
  • step S829 specifically, the amount of change in road slope angle ⁇ Pn [rad.]
  • step S813 road slope angular velocity
  • ⁇ Pn [rad. Zs] standard deviation j8 ⁇ Pn parameter For example, 3/4. This is to determine whether the climbing road slope angle ⁇ Pn [rad.] During traveling is gentler than the step S813, or whether the climbing road surface is almost flat or frozen.
  • the amount of change in the road surface inclination angle ⁇ Pn [rad.] (Road surface inclination angle velocity) ⁇ Pn [rad. Zs] standard deviation j8 0?
  • Step S829: Yes slightly satisfies the climbing slope 'fifth freezing of flat road surface' snow cover condition, and proceeds to the processing of step S830. On the other hand, if the value is not 1.35 ⁇ standard deviation
  • step S859 If it is determined in step S859 that "Z45 [rad.] ⁇ ( ⁇ Gn— ⁇ ⁇ )" (step S859: Yes), the second standard deviation determination unit 716 then 1. It is determined whether or not 6 ⁇ standard deviation j8 ⁇ Pn (step S860). In this step S860, the amount of change in the road slope angle ⁇ Pn [rad.] Calculated by the ring buffer 1702 with 50 samples in step S805 (road slope angular velocity) ⁇ ⁇ Pn [rad. Zs] standard deviation ⁇ Determine the size of Pn.
  • step S860 if the downhill road surface is frozen or snowy, a specific calculation is omitted, but the amount of change in road surface inclination angle ⁇ Gn [rad.] (Road surface inclination angular velocity) ⁇ ⁇ Change amount of road surface inclination angle ⁇ Pn [rad.] (Road surface inclination angle velocity) ⁇ ⁇ Pn [rad. Zs] becomes irregularly smaller than G n [rad. Zs]. This is because the amount of change in road inclination angle ⁇ Pn [rad.] (Road inclination angle velocity) ⁇ Pn [rad.
  • step S860 when calculating vehicle speed pulse speed VPn [m / s] as described in steps S857 and S858 ] (Vehicle speed pulse acceleration) ⁇ VPn [m / s 2 ].
  • the amount of change in the road slope angle ⁇ Pn [rad.] Calculated in step S805 (road slope angular velocity) ⁇ ⁇ Pn [rad. Zs] standard deviation 0 Pr ⁇ “l. 6 ⁇ standard deviation
  • step S860: No) the process proceeds to step S876.
  • step S860 If it is determined by step S860 that it is not “1.6 ⁇ standard deviation
  • step S876 specifically, the amount of change in road slope angle ⁇ Pn [rad.]
  • step S860 road slope angular velocity
  • This is to determine whether the downhill road surface slope angle ⁇ Pn [rad.] Is lower than that of step S860 or whether the downhill road surface is almost flat or frozen.
  • the amount of change in the road surface inclination angle ⁇ Pn [rad.] (Road surface inclination angle velocity) ⁇ Pn [rad.
  • step S876: Yes it slightly satisfies the downhill “fifth freezing” snow condition on a flat road, and the process proceeds to step S877.
  • step S876: No the process proceeds to step S890.
  • step S813 If it is determined in step S813 that "1.8 ⁇ standard deviation
  • 8 0 Pn" (step S813: Yes), the condition counter determination unit 717 then sets the condition 1 establishment counter It is determined whether or not it is 5 seconds (50 times) (step S814).
  • step S814 it is monitored whether the 1st to 5th freezing / snow condition 1 is satisfied for 5 seconds (50 times) while traveling on an uphill road surface with a road surface inclination angle ⁇ Pn [rad. ing.
  • step S814: Yes the process proceeds to step S815.
  • step S814: No the process proceeds to step S824.
  • it is a counter that monitors whether it has been established for 5 seconds (eg, sampling period T: 100 ms, sampling count: 50 times).
  • ⁇ ⁇ ⁇ ⁇ ⁇ is a counter that monitors whether it is V for 5 seconds (for example, sampling period T: 100 ms, sampling count: 50 times).
  • step S802 If it is determined in step S802 that “outside temperature Toutn ⁇ 10 ° C” is not satisfied (step S802: No), it is determined in step S825 that it is not “2.0 [kmZh] ⁇ (VPPn—VGGn)”.
  • Step S825: No if it is determined by Step S826 that “0.2 [m / s 2 ] ⁇ (AV Pn- AVGn)” is not satisfied (Step S826: No), then step S827 If it is determined that it is not “1.35 ⁇ standard deviation PPn” (step S827: No), if it is determined by step S828 that it is not “Z72 [rad.] ⁇ ( ⁇ ⁇ — ⁇ Gn)” (step S828: No), or if it is determined in step S829 that ⁇ 1.35 ⁇ standard deviation j8 0 Pn '' is not! / (Step S829: No), then the outside air temperature determination unit 702 and warning notification The non-flag determining unit 718 determines whether or not the warning 1 notification presence / absence flag is 1 (step S842).
  • step S842 it is checked whether or not the “Warning 1 notification presence / absence flag” is set to “1”. As a result, if the “Warning 1 Notification Flag” is set to “1” (Step S842: Yes), the 1st to 5th frozen 'snow conditions 1 or slightly uphill' running on the uphill road surface will be flat. The process proceeds to step S844 for monitoring whether one of the first to fifth freezing / snow accumulation conditions 2 running on the road surface is released for 5 seconds (50 times). On the other hand, if the “warning 1 notification presence / absence flag” is set to “1” (step S842: No), the process proceeds to step S843.
  • Step S843: Yes the 1st to 5th freezing snow conditions 1 or slightly uphill on the uphill road surface
  • step S844 for monitoring whether one of the first to fifth freezing / snow conditions 2 running on a flat road surface is released for 5 seconds (50 times).
  • step S843: No the process proceeds to step S888.
  • step S872 determines that it is not “1.5 [kmZh] ⁇ (VGGn— VPPn)”.
  • step S873 determines that it is not ⁇ 0.15 [m / s 2 ] ⁇ ( ⁇ VGn-AVPn) '' (Step S873: No). 1.
  • step S890 it is checked whether or not the “Warning 3 notification presence / absence flag” is set to “1”. As a result, if the “Warning 3 Notification Flag” is set to “1” (Step S890: Yes), the 1st to 5th freezing / snow conditions 3 or slightly downhill on the downhill road surface ⁇ First to fifth freezing on a flat road surface ⁇ Snow condition 4 Shifts to the process of step S892 to monitor whether the force is released for 5 seconds (50 times). On the other hand, if the “Warning 3 notification presence / absence flag” is not set to “1” (step S890: No), the process proceeds to step S891.
  • step S892 for monitoring whether one of the first to fifth freezing snow conditions 4 running on the hill 'flat road surface' is released for 5 seconds (50 times).
  • step S891: No when the “warning 4 notification presence / absence flag” is not set to “1” (step S891: No), the process proceeds to step S904.
  • step S841 “Condition 1 establishment force counter” and “Condition 2 establishment counter” are cleared to zero. This is because the first to fifth freezing snow conditions 1 or slightly uphill on the uphill road before step S802 becomes “outside temperature Toutn ⁇ 10 ° C” (step S802: No). This is because the first to fifth freeze / snow conditions 2 running on a flat road may be counted (+1 increment). Then, when the process ends, the process proceeds to step S842.
  • step S802 the first to fifth freezing snow conditions 1 or slightly while driving on the uphill road surface before becoming the case (step S802: No). This is because the release of the 1st to 5th freezing snow conditions 2 while traveling on the uphill 'Taira road surface is being counted (+1 increment). Then, when the process ends, the process shifts to the process of step S889.
  • the condition 3 & 4 release counter is set to 0 by the outside air temperature determination unit 702 and the condition counter determination unit 717 (step S904). Here, all six “condition counters” are cleared to zero. Finally, clear “Condition 3 & 4 Cancel Counter” to zero. This is because, if “outside air temperature Toutn ⁇ 10 ° C” is not satisfied in step S802, the first to fifth freezing snow conditions 3 or on the downhill road before becoming the case (step S802: No). This is because the release of the first to fifth freezing snow conditions 4 running on a slightly downhill flat road surface is being counted (+1 increment) in some cases. When the process ends, the series of processes ends.
  • step S844 the uphill road surface force of the road surface inclination angle ⁇ Pn [rad.]
  • step S892 the downhill road force of road slope angle ⁇ Pn [rad.]
  • step S861 The road slope angle ⁇ Pn [rad.] Is a gentle downhill road surface or closer to flat than in step S861.
  • step S844 the slope of the road slope ⁇ Pn [rad.] In step S814 is smooth, or the slope slope ⁇ Pn [rad.] Is a gentle slope or flatter than that of step S814.
  • a new road condition judgment is also started for the initial force (Step S845).
  • Step S830 one of step S861 or step S877: Yes
  • route search route guidance and hybrid navigation of the driver and upper layer (upper layer)
  • Warning and communication If you know (described later in detail), one of these “warning notification flag”
  • Step S814 If it is determined that it has been established (Step S814, Step S861 or Step S877: Yes), for route search, route guidance and hybrid navigation of drivers and higher layers (upper layers), This is because one of these “warning notification presence / absence flags” is set to “1” when a warning and notification are made (described in detail later). Thereafter, the process proceeds to step S836.
  • Step S867 "Warning 1 Notification Presence Flag”, “Warning 2 Notification Presence Flag”, and “Warning 4 Notification Presence Flag” are cleared to zero. This is because before any transition to this step range, any one of the first to fifth freezing / snow conditions 1, condition 2 or condition 4 is performed for 5 seconds (50 ), If it is determined that it has been established (Step S814, Step S830 or Step S877: Yes), for route search, route guidance and hybrid navigation of drivers and higher layers (upper layers), This is because one of these “warning notification presence / absence flags” is set to “1” when a warning and notification are made (described in detail later). Then, the process proceeds to step S867.
  • Step S814, S830, S861 and! If it is determined that it has been established for 5 seconds (50 times) (one of steps S814, S830, S861 or S877: Yes), the route search for the driver or higher layer (upper layer) This is because when a warning or notification is given to the search, route guidance and hybrid navigation (described later in detail), any one of these “warning notification presence / absence flags” is set to 1 ”. Thereafter, the process proceeds to step S851.
  • step S892 Yes
  • processing is performed.
  • Step S892: Yes the other counters “Condition 1 Satisfaction Counter”, “Condition 2 Satisfaction Counter”, “Condition 3 Satisfaction Counter”, “Condition 4 Satisfaction Force Counter” and “Condition 1 & 2 Cancel Counter” Clear 'zero'.
  • Step S814, S830, S861 and! If it is determined that it has been established for 5 seconds (50 times) (one of steps S814, S830, S861 or S877: Yes), the route search for the driver or higher layer (upper layer) This is because when a warning or notification is given to the search, route guidance and hybrid navigation (described later in detail), any one of these “warning notification presence / absence flags” is set to 1 ”. Thereafter, the process proceeds to step S899.
  • step S830 Processing is performed at Yes).
  • step S836 it is determined that the road surface inclination angle ⁇ Pn [rad.] Is “traveling on a gentle uphill road surface or a gentle uphill road surface” than in step S820.
  • step S837 a voice message is given to the driver, for example, a warning such as “The road surface is very slippery.
  • step S850 determines that the vehicle is not "running on an uphill road surface in a frozen state or a snowy state" (step S851).
  • the driver is notified of the cancellation of either the first to fifth freezing / snow accumulation conditions 1 or 2 (step S852).
  • Step S844: Yes the road surface inclination angle ⁇ Pn [rad.] It is determined that the vehicle is not traveling on an uphill road surface in a frozen state or a snowy state.
  • step S852 the driver is prompted to cancel, for example, “The road surface has been frozen”, or the navigation screen display, for example, “Reset the road surface color on the map” is canceled. , Prompt the release with the same content as the voice guidance in text display, or prompt the release with a sound or the like. Then, the process proceeds to step S853.
  • step S898 determines that the vehicle is not “running on a downhill road surface in a frozen state or a snowy state” (step S899).
  • the driver is notified of the release of either the first to fifth frozen snow conditions 3 or 4 (step S900).
  • step S823 when the process of step S822 is completed, the hybrid navigation weighting determination unit 721 notifies the hybrid navigation of weighting 1 of GPS navigation and independent navigation (step S823).
  • step S823 the road slope angle ⁇ Pn [rad. Because it is “running on the road surface”, the weighting 1 for GPS navigation and autonomous navigation 1 is terminated as follows.
  • Hybrid navigation ⁇ ⁇ (GPS navigation) + (1— ⁇ ) ⁇ (self-contained navigation) as a definition of noble navigation.
  • Each weighting coefficient has a relationship such as “0 ⁇ ⁇ ⁇ 1”.
  • step S838 the hybrid navigation weighting determination unit 721 notifies the hybrid navigation of the weighting 2 of GPS navigation and independent navigation (step S839).
  • step S839 the road surface inclination angle ⁇ Pn [rad.] Is "running on a gentle uphill road surface or a flat uphill road surface” than in step S823. Therefore, weighting of GPS navigation and independent navigation 2 Ends the processing as it is as follows.
  • Hybrid navigation ⁇ ⁇ (GPS navigation) + (1—) ⁇ (self-contained navigation) as a definition of noble navigation.
  • Each weighting coefficient has a relationship such as “0 ⁇ ⁇ ⁇ ⁇ 1”.
  • step S869 the hybrid navigation weight determination unit 721 notifies the hybrid navigation of the weight 3 of GPS navigation and independent navigation (step S870).
  • step S870 because the road surface inclination angle ⁇ Pn [rad.] Is “running down a frozen or snowy downhill road surface”, weighting 3 for GPS navigation and autonomous navigation is as follows: The process is terminated as it is. [0216] (Weight 3)
  • hybrid navigation ⁇ ⁇ (GPS navigation) + (1— ⁇ ) ⁇ (self-contained navigation).
  • Each weighting coefficient has a relationship such as “0 ⁇ ⁇ ⁇ ⁇ 1”.
  • step S885 the hybrid navigation weighting determination unit 721 notifies the hybrid navigation of weighting 4 of GPS navigation and independent navigation (step S886).
  • step S886 the road surface inclination angle ⁇ Pn [rad.] Is “running on a gentle downhill road surface or a flat downhill road surface” than in step S870.
  • the process is terminated as follows.
  • Hybrid navigation ⁇ ⁇ (GPS navigation) + (1 — ⁇ ) ⁇ (self-contained navigation) as a definition of noble navigation.
  • Each weighting coefficient has a relationship such as “0 ⁇ ⁇ ⁇ 1”.
  • Roh and Ivritd navigation mainly uses information on self-contained navigation, and supplements information on GPS navigation. This is because information such as absolute position (latitude, longitude, and altitude) and absolute direction (two-dimensional and three-dimensional directions) cannot be obtained by self-contained navigation itself. Therefore, GPS navigation information and map information (road shape data) are used for various corrections and calibrations of self-contained navigation.
  • step S853 the hybrid navigation weighting determination is performed.
  • Part 721 notifies hybrid navigation of the cancellation of the weighting of GPS navigation and autonomous navigation (step S854).
  • step S844: Yes the process is performed. Thereafter, the series of processing is finished as it is.
  • step S854 the road slope angle ⁇ Pn [rad.] In step S823 is “climbing road in frozen or snowy condition”, or the road slope angle ⁇ Pn [rad.] Is more gradual than in step S823. Because it is not running on an uphill road surface or an uphill road surface that is close to flat, or on a road slope angle ⁇ Pn [rad.] Force Sstep S839, that is, a gentler uphill road surface or a near-flat road surface. By returning to the hybrid navigation, which is the upper layer (upper layer), the return to normal hybrid navigation can be made.
  • step S902 the hybrid navigation weighting determination unit 721 notifies the hybrid navigation of the cancellation of the weighting of GPS navigation and independent navigation (step S902).
  • step S902 whether the road slope angle ⁇ Pn [rad.] In step S870 is "downhill road surface frozen or snowy” or the road slope angle ⁇ Pn [rad. "Slope downhill or close to flat” or road slope angle ⁇ Pn [rad.] Force S Step S886 "Slow downhill road or nearly flat downhill” Since it is not in the middle, weighting 3 or! Of GPS navigation and self-contained navigation is weighted 4 or!, And cancellation of one of them is notified to hybrid navigation which is an upper layer (upper layer). Return to.
  • the condition counter determination unit 717 increments the condition 3 satisfaction counter by +1 (step S871). Thereafter, the series of processing is finished as it is.
  • Step S844: No) the condition counter determination unit 717 increments the condition 1 & 2 cancellation counter by +1 (step S855). Thereafter, the series of processing is finished as it is.
  • Step S892: No the condition counter determination unit 717 increments the condition 3 & 4 release counter by +1 (step S903). After that, the series of processing ends.
  • FIG. 23 is an explanatory diagram showing an example of a drive type selection screen. As shown in the display screen 2300 in FIG. 23, a selection screen 2310 is provided. With this configuration, the user's remote control key operation, touch panel key operation or voice synthesis guidance and voice recognition can be performed from the navigation screen. By selecting one of the drive types, four-wheel drive (4WD), rear-wheel drive (FR, MR, RR) or front-wheel drive (FF) is selected and input.
  • 4WD four-wheel drive
  • FR rear-wheel drive
  • MR MR
  • RR front-wheel drive
  • FF front-wheel drive
  • FIG. 24 is an explanatory diagram showing an example of a wheel type selection screen.
  • a selection screen 2410 is provided as shown in the display screen 2400 in FIG. On this screen, select and input one of the normal tire, radial tire, snow tire or studless tire.
  • FIG. 25 is an explanatory view showing an example of a selection screen for whether or not a tire chain is mounted.
  • a selection screen 2510 is provided. On this screen, select either “Yes” if the tire chain is installed, or “No” if the tire chain is not installed.
  • the “judgment reference temperature” of the outside air temperature Toutn [° C] can be changed, or the condition 1, condition 2, condition 3 or condition 4 establishment counter and condition 1 & 2 up to 5 seconds (50 times) Alternatively, the “count count” of the condition 3 & 4 release counter can be changed.
  • the route guidance priority determination unit 720 notifies the route search and route guidance of road surface avoidance priority 1 (step S822).
  • step S822 by sending the information in step S822 to the upper layer (upper layer) “starting route search”, “during route search”, or “during route guidance”, better “route search” or “route guidance” "Can be the condition.
  • step S822 the information indicating that the vehicle is traveling on a “frozen or snowy uphill road surface” with a road surface inclination angle ⁇ Pn [rad. Layer). Then, the process proceeds to step S823.
  • the route guidance priority determination unit 720 notifies the route search and route guidance of road surface avoidance priority 2 (step S838).
  • step S838 information indicating that the road slope angle ⁇ Pn [rad.] Is traveling on a “gradually uphill road surface or a nearly uphill road surface” than in step S822 is displayed as “prevention of frozen snowy road surface 2”. To the upper layer (upper layer). Then, the process proceeds to step S839.
  • the route guidance priority determination unit 720 notifies the route search and route guidance of road surface avoidance priority 3 (step S869).
  • condition 3 establishment counter 5 seconds (50 times)
  • step S861 Processing is performed at Yes.
  • step S869 the information indicating that the vehicle is traveling on a “downhill road surface in a frozen state or a snowy state” with a road surface inclination angle ⁇ Pn [rad.] is set as “frozen snow road surface priority 3”. Notify the layer (upper layer). Then, the process proceeds to step S870.
  • the route guidance priority determination unit 720 uses a road surface shape for route search and route guidance.
  • Status avoidance priority 4 is notified (step S885).
  • step S885 information indicating that the road inclination angle ⁇ Pn [rad.] Is traveling on a “slower downhill road surface or a flat downhill road surface” than that in step S869 is “frozen snow road surface”. Notify the upper layer (upper layer) as “Avoidance priority 4”. Then, the process proceeds to step S886.
  • route search or “route guidance”
  • the above information is not always effectively used.
  • the destination is a snow area such as a “ski resort” or “outdoor skating rink”, or the area where the navigation device having these functions is used is a snowy area or a cold area during the winter season. If so. Therefore, in order to effectively use the above information, it is left to the judgment of “route search” or “route guidance” itself, which is an upper layer (upper layer).
  • the route guidance priority determination unit 720 notifies the route search and route guidance of the cancellation of either road surface avoidance priority 1 or priority 2 (step S853).
  • step S853 the slope angle ⁇ Pn [rad.] Of the road surface slope in step S822 is either “frozen or snowy climbing road surface”, or the slope angle ⁇ Pn [rad.] Is more gradual than in step S822.
  • the road surface slope angle ⁇ Pn [rad.] Is “gradual uphill road surface or near flat !, uphill road surface” than step S838.
  • the information indicating this is notified to the upper layer (upper layer) as “freezing • cancellation of either priority 1 or priority 2 on avoiding snowy road surface”. Then, the process proceeds to step S854.
  • step S901 the route guidance priority determination unit 720 notifies the route search and route guidance of the cancellation of either road surface avoidance priority 3 or priority 4 (step S901).
  • step S901 the road slope angle ⁇ Pn [rad.] Of step S869 is “downhill road surface in frozen or snowy condition”, or the road slope angle ⁇ Pn [rad.
  • step S885 Notifying the upper layer (upper layer) of the information indicating that the vehicle is not traveling as “freezing • canceling either of priority 3 or 4 of avoidance of snowy road surface”. Then, the process proceeds to step S902.
  • the situation determination operation of the driver of the moving body is assisted by determining the traveling road surface condition with high accuracy. Therefore, the burden on the driver can be reduced.
  • the road surface condition determination method, route search method, and position setting method described in the present embodiment are executed by executing a prepared program on a computer such as a personal computer or a workstation. Can be realized.
  • This program is recorded on a recording medium that can be read by a computer such as a hard disk, flexible disk, CD-ROM, MO, or DVD, and is executed by the recording medium being read by a computer.
  • the program may be a transmission medium that can be distributed through a network such as the Internet.

Abstract

Information on outdoor air temperature in the periphery of a mobile body is acquired by a temperature information acquisition section (101), and at the same time, a GPS signal is received by a receiving section (102) and a first speed is calculated by a first speed calculation section (103). Then, information on the speed of the mobile body is acquired by the speed information acquisition section (104) from a sensor mounted on the mobile body, and a second speed is calculated by a second speed calculation section (105). A determination section (106) determines conditions of a road surface on which the mobile body is traveling and provides the result to a user, where the determination is based on the information on the outdoor air temperature, the first speed, and the second speed.

Description

明 細 書  Specification
路面状況判断装置、経路探索装置、位置設定装置、路面状況判断方法 、経路探索方法、位置設定方法、プログラムおよび記録媒体  Road surface condition determination device, route search device, position setting device, road surface condition determination method, route search method, position setting method, program, and recording medium
技術分野  Technical field
[0001] この発明は、自動的に移動体が走行中の路面の状況判断を行い、この路面状況の 判断結果を用いて、移動体の経路探索や位置設定を行う路面状況判断装置、経路 探索装置、位置設定装置、路面状況判断方法、経路探索方法、位置設定方法、プ ログラムおよび記録媒体に関する。  [0001] The present invention automatically determines a road surface condition on which a moving object is traveling, and uses the determination result of the road surface condition to determine a route and position of the moving object. The present invention relates to a device, a position setting device, a road surface condition determination method, a route search method, a position setting method, a program, and a recording medium.
背景技術  Background art
[0002] 従来、車両などの移動体が、走行中の路面状況を判断する技術として、可視画像 ( カメラ)式、路面上 ·路面下アンテナ式、電波放射式、路面や上空の放射エネルギー 受信式などの様々な方式が開示されている。また、新たな検出機器を追加せずにヮ ィパーや、フォグランプなど気象条件に応じて使用状況が変化する機器の動作を検 出して路面状況を判断するナビゲーシヨン装置も開示されている(例えば、下記特許 文献 1参照。)。  [0002] Conventionally, as a technology for judging the road surface condition while a moving body such as a vehicle is running, a visible image (camera) type, an on-road / under-road antenna type, a radio wave radiation type, a radiant energy reception type on the road surface or in the sky Various methods are disclosed. In addition, a navigation device is also disclosed that determines the road surface condition by detecting the operation of a device whose usage status changes according to weather conditions, such as a wiper or fog lamp, without adding a new detection device (for example, See Patent Document 1 below.)
[0003] 特許文献 1 :特開 2003— 161628号公報  [0003] Patent Document 1: Japanese Patent Application Laid-Open No. 2003-161628
発明の開示  Disclosure of the invention
発明が解決しょうとする課題  Problems to be solved by the invention
[0004] し力しながら、上述した様々な路面状況判断方式の場合、移動体に新たな検出機 器を搭載しなければならず、コスト面や検出機器の取り付けスペースが必要になるな ど、利用者に負担が力かるという問題が一例として挙げられる。  [0004] However, in the case of the various road surface condition determination methods described above, a new detection device must be mounted on the moving body, which requires cost and installation space for the detection device. An example is the problem of burdens on users.
[0005] また、上記特許文献 1に記載のナビゲーシヨン装置の場合、ワイパーやフォグラン プなどの動作は利用者の制御に依存するため、利用者が移動体の外部の気象状況 を正確に把握し、適切な設定を行わなければ正 、路面状況判断が行えな 、と 、う 問題が一例として挙げられる。  [0005] In addition, in the case of the navigation device described in Patent Document 1, the operation of the wiper, the fog lamp, etc. depends on the control of the user, so that the user can accurately grasp the weather condition outside the moving body. One example is the problem that the road surface situation cannot be judged correctly if appropriate settings are not made.
課題を解決するための手段  Means for solving the problem
[0006] 上述した課題を解決し、目的を達成するため、請求項 1の発明にかかる路面状況 判断装置は、移動体周辺の外気温に関する情報を取得する気温情報取得手段と、[0006] In order to solve the above-described problems and achieve the object, the road surface condition according to the invention of claim 1 The determination device includes temperature information acquisition means for acquiring information related to the outside temperature around the moving body,
GPS信号を受信する受信手段と、前記 GPS信号の情報を用いて、前記移動体の第Using the receiving means for receiving the GPS signal and the information of the GPS signal,
1の速度を算出する第 1速度算出手段と、前記移動体に搭載されているセンサから 前記移動体の速度に関する情報を取得する速度情報取得手段と、前記速度に関す る情報を用いて、前記移動体の第 2の速度を算出する第 2速度算出手段と、前記外 気温に関する情報、前記第 1の速度、および前記第 2の速度に基づいて、前記移動 体が走行して ヽる路面の状況を判断する判断手段と、を備えることを特徴とする。 A first speed calculating means for calculating a speed of 1, a speed information acquiring means for acquiring information on the speed of the moving body from a sensor mounted on the moving body, and the information on the speed. A second speed calculating means for calculating a second speed of the moving body; and a road surface on which the moving body travels based on the information on the outside air temperature, the first speed, and the second speed. And a judging means for judging the situation.
[0007] また、請求項 7の発明に力かる経路探索装置は、請求項 1〜6のいずれか一つに記 載の路面状況判断装置と、前記路面状況判断装置による前記移動体が走行してい る路面の状況の判断結果および目的地が属する地域特性に基づ!/、て、前記目的地 までの経路を探索する探索手段と、を備えることを特徴とする。  [0007] Further, in the route search device according to the invention of claim 7, the road surface condition determination device according to any one of claims 1 to 6 and the mobile body by the road surface condition determination device travel. And a search means for searching for a route to the destination based on the determination result of the road surface condition and the regional characteristics to which the destination belongs.
[0008] また、請求項 8の発明に力かる位置設定装置は、請求項 1〜6のいずれか一つに記 載の路面状況判断装置と、前記 GPS信号に基づ 、て前記移動体の位置を測位する 第 1測位手段と、前記第 2の速度を用いて前記移動体の位置を測位する第 2測位手 段と、前記第 1測位手段の測位結果および前記第 2測位手段の測位結果を用いて 前記移動体の位置を設定する設定手段と、を備え、前記設定手段は、前記路面状 況判断装置による前記移動体が走行している路面の状況の判断結果に基づいて、 前記第 1測位手段の測位結果および前記第 2測位手段の測位結果を用いる割合を 決定することを特徴とする。  [0008] Further, a position setting device according to the invention of claim 8 is based on the road surface condition determination device according to any one of claims 1 to 6 and the GPS signal. A first positioning means for positioning the position, a second positioning means for positioning the position of the moving body using the second speed, a positioning result of the first positioning means, and a positioning result of the second positioning means. And setting means for setting the position of the moving body using the above-mentioned setting means, based on the determination result of the condition of the road surface on which the moving object is traveling by the road surface condition determining device. The ratio of using the positioning result of the first positioning means and the positioning result of the second positioning means is determined.
[0009] また、請求項 9の発明にかかる路面状況判断方法は、移動体周辺の外気温に関す る情報を取得する気温情報取得工程と、 GPS信号を受信する受信工程と、前記 GP S信号の情報を用いて、前記移動体の第 1の速度を算出する第 1速度算出工程と、 前記移動体に搭載されているセンサ力 前記移動体の速度に関する情報を取得す る速度情報取得工程と、前記速度に関する情報を用いて、前記移動体の第 2の速度 を算出する第 2速度算出工程と、前記外気温に関する情報、前記第 1の速度、およ び前記第 2の速度に基づ ヽて、前記移動体が走行して!/ヽる路面の状況を判断する 判断工程と、を含むことを特徴とする。  [0009] Further, the road surface condition determination method according to the invention of claim 9 includes an air temperature information acquisition step of acquiring information on the outside air temperature around the moving body, a reception step of receiving a GPS signal, and the GP S signal. A first speed calculating step of calculating a first speed of the moving body using the information of the sensor, a sensor force mounted on the moving body, a speed information acquiring step of acquiring information on the speed of the moving body, A second speed calculating step for calculating a second speed of the moving body using the information on the speed, and the information on the outside air temperature, the first speed, and the second speed. And a determination step of determining the state of the road surface on which the mobile body travels!
[0010] また、請求項 10の発明に力かる経路探索方法は、移動体周辺の外気温に関する 情報を取得する気温情報取得工程と、 GPS信号を受信する受信工程と、前記 GPS 信号の情報を用いて、前記移動体の第 1の速度を算出する第 1速度算出工程と、前 記移動体に搭載されているセンサ力 前記移動体の速度に関する情報を取得する 速度情報取得工程と、前記速度に関する情報を用いて、前記移動体の第 2の速度を 算出する第 2速度算出工程と、前記外気温に関する情報、前記第 1の速度、および 前記第 2の速度に基づ ヽて、前記移動体が走行して!/ヽる路面の状況を判断する判 断工程と、前記判断工程の判断結果および目的地が属する地域特性に基づ!/ヽて、 前記目的地までの経路を探索する探索工程と、を含むことを特徴とする。 [0010] Further, the route search method which is effective for the invention of claim 10 relates to the outside air temperature around the moving body. A temperature information acquisition step of acquiring information; a reception step of receiving a GPS signal; a first speed calculation step of calculating a first speed of the mobile body using the information of the GPS signal; and the mobile body The sensor force mounted on the speed information acquisition step of acquiring information on the speed of the moving body, the second speed calculation step of calculating the second speed of the moving body using the information on the speed, Based on the information on the outside air temperature, the first speed, and the second speed, a judgment process for judging the road surface where the mobile body travels! And a search step of searching for a route to the destination based on the result and the regional characteristics to which the destination belongs.
[0011] また、請求項 11の発明にかかる位置設定方法は、移動体周辺の外気温に関する 情報を取得する気温情報取得工程と、 GPS信号を受信する受信工程と、前記 GPS 信号の情報を用いて、前記移動体の第 1の速度を算出する第 1速度算出工程と、前 記移動体に搭載されているセンサ力 前記移動体の速度に関する情報を取得する 速度情報取得工程と、前記速度に関する情報を用いて、前記移動体の第 2の速度を 算出する第 2速度算出工程と、前記外気温に関する情報、前記第 1の速度、および 前記第 2の速度に基づ ヽて、前記移動体が走行して!/ヽる路面の状況を判断する判 断工程と、前記 GPS信号に基づ 、て前記移動体の位置を測位する第 1測位工程と、 前記第 2の速度を用いて前記移動体の位置を測位する第 2測位工程と、前記判断ェ 程の判断結果に基づいて、前記移動体の位置設定に用いる前記第 1測位工程の測 位結果および前記第 2測位工程の測位結果の割合を決定する決定工程と、前記割 合に応じた前記第 1測位工程の結果および前記第 2測位工程の結果を用いて前記 移動体の位置を設定する設定工程と、を含むことを特徴とする。  [0011] Further, the position setting method according to the invention of claim 11 uses an air temperature information acquisition step of acquiring information on the outside air temperature around the moving body, a reception step of receiving a GPS signal, and information on the GPS signal. A first speed calculating step for calculating a first speed of the moving body, a sensor force mounted on the moving body, a speed information acquiring step for acquiring information on the speed of the moving body, and the speed A second speed calculating step of calculating a second speed of the moving body using information; and the moving body based on the information on the outside air temperature, the first speed, and the second speed. Using the second speed, the first step of determining the position of the moving body based on the GPS signal, and the second speed. Second positioning process for positioning the position of the moving object and determination of the determination process A determination step for determining a ratio of the positioning result of the first positioning step and the positioning result of the second positioning step used for setting the position of the moving body based on the results, and the first positioning according to the ratio And a setting step of setting the position of the moving body using the result of the step and the result of the second positioning step.
[0012] また、請求項 12の発明に力かるプログラムは、請求項 9〜: L 1のいずれか一つに記 載の方法をコンピュータに実行させることを特徴とする。  [0012] Further, a program according to claim 12 is characterized by causing a computer to execute the method according to any one of claims 9 to L1.
[0013] また、請求項 13に記載の記録媒体は、請求項 12に記載のプログラムを記録したこ とを特徴とする。  [0013] Further, the recording medium according to claim 13 records the program according to claim 12.
図面の簡単な説明  Brief Description of Drawings
[0014] [図 1]図 1は、この発明の本実施の形態の路面状況判断装置の機能的構成を示すブ ロック図である。 [図 2]図 2は、路面状況判断装置の処理の内容を示すフローチャートである。 FIG. 1 is a block diagram showing a functional configuration of a road surface condition judging device according to an embodiment of the present invention. [FIG. 2] FIG. 2 is a flowchart showing the contents of processing of the road surface condition judging device.
[図 3]図 3は、この発明の本実施の形態の経路探索装置の機能的構成を示すブロッ ク図である。  FIG. 3 is a block diagram showing a functional configuration of the route search apparatus according to the present embodiment of the present invention.
[図 4]図 4は、経路探索装置の処理の内容を示すフローチャートである。  FIG. 4 is a flowchart showing the contents of processing of the route search device.
[図 5]図 5は、この発明の本実施の形態の位置設定装置の機能的構成を示すブロッ ク図である。  FIG. 5 is a block diagram showing a functional configuration of the position setting device according to the present embodiment of the present invention.
[図 6]図 6は、位置設定装置の処理の内容を示すフローチャートである。  FIG. 6 is a flowchart showing the contents of processing of the position setting device.
[図 7]図 7は、本実施例に力かるナビゲーシヨン装置のハードウェア構成を示すブロッ ク図である。  [FIG. 7] FIG. 7 is a block diagram showing a hardware configuration of a navigation apparatus that is effective in the present embodiment.
[図 8]図 8は、ナビゲーシヨン装置の処理の内容を示すフローチャート(その 1)である  [FIG. 8] FIG. 8 is a flowchart (part 1) showing the processing contents of the navigation device.
[図 9]図 9は、ナビゲーシヨン装置の処理の内容を示すフローチャート(その 2)である [FIG. 9] FIG. 9 is a flowchart (part 2) showing the contents of the processing of the navigation device.
[図 10]図 10は、ナビゲーシヨン装置の処理の内容を示すフローチャート(その 3)であ る。 FIG. 10 is a flowchart (part 3) showing the contents of the processing of the navigation device.
[図 11]図 11は、ナビゲーシヨン装置の処理の内容を示すフローチャート(その 4)であ る。  FIG. 11 is a flowchart (part 4) showing the contents of the processing of the navigation device.
[図 12]図 12は、車速パルス速度 VPn [m/100ms]を格納するリングバッファの構成 を示す説明図である。  FIG. 12 is an explanatory diagram showing a configuration of a ring buffer that stores a vehicle speed pulse speed VPn [m / 100 ms].
[図 13]図 13は、車速パルス速度 VPn [mZs]の変化量(車速パルス加速度) AVPn [mZs2]を格納するリングバッファの構成を示す説明図である。 FIG. 13 is an explanatory diagram showing a configuration of a ring buffer that stores a change amount (vehicle speed pulse acceleration) AVPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs].
[図 14]図 14は、加速度センサ加速度 Δ VAn [m/s2/100ms]を格納するリングバ ッファの構成を示す説明図である。 [14] FIG 14 is an explanatory view showing a configuration of a Ringuba Ffa storing the acceleration sensor acceleration Δ VAn [m / s 2 / 100ms].
[図 15]図 15は、路面傾斜角度 Θ Pn[rad. ]を格納するリングバッファの構成を示す 説明図である。  FIG. 15 is an explanatory diagram showing a configuration of a ring buffer that stores a road surface inclination angle Θ Pn [rad.].
[図 16]図 16は、垂直方向成分 sin Θ Pnと路面傾斜角度 Θ Pn[rad. ]との対応関係を 示す説明図である。  [FIG. 16] FIG. 16 is an explanatory diagram showing the correspondence between the vertical component sin Θ Pn and the road surface inclination angle Θ Pn [rad.].
[図 17]図 17は、路面傾斜角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[ra d. Zs]を格納するリングバッファの構成を示す説明図である。 [Figure 17] Figure 17 shows the amount of change in road slope angle Θ Pn [rad.] (Road slope angular velocity) Δ Θ Pn [ra d. It is explanatory drawing which shows the structure of the ring buffer which stores Zs].
[図 18]図 18は、 GPS速度 VGGn[kmZh]の水平 (X)方向成分を格納するリングバ ッファの構成を示す説明図である。  FIG. 18 is an explanatory diagram showing a configuration of a ring buffer that stores a horizontal (X) direction component of a GPS speed VGGn [kmZh].
[図 19]図 19は、 GPS速度 VGGn [km/h]の垂直 (y)方向成分を格納するリングバ ッファの構成を示す説明図である。  FIG. 19 is an explanatory diagram showing a configuration of a ring buffer that stores a vertical (y) direction component of a GPS speed VGGn [km / h].
[図 20]図 20は、 GPS速度 VGn[mZs]を格納するリングバッファの構成を示す説明 図である。  FIG. 20 is an explanatory diagram showing the configuration of a ring buffer that stores GPS speed VGn [mZs].
[図 21]図 21は、路面傾斜角度 Θ Gn[rad. ]の算出方法を示す説明図(その 1)であ る。  [FIG. 21] FIG. 21 is an explanatory diagram (part 1) showing a method of calculating the road surface inclination angle Θ Gn [rad.].
[図 22]図 22は、路面傾斜角度 Θ Gn[rad. ]の算出方法を示す説明図(その 2)であ る。  [FIG. 22] FIG. 22 is an explanatory diagram (part 2) showing a method of calculating the road surface inclination angle Θ Gn [rad.].
圆 23]図 23は、駆動タイプの選択画面の一例を示す説明図である。 圆 23] FIG. 23 is an explanatory diagram showing an example of a drive type selection screen.
[図 24]図 24は、ホイールタイプの選択画面の一例を示す説明図である。  FIG. 24 is an explanatory diagram showing an example of a wheel type selection screen.
[図 25]図 25は、タイヤチ ーン装着有無の選択画面の一例を示す説明図である。 符号の説明  FIG. 25 is an explanatory diagram showing an example of a selection screen for whether or not a tire chain is mounted. Explanation of symbols
100 路面状況判断装置  100 Road surface condition judgment device
101 気温情報取得部  101 Temperature information acquisition unit
102 受信部  102 Receiver
103 第 1速度算出部  103 First speed calculator
104 速度情報取得部  104 Speed information acquisition unit
105 第 2速度算出部  105 Second speed calculator
106 判断部  106 Judgment part
300 経路探索装置  300 route search device
301 探索部  301 Search unit
500 位置設定装置  500 Position setting device
501 第 1測位部  501 1st positioning unit
502 第 2測位部  502 Second positioning unit
503 設定部 700 ナビゲーシヨン装置 503 Setting section 700 navigation equipment
701 走行,停止判定部  701 Running / stop judgment unit
702 外気温判定部  702 Outside air temperature judgment part
703 外気温取得部  703 Outside temperature acquisition department
704 GPS速度取得部  704 GPS speed acquisition unit
705 第 1路面傾斜角度算出部  705 First road slope angle calculator
706 路面斜度比較判定部  706 Road surface slope comparison judgment section
707 車速パルス速度算出部  707 Vehicle speed pulse speed calculator
708 加速度算出部  708 Acceleration calculator
709 第 2路面傾斜角度算出部  709 Second road slope angle calculation unit
710 路面傾斜角度判定部  710 Road slope angle judgment part
711 車両速度比較判定部  711 Vehicle speed comparison / determination unit
712 車両加速度比較判定部  712 Vehicle acceleration comparison / determination unit
713 第 1標準偏差算出部  713 First standard deviation calculator
714 第 1標準偏差判定部  714 1st standard deviation judgment part
715 第 2標準偏差算出部  715 Second standard deviation calculator
716 第 2標準偏差判定部  716 Second standard deviation judgment part
717 条件カウンタ判定部  717 Condition counter judgment unit
718 警告通知有無フラグ判定部  718 Warning notification presence / absence flag determination unit
719 ドライバー通知判定部  719 Driver notification determination unit
720 経路誘導優先判定部  720 Route guidance priority determination unit
721 ハイブリット航法重み付け判定部  721 Hybrid navigation weighting judgment unit
発明を実施するための最良の形態  BEST MODE FOR CARRYING OUT THE INVENTION
[0016] 以下に添付図面を参照して、この発明にかかる路面状況判断装置、経路探索装置 、位置設定装置、路面状況判断方法、経路探索方法、位置設定方法、プログラムお よび記録媒体の好適な実施の形態を詳細に説明する。  [0016] Hereinafter, with reference to the accompanying drawings, preferred embodiments of a road surface condition determination device, a route search device, a position setting device, a road surface condition determination method, a route search method, a position setting method, a program, and a recording medium according to the present invention The embodiment will be described in detail.
[0017] (路面状況判断装置の機能的構成)  [0017] (Functional configuration of road surface condition judging device)
図 1は、この発明の本実施の形態の路面状況判断装置の機能的構成を示すブロッ ク図である。図 1に示したように路面状況判断装置 100は、気温情報取得部 101と、 受信部 102と、第 1速度算出部 103と、速度情報取得部 104と、第 2速度算出部 105 と、判断部 106とから構成される。 FIG. 1 is a block diagram showing a functional configuration of the road surface condition judging device according to the present embodiment of the present invention. FIG. As shown in FIG. 1, the road surface condition determination device 100 includes an air temperature information acquisition unit 101, a reception unit 102, a first speed calculation unit 103, a speed information acquisition unit 104, and a second speed calculation unit 105. Part 106.
[0018] 気温情報取得部 101は、移動体周辺の外気温に関する情報を取得する。外気温 に関する情報とは、移動体の周辺の外気温度である。また、移動体が、車両などの密 閉空間を有している場合は、移動体の内部と外部との気温差でもよい。この外気温 に関する情報は、移動体が走行中の路面が凍結中もしくは積雪中である力否かの判 断基準となる。気温情報取得部 101は、取得した外気温に関する情報を判断部 106 へ出力する。 [0018] The temperature information acquisition unit 101 acquires information about the outside temperature around the moving body. The information on the outside air temperature is the outside air temperature around the moving body. In addition, when the moving body has a closed space such as a vehicle, the temperature difference between the inside and the outside of the moving body may be used. This information on the outside air temperature is a criterion for determining whether or not the road surface on which the moving body is traveling is frozen or snowy. The temperature information acquisition unit 101 outputs information about the acquired outside temperature to the determination unit 106.
[0019] 受信部 102は、 GPS信号を受信する。 GPS信号は、高度約 2万 kmの 6つの円軌 道に 4つずつ配された GPS衛星から発信される電波である。この GPS信号を複数受 信し、 GPS信号同士の誤差を検出することで、緯度、経度、高度などの情報を数十メ 一トルの精度で割り出すことができる。受信部 102は、受信した GPS信号を、第 1速 度算出部 103へ出力する。  [0019] The receiving unit 102 receives a GPS signal. GPS signals are radio waves transmitted from four GPS satellites arranged in six circular tracks at an altitude of about 20,000 km. By receiving multiple GPS signals and detecting errors between GPS signals, information such as latitude, longitude, and altitude can be determined with an accuracy of several tens of meters. The receiving unit 102 outputs the received GPS signal to the first speed calculating unit 103.
[0020] 第 1速度算出部 103は、受信部 102から入力された GPS信号の情報を用いて、前 記移動体の速度を算出する。上述したように GPS信号を用いることで、移動体の緯 度、経度および高度を求める。第 1速度算出部 103では、この緯度、経度および高度 の情報を時間に応じた変化を記録し、移動体の速度を算出する。以下、 GPS信号を 用いて算出した速度を第 1の速度とする。第 1速度算出部 103は、算出した第 1の速 度を、判断部 106へ出力する。  The first speed calculation unit 103 calculates the speed of the moving body using the information of the GPS signal input from the reception unit 102. As described above, the latitude, longitude and altitude of the moving object are obtained by using the GPS signal. The first speed calculation unit 103 records changes of the latitude, longitude, and altitude information according to time, and calculates the speed of the moving object. Hereinafter, the speed calculated using the GPS signal is the first speed. The first speed calculation unit 103 outputs the calculated first speed to the determination unit 106.
[0021] 速度情報取得部 104は、移動体に搭載されているセンサ力 移動体の速度に関す る情報を取得する。センサとは、移動体の車輪の動作(回転)を検出する機能を備え た検出手段である。例えば、車速パルスを検出するセンサを用いてもよい。車速パル スとは、移動体の車輪の回転をセンサによって検出した信号である。速度情報取得 部 104は、取得した移動体の速度に関する情報を第 2速度算出部 105へ出力する。  [0021] The speed information acquisition unit 104 acquires information about the speed of the sensor force mobile body mounted on the mobile body. The sensor is a detecting means having a function of detecting the operation (rotation) of the wheel of the moving body. For example, a sensor that detects vehicle speed pulses may be used. A vehicle speed pulse is a signal obtained by detecting the rotation of a wheel of a moving object by a sensor. The speed information acquisition unit 104 outputs information about the acquired speed of the moving body to the second speed calculation unit 105.
[0022] 第 2速度算出部 105は、速度情報取得部 104によって取得した移動体の速度に関 する情報を用いて、移動体の速度を算出する。移動体の速度に関する情報として車 速パルスを取得して 、る場合は、車速パルスの周波数の変化に応じて移動体の速度 を算出する。以下、第 1の速度とは異なり、移動体の車輪の動作を検出して算出した 速度を第 2の速度という。第 2速度算出部 105は、算出した第 2の速度を判断部 106 へ出力する。 The second speed calculation unit 105 calculates the speed of the moving object using the information on the speed of the moving object acquired by the speed information acquisition unit 104. When the vehicle speed pulse is acquired as information on the speed of the moving object, the speed of the moving object is changed according to the change in the frequency of the vehicle speed pulse. Is calculated. In the following, unlike the first speed, the speed calculated by detecting the movement of the wheels of the moving object is called the second speed. Second speed calculation unit 105 outputs the calculated second speed to determination unit 106.
[0023] 判断部 106は、気温情報取得部 101から入力された外気温に関する情報と、第 1 速度算出部 103から入力された第 1の速度と、第 2速度算出部 105から入力された 第 2の速度とに基づ ヽて、移動体が走行して ヽる路面の状況を判断する。  [0023] The determination unit 106 includes information on the outside air temperature input from the air temperature information acquisition unit 101, the first speed input from the first speed calculation unit 103, and the first speed input from the second speed calculation unit 105. Based on the speed of 2, determine the road surface where the moving body is traveling.
[0024] 判断部 106によって判断されるのは、凍結状態もしくは積雪状態であるか否か、ま た、路面は水平であるか、上り坂である力、下り坂であるか、さらに、坂の場合は、ど のくらいの坂なのかというような路面状況である。判断部 106は、入力された各パラメ ータをそれぞれ場合分けし、最適な路面状況を判断する。  [0024] The judgment unit 106 judges whether or not it is in a frozen state or a snowy state, whether the road surface is level, whether it is an uphill force, a downhill, In some cases, the road surface is like how much the slope is. The determination unit 106 classifies each input parameter and determines the optimum road surface condition.
[0025] (路面状況判断装置の処理の内容)  [0025] (Processing contents of road surface condition judging device)
つぎに、本発明にかかる路面状況判断装置の処理の内容について説明する。図 2 は、路面状況判断装置の処理の内容を示すフローチャートである。図 2のフローチヤ ートにおいて、まず、気温情報取得部 101によって外気温に関する情報を取得する( ステップ S201)。  Below, the content of the process of the road surface condition judgment apparatus concerning this invention is demonstrated. FIG. 2 is a flowchart showing the contents of the processing of the road surface condition judging device. In the flowchart of FIG. 2, first, the temperature information acquisition unit 101 acquires information about the outside temperature (step S201).
[0026] ステップ S201の処理と同時に、受信部 102によって GPS信号を取得し (ステップ S 202)、第 1速度算出部 103によって、第 1の速度を算出する (ステップ S203)。また、 ステップ S202とステップ S203の処理と同時〖こ、移動体に搭載されているセンサから 速度に関する情報を取得し (ステップ S204)、第 2速度算出部 105によって第 2の速 度を算出する (ステップ S205)。  [0026] Simultaneously with the process of step S201, the GPS signal is acquired by the receiving unit 102 (step S202), and the first speed calculation unit 103 calculates the first speed (step S203). At the same time as the processing of step S202 and step S203, information on the speed is acquired from the sensor mounted on the moving body (step S204), and the second speed calculation unit 105 calculates the second speed ( Step S205).
[0027] ステップ S201、ステップ S203およびステップ S205の処理が終了すると、つぎに、 判断部 106によって、ステップ S201で取得した外気温に関する情報と、ステップ S2 03およびステップ S305で算出した第 1、第 2の速度に基づいて、路面状況を判断す る(ステップ S 206)。  [0027] When the processing of step S201, step S203, and step S205 is completed, the determination unit 106 next performs information on the outside air temperature acquired in step S201 and the first and second values calculated in steps S203 and S305. The road surface condition is judged based on the speed of the road (step S206).
[0028] 続いて、路面状況判断装置 100の処理を終了する力否かを判断する (ステップ S2 07)。路面状況判断を継続する場合 (ステップ S 207 : No)は、ステップ S201の処理 に戻り、ステップ S201〜ステップ S206の処理を繰り返す。路面状況判断を終了する 場合 (ステップ S207 :Yes)は、そのまま一連の処理を終了する。 [0029] 以上説明したように、本発明の実施の形態にかかる路面状況判断装置 100は、高 精度に路面状況を判断することで、移動体の運転者の状況判断動作を補助する。し たがって、運転者の負担を軽減させることができる。 [0028] Subsequently, it is determined whether or not the power to end the processing of the road surface condition determination device 100 is determined (step S2 07). When the road surface condition determination is continued (step S207: No), the process returns to step S201, and the processes from step S201 to step S206 are repeated. When the road surface condition determination is to be ended (step S207: Yes), the series of processes is ended as it is. [0029] As described above, the road surface condition judging device 100 according to the embodiment of the present invention assists the driver of the moving body in the situation judgment operation by judging the road surface condition with high accuracy. Therefore, the burden on the driver can be reduced.
[0030] また、他の実施の形態として、上述したような路面状況判断装置 100の判断部 106 による路面状況判断をさらに正確にするため、パラメータとして第 1の速度の加速度 や、第 2の速度の加速度を用いてもよい。加速度を用いる場合は、第 1速度算出部 1 03および第 2速度算出部 105に加速度を算出する機能を備えればよ 、。加速度を 算出するためには、微少時間ごとの速度を記録する記録手段と、微少時間毎の速度 の変化量を記録する記録手段とが必要となる。記録手段としては、 FIFO (First -In First— Out)方式によって記録することが望ましぐ例えば、リングバッファなどを用 いる。  [0030] As another embodiment, in order to make the determination of the road surface condition by the determination unit 106 of the road surface condition determination device 100 as described above more accurate, the acceleration of the first speed or the second speed is used as a parameter. May be used. When using acceleration, the first speed calculation unit 103 and the second speed calculation unit 105 should have a function for calculating acceleration. In order to calculate the acceleration, a recording means for recording the speed every minute time and a recording means for recording the change in speed every minute time are required. As a recording means, for example, a ring buffer or the like is preferably used for recording by a FIFO (First-In First-Out) method.
[0031] また、第 1速度算出部 103によって算出された第 1の速度の水平方向速度と垂直方 向速度を用いて路面の傾斜角度を算出する手段と、第 2速度算出部 105によって算 出された第 2の速度を用いて路面の傾斜角度を算出する手段とを備え、第 1の速度 力 算出した路面の傾斜角度と、第 2の速度力 算出した路面の傾斜角度とを、路面 状況を判断するためのパラメータとして用いてもょ 、。  [0031] Further, a means for calculating the road surface inclination angle using the horizontal speed and the vertical speed of the first speed calculated by the first speed calculation unit 103, and the second speed calculation unit 105 Means for calculating the slope angle of the road surface using the measured second speed, and the road surface slope angle calculated by the first speed force and the road speed slope angle calculated by the second speed force It can be used as a parameter to judge.
[0032] さらに、路面状況判断装置 100には、駆動方式情報を取得する機能部を設けても よい。駆動方式情報は、移動体の駆動方式力 SFF、 FR、 MR、 RR、 4WDのいずれか であるかの情報にカ卩え、タイヤの種類は何力、さらにチェーンは装着しているかなど 情報を含む。このような駆動方式情報を判断部 106における路面状況の判断の基準 となるパラメータの一つに加えると、さらに高精度に路面状況を判断することができる  [0032] Furthermore, the road surface condition determination apparatus 100 may be provided with a functional unit that acquires drive method information. The drive system information is added to the information on whether the drive system power of the moving body is SFF, FR, MR, RR, or 4WD, and the information such as how much the tire type is and the chain is installed. Including. When such driving method information is added to one of the parameters used as criteria for judging the road surface condition in the judgment unit 106, the road surface condition can be judged with higher accuracy.
[0033] (経路探索装置の機能的構成) [0033] (Functional configuration of route search apparatus)
図 3は、この発明の本実施の形態の経路探索装置の機能的構成を示すブロック図 である。図 3に示したように経路探索装置 300は、路面状況判断装置 100と、探索部 301とから構成される。  FIG. 3 is a block diagram showing a functional configuration of the route search apparatus according to this embodiment of the present invention. As illustrated in FIG. 3, the route search device 300 includes a road surface condition determination device 100 and a search unit 301.
[0034] 探索部 301は、路面状況判断装置 100による移動体が走行している路面の状況の 判断結果および目的地が属する地域特性に基づ!、て、目的地までの経路を探索す る。目的地が属する地域特性とは、スノーエリア、アイスエリアなど、地域の気候的特 徴情報である。地域情報は、好ましくは季節ごとに設定された情報あり、移動体に備 えられた時計機能によって提供される日付情報を参照し、現在の地域情報を取得し てもよい。また、地域情報は、経路探索装置 300にあらかじめ格納された地域情報を 利用する他に、無線通信網から地域情報を受信し、逐次、最新の地域情報に更新し てもよい。 [0034] The search unit 301 searches for a route to the destination based on the determination result of the road surface on which the moving body is traveling by the road surface state determination device 100 and the regional characteristics to which the destination belongs! The The regional characteristics to which the destination belongs are regional climatic feature information such as snow areas and ice areas. The regional information is preferably information set for each season, and the current regional information may be acquired by referring to date information provided by a clock function provided in the mobile unit. In addition to using the area information stored in advance in the route search device 300, the area information may be received from the wireless communication network and sequentially updated to the latest area information.
[0035] (経路探索装置の処理の内容)  (Processing contents of route search device)
つぎに、経路探索装置 300の処理の内容について説明する。図 4は、経路探索装 置の処理の内容を示すフローチャートである。経路探索装置 300は、利用者によつ て目的地の設定を契機 (トリガ)として経路探索を開始する。図 4のフローチャートに おいて、まず、路面状況判断装置 100によってステップ S201〜ステップ S206 (図 2 参照)までの処理を行う(ステップ S401)。以上のステップによって、移動体が現在走 行中の路面状況の判断を行う。  Next, the contents of processing of the route search apparatus 300 will be described. FIG. 4 is a flowchart showing the contents of the processing of the route search device. The route search apparatus 300 starts route search triggered by the setting of the destination by the user. In the flowchart of FIG. 4, first, the road surface condition determination apparatus 100 performs processing from step S201 to step S206 (see FIG. 2) (step S401). By the above steps, the road surface condition that the moving body is currently running is determined.
[0036] 続 、て、目的地の地域特性を取得する (ステップ S402)。探索部 301にお 、て、ス テツプ S401で取得した路面状況の判断結果と、ステップ S402で取得した地域特性 とに基づ 、て、目的地までの経路を探索する (ステップ S403)。  Subsequently, the regional characteristics of the destination are acquired (step S402). The search unit 301 searches for a route to the destination based on the road surface condition determination result acquired in step S401 and the regional characteristics acquired in step S402 (step S403).
[0037] 続 、て、経路探索装置 300の処理を終了するか否かを判断する (ステップ S404)。  Subsequently, it is determined whether or not to end the process of the route search device 300 (step S404).
経路探索を継続する場合 (ステップ S404 : No)は、ステップ S401の処理に戻り、ス テツプ S401〜ステップ S403の処理を繰り返す。経路探索を終了する場合 (ステップ S404 :Yes)は、そのまま一連の処理を終了する。  If the route search is to be continued (step S404: No), the process returns to step S401, and the processes from step S401 to step S403 are repeated. When the route search is to be ended (step S404: Yes), the series of processing is ended as it is.
[0038] 以上説明したように、本発明の実施の形態の経路探索装置 300は、路面状況判断 装置 100による判断結果を用い、路面が凍結もしくは積雪状態である場合には、目 的地の地域情報と対応させて、より安全な経路を探索して利用者に提供することがで きる。  [0038] As described above, the route search device 300 according to the embodiment of the present invention uses the determination result by the road surface condition determination device 100, and when the road surface is frozen or snowy, Corresponding to the information, it is possible to search for a safer route and provide it to the user.
[0039] (位置設定装置の機能的構成)  [0039] (Functional configuration of position setting device)
図 5は、この発明の本実施の形態の位置設定装置の機能的構成を示すブロック図 である。図 5に示したように位置設定装置は、路面状況判断装置 100と、第 1測位部 501と、第 2測位部 502と、設定部 503とから構成される。 [0040] 第 1測位部 501は、路面状況判断装置 100の受信部 102によって受信した GPS信 号に基づいて移動体の位置を測位する。第 1測位部 501は、測位結果を設定部 503 に出力する。 FIG. 5 is a block diagram showing a functional configuration of the position setting apparatus according to this embodiment of the present invention. As shown in FIG. 5, the position setting device includes a road surface condition determination device 100, a first positioning unit 501, a second positioning unit 502, and a setting unit 503. [0040] The first positioning unit 501 measures the position of the moving body based on the GPS signal received by the receiving unit 102 of the road surface condition judging device 100. The first positioning unit 501 outputs the positioning result to the setting unit 503.
[0041] 第 2測位部 502は、路面状況判断装置 100の第 2速度算出部 105によって算出さ れた第 2の速度を用いて移動体の位置を測位する。第 2の速度とは、上述したように 、移動体の車輪の動作に基づいて算出した速度である。第 2測位部 502は、測位結 果を設定部 503に出力する。  [0041] The second positioning unit 502 measures the position of the moving body using the second speed calculated by the second speed calculating unit 105 of the road surface condition judging device 100. As described above, the second speed is a speed calculated based on the operation of the wheels of the moving body. Second positioning section 502 outputs the positioning result to setting section 503.
[0042] 設定部 503は、第 1測位部 501の測位結果および第 2測位部 502の測位結果を用 いて移動体の位置を設定する。位置設定を行うために、設定部 503は、路面状況判 断装置 100による移動体が走行している路面の状況の判断結果に基づいて、第 1測 位部 501の測位結果および第 2測位部 502の測位結果を反映させる際の割合を決 定する。  [0042] Setting section 503 sets the position of the moving body using the positioning result of first positioning section 501 and the positioning result of second positioning section 502. In order to set the position, the setting unit 503 determines the positioning result of the first positioning unit 501 and the second positioning unit based on the determination result of the road surface condition where the moving body is traveling by the road surface condition determination device 100. Determine the ratio for reflecting 502 positioning results.
[0043] (位置設定装置の処理の内容)  [0043] (Contents of processing of position setting device)
つぎに、位置設定装置 500の処理の内容について説明する。図 6は、位置設定装 置の処理の内容を示すフローチャートである。図 6のフローチャートにおいて、まず、 路面状況判断装置 100によってステップ S 201〜ステップ S 206 (図 2参照)までの処 理を行う(ステップ S601)。以上のステップによって、移動体が現在走行中の路面状 況の判断を行う。  Next, the processing contents of the position setting device 500 will be described. FIG. 6 is a flowchart showing the contents of the processing of the position setting device. In the flowchart of FIG. 6, first, processing from step S 201 to step S 206 (see FIG. 2) is performed by the road surface condition determination device 100 (step S 601). By the above steps, the road surface condition that the moving body is currently driving is determined.
[0044] 続いて、第 1測位部 501によって、路面状況判断装置 100の受信部 102で取得し た GPS信号に基づいた第 1の測位を行う (ステップ S602)と同時に、第 2速度算出部 105で算出した第 2の速度を用いた第 2の測位を行う(ステップ S603)。  [0044] Subsequently, the first positioning unit 501 performs the first positioning based on the GPS signal acquired by the receiving unit 102 of the road surface condition determination device 100 (step S602), and at the same time, the second speed calculating unit 105 Second positioning is performed using the second speed calculated in (Step S603).
[0045] ステップ S602およびステップ S603が終了すると、ステップ S601の路面状況の判 断結果に基づいて、ステップ S602の第 1の測位と、ステップ S603の第 2の測位との 利用割合を決定する (ステップ S604)。続いて、設定部 503により、ステップ S604に よって決定した利用割合に応じて、測位結果力も移動体の位置を設定する (ステップ S605)。  [0045] When step S602 and step S603 are completed, the use ratio between the first positioning in step S602 and the second positioning in step S603 is determined based on the road surface condition determination result in step S601 (step S603). S604). Subsequently, the setting unit 503 also sets the position of the moving body for the positioning result force according to the utilization ratio determined in step S604 (step S605).
[0046] その後、位置設定装置 500の処理を終了するか否かを判断する (ステップ S606)。  Thereafter, it is determined whether or not to end the processing of the position setting device 500 (step S606).
位置設定を継続する場合 (ステップ S606 : No)は、ステップ S601の処理に戻り、ス テツプ S601〜ステップ S605の処理を繰り返す。位置設定を終了する場合 (ステップ S606 :Yes)は、そのまま一連の処理を終了する。 When continuing the position setting (step S606: No), return to the process of step S601 and Steps S601 to S605 are repeated. When the position setting is to be ended (step S606: Yes), the series of processing is ended as it is.
[0047] 以上説明したように、本発明の実施の形態の位置設定装置 500は、正確に位置設 定を行うために、第 1の測位の測位結果と、第 2測位手段の測位結果とを、現在の路 面状況に応じて、反映させる割合を変化させる。したがって、利用者に、現在の路面 状況下で得られる最も精度の高!、位置情報を提供できる。 [0047] As described above, the position setting device 500 according to the embodiment of the present invention uses the positioning result of the first positioning and the positioning result of the second positioning means in order to set the position accurately. Depending on the current road conditions, the ratio to be reflected is changed. Therefore, it is possible to provide the user with the most accurate position information obtained under the current road surface condition.
実施例  Example
[0048] 以下にこの発明の実施例について説明する。本実施例では、例えば車両に搭載す るナビゲーシヨン装置として実現される。  [0048] Examples of the present invention will be described below. In this embodiment, for example, it is realized as a navigation device mounted on a vehicle.
[0049] (ナビゲーシヨン装置のハードウェア構成)  [0049] (Hardware configuration of navigation device)
まず本実施例に力かるナビゲーシヨン装置のハードウェア構成を説明する。図 7は、 本実施例に力かるナビゲーシヨン装置のハードウェア構成を示すブロック図である。 図 7に示したように、ナビゲーシヨン装置 700は、走行 ·停止判定部 701と、外気温判 定部 702と、外気温取得部 703と、 GPS速度取得部 704と、第 1路面傾斜角度算出 部 705と、路面斜度比較判定部 706と、車速パルス速度算出部 707と、加速度算出 部 708と、第 2路面傾斜角度算出部 709と、路面傾斜角度判定部 710と、車両速度 比較判定部 711と、車両加速度比較判定部 712と、第 1標準偏差算出部 713と、第 1 標準偏差判定部 714と、第 2標準偏差算出部 715と、第 2標準偏差判定部 716と、条 件カウンタ判定部 717と、警告通知有無フラグ判定部 718と、ドライバー通知判定部 719と、経路誘導優先判定部 720と、ハイブリット航法重み付け判定部 721とから構 成されている。  First, a hardware configuration of a navigation apparatus that is useful in the present embodiment will be described. FIG. 7 is a block diagram showing a hardware configuration of a navigation device that is useful in the present embodiment. As shown in FIG. 7, the navigation device 700 includes a travel / stop determination unit 701, an outside air temperature determination unit 702, an outside air temperature acquisition unit 703, a GPS speed acquisition unit 704, and a first road surface inclination angle calculation. Unit 705, road surface slope comparison determination unit 706, vehicle speed pulse speed calculation unit 707, acceleration calculation unit 708, second road surface inclination angle calculation unit 709, road surface inclination angle determination unit 710, and vehicle speed comparison determination unit 711, vehicle acceleration comparison determination unit 712, first standard deviation calculation unit 713, first standard deviation determination unit 714, second standard deviation calculation unit 715, second standard deviation determination unit 716, condition counter The determination unit 717 includes a warning notification presence / absence flag determination unit 718, a driver notification determination unit 719, a route guidance priority determination unit 720, and a hybrid navigation weighting determination unit 721.
[0050] 走行'停止判定部 701は、ナビゲーシヨン装置 700が搭載された移動体が走行中 であるか、停止中であるかを判定する。走行'停止判定部 701は、走行'停止を判定 するために移動体から車速パルスを検出する。車速パルスとは、移動体の車輪の回 転をセンサによって検出した信号である。したがって、移動体の移動速度 VPPn[km Zh]に応じて車速パルスの周波数は上昇し、停止すれば検出されない。外気温判 定部 702は、外気温取得部 703によって取得された移動体の外気温に関する情報 力もの移動体の外部つまり、屋外の温度の状態を判定する。外気温取得部 703は、 移動体の外気温に関する情報を取得する。外気温に関する情報とは、屋外の温度 や、移動体の内部と外部との温度差などである。本実施例では、外気温取得部 703 は、移動体の外部の温度 Toutn[°C]を取得する。 The traveling / stop determination unit 701 determines whether the moving body on which the navigation device 700 is mounted is traveling or stopped. The travel 'stop determination unit 701 detects a vehicle speed pulse from the moving body in order to determine the travel' stop. A vehicle speed pulse is a signal obtained by detecting the rotation of a wheel of a moving object by a sensor. Therefore, the frequency of the vehicle speed pulse increases according to the moving speed VPPn [km Zh] of the moving body, and is not detected if it stops. The outside air temperature determination unit 702 determines the outside temperature of the mobile body, that is, the state of the outdoor temperature, which is information about the outside air temperature of the mobile body acquired by the outside air temperature acquisition unit 703. The outside temperature acquisition unit 703 Obtain information about the outside temperature of the moving object. The information related to the outside air temperature includes the outdoor temperature and the temperature difference between the inside and outside of the moving body. In the present embodiment, the outside air temperature acquisition unit 703 acquires the temperature Toutn [° C.] outside the moving body.
[0051] (ナビゲーシヨン装置の処理の内容) [0051] (Processing content of the navigation device)
つぎに、以上の構成力もなるナビゲーシヨン装置 700の処理の内容を説明する。図 8〜図 11は、ナビゲーシヨン装置の処理の内容を示すフローチャートである。図 8の フローチャートにおいて、まず、走行 ·停止判定部 701および車速パルス速度算出部 707によって、車速パルス速度 VPPn≠0[kmZh]であるか否かを判断する(ステツ プ S801)。  Next, the contents of processing of the navigation device 700 having the above-described configuration capability will be described. 8 to 11 are flowcharts showing the contents of the processing of the navigation device. In the flowchart of FIG. 8, first, the travel / stop determination unit 701 and the vehicle speed pulse speed calculation unit 707 determine whether or not the vehicle speed pulse speed VPPn ≠ 0 [kmZh] (step S801).
[0052] 具体的には、まず、ナビゲーシヨン装置 700と接続されている車両の車速センサか らサンプリング周期 T (例えば、 100ms)間隔毎に現在の車速パルス数力も算出され た車速パルス速度 VPn[mZl00ms]がサンプリング数 20個のリングバッファ 1202 ( 図 12参照)に最新データとして格納される。なお、以下本実施ではサンプリング周期 Tを 100msとして説明する。  [0052] Specifically, first, the vehicle speed pulse speed VPn [], in which the current vehicle speed pulse number force is also calculated at every sampling period T (eg, 100 ms) from the vehicle speed sensor of the vehicle connected to the navigation device 700. mZl00ms] is stored as the latest data in the ring buffer 1202 (see Fig. 12) with 20 samples. In the following description, the sampling period T is assumed to be 100 ms.
[0053] ここで、車速パルス速度 VPn[mZl00ms]を格納するリングバッファの構成につい て説明を行う。図 12は、車速パルス速度 VPn[mZ 100ms]を格納するリングバッフ ァの構成を示す説明図である。図 12における図表 1200は、リングバッファ 1202およ びリングバッファ 1202に格納されているデータを表す。リングバッファ 1202では最新 のデータ(最新の車速パルス速度 VPn[mZl00ms]) 1201がサンプリング数 20個 のリングバッファ 1202に最新データとして格納されると、リングバッファ 1202のデー タ列では 1データずつシフトされて第 20番目のデータ(第 20番目の車速パルス速度 VPn— 19 [mZl00ms])が第 21番目のデータ(第 21番目の車速パルス速度 VPn — 20 [m/100ms]) 1203となり、リングノ ッファ 1202力ら外れる。よって、サンプリン グ数 20個のリングバッファを実現している。  Here, the configuration of the ring buffer that stores the vehicle speed pulse speed VPn [mZl00ms] will be described. FIG. 12 is an explanatory diagram showing the configuration of the ring buffer that stores the vehicle speed pulse speed VPn [mZ 100 ms]. A chart 1200 in FIG. 12 represents the ring buffer 1202 and the data stored in the ring buffer 1202. In the ring buffer 1202, the latest data (latest vehicle speed pulse speed VPn [mZl00ms]) 1201 is stored as the latest data in the ring buffer 1202 with 20 samples, and the data string in the ring buffer 1202 is shifted by one data at a time. The 20th data (20th vehicle speed pulse speed VPn—19 [mZl00ms]) becomes the 21st data (21st vehicle speed pulse speed VPn—20 [m / 100ms]) 1203, and the ring-offer 1202 I'm out of force. Therefore, a ring buffer with 20 samples is realized.
[0054] そして、リングバッファ 1202の第 1番目のデータ(第 1番目の車速パルス速度 VPn[ mZ 100ms])〜第 10番目のデータ(第 10番目の車速パルス速度 VPn— 9 [mZ 10 Oms] )のサンプリング数 10個の車速パルス速度 VP [m/100ms]データを加算する 。この加算処理によって、現在のサンプリング時刻 nT時の車速パルス速度 VPn [m Zs]が算出される。さらに、車速パルス速度 VPn[mZs]に(3600Z1000)を乗じて 単位変換を行い、車速パルス速度 VPPn[kmZh]を算出する。この車速パルス速度 VPPn[km/h]を用いて車両の「走行中 Z停止中」の判定を行う。 [0054] The first data (the first vehicle speed pulse speed VPn [mZ 100ms]) to the tenth data (the tenth vehicle speed pulse speed VPn—9 [mZ 10 Oms] of the ring buffer 1202 ) Sampling number 10 Vehicle speed pulse speed VP [m / 100ms] Add data. By this addition process, the vehicle speed pulse speed VPn [m at the current sampling time nT Zs] is calculated. Furthermore, the vehicle speed pulse speed VPPn [kmZh] is calculated by multiplying the vehicle speed pulse speed VPn [mZs] by (3600Z1000) and performing unit conversion. This vehicle speed pulse speed VPPn [km / h] is used to determine whether the vehicle is “running Z stopped”.
[0055] 図 8のフローチャートに戻り、ステップ S801の判断で、車速パルス速度 VPPn≠0[ kmZh]である場合 (ステップ S801 :Yes)は、車両は走行中であるため、そのままス テツプ S802の処理に移行する。一方、車速パルス速度 VPPn=0[kmZh]の場合( ステップ S801 :No)は、車両が停止していると判断し、そのまま処理を終了する。  [0055] Returning to the flowchart of FIG. 8, if the vehicle speed pulse speed VPPn ≠ 0 [kmZh] is determined in step S801 (step S801: Yes), the vehicle is traveling, and the process of step S802 is performed as it is. Migrate to On the other hand, when the vehicle speed pulse speed VPPn = 0 [kmZh] (step S801: No), it is determined that the vehicle is stopped, and the processing is ended as it is.
[0056] 続いて、外気温取得部 703および外気温判定部 702によって、ナビゲーシヨン装 置 700に接続されている車両の外気温センサ力 サンプリング周期 T間隔毎に取得 した現在の車両外部の気温 Toutn[°C]が「外気温 Toutn≤ 10°C」であるか否かを 判断する (ステップ S802)。この判断は、路面が凍結もしくは積雪の状態であるかを 判断するために用いる。外気温センサは、車両のアップグレードなどに用いるため、 近年ではほぼ総ての車両に標準装備されて ヽる。「外気温 Toutn≤ 10°C」である場 合 (ステップ S802 :Yes)は、ステップ S803の処理へ移行する。一方、「外気温 Tout n≤ 10°C」でない場合 (ステップ S802 :No)は、ステップ S841の処理へ移行する。  [0056] Subsequently, the outside air temperature sensor force of the vehicle connected to the navigation device 700 by the outside air temperature acquisition unit 703 and the outside air temperature determination unit 702. The current outside air temperature Toutn acquired at every sampling interval T. It is determined whether or not [° C] is “outside temperature Toutn ≦ 10 ° C” (step S802). This judgment is used to judge whether the road surface is frozen or snowy. In recent years, outside temperature sensors are standard equipment on almost all vehicles because they are used for vehicle upgrades. If “outside temperature Toutn ≦ 10 ° C” (step S802: Yes), the process proceeds to step S803. On the other hand, if the “outside temperature Tout n ≦ 10 ° C” is not satisfied (step S802: No), the process proceeds to step S841.
[0057] つぎに、車速パルス速度算出部 707、加速度算出部 708および第 1標準偏差算出 部 713によって、サンプリング周期 T間隔毎に車速パルス速度 VPn[mZs]の変化量 (車速パルス加速度) Δ VPn[mZs2]の標準偏差 α Ρηを算出する (ステップ S803) 。具体的には、まず、図 12に示したリングバッファ 1202の第 1番目のデータ (第 1番 目の車速パルス速度 VPn[mZl00ms])〜第 10番目のデータ(第 10番目の車速 パルス速度 VPn— 9 [mZ 100ms ])のサンプリング数 10個の車速パルス速度 VP [m ZlOOms]データを加算すると現在のサンプリング時刻 nT時の車速パルス速度 VP n[m/s]と、第 11番目のデータ(第 11番目の車速パルス速度 VPn— 10[m/100 ms])〜第 20番目のデータ(第 20番目の車速パルス速度 VPn— 19 [mZl00ms]) のサンプリング数 10個の車速パルス速度 VP [mZlOOms]データをカ卩算して、現在 力も 1秒間前のサンプリング時刻(n— 10)T時の車速パルス速度 VPn— 10[m/s] との差を求める。この処理によって、現在から 1秒前の車速パルス速度 VPn— 10 [m Zs]と、現在の車速パルス速度 VPn [mZs]との差が求まり、サンプリング時刻 nT時 における車速パルス速度 VPn[mZs]の変化量(車速パルス加速度) AVPn[mZs ]が算出される。算出した車速パルス速度 VPn [m/s]の変化量 (車速パルス加速度 ) AVPn[m/s2]は、リングバッファ 1302 (図 13参照)に格納される。 [0057] Next, a change amount (vehicle speed pulse acceleration) Δ VPn of the vehicle speed pulse speed VPn [mZs] at every sampling period T by the vehicle speed pulse speed calculation unit 707, the acceleration calculation unit 708, and the first standard deviation calculation unit 713. The standard deviation α Ρη of [mZs 2 ] is calculated (step S803). Specifically, first, the first data (the first vehicle speed pulse speed VPn [mZl00ms]) to the tenth data (the tenth vehicle speed pulse speed VPn) of the ring buffer 1202 shown in FIG. — Sampling number of 9 [mZ 100ms]) 10 vehicle speed pulse speeds VP [m ZlOOms] When the data is added, the vehicle speed pulse speed VP n [m / s] at the current sampling time nT and the 11th data ( 11th vehicle speed pulse speed VPn—10 [m / 100 ms]) to 20th data (20th vehicle speed pulse speed VPn—19 [mZl00ms]) Sampling number 10 vehicle speed pulse speed VP [mZlOOms ] Count the data and find the difference between the current force and the vehicle speed pulse speed VPn-10 [m / s] at the sampling time (n-10) T 1 second before. By this process, the difference between the vehicle speed pulse speed VPn—10 [m Zs] one second before and the current vehicle speed pulse speed VPn [mZs] is obtained, and the sampling time is nT. A change amount (vehicle speed pulse acceleration) AVPn [mZs] of the vehicle speed pulse speed VPn [mZs] is calculated. The calculated change amount of the vehicle speed pulse speed VPn [m / s] (vehicle speed pulse acceleration) AVPn [m / s 2 ] is stored in the ring buffer 1302 (see FIG. 13).
[0058] ここで、車速パルス速度 VPn [mZs]の変化量(車速パルス加速度) AVPn[mZs2 ]を格納するリングバッファの構成について説明を行う。図 13は、車速パルス速度 VP n [m/s]の変化量(車速パルス加速度) Δ VPn [m/s2]を格納するリングバッファの 構成を示す説明図である。図 13における図表 1300は、リングバッファ 1302およびリ ングバッファ 1302に格納されているデータを表す。リングバッファ 1302では最新の 算出されたデータ (最新の車速パルス速度 VPn [mZs]の変化量 (車速パルス加速 度) Δ VPn[mZs2] ) 1301がサンプリング数 50個のリングバッファ 1302に最新デー タとして格納されると、リングバッファ 1302のデータ列では 1データずつシフトされて 第 50番目のデータ(第 50番目の車速パルス速度 VPn— 49 [m/s]の変化量(車速 パルス加速度) Δ VPn— 49 [m/s2] )が第 51番目のデータ(第 51番目の車速パル ス速度 VPn— 50 [mZs]の変化量(車速パルス加速度) Δ VPn— 50[mZs2] ) 130 3となり、リングバッファ 1302のデータ列から外れる。よって、サンプリング数 50個のリ ングバッファを実現している。このサンプリング数 50個のリングバッファ 1302に格納さ れたデータを用いて、車速パルス速度 VPn [mZs]の変化量(車速パルス加速度) Δ VPn [m/s2]の標準偏差 ex Pnを算出する。 Here, the configuration of the ring buffer that stores the amount of change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) AVPn [mZs 2 ] will be described. FIG. 13 is an explanatory diagram showing a configuration of a ring buffer that stores a change amount (vehicle speed pulse acceleration) ΔVPn [m / s 2 ] of the vehicle speed pulse speed VPn [m / s]. A chart 1300 in FIG. 13 represents data stored in the ring buffer 1302 and the ring buffer 1302. In the ring buffer 1302, the latest calculated data (change in the latest vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ΔVPn [mZs 2 ]) 1301 is the latest data in the ring buffer 1302 with 50 samplings. Is stored in the data string of the ring buffer 1302, and the 50th data (the 50th vehicle speed pulse speed VPn—49 [m / s] change (vehicle speed pulse acceleration) Δ VPn — 49 [m / s 2 ]) is the 51st data (51st vehicle speed pulse speed VPn—50 [mZs] change (vehicle speed pulse acceleration) Δ VPn— 50 [mZs 2 ]) 130 3 Is out of the data string of the ring buffer 1302. Therefore, a ring buffer with 50 samplings is realized. Using the data stored in the ring buffer 1302 with 50 samplings, the standard deviation ex Pn of the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ΔVPn [m / s 2 ] is calculated. .
[0059] ここで、標準偏差 α Ρηの算出方法について説明する。まず、下記の式(1)を用い て、リングバッファ 1302に格納されている 50個の車速パルス速度 VPn[mZs]の変 化量(車速パルス加速度) Δ VPn [m/s2]の平均値 Δ VP [m/s2]を求める。 [0059] Here, a method of calculating the standard deviation α Ρη will be described. First, using the following equation (1), the average value of the amount of change (vehicle speed pulse acceleration) ΔVPn [m / s 2 ] of the 50 vehicle speed pulse speeds VPn [mZs] stored in the ring buffer 1302 Δ VP [m / s 2 ] is obtained.
[0060] [数 1] i = 50  [0060] [Equation 1] i = 50
平均値 ΔνΡ = (1/50) ∑ ( A Vp i) Average value Δν Ρ = (1/50) ∑ (A Vp i)
i = 1  i = 1
■■■( 1 )  ■■■ (1)
[0061] 続いて、現在のサンプリング時刻 nT時の標準偏差 α Pnは、下記の式(2)によって 求 3;る。  [0061] Subsequently, the standard deviation α Pn at the current sampling time nT is obtained by the following equation (2).
[0062] [数 2] (1/50) ∑ ( ΔνΡ 平均値 ΔνΡ) [0062] [Equation 2] (1/50) ∑ (Δν Ρ average value Δν Ρ )
■■■(2)  ■■■ (2)
[0063] したがって、上記の式(2)に式(1)を代入した下記の式(3)によって、現在のサンプ リング時刻 ηΤ時の標準偏差 a Pnが求めることができる。  Therefore, the standard deviation a Pn at the current sampling time ηΤ can be obtained by the following equation (3) obtained by substituting equation (1) into equation (2).
[0064] [数 3]
Figure imgf000018_0001
[0064] [Equation 3]
Figure imgf000018_0001
[0065] 図 8のフローチャートに戻り、つぎに車速パルス速度算出部 707、加速度算出部 70 8および第 2路面傾斜角度算出部 709によって、加速度センサ加速度 A VAn[mZs 2]と車速パルス速度 VPn[mZs]の変化量(車速パルス加速度) Δ VPn [m/s2]から 路面傾斜角度 Θ Pn [rad. ]を算出する (ステップ S804)。具体的には、まず、ナビゲ ーシヨン装置 700に接続された車両ョー方向(車両前後方向)の 1軸の加速度センサ の出力からサンプリング周期 T間隔毎に算出された加速度センサ加速度 A VAn [m Zs2ZlOOms]をリングバッファ 1402 (図 14参照)に格納する。 [0065] Returning to the flowchart of FIG. 8, the vehicle speed pulse speed calculation unit 707, the acceleration calculation unit 70 8 and the second road surface inclination angle calculation unit 709 perform acceleration sensor acceleration A VAn [mZs 2] and vehicle speed pulse speed VPn [ mZs] change amount (vehicle speed pulse acceleration) ΔVPn [m / s 2 ] is used to calculate the road surface inclination angle Θ Pn [rad.] (step S804). Specifically, first, the acceleration sensor acceleration A VAn [m Zs 2 , calculated at each sampling period T from the output of a single-axis acceleration sensor in the vehicle direction (vehicle longitudinal direction) connected to the navigation device 700. ZlOOms] is stored in the ring buffer 1402 (see Figure 14).
[0066] ここで、加速度センサ加速度 Δ VAn [mZs2ZlOOms]を格納するリングバッファの 構成について説明を行う。図 14は、加速度センサ加速度 A VAn [mZs2ZlOOms] を格納するリングバッファの構成を示す説明図である。図 14における図表 1400は、 リングバッファ 1402およびリングバッファ 1402に格納されているデータを表す。リン グバッファ 1402ではサンプリング周期 T間隔毎に算出された最新のデータ(最新の 加速度センサ加速度 Δ VAn [m/sV 1 OOms] ) 1401がサンプリング数 10個のリン グバッファ 1402に最新データとして格納されると、リングバッファ 1402のデータ列で は 1データずつシフトされて第 10番目のデータ (第 10番目の加速度センサ加速度 Δ VAn - 9 [m/sVlOOms] )が第 11番目のデータ(第 11番目の加速度センサ加速 度 A VAn— 10 [mZs2Zl00ms] ) 1403となり、リングバッファ 1402のデータ列から 外れる。よって、サンプリング数 10個のリングバッファを実現している。そして、リング バッファ 1402の第 1番目のデータ(第 1番目の加速度センサ加速度 Δ VAn [mZs2 Z 100ms] )からサンプリング数 10個の加速度センサ加速度 Δ VA [m/s2/ 100ms ]を加算すると、加速度センサ加速度 AVAn[mZs2]が求まる。 Here, the configuration of the ring buffer for storing the acceleration sensor acceleration ΔVAn [mZs 2 ZlOOms] will be described. FIG. 14 is an explanatory diagram showing the configuration of a ring buffer that stores acceleration sensor acceleration A VAn [mZs 2 ZlOOms]. A chart 1400 in FIG. 14 represents the ring buffer 1402 and the data stored in the ring buffer 1402. In the ring buffer 1402, the latest data (latest acceleration sensor acceleration Δ VAn [m / sV 1 OOms]) calculated every sampling cycle T interval 1401 is stored as the latest data in the ring buffer 1402 with 10 samplings. In the data string of the ring buffer 1402, the 10th data (10th acceleration sensor acceleration Δ VAn-9 [m / sVlOOms]) is shifted by 1 data at a time and the 11th data (11th acceleration) Sensor acceleration A VAn— 10 [mZs 2 Zl00ms]) 1403, which is out of the data string of the ring buffer 1402. Therefore, a ring buffer with 10 samplings is realized. Then, the first data of the ring buffer 1402 (the first acceleration sensor acceleration Δ VAn [mZs 2 Acceleration sensor acceleration AVAn [mZs 2 ] is obtained by adding the acceleration sensor acceleration Δ VA [m / s 2 / 100ms] of 10 samples from Z 100 ms]).
[0067] 上述したリングバッファ 1402によって、算出された加速度センサ加速度 AVAn[m Zs2]とステップ S803によって、算出された車速パルス速度 VPn[mZs]の変化量( 車速パルス加速度) AVPn[mZs2]を用いて、さらに路面傾斜角度 Θ Pn[rad. ]を 算出する。なお、路面傾斜角度 Θ Pn[rad. ]の算出方法については後述する。算出 された路面傾斜角度 Θ Pn[rad. ]は、リングバッファ 1502 (図 15参照)に格納される [0067] by a ring buffer 1402 described above, the calculated acceleration sensor acceleration AVAn the [m Zs 2] in step S803, the change amount of the calculated vehicle speed pulse rate VPn [MZS] (speed pulse acceleration) AVPn [mZs 2] Is used to further calculate the road slope angle Θ Pn [rad.]. The method for calculating the road surface inclination angle Θ Pn [rad.] Will be described later. The calculated road inclination angle Θ Pn [rad.] Is stored in the ring buffer 1502 (see Fig. 15).
[0068] ここで、路面傾斜角度 Θ Pn[rad. ]を格納するリングバッファの構成について説明 を行う。図 15は、路面傾斜角度 Θ Pn[rad. ]を格納するリングバッファの構成を示す 説明図である。図 15における図表 1500は、リングバッファ 1502およびリングバッファ 1502に格納されているデータを表す。サンプリング数 20個のリングバッファ 1502に 最新データ(最新の Δ VAn [m/s2]と Δ VPn [m/s2]による路面傾斜角度 Θ Pn [ra d. ]) 1501として格納されると、リングバッファ 1502のデータ列では 1データずっシフ トされて第 20番目のデータ(第 20番目の Δ VAn- 19 [m/s2]と Δ VPn- 19 [m/s 2]による路面傾斜角度 Θ Pn- 19 [rad. ])が第 21番目のデータ(第 21番目の Δ VA n— 20 [m/s2]と Δ VPn— 20 [m/s2]による路面傾斜角度 0 Pn— 20 [rad. ]) 150 3となり、リングバッファ 1502のデータ列から外れる。よって、サンプリング数 20個のリ ングバッファを実現して 、る。 [0068] Here, the configuration of the ring buffer for storing the road surface inclination angle Θ Pn [rad.] Will be described. FIG. 15 is an explanatory diagram showing the configuration of a ring buffer that stores the road surface inclination angle Θ Pn [rad.]. A chart 1500 in FIG. 15 represents the data stored in the ring buffer 1502 and the ring buffer 1502. When the latest data (the road surface inclination angle Θ Pn [ra d.] By the latest ΔVAn [m / s 2 ] and ΔVPn [m / s 2 ]) 1501 is stored in the ring buffer 1502 with 20 samples, In the data string of the ring buffer 1502, the data is shifted by 1 and the 20th data (the 20th Δ VAn-19 [m / s 2 ] and ΔVPn-19 [m / s 2] road surface inclination angle Θ Pn-19 [rad.]) Is the 21st data (21st ΔVA n—20 [m / s 2 ] and Δ VPn—20 [m / s 2 ]). rad.]) 150 3, which is out of the data string of the ring buffer 1502. Therefore, a ring buffer with 20 samplings is realized.
[0069] つぎに、路面傾斜角度 Θ Pn[rad. ]の算出方法について説明する。路面傾斜角度  [0069] Next, a method of calculating the road surface inclination angle Θ Pn [rad.] Will be described. Road slope angle
Θ Pn[rad. ]の算出方法は、公知の技術より、サンプリング周期 T間隔毎に、リングバ ッファ 1302に格納されて!ヽる車速パルス速度 VPn [m/s]の変化量(車速パルス加 速度) AVPn[mZs2]と、リングバッファ 1402によって算出された加速度センサ加速 度 AVAn[mZs2]と、リングバッファ 1502に格納されている路面傾斜角度 Θ Pn[ra d. ]によって算出された重力加速度 g[mZs2]の分力(路面に水平な成分) gsin 0 P n[mZs2]とを用いて、下記の式 (4)によって、路面傾斜角度 Θ Pn[rad. ]の垂直方 向成分 sin Θ Pnを求める。 The calculation method of Θ Pn [rad.] Is calculated from the change amount of the vehicle speed pulse speed VPn [m / s] stored in the ring buffer 1302 at every sampling period T according to a known technique (vehicle speed pulse acceleration). ) AVPn and [MZS 2], and aVAn [mZs 2] acceleration sensor acceleration calculated by the ring buffer 1402, the gravitational acceleration calculated by the road surface slope angle theta Pn stored in the ring buffer 1502 [ra d.] g [mZs 2 ] component (horizontal component on the road surface) Using gsin 0 P n [mZs 2 ] and the following equation (4), the vertical direction component of the road surface inclination angle Θ Pn [rad.] Find sin Θ Pn.
[0070] [数 4] sin Θ p n = (AVA n— AVP J/g [0070] [Equation 4] sin Θ p n = (AV A n — AV P J / g
= (AVA„-ΔνΡ n)/9. 8 = (AV A „-Δν Ρ n ) /9.8
■■■(4) 但し、 重力加速度 : g 9. 8 [π / ] より、  ■■■ (4) However, gravitational acceleration: g 9. 8 [π /],
但し、 (一 π/2)≤ ΘΡ J!rad.]^ (π/2) However, (one π / 2) ≤ Θ Ρ J! Rad.] ^ (Π / 2)
[0071] したがって、上記の式 (4)によって求めた路面傾斜角度 Θ Pn[rad. ]の垂直方向 成分 sin Θ Pnを下記の式(5)によって、路面傾斜角度 Θ Pn[rad. ]へ変換することが できる。 [0071] Therefore, the vertical component sin Θ Pn of the road surface inclination angle Θ Pn [rad.] Obtained by the above equation (4) is converted into the road surface inclination angle Θ Pn [rad.] By the following equation (5). can do.
[0072] [数 5]  [0072] [Equation 5]
Θ P n[rad.] = sin- { (ΔνΑ η- AVP η)/9. 8} Θ P n [rad.] = Sin- {(Δν Α η -AV P η ) /9.8.8}
= arcsin{(AVA η- AVP J/9. 8} = arcsin {(AV A η -AV P J / 9. 8}
= asin{(AVA η-ΔνΡ n)/9. 8} = asin {(AV A η -Δν Ρ n ) /9.8.}
■■■(5) 但し、 (- π/2)≤ θρη[Γ3ά.]≤ (π/2) ■■■ (5) However, (-π / 2) ≤ θρ η [Γ3ά.] ≤ (π / 2)
I . (— π/2)≤ 0p,,[rad.]<Oの場合: 降坂路面  I. (— π / 2) ≤ 0p ,, [rad.] <O: Downhill road surface
II. 0≤ θ ρη[ηκ3.]≤ (π/2)の場合: 登坂路面 II. For 0≤ θ ρ η [ηκ3.] ≤ (π / 2): Climbing slope
[0073] 図 16は、垂直方向成分 sin Θ Pnと路面傾斜角度 Θ Pn[rad. ]との対応関係を示す 説明図である。ちなみに、三角関数には逆関数が存在しない。例えば、 y=sinxの場 合に yの値が一つ確定すると、対応する Xの値は複数確定するので、通常の一次関 数のように 1対 1の写像ではない。したがって、上記の式(5)に補足記載したように 1 周期分 (Xの範囲)の 2 π以内で単調増カロもしくは単調減少する領域に関して Xの範 囲を指定することによって、 1対 1の写像となり逆関数が存在するようになる。したがつ て、上記の式(5)による変換が可能になる。 FIG. 16 is an explanatory diagram showing a correspondence relationship between the vertical direction component sin Θ Pn and the road surface inclination angle Θ Pn [rad.]. Incidentally, there is no inverse function for trigonometric functions. For example, when y = sinx, if one y value is determined, the corresponding X values are determined, so it is not a one-to-one mapping like a normal linear function. Therefore, as described supplementarily in the above equation (5), by specifying the range of X with respect to the region that monotonically increases or decreases monotonously within 2 π of one period (X range), It becomes a mapping and an inverse function exists. Therefore, conversion according to the above equation (5) becomes possible.
[0074] フローチャートに戻り、つぎに、第 2路面傾斜角度算出部 709および第 2標準偏差 算出部 715によって、路面傾斜角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]の標準偏差 j8 Θ Pnを算出する (ステップ S805)。具体的には、まず、 図 15に示したリングバッファ 1502の第 1番目のデータ(第 1番目の路面傾斜角度 Θ Pn[rad. ])〜第 10番目のデータ(第 10番目の路面傾斜角度 0 Pn— 9[rad. ])の サンプリング数 10個の路面傾斜角度 Θ P[rad. ]データを加算して平均化処理する。 そして、現在のサンプリング時刻 nT時の路面傾斜角度 Θ Pn[rad. ]と、第 11番目の データ(第 11番目の路面傾斜角度 θ Pn- 10 [rad. ] )〜第 20番目のデータ (第 20 番目の路面傾斜角度 Θ Pn- 19 [rad. ] )のサンプリング数 10個の路面傾斜角度 Θ P[rad. ]データを加算して平均化処理すると現在から 1秒間前のサンプリング時刻 ( n—10)T時の路面傾斜角度 0 Pn—lO[rad. ]との差が求まる。この処理によって、 現在から 1秒間前の路面傾斜角度 Θ Pn- 10[rad. ]と、現在の路面傾斜角度 Θ Pn [rad. ]との差が求まり、サンプリング時刻 nT時における路面傾斜角度 0 Pn[rad. ] の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]が算出される。算出した路面傾斜角 度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]は、リングバッファ 17 02 (図 17参照)に格納される。 [0074] Returning to the flowchart, the second road surface inclination angle calculation unit 709 and the second standard deviation calculation unit 715 then change the road surface inclination angle Θ Pn [rad.] (Road surface inclination angular velocity) Δ Θ Pn [rad Zs] standard deviation j8 Θ Pn is calculated (step S805). Specifically, first, the first data (the first road surface inclination angle Θ Pn [rad.]) To the tenth data (the tenth road surface inclination angle) of the ring buffer 1502 shown in FIG. 0 Pn—9 [rad.]) The number of samplings of 10 road surface inclination angles Θ P [rad.] Data is added and averaged. Then, the road slope angle Θ Pn [rad.] At the current sampling time nT and the 11th data (11th road slope angle θ Pn-10 [rad.]) To 20th data ( Number of samplings of 20th road slope angle Θ Pn-19 [rad.]) When 10 road slope angles Θ P [rad.] Data are added and averaged, the sampling time (n— 10) The road surface inclination angle at T 0 The difference from 0 Pn-lO [rad.] Is obtained. By this process, the difference between the road slope angle Θ Pn-10 [rad.] 1 second before and the current road slope angle Θ Pn [rad.] Is obtained, and the road slope angle at the sampling time nT 0 Pn The amount of change in [rad.] (road slope angular velocity) ΔΘ Pn [rad. Zs] is calculated. The calculated change amount of the road surface inclination angle Θ Pn [rad.] (Road surface inclination angular velocity) Δ Θ Pn [rad. Zs] is stored in the ring buffer 17 02 (see FIG. 17).
[0075] ここで、標準偏差 |8 Θ Pnの算出方法について説明する。まず、下記の式 (6)を用 いてリングバッファ 1702に格納されている 50個の路面傾斜角度 Θ Pn[rad. ]の変化 量(路面傾斜角速度) Δ Θ Pn[rad. Zs]の平均値 Δ Θ P[rad. Zs]を求める。  Here, a method of calculating the standard deviation | 8 Θ Pn will be described. First, using the following formula (6), the change amount of 50 road surface inclination angles Θ Pn [rad.] Stored in the ring buffer 1702 (road surface inclination angle velocity) ΔΘ Pn [rad. Zs] average value Find Δ Θ P [rad. Zs].
[0076] [数 6] 平均値 Δ Θ (1/50) ∑ ( Δ Θ Ρ Ι ) [0076] [Equation 6] Average Δ Θ (1/50) ∑ (Δ Θ Ρ Ι )
■■■(6) ■■■ (6)
[0077] 続、て、現在のサンプリング時刻 nT時の標準偏差 Β Θ Pnは、下記の式(7)によつ て求まる。  Subsequently, the standard deviation ΒΘ Pn at the current sampling time nT is obtained by the following equation (7).
[0078] [数 7]
Figure imgf000021_0001
[0078] [Equation 7]
Figure imgf000021_0001
■••(7)  ■ (7)
[0079] したがって、上記の式(7)に式(6)を代入した下記の式(8)によって、現在のサンプ リング時刻 nT時の標準偏差 |8 θ Pnを求めることができる。  Accordingly, the standard deviation | 8 θ Pn at the current sampling time nT can be obtained by the following equation (8) obtained by substituting equation (6) into equation (7) above.
[0080] [数 8] 1 / (1/50) ∑{ Δ 9 P i - (l/50)∑ ( Δ θ P:) }2 [0080] [Equation 8] 1 / (1/50) ∑ {Δ 9 P i- (l / 50) ∑ (Δ θ P :)} 2
■■■(8)  ■■■ (8)
[0081] ここで、路面傾斜角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. /s ]を格納するリングバッファの構成について説明を行う。図 17は、路面傾斜角度 Θ Pn [rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]を格納するリングバッファの 構成を示す説明図である。図 17における図表 1700は、リングバッファ 1702およびリ ングバッファ 1702に格納されているデータを表す。リングバッファ 1702では最新の 算出されたデータ (最新の路面傾斜角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]) 1701がサンプリング数 50個のリングバッファ 1702に最新デー タとして格納されると、リングバッファ 1702のデータ列では 1データずつシフトされて 第 50番目のデータ (第 50番目の路面傾斜角度 Θ Pn-49 [rad. ]の変化量 (路面傾 斜角速度) Δ Θ Pn-49 [rad. Zs])が第 51番目のデータ (第 51番目の路面傾斜角 度 Θ Pn- 50[rad. ]の変化量(路面傾斜角速度) Δ Θ Pn— 50[rad. Zs]) 1703と なり、リングバッファ 1702のデータ列から外れる。よって、サンプリング数 50個のリン グバッファを実現している。このサンプリング数 50個のリングバッファ 1702に格納さ れたデータを用いて、路面傾斜角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]の標準偏差 j8 Θ Pnを算出する。 Here, the configuration of the ring buffer that stores the amount of change in the road surface inclination angle Θ Pn [rad.] (Road surface inclination angular velocity) ΔΘ Pn [rad./s] will be described. FIG. 17 is an explanatory diagram showing the configuration of a ring buffer that stores the amount of change in road surface inclination angle Θ Pn [rad.] (Road surface inclination angular velocity) ΔΘ Pn [rad. Zs]. A chart 1700 in FIG. 17 represents data stored in the ring buffer 1702 and the ring buffer 1702. In the ring buffer 1702, the latest calculated data (change in the latest road slope angle Θ Pn [rad.] (Road slope angular velocity) Δ Θ Pn [rad. Zs]) 1701 is stored in the ring buffer 1702 with 50 samples. When stored as the latest data, the data sequence in the ring buffer 1702 is shifted by one data, and the 50th data (the 50th road surface inclination angle Θ Pn-49 [rad.] Change amount (the road surface inclination) Angular velocity) Δ Θ Pn-49 [rad. Zs]) is the 51st data (51st road slope angle Θ Pn-50 [rad.] Change amount (road slope angular velocity) Δ Θ Pn— 50 [ rad. Zs]) 1703, which is out of the data string of the ring buffer 1702. Therefore, a ring buffer with 50 samplings is realized. Using the data stored in the ring buffer 1702 with 50 samples, the amount of change in road inclination angle Θ Pn [rad.] (Road inclination angular velocity) Δ Θ Pn [rad. Zs] standard deviation j8 Θ Pn Is calculated.
[0082] 図 8のフローチャートに戻り、つぎに、 GPS速度取得部 704および第 1路面傾斜角 度算出部 705によって、 GPS速度 VGGn[kmZh]の水平 (X)方向成分と垂直 (y) 方向成分による路面傾斜角度 Θ Gn[rad. ]を算出する (ステップ S806)。ナビゲー シヨン装置 700内に備えられた GPS受信機能部は、 1枚の CPUにより GPS受信処理 (電波受信処理や衛星捕捉処理や測位データ生成処理など)と、自立航法処理とを 同時に行うことができる。具体的には、まず、サンプリング周期 T間隔毎に算出された 現在のサンプリング時刻 nT時の水平 (X)方向速度 VGGxn[kmZh]はリングバッフ ァ 1802 (図 18参照)に、現在のサンプリング時刻 nT時の垂直 (y)方向速度 VGGyn [km/h]はリングバッファ 1902 (図 19参照)に格納される。  [0082] Returning to the flowchart of FIG. 8, the GPS speed acquisition unit 704 and the first road surface inclination angle calculation unit 705 perform the horizontal (X) direction component and the vertical (y) direction component of the GPS speed VGGn [kmZh]. The road surface inclination angle Θ Gn [rad.] Is calculated by (Step S806). The GPS reception function unit provided in the navigation device 700 can perform GPS reception processing (radio wave reception processing, satellite capture processing, positioning data generation processing, etc.) and self-contained navigation processing simultaneously with a single CPU. . Specifically, first, the horizontal (X) direction velocity VGGxn [kmZh] at the current sampling time nT calculated for each sampling period T is calculated by the ring buffer 1802 (see Fig. 18) at the current sampling time nT. The vertical (y) speed VGGyn [km / h] is stored in the ring buffer 1902 (see Fig. 19).
[0083] ここで、 GPS速度 VGGn[kmZh]の水平 (X)方向成分と垂直 (y)方向成分を格納 するリングバッファの構成について説明を行う。図 18は、 GPS速度 VGGn[kmZh] の水平 (X)方向成分を格納するリングバッファの構成を示す説明図である。図 18に おける図表 1800は、リングバッファ 1802およびリングバッファ 1802に格納されてい るデータを表す。また、図 19は、 GPS速度 VGGn[kmZh]の垂直 (y)方向成分を格 納するリングバッファの構成を示す説明図である。図 19における図表 1900は、リング バッファ 1902およびリングバッファ 1902に格納されているデータを表す。 [0083] Here, horizontal (X) direction component and vertical (y) direction component of GPS velocity VGGn [kmZh] are stored. The structure of the ring buffer to be performed will be described. FIG. 18 is an explanatory diagram showing the configuration of the ring buffer that stores the horizontal (X) direction component of the GPS speed VGGn [kmZh]. The chart 1800 in FIG. 18 represents the data stored in the ring buffer 1802 and the ring buffer 1802. FIG. 19 is an explanatory diagram showing the configuration of the ring buffer that stores the vertical (y) direction component of the GPS speed VGGn [kmZh]. A chart 1900 in FIG. 19 represents the ring buffer 1902 and the data stored in the ring buffer 1902.
[0084] 図表 1800のリングバッファ 1802の場合は、最新のデータ(最新の GPS速度 VGG n[kmZh]の水平 (X)方向速度 VGGxn[kmZh]) 1801が格納されると、リングバッ ファ 1802のデータ列から 1データずつシフトされて第 10番目のデータ(第 10番目の GPS速度 VGGn— 9 [km/h]の水平 (x)方向速度 VGGxn— 9 [km/h] )が第 11 番目のデータ(第 11番目の GPS速度 VGGn— 10 [km/h]の水平 (x)方向速度 V GGxn—10[kmZh])となり、リングバッファ 1802のデータ列から外れる。よって、サ ンプリング数 10個のリングバッファを実現している。  [0084] For the ring buffer 1802 in Figure 1800, when the latest data (latest GPS velocity VGG n [kmZh] horizontal (X) direction velocity VGGxn [kmZh]) 1801 is stored, the data in ring buffer 1802 is stored. The 10th data (the 10th GPS speed VGGn—9 [km / h] horizontal (x) speed VGGxn—9 [km / h]) is shifted by 1 data from the column and the 11th data. (11th GPS speed VGGn—horizontal (x) direction speed V GGxn—10 [kmZh] at 10 [km / h]), and deviates from the data string in the ring buffer 1802. Therefore, a ring buffer with 10 samples is realized.
[0085] 同様に、図表 1900のリングバッファ 1902の場合は、最新のデータ(最新の GPS速 度 VGGn[kmZh]の垂直 (y)方向速度 VGGyn[kmZh]) 1901が格納されると、リ ングバッファ 1902のデータ列から 1データずつシフトされて第 10番目のデータ(第 1 0番目の GPS速度 VGGn— 9 [km/h]の垂直 (y)方向速度 VGGyn— 9 [km/h] ) が第 11番目のデータ(第 11番目の GPS速度 VGGn— 10 [km/h]の垂直 (y)方向 速度 VGGyn— 10[kmZh])となり、リングバッファ 1902のデータ列から外れる。よつ て、サンプリング数 10個のリングバッファを実現している。  [0085] Similarly, in the case of the ring buffer 1902 in Chart 1900, when the latest data (vertical (y) speed VGGyn [kmZh] of the latest GPS speed VGGn [kmZh]) 1901 is stored, the ring is stored. The 10th data (the 10th GPS speed VGGn—9 [km / h] vertical (y) speed VGGyn—9 [km / h]) is shifted one by one from the data sequence in buffer 1902. The eleventh data (the eleventh GPS speed VGGn—10 [km / h] vertical (y) direction speed VGGyn—10 [kmZh]), which is out of the ring buffer 1902 data string. Therefore, a ring buffer with 10 samples is realized.
[0086] そして、リングバッファ 1802では、第 1番目のデータ(第 1番目の GPS速度 VGGn[ km/h]の水平(X)方向速度 VGGxn[kmZh] )〜第 10番目のデータ(第 10番目の GPS¾itVGGn- 9 [km/h]の水平(x)方向速度 VGGxn— 9 [km/h] )のサンプ リング数 10個の GPS速度 VGG [km/h]の水平(x)方向速度 VGGx [km/h]デー タを加算して平均化処理することで、現在のサンプリング時刻 nT時の水平 (X)方向 速度 VGGxn [kmZh]を算出する。  [0086] Then, in the ring buffer 1802, the first data (the first GPS speed VGGn [km / h] horizontal (X) direction speed VGGxn [kmZh]) to the tenth data (10th data) GPS¾itVGGn- 9 [km / h] horizontal (x) direction velocity VGGxn—9 [km / h]) Number of sampling 10 GPS speed VGG [km / h] horizontal (x) direction velocity VGGx [km / h] Data is added and averaged to calculate the horizontal (X) speed VGGxn [kmZh] at the current sampling time nT.
[0087] また、リングバッファ 1902では、第 1番目のデータ(第 1番目の GPS速度 VGGn[k m/h]の垂直 (y)方向速度 VGGyn[kmZh] )〜第 10番目のデータ(第 10番目の GPS速度 VGGn— 9 [km/h]の垂直 (y)方向速度 VGGyn— 9 [km/h] )のサンプ リング数 10個の GPS速度 VGG [km/h]の垂直 (y)方向速度 VGGy [km/h]デー タを加算して平均化処理することで、現在のサンプリング時刻 nT時の垂直 (y)方向 速度 VGGyn [km/h]を算出する。以上のように算出した水平 (x)方向速度 VGGx n[kmZh]と、垂直 (y)方向速度 VGGyn[kmZh]による路面傾斜角度 Θ Gn[rad. ]を算出する。なお、 GPS測位データの生成 (更新)は 1秒間隔で、非測位時も同様 に行われる。 [0087] Also, in the ring buffer 1902, the first data (vertical (y) direction speed VGGyn [kmZh] of the first GPS speed VGGn [km / h]) to the tenth data (the tenth data) of GPS velocity VGGn— Vertical (y) velocity of 9 [km / h] VGGyn— Number of samplings of 9 [km / h]) 10 GPS velocity VGG [km / h] Vertical (y) velocity of VGGy [ km / h] data is added and averaged to calculate the vertical (y) speed VGGyn [km / h] at the current sampling time nT. The road surface inclination angle Θ Gn [rad.] Is calculated using the horizontal (x) direction velocity VGGx n [kmZh] and the vertical (y) direction velocity VGGyn [kmZh] calculated as described above. Note that GPS positioning data is generated (updated) at 1-second intervals, and is also performed when no positioning is performed.
[0088] 図 8のフローチャートに戻り、つぎに、 GPS速度取得部 704および加速度算出部 7 08によって、 GPS速度 VGn[mZs]の変化量(GPS加速度) Δ VGn[mZs2]を算出 する (ステップ S807)。具体的には、まず、サンプリング周期 T間隔毎に取得した現在 のサンプリング時刻 nT時の GPS速度 VGGn[kmZh]に(1000Z3600)を乗じて 単位変換して得た GPS速度 VGn[mZs]を、リングバッファ 2002 (図 20参照)に格 納する。 [0088] Returning to the flowchart of FIG. 8, the GPS speed acquisition unit 704 and the acceleration calculation unit 708 calculate the change amount (GPS acceleration) ΔVGn [mZs 2 ] of the GPS speed VGn [mZs] (steps). S807). Specifically, the GPS speed VVGn [mZs] obtained by multiplying the GPS speed VGGn [kmZh] obtained at every sampling period T interval at the current sampling time nT by (1000Z3600) and converting the unit, Store in buffer 2002 (see Figure 20).
[0089] ここで、 GPS速度 VGn[mZs]を格納するリングバッファの構成について説明を行 う。図 20は、 GPS速度 VGn[mZs]を格納するリングバッファの構成を示す説明図で ある。図 20における図表 2000は、リングノ ッファ 2002およびリングノ ッファ 2002に 格納されているデータを表す。リングバッファ 2002ではサンプリング周期 T間隔毎に 算出された最新のデータ (最新の GPS速度 VGn[mZs]) 2001がサンプリング数 20 個のリングバッファ 2002に最新データとして格納されると、リングバッファ 2002のデ ータ列では 1データずつシフトされて第 20番目のデータ(第 20番目の GPS速度 VG n— 19 [mZs])が第 21番目のデータ(第 21番目の GPS速度 VGn— 20[mZs]) 2 003となり、リングバッファ 2002のデータ列から外れる。よって、サンプリング数 20個 のリングノ ッファを実現して ヽる。  Here, the configuration of the ring buffer for storing the GPS speed VGn [mZs] will be described. FIG. 20 is an explanatory diagram showing the configuration of the ring buffer that stores the GPS speed VGn [mZs]. The chart 2000 in FIG. 20 represents the ring nota 2002 and the data stored in the ring nota 2002. In the ring buffer 2002, when the latest data (latest GPS speed VGn [mZs]) 2001 calculated every sampling period T interval is stored as the latest data in the ring buffer 2002 with 20 samplings, the data of the ring buffer 2002 is deleted. The 20th data (20th GPS speed VG n—19 [mZs]) is 21st data (21st GPS speed VGn—20 [mZs]). 2 003, which is out of the data string of the ring buffer 2002. Therefore, a ring knoffer with 20 samplings can be realized.
[0090] さらに、 GPS速度 VGn[mZs]の変化量(GPS加速度) Δ VGn[mZs2]を算出す るために、リングバッファ 2002の第 1番目のデータ(第 1番目の GPS速度 VGn[mZ s])〜第 10番目のデータ(第 10番目の GPS速度 VGn— 9 [mZs])のサンプリング 数 10個の GPS速度 VG [mZs]データを加算して平均化処理すると現在のサンプリ ング時刻 nT時の GPS速度 VGn[mZs]と、第 11番目のデータ(第 11番目の GPS速 度 VGn— 10[mZs])〜第 20番目のデータ(第 20番目の GPS速度 VGn— 19 [mZ s] )のサンプリング数 10個の GPS速度 VG [m/s]データを加算して平均化処理する と現在から 1秒間前のサンプリング時刻(n— 10)T時の GPS速度 VGn— 10 [m/s] との差を求める。この処理によって、現在から 1秒間前の GPS速度 VGn— 10[mZs ]と、現在の GPS速度 VGn [mZs]との差が求まり、サンプリング時刻 nT時における GPS速度 VGn[mZs]の変化量(GPS加速度) Δ VGn[mZs2]が算出される。なお 、基本的に、 GPS速度 VGGn[kmZh]は、ステップ S806で取得し算出した水平 (x )方向速度 VGGxn[kmZh]と垂直 (y)方向速度 VGGyn[kmZh]の速度合成によ つて算出されている。 [0090] Furthermore, in order to calculate the amount of change in GPS speed VGn [mZs] (GPS acceleration) Δ VGn [mZs 2 ], the first data of ring buffer 2002 (first GPS speed VGn [mZs s]) to 10th data (10th GPS speed VGn—9 [mZs]) Sampling number 10 GPS speeds VG [mZs] Data is added and averaged to obtain the current sampling time nT GPS speed VGn [mZs] and the 11th data (11th GPS speed) Degree VGn—10 [mZs]) to 20th data (20th GPS speed VGn—19 [mZ s]) Sampling number 10 GPS speeds VG [m / s] data are added and averaged When processed, the difference from the GPS speed VGn-10 [m / s] at the sampling time (n-10) T one second before the current time is obtained. By this process, the difference between the GPS speed VGn—10 [mZs] 1 second before and the current GPS speed VGn [mZs] is obtained, and the change in the GPS speed VGn [mZs] at the sampling time nT (GPS Acceleration) ΔVGn [mZs 2 ] is calculated. Basically, the GPS speed VGGn [kmZh] is calculated by speed synthesis of the horizontal (x) direction speed VGGxn [kmZh] and the vertical (y) direction speed VGGyn [kmZh] obtained and calculated in step S806. ing.
[0091] 続いて、路面傾斜角度 Θ Gn[rad. ]の算出方法について説明する。図 21および 図 22は、路面傾斜角度 Θ Gn[rad. ]の算出方法を示す説明図である。ここでは、公 知の技術を用いて路面傾斜角度 Θ Gn[rad. ]を算出する。具体的には、図 21およ び図 22に示すような GPS速度 VGGn[kmZh]と、ステップ S806でサンプリング周 期 T間隔毎に取得し算出された GPS速度 VGGn [kmZh]の水平 (X)方向速度 VG Gxn [km/h]と、垂直 (y)方向速度 VGGyn [km/h]との関係図 21を用いた算出 方法がある。また、図 21によってサンプリング時刻 nT時における路面傾斜角度 Θ Gn [rad. ]は下記の式(9)のような関係式になる。  [0091] Next, a method of calculating the road surface inclination angle Θ Gn [rad.] Will be described. FIG. 21 and FIG. 22 are explanatory diagrams showing a method of calculating the road surface inclination angle Θ Gn [rad.]. Here, the road slope angle Θ Gn [rad.] Is calculated using a known technique. Specifically, the GPS velocity VGGn [kmZh] as shown in Fig. 21 and Fig. 22 and the horizontal (X) of the GPS velocity VGGn [kmZh] obtained and calculated at every sampling interval T in step S806. There is a calculation method using the relationship diagram 21 between the directional velocity VG Gxn [km / h] and the vertical (y) directional velocity VGGyn [km / h]. Further, as shown in FIG. 21, the road surface inclination angle Θ Gn [rad.] At the sampling time nT becomes a relational expression such as the following expression (9).
[0092] [数 9] tan Θ G n = VGG N /VGG X n ,■■(。) 但し、 (一 π Ζ2) < 0 G n [rad.]く(π /2) [0092] [Equation 9] tan Θ G n = VGG N / VGG X n, ■■ (.) Where (1 π Ζ2) <0 G n [rad.] (Π / 2)
[0093] なお、ここでも、図 22から明らかなように、図 16における説明と同様に、三角関数に は逆関数が存在しない。例えば、 y=tanxの場合に yの値が一つ確定すると、対応 する Xの値は複数確定するので、通常の一次関数のように 1対 1の写像ではない。し たがって、下記の式(10)に補足記載したように 1周期分 (Xの範囲)の 2 π以内で単 調増カロもしくは単調減少する領域に関して Xの範囲を指定することによって、 1対 1の 写像となり逆関数が存在するようになる。したがって、下記の式(10)による変換が可 會 になる。 [0094] [数 10] eGn[rad.] = tan_1(VGG n/VGG¾rn) [0093] Here, as is clear from FIG. 22, there is no inverse function in the trigonometric function as in the description in FIG. For example, if y = tanx and one y value is determined, the corresponding X values are determined, so it is not a one-to-one mapping like a normal linear function. Therefore, as described in the following formula (10), by specifying the range of X for the region that monotonically increases or decreases monotonically within 2 π of one period (X range), It becomes a map of 1 and there is an inverse function. Therefore, conversion according to the following equation (10) is possible. [0094] [Equation 10] eGn [rad.] = Tan _1 (VGG n / VGG¾rn)
= arctan (VGG y n /VGG X= arctan (VGG y n / VGG X
Figure imgf000026_0001
Figure imgf000026_0001
但し、 (一 π/2)< t(Gn[rad.]< (7r/2) However, (one π / 2) <t (G n [rad.] <(7r / 2)
I . (— π/2)< epn[rad.]<0の場合: 降坂路面 I. (— Π / 2) <ep n [rad.] <0: Downhill road surface
Π.0≤ 9pn[rad.]< (7r/2)の場合: 登坂路面 Π.0≤ 9p n [rad.] <(7r / 2): Climbing slope
[0095] 図 8のフローチャートに戻り、つぎに路面傾斜角度判定部 710によって、 0[rad. ] ≤路面傾斜角度 θ Pnであるか否かを判断する(ステップ S808)。このステップ S808 により、 0[rad. ]≤路面傾斜角度 Θ Pnでない場合 (ステップ S808:No)は、降坂路 面状況のステップ S856の処理へ移行する。 Returning to the flowchart of FIG. 8, the road surface inclination angle determination unit 710 determines whether or not 0 [rad.] ≤ road surface inclination angle θ Pn (step S808). By this step S808, when 0 [rad.] ≤ road surface inclination angle Θ Pn is not satisfied (step S808: No), the process proceeds to step S856 of the downhill road surface condition.
[0096] ステップ S804で算出された路面傾斜角度 Θ Pn[rad. ]が 0[rad. ]≤路面傾斜角 度 Θ Pnである場合 (ステップ S808:Yes)は、つぎに、車両速度比較判定部 711によ つて、 4.0[kmZh]≤ (VPPn—VGGn)であるか否かを判断する(ステップ S809)。 このステップ S809では、ステップ S801で取得し算出された車速パルス速度 VPPn[ km/h]とステップ S807で取得し算出された GPS速度 VGGn[kmZh]を比較して 速度差の大きさを判定する。ステップ S809の判断により、車両が走行中の登坂路面 が凍結状態や積雪状態の場合には、車速パルス速度 VPPn[kmZh]よりも GPS速 度 VGGn[kmZh]の方が正確な車両の速度データを得ることができる。何故ならば 、車速パルス速度 VPPn [kmZh]の場合は、車両の駆動輪が空回りをしながら走行 する。さらに、アクセルシステムを動作させる(アクセルを踏む)と駆動輪の空回りが増 カロしながら速度を上げて行く。したがって、単位時間当り(例えば、サンプリング周期 T( 100ms) X 10=1秒間)の車速センサ力も発生する車速パルス数は、通常(乾燥' 湿潤状態)の路面走行時よりも多くなるので、算出された車速パルス速度 VPPn [km /h]は GPS速度 VGGn[kmZh]よりも大きくなる。  [0096] If the road surface inclination angle Θ Pn [rad.] Calculated in step S804 is 0 [rad.] ≤ road surface inclination angle Θ Pn (step S808: Yes), then the vehicle speed comparison / determination unit Based on 711, it is determined whether or not 4.0 [kmZh] ≤ (VPPn—VGGn) (step S809). In step S809, the vehicle speed pulse speed VPPn [km / h] acquired and calculated in step S801 is compared with the GPS speed VGGn [kmZh] acquired and calculated in step S807, and the magnitude of the speed difference is determined. If the uphill road surface on which the vehicle is running is frozen or snowy, the GPS speed VGGn [kmZh] provides more accurate vehicle speed data than the vehicle speed pulse speed VPPn [kmZh]. Obtainable. This is because when the vehicle speed pulse speed is VPPn [kmZh], the vehicle's drive wheels run while idling. Furthermore, when the accelerator system is operated (stepping on the accelerator), the speed of the drive wheels increases while the idle rotation of the drive wheels increases. Therefore, the number of vehicle speed pulses that also generate vehicle speed sensor force per unit time (for example, sampling period T (100 ms) X 10 = 1 second) is larger than that when driving on a normal road (dry or wet). The vehicle speed pulse speed VPPn [km / h] is larger than the GPS speed VGGn [kmZh].
[0097] つまり、車速パルス速度 VPPn [km/h]と、 GPS速度 VGGn [km/h]との速度差 力 「4.0[kmZh]≤ (VPPn—VGGn)」である場合 (ステップ S809: Yes)は、登坂 路面の第 1凍結'積雪条件を満たすことになり、ステップ S810の処理へ移行する。一 方、「4. 0[km/h]≤ (VPPn— VGGn)」でない場合 (ステップ S809 :No)は、ステ ップ S825の処理へ移行する。 [0097] That is, when the speed difference between the vehicle speed pulse speed VPPn [km / h] and the GPS speed VGGn [km / h] is 4.0 [kmZh] ≤ (VPPn—VGGn) (step S809: Yes) Will satisfy the first freezing snow condition on the uphill road surface, and the process proceeds to step S810. one On the other hand, if it is not “4.0 [km / h] ≤ (VPPn—VGGn)” (step S809: No), the process proceeds to step S825.
[0098] ステップ S809によって、「4. 0[km/h]≤ (VPPn—VGGn)」でないと判断された 場合 (ステップ S809 :No)は、つぎに、車両速度比較判定部 711によって、 2. 0[km Zh]≤ (VPPn—VGGn)であるか否かを判断する(ステップ S825)。このステップ S 825では、ステップ S801で取得し算出された車速パルス速度 VPPn[kmZh]とステ ップ S807で取得し算出された GPS速度 VGGn[kmZh]を比較して速度差の大きさ を判定する。具体的には、ステップ S809での速度差のパラメータを例えば 2分の 1に する。これは走行中の登坂路面傾斜角度 Θ Pn[rad. ]がステップ S809よりも緩やか な登坂路面か或 、は平坦に近!、登坂路面の凍結状態や積雪状態を判定するため である。例えば、その速度差が「2. 0[kmZh]≤ (VPPn— VGGn)」である場合 (ス テツプ S825 :Yes)は、やや登坂'平坦路面の第 1凍結'積雪条件を満たし、ステップ S826の処理へ移行する。一方、「2. 0[kmZh]≤
Figure imgf000027_0001
」でなぃ場合( ステップ S825 :No)は、ステップ S842の処理へ移行する。
[0098] If it is determined in step S809 that "4.0 [km / h] ≤ (VPPn—VGGn)" is not satisfied (step S809: No), the vehicle speed comparison determination unit 711 then executes 2. It is determined whether or not 0 [km Zh] ≤ (VPPn-VGGn) (step S825). In step S825, the vehicle speed pulse speed VPPn [kmZh] obtained and calculated in step S801 is compared with the GPS speed VGGn [kmZh] obtained and calculated in step S807 to determine the magnitude of the speed difference. . Specifically, for example, the speed difference parameter in step S809 is halved. This is because the slope angle Θ Pn [rad.] Of the climbing road surface during traveling is gentler than that of step S809 or is almost flat! In order to determine whether the climbing road surface is frozen or snowy. For example, if the speed difference is “2.0 [kmZh] ≤ (VPPn—VGGn)” (Step S825: Yes), the condition of the first freezing on the flat road and the first snow cover condition is met. Transition to processing. On the other hand, "2.0 [kmZh] ≤
Figure imgf000027_0001
Otherwise (step S825: No), the process proceeds to step S842.
[0099] 続いて、ステップ S808によって、 0[rad. ]≤路面傾斜角度 θ Pnでないと判断され た場合 (ステップ S808 : No)、つまり、降坂路面を走行している場合の処理について 説明する。まず、車両速度比較判定部 711によって、 3. 0[km/h]≤(VGGn-VP Pn)であるか否かを判断する(ステップ S856)。このステップ S856では、ステップ S8 01で取得し算出された車速パルス速度 VPPn[kmZh]とステップ S807で取得し算 出された GPS速度 VGGn[kmZh]を比較して速度差の大きさを判定する。  [0099] Next, a description will be given of processing when it is determined in step S808 that 0 [rad.] ≤ road surface inclination angle θ Pn is not satisfied (step S808: No), that is, when traveling on a downhill road surface. . First, the vehicle speed comparison / determination unit 711 determines whether or not 3.0 [km / h] ≤ (VGGn-VP Pn) (step S856). In step S856, the vehicle speed pulse speed VPPn [kmZh] obtained and calculated in step S801 is compared with the GPS speed VGGn [kmZh] obtained and calculated in step S807 to determine the magnitude of the speed difference.
[0100] ステップ S856では、車両が走行中の降坂路面が凍結状態や積雪状態の場合には 、車速パルス速度 VPPn[kmZh]よりも GPS速度 VGGn[kmZh]の方が正確な車 両の速度データを得ることができる。何故ならば、車速パルス速度 VPPn [kmZh]の 場合は車両の駆動輪が回転しながら滑降する。さらに、ブレーキシステムを動作させ る(ブレーキをかける)と駆動輪が殆んど回転しないまま滑降する。また、 ABS装置装 着車でも ABSが動作 (駆動輪の回転数は少ない)しながら滑降する。  [0100] In step S856, if the downhill road surface on which the vehicle is traveling is frozen or snowy, the GPS speed VGGn [kmZh] is more accurate than the vehicle speed pulse speed VPPn [kmZh]. Data can be obtained. This is because when the vehicle speed pulse speed is VPPn [kmZh], the drive wheels of the vehicle slide down. Furthermore, when the brake system is operated (braking), the drive wheels slide down with little rotation. In addition, even if the vehicle is equipped with an ABS device, the ABS will move down (the drive wheel speed is low) and the vehicle will slide down.
[0101] したがって、単位時間当り(例えば、サンプリング周期 T( 100ms) X 10= 1秒間)の 車速センサ力 発生する車速パルス数は、通常 (乾燥'湿潤状態)の路面走行時より も少なくなるので、算出された車速パルス速度 VPPn[kmZh]は GPS速度 VGGn[k mZh]よりも小さくなる。例えば、その速度差が「3. 0[km/h]≤ (VGGn-VPPn) 」である場合 (ステップ S856 :Yes)は、降坂路面の第 1凍結'積雪条件を満たし、ス テツプ S857の処理へ移行する。一方、「3. 0[kmZh]≤ (VGGn— VPPn)」でない 場合 (ステップ S856 :No)は、ステップ S872の処理へ移行する。 [0101] Therefore, the vehicle speed sensor force per unit time (for example, sampling cycle T (100ms) x 10 = 1 second) is higher than that when driving on a normal (dry or wet) road surface. Therefore, the calculated vehicle speed pulse speed VPPn [kmZh] is smaller than the GPS speed VGGn [kmZh]. For example, if the speed difference is "3.0 [km / h] ≤ (VGGn-VPPn)" (step S856: Yes), the first freezing snow condition on the downhill road surface is satisfied, and step S857 Transition to processing. On the other hand, if it is not “3.0 [kmZh] ≤ (VGGn—VPPn)” (step S856: No), the process proceeds to step S872.
[0102] ステップ S856によって、「3. 0[kmZh]≤ (VGGn—VPPn)」でないと判断された 場合 (ステップ S856 :No)は、続いて、車両速度比較判定部 711によって、 1. 5 [km Zh]≤ (VGGn—VPPn)であるか否かを判断する(ステップ S872)。このステップ S 872では、ステップ S801で取得し算出された車速パルス速度 VPPn[kmZh]とステ ップ S807で取得し算出された GPS速度 VGGn[kmZh]を比較して速度差の大きさ を判定する。 [0102] If it is determined in step S856 that "3.0 [kmZh] ≤ (VGGn—VPPn)" is not satisfied (step S856: No), the vehicle speed comparison determination unit 711 then selects 1.5 [ It is determined whether km Zh] ≤ (VGGn—VPPn) (step S872). In step S 872, the vehicle speed pulse speed VPPn [kmZh] obtained and calculated in step S801 is compared with the GPS speed VGGn [kmZh] obtained and calculated in step S807 to determine the magnitude of the speed difference. .
[0103] ステップ S872では、ステップ S856での速度差のパラメータを例えば 2分の 1にする 。これは走行中の降坂路面傾斜角度 Θ Pn[rad. ]がステップ S856よりも緩やかな降 坂路面か或!、は平坦に近!、降坂路面の凍結状態や積雪状態を判定するためである 。例えば、その速度差が「1. 5 [kmZh]≤ (VGGn— VPPn)」である場合 (ステップ S 872 : Yes)は、やや降坂 ·平坦路面の第 1凍結 ·積雪条件を満たし、ステップ S873の 処理へ移行する。一方、「1. 5 [kmZh]≤ (VGGn—VPPn)」でない場合 (ステップ S872 :No)は、ステップ S890の処理へ移行する。  [0103] In step S872, the parameter of the speed difference in step S856 is set to 1/2, for example. This is because the slope angle Θ Pn [rad.] Of the downhill road during traveling is a gentle downhill road surface that is gentler than step S856 or is almost flat! This is to determine whether the downhill road surface is frozen or snowy. is there . For example, if the speed difference is “1.5 [kmZh] ≤ (VGGn—VPPn)” (step S 872: Yes), the first freezing on the downhill / flat road surface / snow condition is met, and step S873 Move on to processing. On the other hand, when “1.5 [kmZh] ≦ (VGGn—VPPn)” is not satisfied (step S872: No), the process proceeds to step S890.
[0104] 続いて、ステップ S809によって、車速パルス速度 VPPn[kmZh]と、 GPS速度 V GGn[kmZh]との速度差力 「4. 0[kmZh]≤ (VPPn— VGGn)」であると判断さ れた場合 (ステップ S809 :Yes)は、続いて、車両加速度比較判定部 712によって、 0 . 4[m/s2]≤ ( AVPn- Δ VGn)であるか否かを判断する(ステップ S810)。このス テツプ S810では、ステップ S803で取得し算出された車速パルス速度 VPn[mZs] の変化量(車速パルス加速度) AVPn[mZs2]とステップ S807で取得し算出された GPS速度 VGn[mZs]の変化量 (GPS加速度) Δ VGn[mZs2]を比較して、速度の 変化量 (加速度)差の大きさを判定する。 [0104] Subsequently, in step S809, it is determined that the speed difference between the vehicle speed pulse speed VPPn [kmZh] and the GPS speed V GGn [kmZh] is 4.0 [kmZh] ≤ (VPPn—VGGn). If it is determined (step S809: Yes), the vehicle acceleration comparison / determination unit 712 subsequently determines whether or not 0.4 [m / s 2 ] ≤ (AVPn-ΔVGn) (step S810). . In this step S810, the change amount (vehicle speed pulse acceleration) AVPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs] obtained and calculated in step S803 and the GPS speed VGn [mZs] obtained and calculated in step S807 are calculated. Change (GPS acceleration) Δ VGn [mZs 2 ] is compared to determine the magnitude of the speed change (acceleration) difference.
[0105] ステップ S810では、走行中の登坂路面が凍結状態や積雪状態の場合には、車速 パルス速度 VPn[mZs]の変化量(車速パルス加速度) AVPn[mZs2]よりも、 GPS 速度 VGn [m/s]の変化量 (GPS加速度) Δ VGn [m/s2]の方が実際の車両の走 行動作に合って 、る正確な速度の変化量 (加速度)を得ることができる。何故ならば、 車速パルス速度 VPn[mZs]の変化量(車速パルス加速度) AVPn[mZs2]は、車 両の駆動輪が不規則な空回りをしながら走行する。さらに、アクセルシステムを動作さ せる(アクセルを踏む)と駆動輪の不規則な空回りが増カロしながら速度を上げる。 [0105] In step S810, when the climbing road surface is frozen or snowy, the change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) is more effective than GPS AVPn [mZs 2 ]. Change in speed VGn [m / s] (GPS acceleration) Δ VGn [m / s 2 ] is more accurate for the actual movement of the vehicle. it can. This is because the amount of change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) AVPn [mZs 2 ] travels while the drive wheels of the vehicle run irregularly. In addition, operating the accelerator system (stepping on the accelerator) increases the speed while increasing irregular idling of the drive wheels.
[0106] したがって、単位時間当り(例えば、サンプリング周期 T( 100ms) X 10= 1秒間)の 車速センサ力 発生する車速パルス数は、通常 (乾燥'湿潤状態)の路面走行時より も不規則な時間間隔で多くなるので、算出された車速パルス速度 VPn[mZs]の変 化量(車速パルス加速度) Δ VPn[m/s2]は GPS速度 VGn [m/s]の変化量(GPS 加速度) Δ VGn [m/s2]よりも不規則に大きくなる。 [0106] Therefore, the vehicle speed sensor force per unit time (for example, sampling period T (100ms) X 10 = 1 second) is generated more irregularly than when driving on a normal (dry or wet) road surface. Since it increases at time intervals, the calculated change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ΔVPn [m / s 2 ] is the change in GPS speed VGn [m / s] (GPS acceleration) It becomes irregularly larger than Δ VGn [m / s 2 ].
[0107] 例えば、上記の変化量 (加速度)の差が「0. 4[m/s2]≤( AVPn- AVGn)」であ る場合 (ステップ S810 : Yes)は、登坂路面の第 2凍結'積雪条件を満たし、ステップ S811の処理へ移行する。一方、「0. 4[m/s2]≤( AVPn- AVGn)」でない場合( ステップ S810 : No)は、ステップ S826へ進む。 [0107] For example, if the difference (acceleration) is “0.4 [m / s 2 ] ≤ (AVPn-AVGn)" (step S810: Yes), the second freezing of the uphill road surface 'Snow condition is satisfied and the process proceeds to step S811. On the other hand, if “0.4 [m / s 2 ] ≤ (AVPn−AVGn)” is not satisfied (step S810: No), the process proceeds to step S826.
[0108] つぎに、ステップ S810によって「0. 4[m/s2]≤ ( AVPn- Δ VGn)」でないと判断 された場合 (ステップ S810 : No)、もしくはステップ S825によって「2. 0[km/h]≤( VPPn— VGGn)」であると判断された場合 (ステップ S825 :Yes)は、つぎに、車両 加速度比較判定部 712によって、 0. 2[m/s2]≤( AVPn- Δ VGn)であるか否か を判断する (ステップ S826)。 [0108] Next, when it is determined in step S810 that “0.4 [m / s 2 ] ≤ (AVPn-ΔVGn)" is not satisfied (step S810: No), or in step S825, “2.0 [km / h] ≤ (VPPn—VGGn) ”(step S825: Yes), the vehicle acceleration comparison / determination unit 712 then selects 0.2 [m / s 2 ] ≤ (AVPn-Δ It is determined whether or not (VGn) (step S826).
[0109] このステップ S826では、ステップ S803で取得し算出された車速パルス速度 VPn[ m/s]の変化量(車速パルス加速度) Δ VPn [m/s2]とステップ S807で取得し算出 された GPS速度 VGn[mZs]の変化量(GPS加速度) Δ VGn [m/s2]を比較して速 度の変化量 (加速度)差の大きさを判定する。具体的には、ステップ S810での速度 の変化量 (加速度)差のパラメータを例えば 2分の 1にする。これは走行中の登坂路 面傾斜角度 Θ Pn[rad. ]がステップ S810よりも緩やかな登坂路面か或いは平坦に 近い登坂路面の凍結状態や積雪状態を判定するためである。 [0109] In this step S826, the change amount (vehicle speed pulse acceleration) ΔVPn [m / s 2 ] of the vehicle speed pulse velocity VPn [m / s] obtained and calculated in step S803 and obtained and calculated in step S807. GPS speed VGn [mZs] change (GPS acceleration) Δ VGn [m / s 2 ] is compared to determine the speed change (acceleration) difference. Specifically, the parameter of the speed change amount (acceleration) difference in step S810 is set to, for example, half. This is to determine whether the climbing road surface slope angle Θ Pn [rad.] Is lower than that of step S810 or whether the climbing road surface is almost flat or frozen.
[0110] 例えば、その速度の変化量 (加速度)差が「0. 2 [m/s2]≤( AVPn- AVGn)」で ある場合 (ステップ S826 :Yes)は、やや登坂'平坦路面の第 2凍結'積雪条件を満た し、ステップ S827の処理へ移行する。一方、「0. 2[m/s2]≤ ( AVPn- AVGn)」 でない場合 (ステップ S826 :No)は、ステップ S842の処理へ移行する。 [0110] For example, if the speed change (acceleration) difference is "0.2 [m / s 2 ] ≤ (AVPn-AVGn)" (step S826: Yes), the first step on the slightly uphill flat surface 2 Meet freezing snow conditions Then, the process proceeds to step S827. On the other hand, if “0.2 [m / s 2 ] ≤ (AVPn−AVGn)” is not satisfied (step S826: No), the process proceeds to step S842.
[0111] 続いて、ステップ S856によって「3. 0[kmZh]≤ (VGGn— VPPn)」であると判断 された場合 (ステップ S856 : Yes)は、つぎに、車両加速度比較判定部 712によって 、 0. 3 [m/s2]≤( AVGn- Δ VPn)であるか否かを判断する(ステップ S857)。この ステップ S857では、ステップ S803で取得し算出された車速パルス速度 VPn[mZs ]の変化量(車速パルス加速度) AVPn[mZv]と、ステップ S807で取得し算出され た GPS速度 VGn[mZs]の変化量 (GPS加速度) Δ VGn[mZs2]とを比較して速度 の変化量 (加速度)差の大きさを判定する。 [0111] Subsequently, when it is determined in step S856 that "3.0 [kmZh] ≤ (VGGn—VPPn)" (step S856: Yes), the vehicle acceleration comparison determination unit 712 then sets It is determined whether or not 3 [m / s 2 ] ≤ (AVGn-ΔVPn) (step S857). In this step S857, the change in the vehicle speed pulse speed VPn [mZs] obtained and calculated in step S803 (vehicle speed pulse acceleration) AVPn [mZv] and the change in the GPS speed VGn [mZs] obtained and calculated in step S807 Compare the amount (GPS acceleration) ΔVGn [mZs 2 ] to determine the magnitude of the speed change (acceleration) difference.
[0112] ステップ S857では、ステップ S856の判定結果が「3. 0[km/h]≤ (VGGn -VP Pn)」である場合 (ステップ S856 :Yes)に処理が行われる。ここでは走行中の降坂路 面が凍結状態や積雪状態の場合には、車速パルス速度 VPn [mZs]の変化量 (車 速パルス加速度) Δ VPn[mZs2]よりも GPS速度 VGn [m/s]の変化量(GPS加速 度) Δ VGn [mZs2]の方が実際の車両の走行動作に合っている正確な速度の変化 量 (加速度)を得ることができる。何故ならば、車速パルス速度 VPn [mZs]の変化量 (車速パルス加速度) AVPn[mZs2]の場合は、車両の駆動輪が不規則に回転しな がら滑降する。さらに、ブレーキシステムを動作させる(ブレーキをかける)と、駆動輪 が不規則で殆ど回転しないまま滑降する。また、 ABS装置装着車でも ABSが動作( 駆動輪の不規則な回転数は少ない)しながら滑降するため、単位時間当り(例えば、 サンプリング周期 T(100ms) X 10= 1秒間)の車速センサ力も発生する車速パルス 数は、通常 (乾燥 ·湿潤状態)の路面走行時よりも不規則な時間間隔で少なくなる。 In step S857, processing is performed when the determination result in step S856 is “3.0 [km / h] ≦ (VGGn−VP Pn)” (step S856: Yes). Here, when the running downhill road surface is frozen or snowy, the GPS speed VGn [m / s] is greater than the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ΔVPn [mZs 2 ]. ] (GPS acceleration) Δ VGn [mZs 2 ] can obtain an accurate speed change (acceleration) that matches the actual driving behavior of the vehicle. This is because the amount of change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) AVPn [mZs 2 ] causes the vehicle's drive wheels to slide down irregularly. In addition, when the brake system is operated (braking), the drive wheels slide down with irregular and almost no rotation. In addition, even in the vehicle equipped with the ABS device, the ABS slides while operating (the number of irregular rotations of the drive wheels is small), so the vehicle speed sensor force per unit time (for example, sampling cycle T (100ms) X 10 = 1 second) The number of vehicle speed pulses generated is smaller at irregular time intervals than when driving on a normal (dry / wet) road surface.
[0113] したがって、算出された車速パルス速度 VPn [mZs]の変化量(車速パルス加速度 ) AVPn[mZs2]は GPS速度 VGn[mZs]の変化量(GPS加速度) AVGn[mZs2] よりも不規則に小さくなる。例えば、その速度の変化量 (加速度)差が「0. 3 [m/s2] ≤( AVGn- AVPn)」である場合 (ステップ S857 :Yes)は、降坂路面の第 2凍結- 積雪条件を満たし、ステップ S858の処理へ移行する。一方、「0. 3 [m/s2]≤( AV Gn- AVPn)」でない場合 (ステップ S857 :No)は、ステップ S873の処理へ移行す る。 [0114] 続いて、ステップ S857によって「0. 3[m/s2]≤ (AVGn— AVPn)」でないと判断 された場合 (ステップ S857: No)、もしくはステップ S872によって、「1. 5[km/h]≤ (VGGn— VPPn)」であると判断された場合 (ステップ S872:Yes)は、車両加速度 比較判定部 712によって、 0. 15[m/s2]≤ (AVGn- Δ VPn)である力否かを判断 する(ステップ S873)。 [0113] Therefore, the calculated change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) AVPn [mZs 2 ] is less than the change in GPS speed VGn [mZs] (GPS acceleration) AVGn [mZs 2 ]. Become smaller in the rules. For example, if the speed change (acceleration) difference is 0.3 (m / s 2 ) ≤ (AVGn-AVPn) (step S857: Yes), the second freezing-snow condition on the downhill road surface And the process proceeds to step S858. On the other hand, if “0.3 [m / s 2 ] ≤ (AV Gn− AVPn)” is not satisfied (step S857: No), the process proceeds to step S873. [0114] Subsequently, if it is determined in step S857 that “0.3 [m / s 2 ] ≤ (AVGn—AVPn)” is not satisfied (step S857: No), or in step S872, “1.5 [km / h] ≤ (VGGn—VPPn) ”(step S872: Yes), the vehicle acceleration comparison / determination unit 712 determines that 0.15 [m / s 2 ] ≤ (AVGn-ΔVPn) It is determined whether or not there is a certain force (step S873).
[0115] このステップ S873では、ステップ S803で取得し算出された車速パルス速度 VPn[ mZs]の変化量(車速パルス加速度) AVPn[mZs2]と、ステップ S807で取得し算 出された GPS速度 VGn[mZs]の変化量 (GPS加速度) Δ VGn[mZs2]とを比較し て速度の変化量 (加速度)差の大きさを判定する。 [0115] In this step S873, the change amount (vehicle speed pulse acceleration) AVPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs] obtained and calculated in step S803, and the GPS speed VGn obtained and calculated in step S807. Compare the change in [mZs] (GPS acceleration) Δ VGn [mZs 2 ] to determine the magnitude of the speed change (acceleration) difference.
[0116] ステップ S873では、具体的には、ステップ S857での速度の変化量 (加速度)差の ノ ラメータを例えば 2分の 1にする。これは走行中の降坂路面傾斜角度 Θ Pn[rad. ] 力ステップ S857よりも緩や力な降坂路面か或いは平坦に近い降坂路面の凍結状態 や積雪状態を判定するためである。例えば、速度の変化量 (加速度)差が「0. 15[m /s2]≤ (AVGn- AVPn)」である場合 (ステップ S873:Yes)は、やや降坂'平坦 路面の第 2凍結'積雪条件を満たし、ステップ S874の処理へ移行する。一方、「0. 1 5[m/s2]≤ (AVGn- AVPn)」でない場合 (ステップ S873:No)は、ステップ S89 0の処理へ移行する。 [0116] Specifically, in step S873, the parameter of the speed change (acceleration) difference in step S857 is reduced to, for example, one half. This is to determine whether the downhill road surface inclination angle Θ Pn [rad.] Force step S857 during driving is freezing or snowy on a downhill road surface that is gentler or more powerful than the step S857. For example, if the speed change (acceleration) difference is “0.15 [m / s 2 ] ≤ (AVGn-AVPn)” (step S873: Yes), it will be slightly downhill 'second freezing of flat road surface' The snow condition is satisfied, and the process proceeds to step S874. On the other hand, if “0.15 [m / s 2 ] ≦ (AVGn−AVPn)” is not satisfied (step S873: No), the process proceeds to step S890.
[0117] つぎに、ステップ S810によって、「0.4[m/s2]≤ (AVPn- AVGn)」であると判 断された場合 (ステップ S810: Yes)は、つぎに、第 1標準偏差判定部 714によって、 1. 8≤標準偏差 αΡηであるか否かを判断する(ステップ S811)。このステップ S811 では、ステップ S803でサンプリング数 50個のリングバッファ 1302により算出された車 速パルス速度 VPn[mZs]の変化量(車速パルス加速度) Δ VPn [m/s2]の標準偏 差 a Pnの大きさを判定する。 [0117] Next, if it is determined in step S810 that "0.4 [m / s 2 ] ≤ (AVPn-AVGn)" (step S810: Yes), then the first standard deviation determination unit From 714, it is determined whether or not 1.8≤standard deviation αΡη (step S811). In this step S811, the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ΔVPn [m / s 2 ] calculated by the ring buffer 1302 with 50 samples in step S803 a Pn Determine the size of.
[0118] ステップ S811では、走行中の登坂路面が凍結状態や積雪状態の場合には、ステ ップ S810でも記載した力 車速パルス速度 VPn [mZs]の変化量(車速パルス加速 度) AVPn[mZs2]の場合は車両の駆動輪が不規則な空回りをしながら走行する。 さらに、アクセルシステムを動作させる(アクセルを踏む)と駆動輪の不規則な空回り が増加しながら速度を上げる。 [0119] したがって、単位時間当り(例えば、サンプリング周期 T ( 100ms) X 10 = 1秒間)の 車速センサ力 発生する車速パルス数は、通常 (乾燥'湿潤状態)の路面走行時より も不規則な時間間隔で多くなる。つまり、算出された車速パルス速度 VPn[mZs]の 変化量(車速パルス加速度) Δ VPn[m/s2]は GPS速度 VGn [m/s]の変化量(G PS加速度) Δ VGn [mZs2]よりも不規則に大きくなる。 [0118] In step S811, if the running uphill road surface is frozen or snowy, the amount of change in vehicle speed pulse speed VPn [mZs] described in step S810 (vehicle speed pulse acceleration) AVPn [mZs In the case of 2 ], the vehicle travels while the drive wheels of the vehicle run irregularly. In addition, operating the accelerator system (stepping on the accelerator) increases the speed while increasing irregular idling of the drive wheels. [0119] Therefore, the vehicle speed sensor force per unit time (for example, sampling period T (100ms) X 10 = 1 second) is generated more irregularly than when driving on a normal (dry or wet) road surface. Increase at time intervals. In other words, the calculated change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ΔVPn [m / s 2 ] is the change in GPS speed VGn [m / s] (G PS acceleration) Δ VGn [mZs 2 ] Irregularly larger than].
[0120] 例えば、そのステップ S803で取得し算出された車速パルス速度 VPn[mZs]の変 化量 (車速パルス加速度) A VPn[mZs2]の標準偏差 α Ρηが「1. 8≤標準偏差《Ρ η」である場合 (ステップ S811: Yes)は、登坂路面の第 3凍結'積雪条件を満たし、ス テツプ S812の処理へ移行する。一方、「1. 8≤標準偏差 α Ρη」でない場合 (ステツ プ S811 : Νο)は、ステップ S827の処理へ移行する。 [0120] For example, the standard deviation α Ρη of the variation (vehicle speed pulse acceleration) A VPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs] obtained and calculated in step S803 is “1.8≤standard deviation << If “Ρη” (step S811: Yes), the third freezing snow condition on the uphill road surface is satisfied, and the process proceeds to step S812. On the other hand, if “1.8 ≤ standard deviation α Ρη” is not satisfied (step S811: Νο), the process proceeds to step S827.
[0121] ステップ S811によって、「1. 8≤標準偏差 α Ρη」でないと判断された場合 (ステツ プ S811 : No)、もしくはステップ S826によって、「0. 2 [m/s2]≤ ( Δ VPn- Δ VGn )」であると判断された場合 (ステップ S826 : Yes)は、つぎに、第 1標準偏差判定部 7 14によって、 1. 35≤標準偏差 α Ρηであるか否かを判断する(ステップ S827)。この ステップ S827では、ステップ S803でサンプリング数 50個のリングバッファ 1302によ り算出された車速パルス速度 VPn [mZs]の変化量(車速パルス加速度) A VPn[m /s2]の標準偏差 a Pnの大きさを判定する。 [0121] If it is determined in step S811 that “1.8 ≤ standard deviation α Ρη” is not satisfied (step S811: No), or in step S826, “0.2 [m / s 2 ] ≤ (ΔVPn -ΔVGn) ”(step S826: Yes), the first standard deviation determination unit 714 then determines whether or not 1.35 ≦ standard deviation α Ρη ( Step S827). In this step S827, the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) A VPn [m / s 2 ] calculated by the ring buffer 1302 with 50 samples in step S803 a Pn Determine the size of.
[0122] ステップ S827では、ステップ S811での車速パルス速度 VPn[mZs]の変化量(車 速パルス加速度) Δ VPn[mZs2]の標準偏差 α Pnのパラメータを例えば 4分の 3に する。これは走行中の登坂路面傾斜角度 Θ Pn [rad. ]が、ステップ S811よりも緩や かな登坂路面か或いは平坦に近!、登坂路面の凍結状態や積雪状態を判定するた めである。例えば、その車速パルス速度 VPn [mZs]の変化量(車速パルス加速度) Δ VPn [m/s2]の標準偏差 oc Pnが「 1. 35≤標準偏差 oc Pnjである場合 (ステップ S 827 : Yes)は、やや登坂 ·平坦路面の第 3凍結 ·積雪条件を満たし、ステップ S828の 処理へ移行する。一方、「1. 35≤標準偏差 α Ρη」でない場合 (ステップ S827 : No) は、ステップ S842の処理へ移行する。 [0122] In step S827, the parameter of the standard deviation α Pn of the change amount (vehicle speed pulse acceleration) ΔVPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs] in step S811 is set to, for example, 3/4. This is because the slope angle Θ Pn [rad.] Of the climbing road surface during traveling is gentler than the step S811 or closer to the flat surface! In order to determine whether the climbing road surface is frozen or snowy. For example, if the standard deviation oc Pn of the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ΔVPn [m / s 2 ] is 1.35≤standard deviation oc Pnj (Step S 827: Yes ) Satisfies the third freezing / snow accumulation condition on the slightly uphill / flat road surface, and proceeds to the processing of step S828, while if it is not “1. 35≤ standard deviation α Ρη” (step S827: No), then step S842 Move on to processing.
[0123] ステップ S857によって、「0. 3 [mZs2]≤ ( Δ VGn— Δ VPn)」であると判断された 場合 (ステップ S857 : Yes)は、続いて、第 1標準偏差判定部 714によって、 1. 6≤標 準偏差 α Ρηであるか否かを判断する(ステップ S858)。このステップ S858では、ス テツプ S803でサンプリング数 50個のリングバッファ 1302により算出された車速パル ス速度 VPn[mZs]の変化量 (車速パルス加速度) Δ VPn[mZs2]の標準偏差 a Pn の大きさを判定する。 [0123] in step S857, "0 3 [mZs 2] ≤ ( Δ VGn- Δ VPn). " If it is determined that (step S857: Yes), in turn, the first standard deviation determination unit 714 , 1.6 ≤ standard It is determined whether or not the quasi deviation α Ρη is satisfied (step S858). In this step S858, the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ΔVPn [mZs 2 ] calculated by the ring buffer 1302 with 50 samples in step S803 is the magnitude of the standard deviation a Pn Judging.
[0124] ステップ S858では、走行中の降坂路面が凍結状態や積雪状態の場合には、ステ ップ S857でも記載した力 車速パルス速度 VPn[mZs]の変化量(車速パルス加速 度) A VPn[mZs2]の場合は車両の駆動輪が不規則に回転しながら滑降する。さら に、ブレーキシステムを動作させる(ブレーキをかける)と駆動輪が不規則で殆ど回転 しないまま滑降する。また、 ABS装置装着車でも ABSが動作 (駆動輪の不規則な回 転数は少ない)しながら滑降する。つまり、単位時間当り(例えば、サンプリング周期 T (100ms) X 10= 1秒間)の車速センサ力も発生する車速パルス数は、通常(乾燥 · 湿潤状態)の路面走行時よりも不規則な時間間隔で少なくなる。 [0124] In step S858, if the downhill road surface is frozen or snowy, the change in vehicle speed pulse speed VPn [mZs] described in step S857 (vehicle speed pulse acceleration) A VPn In the case of [mZs 2 ], the drive wheel of the vehicle slides down irregularly. In addition, when the brake system is operated (braking), the drive wheels are irregular and slide down with little rotation. In addition, even if the vehicle is equipped with an ABS device, the ABS will run down (the drive wheel has an irregular number of rotations) and will slide down. In other words, the number of vehicle speed pulses that also generate vehicle speed sensor force per unit time (for example, sampling cycle T (100ms) X 10 = 1 second) is more irregular than the normal (dry / wet) road surface. Less.
[0125] したがって、算出された車速パルス速度 VPn[mZs]の変化量(車速パルス加速度 ) A VPn[mZs2]は GPS速度 VGn[mZs]の変化量(GPS加速度) A VGn[mZs2] よりも不規則に小さくなる。例えば、そのステップ S803で取得し算出された車速パル ス速度 VPn[mZs]の変化量 (車速パルス加速度) Δ VPn[mZs2]の標準偏差 a Pn 力 S「l . 6≤標準偏差 α Ρη」である場合 (ステップ S858 :Yes)は、降坂路面の第 3凍 結'積雪条件を満たし、ステップ S859の処理へ移行する。一方、「1. 6≤標準偏差 α Ρη」でない場合 (ステップ S858 : No)は、ステップ S874の処理へ移行する。 [0125] Therefore, the calculated change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) A VPn [mZs 2 ] is calculated from the change in GPS speed VGn [mZs] (GPS acceleration) A VGn [mZs 2 ] Becomes irregularly small. For example, the amount of change in the vehicle speed pulse speed VPn [mZs] obtained and calculated in step S803 (vehicle speed pulse acceleration) ΔVPn [mZs 2 ] standard deviation a Pn force S "l. 6 ≤ standard deviation α Ρη" If it is (step S858: Yes), the third icy snowfall condition on the downhill road surface is satisfied, and the process proceeds to step S859. On the other hand, if it is not “1.6 ≦ standard deviation α Ρη” (step S858: No), the process proceeds to step S874.
[0126] ステップ S858によって、「1. 6≤標準偏差 α Pn」でないと判断された場合 (ステツ プ S858 : No)、もしくはステップ S873によって、「0. 15 [m/s2]≤ ( Δ VGn— Δ VP n)」であると判断された場合 (ステップ S873 :Yes)は、続いて、第 1標準偏差判定部 714によって、 1. 2≤標準偏差 α Ρηであるか否かを判断する(ステップ S874)。この ステップ S874では、ステップ S803でサンプリング数 50個のリングバッファ 1302によ り算出された車速パルス速度 VPn[mZs]の変化量(車速パルス加速度) A VPn[m /s2]の標準偏差 a Pnの大きさを判定する。 [0126] If it is determined by step S858 that “1.6 ≤ standard deviation α Pn” is not satisfied (step S858: No), or by step S873, “0.15 [m / s 2 ] ≤ (Δ VGn — ΔVP n) ”(step S873: Yes), the first standard deviation determination unit 714 subsequently determines whether 1.2 ≦ standard deviation α Ρη ( Step S874). In this step S874, the change amount (vehicle speed pulse acceleration) A VPn [m / s 2 ] of the vehicle speed pulse speed VPn [mZs] calculated by the ring buffer 1302 with 50 samples in step S803 a Pn Determine the size of.
[0127] ステップ S874は、ステップ S858での車速パルス速度 VPn[mZs]の変化量(車速 パルス加速度) Δ VPn[mZs2]の標準偏差 α Pnのパラメータを例えば 4分の 3にす る。これは走行中の降坂路面傾斜角度 Θ Pn[rad. ]がステップ S858よりも緩やかな 降坂路面か或!、は平坦に近!、降坂路面の凍結状態や積雪状態を判定するためで ある。例えば、その車速パルス速度 VPn[mZs]の変化量(車速パルス加速度) Δν Pn [m/s2]の標準偏差 oc Pnが「 1. 2≤標準偏差 oc Pnjである場合 (ステップ S874: Yes)は、やや降坂 ·平坦路面の第 3凍結 ·積雪条件を満たし、ステップ S875の処理 へ移行する。一方、「1. 2≤標準偏差 α Ρη」でない場合 (ステップ S874 : No)は、ス テツプ S890の処理へ移行する。 [0127] In step S874, the parameter of the standard deviation α Pn of the change amount (vehicle speed pulse acceleration) ΔVPn [mZs 2 ] of the vehicle speed pulse speed VPn [mZs] in step S858 is set to 3/4, for example. The This is to determine whether the downhill road slope angle Θ Pn [rad.] During traveling is a gentle downhill road surface that is gentler than step S858 or near flat! is there. For example, when the standard deviation oc Pn of the change amount of the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) Δν Pn [m / s 2 ] is “1.2 ≤ standard deviation oc Pnj (Step S874: Yes) Slightly downhill • The third freezing condition on a flat road surface • Snow conditions are met, and the process proceeds to step S875, while if it is not “1.2 ≤ standard deviation α Ρη” (step S874: No), step Move on to S890 processing.
[0128] ステップ S811によって標準偏差 α Ρηが「1. 8≤標準偏差 α Ρη」であると判断され た場合 (ステップ S811 :Yes)は、続いて、路面斜度比較判定部 706によって、 π /3 6 [rad. ]≤( θ Pn- Θ Gn)であるか否かを判断する(ステップ S812)。このステップ S812では、ステップ S804で加速度センサ加速度 Δ VAn[mZs2]および車速パル ス速度 VPn[mZs]の変化量 (車速パルス加速度) Δ VPn[mZs2]により算出された 路面傾斜角度 Θ Pn[rad. ]と、ステップ S806で GPS速度 VGGn[kmZh]の水平( X)方向速度 VGGxn[kmZh]および垂直 (y)方向速度 VGGyn[kmZh]により算 出された路面傾斜角度 Θ Gn[rad. ]とを比較して、路面傾斜角度差の大きさを判定 する。 [0128] If it is determined in step S811 that the standard deviation α Ρη is “1.8 ≤ standard deviation α Ρη” (step S811: Yes), the road surface slope comparison and determination unit 706 subsequently performs π / It is determined whether or not 3 6 [rad.] ≤ (θ Pn− Θ Gn) (step S812). In this step S812, the road surface inclination angle Θ Pn [calculated by the amount of change in the acceleration sensor acceleration Δ VAn [mZs 2 ] and the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ΔVPn [mZs 2 ] in step S804. ], and the road inclination angle Θ Gn [rad.] calculated by the horizontal (X) direction velocity VGGxn [kmZh] and vertical (y) direction velocity VGGyn [kmZh] of the GPS velocity VGGn [kmZh] in step S806 To determine the magnitude of the road surface inclination angle difference.
[0129] ステップ S812では、走行中の登坂路面が凍結状態や積雪状態の場合には、路面 傾斜角度 Θ Pn[rad. ]よりも路面傾斜角度 Θ Gn[rad. ]の方が正確な走行中の路 面傾斜角度を得ることができる。何故ならば、路面傾斜角度 Θ Pn[rad. ]算出時にス テツプ S810、 S811で記載したような車速パルス速度 VPn[mZs]の変化量(車速パ ルス加速度) A VPn[mZs2]の影響を受けてしまうためである。例えば、その路面傾 斜角度 0 Pn[rad. ]と路面傾斜角度 Θ Gn[rad. ]の路面傾斜角度差が「 π Z36 [ra d. ]≤( Θ Ρη- θ Gn)」である場合 (ステップ S812 :Yes)は、登坂路面の第 4凍結' 積雪条件を満たし、ステップ S813の処理へ移行する。一方、「 π /36 [rad. ]≤( θ Pn- Θ Gn)」でない場合 (ステップ S812 : No)は、ステップ S828の処理へ移行する [0129] In step S812, when the running uphill road surface is frozen or snowy, the road slope angle Θ Gn [rad.] Is more accurate than the road slope angle Θ Pn [rad. The road surface inclination angle can be obtained. This is because the amount of change in vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) A VPn [mZs 2 ] as described in steps S810 and S811 when calculating the road surface inclination angle Θ Pn [rad. It is for receiving. For example, when the road surface inclination angle difference between the road surface inclination angle 0 Pn [rad.] And the road surface inclination angle Θ Gn [rad.] Is “π Z36 [ra d.] ≤ (Θ Ρη- θ Gn)” ( Step S812: Yes) satisfies the fourth freezing snow condition on the uphill road surface, and proceeds to the process of Step S813. On the other hand, if “π / 36 [rad.] ≤ (θ Pn- Θ Gn)” is not satisfied (step S812: No), the process proceeds to step S828.
[0130] つぎに、ステップ S812によって、「 Z36 [rad. ]≤( θ Pn— Θ Gn)」でないと判断 された場合 (ステップ S812 : No)、もしくはステップ S827によって、「1. 35≤標準偏 差 a Pnjであると判断された場合 (ステップ S827: Yes)は、続 、て、路面斜度比較 判定部 706によって、 π /72 [rad. ]≤( θ Ρη— θ Gn)であるか否かを判断する(ス テツプ S828)。このステップ S828では、ステップ S804で加速度センサ加速度 Δ VA n[mZs2]と、車速パルス速度 VPn[mZs]の変化量(車速パルス加速度) AVPn[m Zs2]とにより算出された路面傾斜角度 Θ Pn[rad. ]と、ステップ S806で GPS速度 V GGn[km/h]の水平(x)方向速度 VGGxn[kmZh]と、垂直 (y)方向速度 VGGyn [kmZh]とにより算出された路面傾斜角度 Θ Gn[rad. ]とを比較して、路面傾斜角 度差の大きさを判定する。 [0130] Next, when it is determined in step S812 that “Z36 [rad.] ≤ (θ Pn— Θ Gn)” is not satisfied (step S812: No), or in step S827, “1. If it is determined that the difference is a Pnj (step S827: Yes), then whether or not π / 72 [rad.] ≤ (θ Ρη- θ Gn) is determined by the road surface slope comparison determination unit 706 (Step S828). In this step S828, the road surface inclination angle Θ calculated by the acceleration sensor acceleration ΔVA n [mZs 2 ] and the change amount of the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) AVPn [m Zs 2 ] in step S804. Pn [rad.] And the road slope angle calculated in step S806 from the GPS velocity V GGn [km / h] horizontal (x) direction velocity VGGxn [kmZh] and vertical (y) direction velocity VGGyn [kmZh] Compare with Θ Gn [rad.] To determine the magnitude of the road slope angle difference.
[0131] ステップ S828では、ステップ S812での路面傾斜角度差のパラメータを例えば 2分 の 1にする。これは走行中の登坂路面傾斜角度 Θ Pn[rad. ]がステップ S812よりも 緩やかな登坂路面か或いは平坦に近!、登坂路面の凍結状態や積雪状態を判定す るためである。例えば、その路面傾斜角度 Θ Pn[rad. ]と路面傾斜角度 Θ Gn[rad. ]の路面傾斜角度差が Z72[rad. ]≤( θ Ρη— Θ Gn)」である場合 (ステップ S8 28 : Yes)は、やや登坂 ·平坦路面の第 4凍結 ·積雪条件を満たし、ステップ S829の 処理へ移行する。一方、「 π /72[rad. ]≤( θ Ρη— θ Gn)」でない場合 (ステップ S 828 : No)は、ステップ S842の処理へ移行する。  [0131] In step S828, the parameter of the road surface inclination angle difference in step S812 is set to 1/2, for example. This is because the slope angle Θ Pn [rad.] Of the climbing road surface during traveling is gentler than the step S812 or near flat, and it is judged whether the climbing road surface is frozen or snowy. For example, if the road surface inclination angle difference between the road surface inclination angle Θ Pn [rad.] And the road surface inclination angle Θ Gn [rad.] Is Z72 [rad.] ≤ (θ Ρη— Θ Gn) ”(step S8 28: If Yes), the conditions are met slightly uphill / fourth freezing / snow coverage on flat road surface, and the process proceeds to step S829. On the other hand, if “π / 72 [rad.] ≤ (θ (η—θGn)” is not satisfied (step S828: No), the process proceeds to step S842.
[0132] ステップ S858によって、「1. 6≤標準偏差 α Pn」であると判断された場合 (ステップ S858 :Yes)は、続いて、路面斜度比較判定部 706によって、 w Z45 [rad. ]≤( θ Gn- θ Ρη)であるか否かを判断する(ステップ S859)。このステップ S859では、ステ ップ S804でカ卩速度センサ加速度 Δ VAn[mZs2]と、車速パルス速度 VPn[mZs] の変化量 (車速パルス加速度) AVPn[mZs2]とにより算出された路面傾斜角度 θ P n[rad. ]と、ステップ S806で GPS速度 VGGn[kmZh]の水平(x)方向速度 VGGx n[km/h]と、垂直 (y)方向速度 VGGyn[kmZh]とにより算出された路面傾斜角度 Θ Gn[rad. ]とを比較して、路面傾斜角度差の大きさを判定する。 [0132] If it is determined in step S858 that "1.6 ≤ standard deviation α Pn" (step S858: Yes), the road surface slope comparison determination unit 706 subsequently performs w Z45 [rad.] It is determined whether or not ≤ (θ Gn-θ Ρη) (step S859). In step S859, the mosquito卩速degree sensor acceleration Δ VAn [mZs 2] with stearyl-up S804, variation in the vehicle speed pulse rate VPn [MZS] road surface inclination calculated by the (vehicle speed pulse acceleration) AVPn [mZs 2] The angle θ P n [rad.], And the GPS velocity VGGn [kmZh] horizontal (x) direction velocity VGGx n [km / h] and vertical (y) direction velocity VGGyn [kmZh] calculated in step S806. The road surface inclination angle Θ Gn [rad.] Is compared to determine the magnitude of the road surface inclination angle difference.
[0133] ステップ S859では、走行中の降坂路面が凍結状態や積雪状態の場合には、路面 傾斜角度 Θ Pn[rad. ]よりも路面傾斜角度 Θ Gn[rad. ]の方が正確な走行中の路 面傾斜角度を得ることができる。何故ならば、路面傾斜角度 Θ Pn[rad. ]算出時にス テツプ S857、 S858で記載したような車速パルス速度 VPn[mZs]の変化量(車速パ ルス加速度) Δ VPn [mZs2]の影響を受けてしまうためである。例えば、その路面傾 斜角度 0 Gn[rad. ]と路面傾斜角度 Θ Pn[rad. ]の路面傾斜角度差が「 π Z45 [ra d. ]≤( θ Gn- θ Ρη)」である場合 (ステップ S859 :Yes)は、降坂路面の第 4凍結 · 積雪条件を満たし、ステップ S860の処理へ移行する。一方、「 π /45 [rad. ]≤( θ Gn- θ Pn)」でない場合 (ステップ S859 :No)は、ステップ S875の処理へ移行する [0133] In step S859, when the downhill road surface is frozen or snowy, the road surface inclination angle Θ Gn [rad.] Is more accurate than the road surface inclination angle Θ Pn [rad. It is possible to obtain the inside road slope angle. This is because the amount of change in vehicle speed pulse speed VPn [mZs] as described in steps S857 and S858 (vehicle speed This is because it is affected by (Luth acceleration) ΔVPn [mZs 2 ]. For example, when the road surface inclination angle difference between the road surface inclination angle 0 Gn [rad.] And the road surface inclination angle Θ Pn [rad.] Is “π Z45 [ra d.] ≤ (θ Gn- θ Ρη)” ( In step S859: Yes), the fourth freezing / snow accumulation condition on the downhill road surface is satisfied, and the process proceeds to step S860. On the other hand, if it is not “π / 45 [rad.] ≤ (θ Gn- θ Pn)” (step S859: No), the process proceeds to step S875.
[0134] ステップ S859によって、「 Z45 [rad. ]≤( θ Gn— θ Ρη)」でないと判断された 場合 (ステップ S859 : No)、もしくはステップ S874によって、「1. 2≤標準偏差 α Ρη 」であると判断された場合 (ステップ S874 : Yes)は、続いて、路面斜度比較判定部 7 06によって、 π /90[rad. ]≤( θ Gn— θ Pn)であるか否かを判断する(ステップ S8 75)。このステップ S875では、ステップ S 804でカ卩速度センサ加速度 AVAn [m/s2 ]および車速パルス速度 VPn [m/s]の変化量(車速パルス加速度) Δ VPn [m/s2] により算出された路面傾斜角度 Θ Pn[rad. ]と、ステップ S806で GPS速度 VGGn[ km/h]の水平 (X)方向速度 VGGxn[kmZh]および垂直 (y)方向速度 VGGyn[k mZh]により算出された路面傾斜角度 Θ Gn[rad. ]とを比較して、路面傾斜角度差 の大きさを判定する。 [0134] If it is determined by step S859 that it is not "Z45 [rad.] ≤ (θ Gn— θ Ρη)" (step S859: No), or by step S874, "1.2 ≤ standard deviation α Ρη" (Step S874: Yes), the road surface slope comparison / determination unit 700 determines whether or not π / 90 [rad.] ≤ (θ Gn— θ Pn). (Step S8 75). In this step S875, it is calculated in step S804 based on the amount of change in the vehicle speed sensor acceleration AVAn [m / s 2 ] and the vehicle speed pulse speed VPn [m / s] (vehicle speed pulse acceleration) ΔVPn [m / s 2 ]. Calculated in step S806 using the horizontal (X) direction velocity VGGxn [kmZh] and the vertical (y) direction velocity VGGyn [k mZh] in step S806. The road surface inclination angle Θ Gn [rad.] Is compared to determine the magnitude of the road surface inclination angle difference.
[0135] ステップ S875では、ステップ S859での路面傾斜角度差のパラメータを例えば 2分 の 1にする。これは走行中の降坂路面傾斜角度 Θ Pn[rad. ]が、ステップ S859よりも 緩やかな降坂路面か或いは平坦に近い降坂路面の凍結状態や積雪状態を判定す るためである。例えば、その路面傾斜角度 Θ Gn[rad. ]と路面傾斜角度 Θ Pn[rad. ]の路面傾斜角度差が Z90[rad. ]≤( θ Gn- θ Pn)」である場合 (ステップ S8 75 : Yes)は、やや降坂 '平坦路面の第 4凍結'積雪条件を満たし、ステップ S876の 処理へ移行する。一方、「 π /90[rad. ]≤( θ Gn— Θ Pn)」でない場合 (ステップ S 875 : No)は、ステップ S890の処理へ移行する。  [0135] In step S875, the parameter of the road surface inclination angle difference in step S859 is set to 1/2, for example. This is to determine whether the downhill road surface inclination angle Θ Pn [rad.] During traveling is a gentle downhill road surface that is gentler than step S859 or a downhill road surface that is almost flat or snowy. For example, when the road surface inclination angle difference between the road surface inclination angle Θ Gn [rad.] And the road surface inclination angle Θ Pn [rad.] Is Z90 [rad.] ≤ (θ Gn- θ Pn) ”(step S8 75: If Yes), slightly downhill 'Fourth freezing on flat road' snow condition is satisfied, and the process proceeds to step S876. On the other hand, if “π / 90 [rad.] ≤ (θ Gn—Θ Pn)” is not satisfied (step S 875: No), the process proceeds to step S 890.
[0136] ステップ S812によって、「 Z36 [rad. ]≤( θ Pn— Θ Gn)」であると判断された場 合 (ステップ S812 :Yes)は、つぎに、第 2標準偏差判定部 716によって、 1. 8≤標準 偏差 j8 Θ Pnであるか否かを判断する(ステップ S813)。このステップ S813では、ス テツプ S805でサンプリング数 50個のリングバッファ 1702により算出された路面傾斜 角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]の標準偏差 Θ Ρηの大きさを判定する。 [0136] If it is determined in step S812 that "Z36 [rad.] ≤ (θ Pn— Θ Gn)" (step S812: Yes), the second standard deviation determination unit 716 then 1. It is determined whether or not 8≤standard deviation j8 Θ Pn (step S813). In this step S813, the road slope calculated by the ring buffer 1702 with 50 samples in step S805 is obtained. Change in angle Θ Pn [rad.] (Road slope angular velocity) Δ Θ Determine the magnitude of Pn [rad. Zs] standard deviation Θ Ρη.
[0137] ステップ S813では、走行中の登坂路面が凍結状態や積雪状態の場合、具体的な 算出は省略するが、路面傾斜角度 Θ Gn[rad. ]の変化量 (路面傾斜角速度) Δ Θ G n[rad. Zs]よりも路面傾斜角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ θ Pn[ rad. Zs]の方が不規則に大きくなる。何故ならば、路面傾斜角度 Θ Pn[rad. ]の変 化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]算出時にステップ S810、 S811で記載し たような車速パルス速度 VPn [m/s]の変化量(車速パルス加速度) Δ VPn [m/s2] の影響を受けてしまうためである。例えば、そのステップ S805で算出された路面傾斜 角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]の標準偏差 Θ Ρηが「1. 8≤標準偏差 |8 0 Pn」である場合 (ステップ S813 :Yes)は、登坂路面の第 5凍結'積雪条件を満たし、ステップ S814の処理へ移行する。一方、「1. 8≤標準偏 差 β θ Ρη」でない場合 (ステップ S813 :No)は、ステップ S829の処理へ移行する。 [0137] In step S813, if the running uphill road surface is frozen or snowy, a specific calculation is omitted, but the amount of change in road slope angle Θ Gn [rad.] (Road slope angular velocity) Δ Θ G The amount of change in road inclination angle Θ Pn [rad.] (road inclination angular velocity) Δ θ Pn [rad. Zs] is irregularly larger than n [rad. Zs]. This is because the amount of change in road inclination angle Θ Pn [rad.] (Road inclination angle velocity) ΔΘ Pn [rad. Zs] When calculating vehicle speed pulse speed VPn [m / s] as described in steps S810 and S811 ] (Vehicle speed pulse acceleration) Δ VPn [m / s 2 ]. For example, the amount of change in the road slope angle Θ Pn [rad.] Calculated in step S805 (road slope angular velocity) Δ Θ Pn [rad. Zs] standard deviation Θ Ρη is “1.8 ≤ standard deviation | 8 0 If “Pn” (step S813: Yes), the fifth freezing snow condition on the uphill road surface is satisfied, and the process proceeds to step S814. On the other hand, if “1.8 ≦ standard deviation β θ Ρη” is not satisfied (step S813: No), the process proceeds to step S829.
[0138] ステップ S813によって、「1. 8≤標準偏差 |8 0 Pn」でないと判断された場合 (ステ ップ S813 :No)、もしく ίまステップ S828によって、「7u /72[rad. ]≤ ( θ Ρη— Θ Gn )」と判断された場合 (ステップ S828 :Yes)は、つぎに、第 2標準偏差判定部 716によ つて、 1. 35≤標準偏差 j8 Θ Ρηであるか否かを判断する(ステップ S829)。このステ ップ S829で ίま、ステップ S805でサンプリング数 50偶のリングノッファ 1702【こより算 出された路面傾斜角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. /s ]の標準偏差 θ Ρηの大きさを判定する。  [0138] If it is determined by step S813 that “1. 8 ≤ standard deviation | 8 0 Pn” is not satisfied (step S813: No), or step S828, “7u / 72 [rad.] ≤ (θ Ρη— Θ Gn) ”(step S828: Yes), the second standard deviation judgment unit 716 then determines whether or not 1.35≤standard deviation j8 Θ Ρη. Is determined (step S829). This step S829 reaches ί, and in step S805 the number of samplings is 50 even. The amount of change in the road slope angle Θ Pn [rad.] (The road slope angular velocity) ΔΘ Pn [rad./s The standard deviation of θ Ρη is determined.
[0139] ステップ S829では、具体的には、ステップ S813での路面傾斜角度 Θ Pn[rad. ] の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]の標準偏差 j8 θ Pnのパラメータを 例えば 4分の 3にする。これは走行中の登坂路面傾斜角度 Θ Pn[rad. ]がステップ S 813よりも緩やかな登坂路面か或いは平坦に近い登坂路面の凍結状態や積雪状態 を判定するためである。例えば、その路面傾斜角度 Θ Pn[rad. ]の変化量 (路面傾 斜角速度) Δ Θ Pn[rad. Zs]の標準偏差 j8 0 ?11が「1. 35≤標準偏差 Θ Ρη」で ある場合 (ステップ S829 :Yes)は、やや登坂'平坦路面の第 5凍結'積雪条件を満た し、ステップ S830の処理へ移行する。一方、「1. 35≤標準偏差 |8 Θ Ρη」でない場 合 (ステップ S829 :No)は、ステップ S842の処理へ移行する。 [0139] In step S829, specifically, the amount of change in road slope angle Θ Pn [rad.] In step S813 (road slope angular velocity) ΔΘ Pn [rad. Zs] standard deviation j8 θ Pn parameter For example, 3/4. This is to determine whether the climbing road slope angle Θ Pn [rad.] During traveling is gentler than the step S813, or whether the climbing road surface is almost flat or frozen. For example, the amount of change in the road surface inclination angle Θ Pn [rad.] (Road surface inclination angle velocity) ΔΘ Pn [rad. Zs] standard deviation j8 0? 11 is "1.35≤standard deviation Θ Ρη" (Step S829: Yes) slightly satisfies the climbing slope 'fifth freezing of flat road surface' snow cover condition, and proceeds to the processing of step S830. On the other hand, if the value is not 1.35≤standard deviation | 8 Θ Ρη If YES (step S829: No), the process proceeds to step S842.
[0140] ステップ S859によって、「 Z45 [rad. ]≤( θ Gn— θ Ρη)」であると判断された場 合 (ステップ S859 :Yes)は、続いて、第 2標準偏差判定部 716によって、 1. 6≤標準 偏差 j8 θ Pnであるか否かを判断する(ステップ S860)。このステップ S860では、ス テツプ S805でサンプリング数 50個のリングバッファ 1702により算出された路面傾斜 角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]の標準偏差 Θ Pnの大きさを判定する。 [0140] If it is determined in step S859 that "Z45 [rad.] ≤ (θ Gn— θ Ρη)" (step S859: Yes), the second standard deviation determination unit 716 then 1. It is determined whether or not 6≤standard deviation j8 θ Pn (step S860). In this step S860, the amount of change in the road slope angle Θ Pn [rad.] Calculated by the ring buffer 1702 with 50 samples in step S805 (road slope angular velocity) Δ Θ Pn [rad. Zs] standard deviation Θ Determine the size of Pn.
[0141] ステップ S860では、走行中の降坂路面が凍結状態や積雪状態の場合、具体的な 算出は省略するが、路面傾斜角度 Θ Gn[rad. ]の変化量 (路面傾斜角速度) Δ Θ G n[rad. Zs]よりも路面傾斜角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ θ Pn[ rad. Zs]の方が不規則に小さくなる。何故ならば、路面傾斜角度 Θ Pn[rad. ]の変 化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]算出時にステップ S857、 S858で記載し たような車速パルス速度 VPn [m/s]の変化量(車速パルス加速度) Δ VPn [m/s2 ]の影響を受けてしまうためである。例えば、そのステップ S805で算出された路面傾 斜角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]の標準偏差 0 Pr^「l. 6≤標準偏差 |8 0 Pn」である場合 (ステップ S860 :Yes)は、降坂路面の 第 5凍結'積雪条件を満たし、ステップ S861の処理へ移行する。一方、「1. 6≤標準 偏差 j8 θ Pn」でない場合 (ステップ S860 :No)は、ステップ S876の処理へ移行する [0141] In step S860, if the downhill road surface is frozen or snowy, a specific calculation is omitted, but the amount of change in road surface inclination angle Θ Gn [rad.] (Road surface inclination angular velocity) Δ Θ Change amount of road surface inclination angle Θ Pn [rad.] (Road surface inclination angle velocity) Δ θ Pn [rad. Zs] becomes irregularly smaller than G n [rad. Zs]. This is because the amount of change in road inclination angle Θ Pn [rad.] (Road inclination angle velocity) ΔΘ Pn [rad. Zs] when calculating vehicle speed pulse speed VPn [m / s] as described in steps S857 and S858 ] (Vehicle speed pulse acceleration) ΔVPn [m / s 2 ]. For example, the amount of change in the road slope angle Θ Pn [rad.] Calculated in step S805 (road slope angular velocity) Δ Θ Pn [rad. Zs] standard deviation 0 Pr ^ “l. 6≤standard deviation | 8 If “0 Pn” (step S860: Yes), the fifth freezing snow condition on the downhill road surface is satisfied, and the process proceeds to step S861. On the other hand, if it is not “1.6 ≤ standard deviation j8 θ Pn” (step S860: No), the process proceeds to step S876.
[0142] ステップ S860によって、「1. 6≤標準偏差 |8 0 Pn」でないと判断された場合 (ステ ップ S860 :No)、もしく ίまステップ S875によって、「7u /90[rad. ]≤ ( Θ Gn— θ Pn )」と判断された場合 (ステップ S875 :Yes)は、続いて、第 2標準偏差判定部 716によ つて、 1. 2≤標準偏差 |8 Θ Ρηであるか否かを判断する (ステップ S876)。このステツ プ S876では、ステップ S805でサンプリング数 50個のリングバッファ 1702により算出 された路面傾斜角度 Θ Pn[rad. ]の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]の 標準偏差 Θ Pnの大きさを判定する。 [0142] If it is determined by step S860 that it is not “1.6 ≤ standard deviation | 8 0 Pn” (step S860: No), it will be changed to 7u / 90 [rad. ≤ (Θ Gn— θ Pn) '' (step S875: Yes), the second standard deviation judgment unit 716 subsequently determines whether 1.2 ≤ standard deviation | 8 Θ Ρη. (Step S876). In this step S876, the amount of change in the road surface inclination angle Θ Pn [rad.] Calculated by the ring buffer 1702 with 50 samples in step S805 (road surface inclination angular velocity) ΔΘ Pn [rad. Zs] standard deviation Θ Determine the size of Pn.
[0143] ステップ S876では、具体的には、ステップ S860での路面傾斜角度 Θ Pn[rad. ] の変化量 (路面傾斜角速度) Δ Θ Pn[rad. Zs]の標準偏差 j8 Θ Pnのパラメータを 例えば 4分の 3にする。これは走行中の降坂路面傾斜角度 Θ Pn[rad. ]がステップ S 860よりも緩やかな降坂路面か或いは平坦に近い降坂路面の凍結状態や積雪状態 を判定するためである。例えば、その路面傾斜角度 Θ Pn[rad. ]の変化量 (路面傾 斜角速度) Δ Θ Pn[rad. Zs]の標準偏差 j8 0 ?11が「1. 2≤標準偏差 Θ Ρη」であ る場合 (ステップ S876 :Yes)は、やや降坂'平坦路面の第 5凍結'積雪条件を満たし 、ステップ S877の処理へ移行する。一方、「1. 2≤標準偏差 |8 0 Pn」でない場合( ステップ S876 :No)は、ステップ S890の処理へ移行する。 [0143] In step S876, specifically, the amount of change in road slope angle Θ Pn [rad.] In step S860 (road slope angular velocity) ΔΘ Pn [rad. Zs] standard deviation j8 Θ Pn parameter For example, 3/4. This is to determine whether the downhill road surface slope angle Θ Pn [rad.] Is lower than that of step S860 or whether the downhill road surface is almost flat or frozen. For example, the amount of change in the road surface inclination angle Θ Pn [rad.] (Road surface inclination angle velocity) ΔΘ Pn [rad. Zs] standard deviation j8 0 to 11 is “1.2 ≤ standard deviation Θ Ρη” If this is the case (step S876: Yes), it slightly satisfies the downhill “fifth freezing” snow condition on a flat road, and the process proceeds to step S877. On the other hand, if “1.2 ≦ standard deviation | 8 0 Pn” is not satisfied (step S876: No), the process proceeds to step S890.
[0144] ステップ S813によって、「1. 8≤標準偏差 |8 0 Pn」であると判断された場合 (ステツ プ S813 :Yes)は、つぎに、条件カウンタ判定部 717によって、条件 1成立カウンタ = 5秒間(50回)であるか否かを判断する(ステップ S814)。このステップ S814では、第 1〜第 5の凍結 ·積雪条件 1 (速度差、加速度差、標準偏差 1 (= 分散 1)、路面傾 斜角度差および標準偏差 2 (= 分散 2) )がサンプリング期間 λ Τの例えば 5秒間( 例えば、サンプリング周期 T: 100ms、サンプリング数え:50回)、成立しているかどう 力を監視するカウンタである。  [0144] If it is determined in step S813 that "1.8 ≤ standard deviation | 8 0 Pn" (step S813: Yes), the condition counter determination unit 717 then sets the condition 1 establishment counter = It is determined whether or not it is 5 seconds (50 times) (step S814). In this step S814, the first to fifth frozen / snow conditions 1 (speed difference, acceleration difference, standard deviation 1 (= variance 1), road slope angle difference and standard deviation 2 (= variance 2)) are sampled. This is a counter that monitors the power of λ 例 え ば for example for 5 seconds (for example, sampling period T: 100 ms, sampling count: 50 times).
[0145] ステップ S814では、路面傾斜角度 Θ Pn[rad. ]の登坂路面を走行中に第 1〜第 5 の凍結 ·積雪条件 1が 5秒間(50回)、成立しているかどうかを監視している。例えば、 そのカウンタが「条件 1成立カウンタ = 5秒間(50回)」である場合 (ステップ S814: Ye s)は、ステップ S815の処理へ移行する。一方、「条件 1成立カウンタ = 5秒間(50回) 」でない場合 (ステップ S814 : No)は、ステップ S824の処理へ移行する。  [0145] In step S814, it is monitored whether the 1st to 5th freezing / snow condition 1 is satisfied for 5 seconds (50 times) while traveling on an uphill road surface with a road surface inclination angle Θ Pn [rad. ing. For example, when the counter is “Condition 1 Satisfaction Counter = 5 seconds (50 times)” (step S814: Yes), the process proceeds to step S815. On the other hand, if “condition 1 establishment counter = 5 seconds (50 times)” is not satisfied (step S814: No), the process proceeds to step S824.
[0146] ステップ S829によって、「1. 35≤標準偏差 0 Ρη」であると判断された場合 (ステ ップ S829 :Yes)は、つぎに、条件カウンタ判定部 717によって、条件 2成立カウンタ = 5秒間(50回)であるか否かを判断する(ステップ S830)。このステップ S830では、 第 1〜第 5の凍結 ·積雪条件 2 (速度差、加速度差、標準偏差 1 (= 分散 1)、路面 傾斜角度差および標準偏差 2 (= 分散 2) )がサンプリング期間 λ Τの例えば 5秒間 (例えば、サンプリング周期 T: 100ms、サンプリング数え:50回)、成立しているかど うかを監視するカウンタとなる。  [0146] If it is determined in step S829 that "1.35≤standard deviation 0 Ρη" (step S829: Yes), then the condition counter determination unit 717 next sets the condition 2 establishment counter = 5 It is determined whether it is a second (50 times) (step S830). In this step S830, the first to fifth frozen / snow conditions 2 (speed difference, acceleration difference, standard deviation 1 (= variance 1), road surface inclination angle difference and standard deviation 2 (= variance 2)) For example, it is a counter that monitors whether it has been established for 5 seconds (eg, sampling period T: 100 ms, sampling count: 50 times).
[0147] ステップ S830では、路面傾斜角度 Θ Pn[rad. ]がステップ S814よりも緩やかな登 坂路面か或いは平坦に近い登坂路面を走行中に第 1〜第 5の凍結 ·積雪条件 2が 5 秒間(50回)、成立しているかどうかを監視している。例えば、そのカウンタが「条件 2 成立カウンタ = 5秒間(50回)」である場合 (ステップ S830 : Yes)は、ステップ S831 の処理へ移行する。一方、「条件 2成立カウンタ = 5秒間(50回)」でな 、場合 (ステツ プ S830 :No)は、ステップ S840の処理へ移行する。 [0147] In Step S830, the first to fifth freezing / snow coverage conditions 2 are 5 while traveling on an uphill road surface where the road surface inclination angle Θ Pn [rad. It is monitored whether it is established for 50 seconds. For example, if the counter is “Condition 2 Satisfaction Counter = 5 seconds (50 times)” (step S830: Yes), the process proceeds to step S831. On the other hand, if “Condition 2 satisfaction counter = 5 seconds (50 times)” is not satisfied (step S830: No), the process proceeds to step S840.
[0148] ステップ S860によって、「1. 6≤標準偏差 |8 0 Pn」であると判断された場合 (ステツ プ S860 :Yes)は、続いて、条件カウンタ判定部 717によって、条件 3成立カウンタ = 5秒間(50回)であるか否かを判断する(ステップ S861)。このステップ S861では、第 1〜第 5の凍結 ·積雪条件 3 (速度差、加速度差、標準偏差 1 (= 分散 1)、路面傾 斜角度差および標準偏差 2 (= 分散 2) )がサンプリング期間 λ Τの例えば 5秒間( 例えば、サンプリング周期 T: 100ms、サンプリング数え:50回)、成立しているかどう 力を監視するカウンタである。  [0148] If it is determined in step S860 that "1.6 ≤ standard deviation | 8 0 Pn" (step S860: Yes), then condition counter determination unit 717 sets condition 3 establishment counter = It is determined whether or not it is 5 seconds (50 times) (step S861). In this step S861, the first to fifth frozen / snow conditions 3 (speed difference, acceleration difference, standard deviation 1 (= variance 1), road slope angle difference and standard deviation 2 (= variance 2)) are sampled. This is a counter that monitors the power of λ 例 え ば for example for 5 seconds (for example, sampling period T: 100 ms, sampling count: 50 times).
[0149] ステップ S861では、路面傾斜角度 Θ Pn[rad. ]の降坂路面を走行中に第 1〜第 5 の凍結 ·積雪条件 3が 5秒間(50回)、成立しているかどうかを監視している。例えば、 そのカウンタが「条件 3成立カウンタ = 5秒間(50回)」である場合 (ステップ S861 : Ye s)は、ステップ S862の処理へ移行する。一方、「条件 3成立カウンタ = 5秒間(50回) 」でない場合 (ステップ S861 :No)は、ステップ S871の処理へ移行する。  [0149] In step S861, monitoring whether the 1st to 5th freezing and snow conditions 3 are satisfied for 5 seconds (50 times) while traveling on a downhill road surface with a road surface inclination angle Θ Pn [rad.] is doing. For example, if the counter is “Condition 3 Satisfaction Counter = 5 seconds (50 times)” (step S861: Yes), the process proceeds to step S862. On the other hand, if it is not “Condition 3 satisfaction counter = 5 seconds (50 times)” (step S861: No), the process proceeds to step S871.
[0150] 最後に、ステップ S876によって、「1. 2≤標準偏差 |8 θ Pn」であると判断された場 合 (ステップ S876 :Yes)は、つぎに、条件カウンタ判定部 717によって、条件 4成立 カウンタ = 5秒間(50回)であるか否かを判断する(ステップ S877)。このステップ S8 77では、第 1〜第 5の凍結 ·積雪条件 4 (速度差、加速度差、標準偏差 1 (= 分散 1 )、路面傾斜角度差および標準偏差 2 (= 分散 2) )がサンプリング期間 λ Τの例え ば 5秒間(例えば、サンプリング周期 T: 100ms、サンプリング数え:50回)、成立して V、るかどうかを監視するカウンタである。  [0150] Finally, if it is determined in step S876 that “1.2 ≤ standard deviation | 8 θ Pn” (step S876: Yes), then the condition counter determination unit 717 executes condition 4 It is determined whether or not the establishment counter = 5 seconds (50 times) (step S877). In this step S8 77, the first to fifth frozen / snow conditions 4 (speed difference, acceleration difference, standard deviation 1 (= variance 1), road surface inclination angle difference and standard deviation 2 (= variance 2)) are sampled. For example, λ カ ウ ン タ is a counter that monitors whether it is V for 5 seconds (for example, sampling period T: 100 ms, sampling count: 50 times).
[0151] ステップ S877では、路面傾斜角度 Θ Pn[rad. ]がステップ S861よりも緩やかな降 坂路面か或いは平坦に近い降坂路面を走行中に第 1〜第 5の凍結 ·積雪条件 4が 5 秒間(50回)、成立しているかどうかを監視している。例えば、カウンタが「条件 4成立 カウンタ = 5秒間(50回)」である場合 (ステップ S877: Yes)は、ステップ S878の処 理へ移行する。一方、「条件 4成立カウンタ = 5秒間(50回)」でな 、場合 (ステップ S8 77 : No)は、ステップ S887の処理へ移行する。 [0151] In step S877, the road surface inclination angle Θ Pn [rad.] Is lower than that in step S861, or the first to fifth freezing / snow conditions 4 are It is monitored for 5 seconds (50 times). For example, if the counter is “Condition 4 Satisfaction Counter = 5 seconds (50 times)” (step S877: Yes), the process proceeds to step S878. On the other hand, if “Condition 4 Satisfaction Counter = 5 seconds (50 times)” (Step S8 77: No) shifts to the processing of step S887.
[0152] ステップ S802によって「外気温 Toutn≤ 10°C」でな ヽと判断された場合 (ステップ S802 :No)、ステップ S825によって「2. 0[kmZh]≤ (VPPn— VGGn)」でないと 判断された場合 (ステップ S825 :No)、ステップ S826によって「0. 2[m/s2]≤ ( AV Pn- AVGn)」でないと判断された場合 (ステップ S826 :No)、ステップ S827によつ て「1. 35≤標準偏差ひ Pn」でないと判断された場合 (ステップ S827 : No)、ステップ S828によって「 Z72[rad. ]≤( θ Ρη— Θ Gn)」でないと判断された場合 (ステツ プ S828 :No)、もしくはステップ S829によって「1. 35≤標準偏差 j8 0 Pn」でな!/、と 判断された場合 (ステップ S829 : No)は、つぎに、外気温判定部 702と警告通知有 無フラグ判定部 718によって、警告 1通知有無フラグ = 1である力否かを判断する (ス テツプ S842)。 [0152] If it is determined in step S802 that “outside temperature Toutn ≤ 10 ° C” is not satisfied (step S802: No), it is determined in step S825 that it is not “2.0 [kmZh] ≤ (VPPn—VGGn)”. (Step S825: No), if it is determined by Step S826 that “0.2 [m / s 2 ] ≤ (AV Pn- AVGn)” is not satisfied (Step S826: No), then step S827 If it is determined that it is not “1.35≤standard deviation PPn” (step S827: No), if it is determined by step S828 that it is not “Z72 [rad.] ≤ (θ Ρη—ΘGn)” (step S828: No), or if it is determined in step S829 that `` 1.35≤standard deviation j8 0 Pn '' is not! / (Step S829: No), then the outside air temperature determination unit 702 and warning notification The non-flag determining unit 718 determines whether or not the warning 1 notification presence / absence flag is 1 (step S842).
[0153] このステップ S842では、「警告 1通知有無フラグ」が" 1"にセットされている力否かを チェックする。その結果により「警告 1通知有無フラグ」が" 1"にセットされている場合( ステップ S842 :Yes)は、登坂路面を走行中の第 1〜第 5の凍結'積雪条件 1或いは やや登坂'平坦路面を走行中の第 1〜第 5の凍結'積雪条件 2のいずれか一方が 5 秒間(50回)、解除している力否かを監視するステップ S844の処理へ移行する。一 方、「警告 1通知有無フラグ」が" 1"にセットされて ヽな 、場合 (ステップ S842: No)は 、ステップ S843の処理へ移行する。  In this step S842, it is checked whether or not the “Warning 1 notification presence / absence flag” is set to “1”. As a result, if the “Warning 1 Notification Flag” is set to “1” (Step S842: Yes), the 1st to 5th frozen 'snow conditions 1 or slightly uphill' running on the uphill road surface will be flat. The process proceeds to step S844 for monitoring whether one of the first to fifth freezing / snow accumulation conditions 2 running on the road surface is released for 5 seconds (50 times). On the other hand, if the “warning 1 notification presence / absence flag” is set to “1” (step S842: No), the process proceeds to step S843.
[0154] ステップ S842によって、「警告 1通知有無フラグ」が" 1"にセットされていないと判断 された場合 (ステップ S842 :No)は、つぎに、外気温判定部 702と警告通知有無フラ グ判定部 718によって、警告 2通知有無フラグ = 1である力否かを判断する (ステップ S843)。このステップ S843では、「警告 2通知有無フラグ」が" 1"にセットされている か否かをチェックする。その結果により「警告 2通知有無フラグ」が" 1"にセットされて いる場合 (ステップ S843 :Yes)は、登坂路面を走行中の第 1〜第 5の凍結'積雪条 件 1或いはやや登坂'平坦路面を走行中の第 1〜第 5の凍結'積雪条件 2のいずれ か一方が 5秒間(50回)、解除しているか否かを監視するステップ S844の処理へ移 行する。一方、「警告 2通知有無フラグ」が" 1"にセットされていない場合 (ステップ S8 43 : No)は、ステップ S888の処理へ移行する。 [0155] ステップ S802によって「外気温 Toutn≤ 10°C」でな ヽと判断された場合 (ステップ S802 :No)、ステップ S872によって「1. 5[kmZh]≤ (VGGn— VPPn)」でないと 判断された場合 (ステップ S872 :No)、ステップ S873によって「0. 15 [m/s2]≤ ( Δ VGn- AVPn)」でないと判断された場合 (ステップ S873 :No)、ステップ S874によ つて「1. 2≤標準偏差 α Ρη」でないと判断された場合 (ステップ S874 :No)、ステツ プ S875によって「 Z90[rad. ]≤( θ Gn— θ Ρη)」でないと判断された場合 (ステ ップ S875 :No)、もしくはステップ S876によって「1. 2≤標準偏差 j8 0 Pn」でないと 判断された場合 (ステップ S876 : No)は、つぎに、外気温判定部 702と警告通知有 無フラグ判定部 718によって、警告 3通知有無フラグ = 1である力否かを判断する (ス テツプ S890)。 [0154] If it is determined in step S842 that the "warning 1 notification presence / absence flag" is not set to "1" (step S842: No), next, the outside air temperature determination unit 702 and the warning notification presence / absence flag are displayed. Judgment unit 718 judges whether or not the power is warning 2 notification presence flag = 1 (step S843). In this step S843, it is checked whether or not the “Warning 2 notification presence / absence flag” is set to “1”. As a result, if the “Warning 2 Notification Flag” is set to “1” (Step S843: Yes), the 1st to 5th freezing snow conditions 1 or slightly uphill on the uphill road surface The process proceeds to the process of step S844 for monitoring whether one of the first to fifth freezing / snow conditions 2 running on a flat road surface is released for 5 seconds (50 times). On the other hand, if the “warning 2 notification presence / absence flag” is not set to “1” (step S843: No), the process proceeds to step S888. [0155] If it is determined in step S802 that “outside temperature Toutn ≤ 10 ° C” is not satisfied (step S802: No), it is determined in step S872 that it is not “1.5 [kmZh] ≤ (VGGn— VPPn)”. (Step S872: No), step S873 determines that it is not `` 0.15 [m / s 2 ] ≤ (ΔVGn-AVPn) '' (Step S873: No). 1. If it is determined that it is not 2≤standard deviation α ス テ ッ プ η (step S874: No), it is determined that it is not `` Z90 [rad.] ≤ (θ Gn— θ Ρη) '' in step S875 (step S874: No) S875: No), or if it is determined by step S876 that `` 1.2 ≤ standard deviation j8 0 Pn '' is not satisfied (step S876: No), then the outside air temperature determination unit 702 and warning notification flag flag determination Part 718 determines whether or not the power of warning 3 notification presence flag = 1 is set (step S890).
[0156] このステップ S890では、「警告 3通知有無フラグ」が" 1"にセットされているか否かを チェックする。その結果により「警告 3通知有無フラグ」が" 1"にセットされている場合( ステップ S890 :Yes)は、降坂路面を走行中の第 1〜第 5の凍結 ·積雪条件 3或いは やや降坂 ·平坦路面を走行中の第 1〜第 5の凍結 ·積雪条件 4のいずれか一方が 5 秒間(50回)、解除している力否かを監視するステップ S892の処理へ移行する。一 方、「警告 3通知有無フラグ」が" 1"にセットされていない場合 (ステップ S890 :No)は 、ステップ S891の処理へ移行する。  In this step S890, it is checked whether or not the “Warning 3 notification presence / absence flag” is set to “1”. As a result, if the “Warning 3 Notification Flag” is set to “1” (Step S890: Yes), the 1st to 5th freezing / snow conditions 3 or slightly downhill on the downhill road surface · First to fifth freezing on a flat road surface · Snow condition 4 Shifts to the process of step S892 to monitor whether the force is released for 5 seconds (50 times). On the other hand, if the “Warning 3 notification presence / absence flag” is not set to “1” (step S890: No), the process proceeds to step S891.
[0157] ステップ S890によって、「警告 3通知有無フラグ」が" 1"にセットされていないと判断 された場合 (ステップ S890 :No)は、つぎに、外気温判定部 702と警告通知有無フラ グ判定部 718によって、警告 4通知有無フラグ = 1である力否かを判断する (ステップ S891)。このステップ S891では、「警告 4通知有無フラグ」が" 1"にセットされている か否かをチェックする。その結果により「警告 4通知有無フラグ」が" 1"にセットされて いる場合 (ステップ S891 :Yes)は、降坂路面を走行中の第 1〜第 5の凍結'積雪条 件 3或いはやや降坂'平坦路面を走行中の第 1〜第 5の凍結'積雪条件 4のいずれ か一方が 5秒間(50回)、解除しているか否かを監視するステップ S892の処理へ移 行する。一方、「警告 4通知有無フラグ」が" 1"にセットされていない場合 (ステップ S8 91 :No)は、ステップ S904の処理へ移行する。  [0157] If it is determined in step S890 that the "Warning 3 notification presence / absence flag" is not set to "1" (No in step S890), the outside air temperature determination unit 702 and the warning notification presence / absence flag are then used. Judgment unit 718 judges whether or not the power is warning 4 notification presence flag = 1 (step S891). In this step S891, it is checked whether or not the “Warning 4 notification presence / absence flag” is set to “1”. As a result, if the “Warning 4 Notification Flag” is set to “1” (Step S891: Yes), the 1st to 5th freezing snow conditions 3 or slightly falling on the downhill road surface. The process proceeds to step S892 for monitoring whether one of the first to fifth freezing snow conditions 4 running on the hill 'flat road surface' is released for 5 seconds (50 times). On the other hand, when the “warning 4 notification presence / absence flag” is not set to “1” (step S891: No), the process proceeds to step S904.
[0158] ステップ S802にお!/、て、「外気温 Toutn≤ 10°C」でな 、と判断された場合 (ステツ プ S802 :No)は、つぎに、外気温判定部 702と条件カウンタ判定部 717によって、条 件 1成立カウンタ =0および条件 2成立カウンタ =0とする(ステップ S841)。ここでは 6個全ての「条件カウンタ」をゼロ'クリアする。まず、ステップ S841では「条件 1成立力 ゥンタ」および「条件 2成立カウンタ」をゼロ'クリアする。何故ならば、ステップ S802で 「外気温 Toutn≤ 10°C」でない場合 (ステップ S802 :No)になる前に登坂路面を走 行中の第 1〜第 5の凍結'積雪条件 1或いはやや登坂'平坦路面を走行中の第 1〜 第 5の凍結 ·積雪条件 2の成立をカウント(+ 1インクリメント)している途中の場合があ るためである。そして、処理が終了すると、ステップ S842の処理へ移行する。 [0158] In step S802, if it is determined that “outside temperature Toutn ≤ 10 ° C”, In step S802: No), the outside air temperature determination unit 702 and the condition counter determination unit 717 set the condition 1 establishment counter = 0 and the condition 2 establishment counter = 0 (step S841). Here, all six “condition counters” are cleared to zero. First, in step S841, “Condition 1 establishment force counter” and “Condition 2 establishment counter” are cleared to zero. This is because the first to fifth freezing snow conditions 1 or slightly uphill on the uphill road before step S802 becomes “outside temperature Toutn ≤ 10 ° C” (step S802: No). This is because the first to fifth freeze / snow conditions 2 running on a flat road may be counted (+1 increment). Then, when the process ends, the process proceeds to step S842.
[0159] ステップ S842で「警告 1通知有無フラグ = 1」でないと判断された場合 (ステップ S8 42 : No)、且つステップ S843で「警告 2通知有無フラグ = 1」でないと判断された場 合 (ステップ S843 :No)は、つぎに、外気温判定部 702と条件カウンタ判定部 717に よって、条件 1 &2解除カウンタ =0とする (ステップ S888)。ここでは 6個全ての「条件 カウンタ」をゼロ'クリアする。つぎは、「条件 1 &2解除カウンタ」をゼロ'クリアする。何 故ならば、ステップ S802で「外気温 Toutn≤ 10°C」でな 、場合 (ステップ S802: No )になる前に登坂路面を走行中の第 1〜第 5の凍結'積雪条件 1或いはやや登坂'平 坦路面を走行中の第 1〜第 5の凍結'積雪条件 2の解除をカウント(+ 1インクリメント) している途中の場合があるためである。そして、処理が終了すると、ステップ S889の 処理へ移行する。 [0159] If it is determined in step S842 that "Warning 1 notification presence flag = 1" is not satisfied (step S84: No), and if it is determined in step S843 that "Warning 2 notification presence flag is not equal to 1" ( Next, in step S843: No), the outside air temperature determination unit 702 and the condition counter determination unit 717 set the condition 1 & 2 release counter = 0 (step S888). Here, all six “condition counters” are cleared to zero. Next, clear “Condition 1 & 2 Cancel Counter” to zero. This is because, if “outside air temperature Toutn ≤ 10 ° C” is not satisfied in step S802, the first to fifth freezing snow conditions 1 or slightly while driving on the uphill road surface before becoming the case (step S802: No). This is because the release of the 1st to 5th freezing snow conditions 2 while traveling on the uphill 'Taira road surface is being counted (+1 increment). Then, when the process ends, the process shifts to the process of step S889.
[0160] ステップ S888の処理が終了すると、つぎに、外気温判定部 702と条件カウンタ判 定部 717によって、条件 3成立カウンタ =0および条件 4成立カウンタ =0とする (ステ ップ S889)。ここでは 6個全ての「条件カウンタ」をゼロ'クリアする。続いては、「条件 3成立カウンタ」および「条件 4成立カウンタ」をゼロ'クリアする。何故ならば、ステップ S802で「外気温 Toutn≤ 10°C」でない場合 (ステップ S802 :No)になる前に降坂路 面を走行中の第 1〜第 5の凍結'積雪条件 3或いはやや降坂'平坦路面を走行中の 第 1〜第 5の凍結'積雪条件 4の成立をカウント(+ 1インクリメント)している途中の場 合があるためである。そして、処理が終了すると、ステップ S890の処理へ移行する。  [0160] When the process of step S888 ends, the outside air temperature determination unit 702 and the condition counter determination unit 717 set the condition 3 satisfaction counter = 0 and the condition 4 satisfaction counter = 0 (step S889). Here, all six “condition counters” are cleared to zero. Next, “Condition 3 Satisfaction Counter” and “Condition 4 Satisfaction Counter” are cleared to zero. This is because the first to fifth freezing snow conditions 3 or slightly downhill on the downhill road before becoming “outside temperature Toutn ≤ 10 ° C” in step S802 (step S802: No). This is because there may be cases where the first to fifth freezing snow conditions 4 running on a flat road are being counted (+1 increment). Then, when the process ends, the process proceeds to step S890.
[0161] ステップ S890で「警告 3通知有無フラグ = 1」でないと判断された場合 (ステップ S8 90 : No)、且つステップ S891で「警告 4通知有無フラグ = 1」でないと判断された場 合 (ステップ S891 :No)は、つぎに、外気温判定部 702と条件カウンタ判定部 717に よって、条件 3 & 4解除カウンタ =0とする(ステップ S904)。ここでは 6個全ての「条件 カウンタ」をゼロ'クリアする。最後は、「条件 3 & 4解除カウンタ」をゼロ'クリアする。何 故ならば、ステップ S802で「外気温 Toutn≤ 10°C」でな 、場合 (ステップ S802: No )になる前に降坂路面を走行中の第 1〜第 5の凍結'積雪条件 3或いはやや降坂'平 坦路面を走行中の第 1〜第 5の凍結'積雪条件 4の解除をカウント(+ 1インクリメント) している途中の場合があるためである。そして、処理が終了すると、そのまま一連の 処理を終了する。 [0161] If it is determined in step S890 that "Warning 3 notification presence flag = 1" is not satisfied (step S8 90: No), and if it is determined in step S891 that "Warning 4 notification presence flag is not 1" Next, the condition 3 & 4 release counter is set to 0 by the outside air temperature determination unit 702 and the condition counter determination unit 717 (step S904). Here, all six “condition counters” are cleared to zero. Finally, clear “Condition 3 & 4 Cancel Counter” to zero. This is because, if “outside air temperature Toutn ≤ 10 ° C” is not satisfied in step S802, the first to fifth freezing snow conditions 3 or on the downhill road before becoming the case (step S802: No). This is because the release of the first to fifth freezing snow conditions 4 running on a slightly downhill flat road surface is being counted (+1 increment) in some cases. When the process ends, the series of processes ends.
[0162] まず、ステップ S842によって、「警告 1通知有無フラグ」が" 1"にセットされていると 判断された場合 (ステップ S842 : Yes)、もしくはステップ S843によって、「警告 2通知 有無フラグ」が" 1"にセットされていると判断された場合 (ステップ S843 :Yes)、つぎ に、条件カウンタ判定部 717によって、条件 1 &2解除カウンタ = 5秒間(50回)であ る力否かを判断する (ステップ S844)。このステップ S844では、第 1〜第 5の凍結'積 雪条件 1或いは条件 2 (速度差、加速度差、標準偏差 1 (= 分散 1)、路面傾斜角度 差および標準偏差 2 (= 分散 2) )がサンプリング期間 λ Τの例えば 5秒間(例えば、 サンプリング周期 T: 100ms、サンプリング数え:50回)、解除しているかどうかを監視 するカウンタである。  [0162] First, if it is determined in step S842 that the "Warning 1 notification presence / absence flag" is set to "1" (step S842: Yes), or in step S843, the "Warning 2 notification presence / absence flag" is set. If it is determined that it is set to “1” (step S843: Yes), then the condition counter determination unit 717 determines whether the force is condition 1 & 2 release counter = 5 seconds (50 times). (Step S844). In this step S844, the first to fifth frozen snow conditions 1 or 2 (speed difference, acceleration difference, standard deviation 1 (= variance 1), road slope angle difference and standard deviation 2 (= variance 2)) Is a counter that monitors whether it has been released for 5 seconds (eg, sampling period T: 100 ms, sampling count: 50 times) during the sampling period λΤ.
[0163] このステップ S844では、ステップ S814の路面傾斜角度 Θ Pn[rad. ]の登坂路面 力 路面傾斜角度 Θ Pn[rad. ]がステップ S814よりも緩やかな登坂路面か或いは平 坦に近い登坂路面か、もしくは路面傾斜角度 Θ Pn[rad. ]がステップ S830よりも緩 やかな登坂路面か或いは平坦に近い登坂路面を走行中に第 1〜第 5の凍結,積雪 条件 1或いは条件 2が 5秒間(50回)、解除しているかどうかを監視している。例えば、 そのカウンタが「条件 1 &2解除カウンタ = 5秒間(50回)」である場合 (ステップ S844 : Yes)は、ステップ S845の処理へ移行する。一方、「条件 1 &2解除カウンタ = 5秒 間(50回)」でない場合 (ステップ S844 : No)は、ステップ S855の処理へ移行する。  [0163] In this step S844, the uphill road surface force of the road surface inclination angle Θ Pn [rad.] In step S814 The uphill road surface where the road surface inclination angle Θ Pn [rad.] Is gentler than that of step S814 or close to flat Or the slope angle Θ Pn [rad.] Is a gentle uphill road surface than step S830, or the first to fifth freezing and snow accumulation conditions 1 or 2 while running on an uphill road surface that is nearly flat for 5 seconds. (50 times), monitoring whether it is released. For example, if the counter is “Condition 1 & 2 cancellation counter = 5 seconds (50 times)” (step S844: Yes), the process proceeds to step S845. On the other hand, if it is not “Condition 1 & 2 cancellation counter = 5 seconds (50 times)” (step S844: No), the process proceeds to step S855.
[0164] つぎは、ステップ S890によって、「警告 3通知有無フラグ」が" 1"にセットされている と判断された場合 (ステップ S890 : Yes)、もしくはステップ S891によって、「警告 4通 知有無フラグ」が" 1"にセットされていると判断された場合 (ステップ S891: Yes)、つ ぎに、条件カウンタ判定部 717によって、条件 3 & 4解除カウンタ = 5秒間(50回)で あるか否かを判断する(ステップ S892)。このステップ S892では、第 1〜第 5の凍結' 積雪条件 3或いは条件 4 (速度差、加速度差、標準偏差 1 (= 分散 1)、路面傾斜角 度差および標準偏差 2 (= 分散 2) )がサンプリング期間 λ Τの例えば 5秒間 (例え ば、サンプリング周期 T: 100ms、サンプリング数え:50回)、解除しているかどうかを 監視するカウンタである。 [0164] Next, when it is determined in step S890 that the "Warning 3 Notification Presence / Absence Flag" is set to "1" (Step S890: Yes), or in Step S891, the "Warning 4 Notification Presence / Absence Flag" is set. "" Is set to "1" (step S891: Yes), Then, the condition counter determination unit 717 determines whether or not the condition 3 & 4 release counter = 5 seconds (50 times) (step S892). In this step S892, the first to fifth frozen snow conditions 3 or 4 (speed difference, acceleration difference, standard deviation 1 (= variance 1), road surface inclination angle difference and standard deviation 2 (= variance 2)) Is a counter that monitors whether or not the sampling period λΤ has been released, for example, for 5 seconds (for example, sampling period T: 100 ms, sampling count: 50 times).
[0165] このステップ S892では、ステップ S861の路面傾斜角度 Θ Pn[rad. ]の降坂路面 力 路面傾斜角度 Θ Pn[rad. ]がステップ S861よりも緩やかな降坂路面か或いは平 坦に近い降坂路面か、もしくは路面傾斜角度 Θ Pn[rad. ]がステップ S877よりも緩 やかな降坂路面か或いは平坦に近い降坂路面を走行中に第 1〜第 5の凍結 '積雪 条件 3或いは条件 4が 5秒間(50回)、解除しているかどうかを監視している。例えば、 そのカウンタが「条件 3 & 4解除カウンタ = 5秒間(50回)」である場合 (ステップ S892 : Yes)は、ステップ S893の処理へ移行する。一方、「条件 3 & 4解除カウンタ = 5秒 間(50回)」でな!/、場合 (ステップ S892: No)は、ステップ S 903の処理へ移行する。  [0165] In step S892, the downhill road force of road slope angle Θ Pn [rad.] In step S861 The road slope angle Θ Pn [rad.] Is a gentle downhill road surface or closer to flat than in step S861. The first to fifth frozen snow conditions 3 or while running on a downhill road surface or a downhill road surface whose slope angle Θ Pn [rad. Whether condition 4 is released for 5 seconds (50 times) is monitored. For example, if the counter is “condition 3 & 4 cancellation counter = 5 seconds (50 times)” (step S892: Yes), the process proceeds to step S893. On the other hand, if “condition 3 & 4 release counter = 5 seconds (50 times)”! /, (Step S892: No), the process proceeds to step S903.
[0166] まず、ステップ S814によって、路面傾斜角度 Θ Pn[rad. ]の登坂路面を走行中に 第 1〜第 5の凍結 ·積雪条件 1が成立(「条件 1成立カウンタ = 5秒間(50回)」)してい ると判断された場合 (ステップ S814 : Yes)、つぎに、条件カウンタ判定部 717によつ て、条件 1成立カウンタ =0とし、新たに最初から走行路面の状況判定を開始する (ス テツプ S815)。  [0166] First, in step S814, the first to fifth freeze / snow conditions 1 are satisfied while traveling on the uphill road surface at the road surface inclination angle Θ Pn [rad.] ("Condition 1 establishment counter = 5 seconds (50 times ) ”) (Step S814: Yes), then the condition counter determination unit 717 sets the condition 1 establishment counter = 0, and newly starts the road surface condition determination from the beginning. Yes (Step S815).
[0167] このステップ S815では、ステップ S814で路面傾斜角度 Θ Pn[rad. ]の登坂路面 を走行中に第 1〜第 5の凍結 ·積雪条件 1が「条件 1成立カウンタ = 5秒間(50回)」で 成立して ヽると判断された場合 (ステップ S814: Yes)、「条件 1成立カウンタ」をゼロ · クリアする。何故ならば、次回から路面傾斜角度 Θ P[rad. ]の登坂或いは降坂路面 を走行中に第 1〜第 5の凍結'積雪条件 1、条件 2、条件 3或いは条件 4のいずれ力ゝ 一つが 5秒間(50回)成立していると判断された場合 (ステップ S814、ステップ S830 、ステップ S861或いはステップ S877のいずれか一つ: Yes)、路面状況は刻々と変 化していることから、毎回「条件 1成立カウンタ =0秒間(0回)」にすることで、新たに 最初から走行路面の状況判定を開始できるようにするためである。そして、ステップ S 816の処理へ移行する。 [0167] In this step S815, the 1st to 5th freeze / snow condition 1 is set to "Condition 1 Satisfaction Counter = 5 seconds (50 times) while traveling on the uphill road surface at the road surface inclination angle Θ Pn [rad. ) ”Is determined to be satisfied (Step S814: Yes),“ Condition 1 Satisfaction Counter ”is cleared to zero. This is because the first to fifth freezing snow conditions 1, condition 2, condition 3, or condition 4 will be the same during the uphill or downhill road surface with the road surface inclination angle Θ P [rad.] From the next time. When it is determined that the vehicle has been established for 5 seconds (50 times) (Step S814, Step S830, Step S861 or Step S877: Yes), the road surface condition is changing every moment. This is to make it possible to newly start the road surface condition determination from the beginning by setting “Condition 1 Satisfaction Counter = 0 seconds (0 times)”. And step S Move to 816 processing.
[0168] つぎは、ステップ S830によって、路面傾斜角度 Θ Pn[rad. ]がステップ S814よりも 緩やかな登坂路面か或いは平坦に近い登坂路面を走行中に第 1〜第 5の凍結 '積 雪条件 2が成立(「条件 2成立カウンタ = 5秒間(50回)」)して 、ると判断された場合 ( ステップ S830 : Yes)、つぎに、条件カウンタ判定部 717によって、条件 2成立カウン タ =0とし、新たに最初から走行路面の状況判定を開始する (ステップ S831)。  [0168] Next, in Step S830, the 1st to 5th freezing snow conditions when the road surface inclination angle Θ Pn [rad.] Is traveling on a gentle uphill road surface that is gentler or flatter than in Step S814. 2 is satisfied ("Condition 2 Satisfaction Counter = 5 seconds (50 times)") (Step S830: Yes), then Condition Counter Determination Unit 717 causes Condition 2 Satisfaction Counter = A new road surface condition determination is started from the beginning (step S831).
[0169] このステップ S831では、ステップ S830で路面傾斜角度 Θ Pn[rad. ]がステップ S8 14よりも緩やかな登坂路面か或いは平坦に近い登坂路面を走行中に第 1〜第 5の 凍結'積雪条件 2が「条件 2成立カウンタ = 5秒間(50回)」で成立していると判断され た場合 (ステップ S830 :Yes)、「条件 2成立カウンタ」をゼロ'クリアする。何故ならば、 次回から路面傾斜角度 Θ P[rad. ]の登坂或いは降坂路面を走行中に第 1〜第 5の 凍結'積雪条件 1、条件 2、条件 3或いは条件 4のいずれか一つが 5秒間(50回)、成 立していると判断された場合 (ステップ S814、ステップ S830、ステップ S861或いは ステップ S877のいずれか一つ: Yes)、路面状況は刻々と変化していることから、毎 回「条件 2成立カウンタ =0秒間(0回)」にすることで、新たに最初から走行路面の状 況判定を開始できるようにするためである。そして、ステップ S832の処理へ移行する  [0169] In this step S831, the first to fifth frozen snowfalls are carried out while traveling on an uphill road surface in which the road surface inclination angle Θ Pn [rad.] Is gentler or flatter than in step S814 in step S830. If it is determined that Condition 2 is satisfied with “Condition 2 Satisfaction Counter = 5 seconds (50 times)” (step S830: Yes), “Condition 2 Satisfaction Counter” is cleared to zero. This is because any one of the 1st to 5th freezing snow conditions 1, condition 2, condition 3 or condition 4 while running on an uphill or downhill road surface with a road surface inclination angle Θ P [rad. If it is determined that it has been established for 5 seconds (50 times) (Step S814, Step S830, Step S861 or Step S877: Yes), the road surface condition changes every moment. By setting “Condition 2 Satisfaction Counter = 0 seconds (0 times)” each time, it is possible to newly start the road surface condition determination from the beginning. Then, the process proceeds to step S832.
[0170] 続いて、ステップ S861によって、路面傾斜角度 Θ Pn[rad. ]の降坂路面を走行中 に第 1〜第 5の凍結'積雪条件 3が成立(「条件 3成立カウンタ = 5秒間(50回)」)して いると判断された場合 (ステップ S861 : Yes)、つぎに、条件カウンタ判定部 717によ つて、条件 3成立カウンタ =0とし、新たに最初から走行路面の状況判定を開始する( ステップ S862)。 [0170] Subsequently, in step S861, the first to fifth frozen / snow conditions 3 are satisfied while traveling on the downhill road surface at the road surface inclination angle Θ Pn [rad.] ("Condition 3 satisfaction counter = 5 seconds ( 50)))) (step S861: Yes), the condition counter determination unit 717 then sets the condition 3 establishment counter to = 0 and newly determines the road surface condition from the beginning. Start (step S862).
[0171] このステップ S862では、ステップ S861で路面傾斜角度 Θ Pn[rad. ]の降坂路面 を走行中に第 1〜第 5の凍結 ·積雪条件 3が「条件 3成立カウンタ = 5秒間(50回)」で 成立していると判断された場合 (ステップ S861: Yes)、「条件 3成立カウンタ」をゼロ' クリアする。何故ならば、次回から路面傾斜角度 Θ P[rad. ]の登坂或いは降坂路面 を走行中に第 1〜第 5の凍結'積雪条件 1、条件 2、条件 3或いは条件 4のいずれ力ゝ 一つが 5秒間(50回)、成立していると判断された場合 (ステップ S814、ステップ S83 0、ステップ S861或いはステップ S877のいずれか一つ: Yes)、路面状況は刻々と 変化していることから、毎回「条件 3成立カウンタ =0秒間(0回)」にすることで、新た に最初力も走行路面の状況判定を開始できるようにするためである。そして、ステップ S863の処理へ移行する。 [0171] In this step S862, the 1st to 5th freezing / snow coverage conditions 3 are expressed as “Condition 3 establishment counter = 5 seconds (50 seconds) while traveling on the downhill road surface with the road surface inclination angle Θ Pn [rad.] In step S861. If it is determined that the condition is satisfied (step S861: Yes), “Condition 3 satisfaction counter” is cleared to zero. This is because the first to fifth freezing snow conditions 1, condition 2, condition 3, or condition 4 will be the same during the uphill or downhill road surface with the road surface inclination angle Θ P [rad.] From the next time. Is determined to have been established for 5 seconds (50 times) (Step S814, Step S83) 0, one of step S861 or step S877: Yes) Since the road surface condition is changing every moment, every time “Condition 3 satisfaction counter = 0 seconds (0 times)”, a new first This is also because the force can start the situation determination of the traveling road surface. Then, the process proceeds to step S863.
[0172] 最後に、ステップ S877によって、路面傾斜角度 Θ Pn[rad. ]がステップ S861よりも 緩やかな降坂路面か或いは平坦に近い降坂路面を走行中に第 1〜第 5の凍結 '積 雪条件 4が成立(「条件 4成立カウンタ = 5秒間(50回)」)して ヽると判断された場合 ( ステップ S877 : Yes)、つぎに、条件カウンタ判定部 717によって、条件 4成立カウン タ =0とし、新たに最初から走行路面の状況判定を開始する (ステップ S878)。  [0172] Finally, in step S877, the first to fifth freezing products are accumulated while the road surface inclination angle Θ Pn [rad.] Is traveling on a gentle downhill road surface that is gentler or flatter than in step S861. If it is determined that the snow condition 4 is satisfied ("Condition 4 satisfaction counter = 5 seconds (50 times)") (step S877: Yes), then the condition counter determination unit 717 causes the condition 4 satisfaction counter to count. The road surface condition determination is newly started from the beginning (step S878).
[0173] このステップ S878では、ステップ S877で路面傾斜角度 Θ Pn[rad. ]がステップ S8 61よりも緩や力な降坂路面か或いは平坦に近い降坂路面を走行中に第 1〜第 5の 凍結 ·積雪条件 4が「条件 4成立カウンタ = 5秒間(50回)」で成立していると判断され た場合 (ステップ S877 :Yes)、「条件 4成立カウンタ」をゼロ'クリアする。何故ならば、 次回から路面傾斜角度 Θ P[rad. ]の登坂或いは降坂路面を走行中に第 1〜第 5の 凍結'積雪条件 1、条件 2、条件 3或いは条件 4のいずれか一つが 5秒間(50回)、成 立していると判断された場合 (ステップ S814、ステップ S830、ステップ S861或いは ステップ S877のいずれか一つ: Yes)、路面状況は刻々と変化していることから、毎 回「条件 4成立カウンタ =0秒間(0回)」にすることで、新たに最初から走行路面の状 況判定を開始できるようにするためである。そして、ステップ S879の処理へ移行する  [0173] In this step S878, the road surface inclination angle Θ Pn [rad.] Is lower than that of step S8 61 in step S877, or the first to fifth during traveling on the downhill road surface that is nearly flat. If it is determined that the condition 4 Freezing / Snow Coverage Condition 4 is satisfied with “Condition 4 Satisfaction Counter = 5 seconds (50 times)” (Step S877: Yes), clear “Condition 4 Satisfaction Counter” to zero. This is because any one of the 1st to 5th freezing snow conditions 1, condition 2, condition 3 or condition 4 while running on an uphill or downhill road surface with a road surface inclination angle Θ P [rad. If it is determined that it has been established for 5 seconds (50 times) (Step S814, Step S830, Step S861 or Step S877: Yes), the road surface condition changes every moment. By setting “Condition 4 Satisfaction Counter = 0 second (0 times)” every time, it is possible to newly start the road surface condition determination from the beginning. Then, the process proceeds to step S879.
[0174] まず、ステップ S844によって、ステップ S814の路面傾斜角度 Θ Pn[rad. ]の登坂 路面か、路面傾斜角度 Θ Pn[rad. ]がステップ S814よりも緩やかな登坂路面か或い は平坦に近い登坂路面か、もしくは路面傾斜角度 Θ Pn[rad. ]がステップ S830より も緩やかな登坂路面か或いは平坦に近い登坂路面を走行中に第 1〜第 5の凍結 '積 雪条件 1或いは条件 2が解除(「条件 1 &2解除カウンタ = 5秒間(50回)」)していると 判断された場合 (ステップ S844 : Yes)、つぎに、条件カウンタ判定部 717によって、 条件 1 &2解除カウンタ =0とし、新たに最初力も走行路面の状況判定を開始する (ス テツプ S845)。 [0175] このステップ S845では、ステップ S844でステップ S814の路面傾斜角度 Θ Pn[ra d. ]の登坂路面、または、路面傾斜角度 Θ Pn[rad. ]がステップ S814よりも緩やか な登坂路面か或いは平坦に近い登坂路面、もしくは路面傾斜角度 Θ Pn[rad. ]がス テツプ S830よりも緩やかな登坂路面か或いは平坦に近 、登坂路面を走行中に第 1 〜第 5の凍結 ·積雪条件 1或いは条件 2が「条件 1 &2解除カウンタ = 5秒間(50回)」 で解除していると判断された場合 (ステップ S844 : Yes)、「条件 1 &2解除カウンタ」 をゼロ'クリアする。何故ならば、次回から路面傾斜角度 Θ P[rad. ]の登坂或いは降 坂路面を走行中に第 1〜第 5の凍結'積雪条件 1、条件 2、条件 3或いは条件 4のい ずれか一つが 5秒間(50回)、成立していると判断された場合 (ステップ S814、ステツ プ S830、ステップ S861或いはステップ S877のいずれか一つ: Yes)、路面状況は 刻々と変化していることから、毎回「条件 1 &2解除カウンタ =0秒間(0回)」にするこ とで、新たに最初力も走行路面の状況判定を開始できるようにするためである。そし て、ステップ S846の処理へ移行する。 [0174] First, in step S844, the slope of the road slope Θ Pn [rad.] In step S814 is smooth, or the slope slope Θ Pn [rad.] Is a gentle slope or flatter than that of step S814. The first to fifth frozen snow conditions 1 or 2 while driving on an uphill road surface where the slope angle Θ Pn [rad.] Is closer than that of step S830 or near the flat road surface. Is released ("Condition 1 & 2 Cancel Counter = 5 seconds (50 times)") (Step S844: Yes), then Condition Counter Checking Unit 717 sets Condition 1 & 2 Cancel Counter = 0 Then, a new road condition judgment is also started for the initial force (Step S845). [0175] In step S845, in step S844, the climbing road surface of the road surface inclination angle Θ Pn [ra d.] In step S814, or the climbing road surface in which the road surface inclination angle Θ Pn [rad. Climbing road surface close to flat, or road inclination angle Θ Pn [rad.] Is gentler than that of step S830 or close to flat, and the first to fifth freezing / snow conditions 1 or 5 If it is determined that condition 2 is released with “condition 1 & 2 release counter = 5 seconds (50 times)” (step S844: Yes), “condition 1 & 2 release counter” is cleared to zero. This is because one of the first to fifth freezing snow conditions 1, condition 2, condition 3, or condition 4 while traveling on an uphill or downhill road surface with a road surface inclination angle Θ P [rad.] If it is determined that the vehicle has been established for 5 seconds (50 times) (Step S814, Step S830, Step S861 or Step S877: Yes), the road surface condition changes every moment. By setting “Condition 1 & 2 Cancel Counter = 0 second (0 times)” every time, the initial force can be newly started to determine the road surface condition. Then, the process proceeds to step S846.
[0176] つぎは、ステップ S892によって、ステップ S861の路面傾斜角度 Θ Pn[rad. ]の降 坂路面、または、路面傾斜角度 Θ Pn[rad. ]がステップ S861よりも緩やかな降坂路 面か或いは平坦に近い降坂路面、もしくは路面傾斜角度 Θ Pn[rad. ]がステップ S8 77よりも緩や力な降坂路面か或いは平坦に近い降坂路面を走行中に第 1〜第 5の 凍結 ·積雪条件 3或いは条件 4が解除(「条件 3 & 4解除カウンタ = 5秒間(50回)」)し ていると判断された場合 (ステップ S892 : Yes)、つぎに、条件カウンタ判定部 717に よって、条件 3 & 4解除カウンタ =0とし、新たに最初から走行路面の状況判定を開始 する(ステップ S 893)。  [0176] Next, according to step S892, the road slope angle Θ Pn [rad.] Of step S861 or the slope slope Θ Pn [rad.] Is gentler than that of step S861, or 1st to 5th freezing while driving on a downhill road surface that is close to flat or on a downhill road surface where the road inclination angle Θ Pn [rad.] Is slower or stronger than step S877 If it is determined that the snow condition 3 or 4 has been canceled ("Condition 3 & 4 Cancel Counter = 5 seconds (50 times)") (step S892: Yes), then the condition counter determination unit 717 The condition 3 & 4 release counter is set to 0, and the road surface condition determination is newly started from the beginning (step S893).
[0177] このステップ S893では、ステップ S892でステップ S861の路面傾斜角度 Θ Pn[ra d. ]の降坂路面、または、路面傾斜角度 Θ Pn[rad. ]がステップ S861よりも緩やか な降坂路面か或いは平坦に近い降坂路面か、もしくは路面傾斜角度 Θ Pn[rad. ]が ステップ S877よりも緩やかな降坂路面か或いは平坦に近い降坂路面を走行中に第 1〜第 5の凍結 ·積雪条件 3或いは条件 4が「条件 3 & 4解除カウンタ = 5秒間(50回) 」で解除していると判断された場合 (ステップ S892 : Yes)、「条件 3 & 4解除カウンタ」 をゼロ'クリアする。何故ならば、次回から路面傾斜角度 Θ P[rad. ]の登坂或いは降 坂路面を走行中に第 1〜第 5の凍結'積雪条件 1、条件 2、条件 3或いは条件 4のい ずれか一つが 5秒間(50回)、成立していると判断された場合 (ステップ S814、ステツ プ S830、ステップ S861或いはステップ S877のいずれか一つ: Yes)、路面状況は 刻々と変化していることから、毎回「条件 3 & 4解除カウンタ =0秒間(0回)」にするこ とで、新たに最初力も走行路面の状況判定を開始できるようにするためである。そし て、ステップ S894の処理へ移行する。 [0177] In this step S893, in step S892, the downhill road surface of the road surface inclination angle Θ Pn [ra d.] Of step S861 or the downhill road surface in which the road surface inclination angle Θ Pn [rad.] Is gentler than in step S861 1st to 5th freezing while driving on a downhill road surface where the slope angle Θ Pn [rad.] Is less flat than step S877 or on a downhill road surface which is close to flat. If it is determined that snow condition 3 or condition 4 has been canceled with "condition 3 & 4 cancellation counter = 5 seconds (50 times)" (step S892: Yes), set "condition 3 & 4 cancellation counter" to zero. clear. This is because the road slope angle Θ P [rad. If it is judged that one of the 1st to 5th freezing snow conditions 1, condition 2, condition 3 or condition 4 is met for 5 seconds (50 times) while driving on a slope (step) Any one of S814, Step S830, Step S861 or Step S877: Yes) Since the road surface condition is changing every moment, “Condition 3 & 4 release counter = 0 seconds (0 times)” every time. This is to make it possible for the initial force to be newly determined for the road surface condition. Then, the process proceeds to step S894.
[0178] まず、ステップ S815の処理が終了すると、つぎに、条件カウンタ判定部 717および 警告通知有無フラグ判定部 718によって、条件 2成立カウンタ =0および警告 2通知 有無フラグ = 0 (ステップ S816)、条件 3成立カウンタ = 0および警告 3通知有無フラ グ = 0 (ステップ S817)、条件 4成立カウンタ = 0および警告 4通知有無フラグ = 0 (ス テツプ S818)、条件 1 & 2解除カウンタ = 0および条件 3 & 4解除カウンタ = 0 (ステツ プ S819)として、それぞれ設定する。  [0178] First, when the processing of step S815 is completed, the condition counter determination unit 717 and the warning notification presence / absence flag determination unit 718 then execute a condition 2 establishment counter = 0 and a warning 2 notification presence / absence flag = 0 (step S816), Condition 3 satisfaction counter = 0 and warning 3 notification presence flag = 0 (step S817), condition 4 satisfaction counter = 0 and warning 4 notification presence flag = 0 (step S818), condition 1 & 2 release counter = 0 and condition Set 3 & 4 release counter = 0 (step S819).
[0179] 上記のステップ範囲では、ステップ S814で第 1〜第 5の凍結 ·積雪条件 1が成立(「 条件 1成立カウンタ = 5秒間(50回)」)して 、ると判断された場合 (ステップ S814: Ye s)に処理が行われる。このステップ範囲では、ステップ S814で第 1〜第 5の凍結'積 雪条件 1が「条件 1成立カウンタ = 5秒間(50回)」で成立していると判断された場合( ステップ S814 : Yes)、その他のカウンタである「条件 2成立カウンタ」、「条件 3成立力 ゥンタ」、「条件 4成立カウンタ」、「条件 1 &2解除カウンタ」および「条件 3 & 4解除力 ゥンタ」をゼロ'クリアする。何故ならば、「条件 1成立カウンタ = 5秒間(50回)」になる 前に、その他のカウンタが第 1〜第 5の凍結 ·積雪条件 2、条件 3或いは条件 4のいず れか一つの成立或いは解除をカウント( + 1インクリメント)して 、る途中の場合がある ためである。  [0179] In the above step range, if it is determined in step S814 that the first to fifth frozen / snow condition 1 is satisfied ("Condition 1 satisfied counter = 5 seconds (50 times)") ( Processing is performed in step S814: Ye s). In this step range, if it is determined in step S814 that the 1st to 5th freezing / snow condition 1 is satisfied with "Condition 1 establishment counter = 5 seconds (50 times)" (step S814: Yes) The other counters, “Condition 2 Satisfaction Counter”, “Condition 3 Satisfaction Force Counter”, “Condition 4 Satisfaction Counter”, “Condition 1 & 2 Cancel Counter” and “Condition 3 & 4 Cancel Force Counter” are cleared to zero. . The reason is that before the “Condition 1 Satisfaction Counter = 5 seconds (50 times)”, the other counters are either 1st to 5th Freezing / Snow Covering Condition 2, Condition 3 or Condition 4. This is because there are cases where establishment or release is counted (+1 increment) and in the middle.
[0180] また、「警告 2通知有無フラグ」、「警告 3通知有無フラグ」および「警告 4通知有無フ ラグ」もゼロ .クリアする。何故ならば、このステップ範囲に遷移する以前にステップ S8 30、 S861および S877のいずれかで第 1〜第 5の凍結 ·積雪条件 2、条件 3或いは 条件 4のいずれか一つが 5秒間(50回)、成立していると判断された場合 (ステップ S8 30、ステップ S861或いはステップ S877のいずれか一つ: Yes)、ドライバーや上位 層(上位レイヤ)の経路探索、経路誘導およびハイブリッド航法に対し、警告および通 知をする(下記で詳しく後述する)と、これら「警告通知有無フラグ」の 、ずれか一つが[0180] Also, "Warning 2 Notification Presence Flag", "Warning 3 Notification Presence Flag", and "Warning 4 Notification Presence Flag" are cleared to zero. This is because before transition to this step range, any one of Steps S8 30, S861 and S877 will be performed for 5 seconds (50 times). ), If it is determined that it has been established (step S830, one of step S861 or step S877: Yes), for route search, route guidance and hybrid navigation of the driver and upper layer (upper layer), Warning and communication If you know (described later in detail), one of these “warning notification flag”
"1"にセットされるためである。そして、その後、ステップ S820の処理へ移行する。 This is because it is set to "1". Then, the process proceeds to step S820.
[0181] つぎは、ステップ S831の処理が終了すると、つぎに、条件カウンタ判定部 717およ び警告通知有無フラグ判定部 718によって、条件 1成立カウンタ =0および警告 1通 知有無フラグ =0 (ステップ S832)、条件 3成立カウンタ =0および警告 3通知有無フ ラグ = 0 (ステップ S833)、条件 4成立カウンタ = 0および警告 4通知有無フラグ = 0 ( ステップ S834)、条件 1 & 2解除カウンタ = 0および条件 3 & 4解除カウンタ = 0 (ステ ップ S835)と、それぞれ設定する。 [0181] Next, when the processing of step S831 is completed, the condition counter determination unit 717 and the warning notification presence / absence flag determination unit 718 then execute a condition 1 establishment counter = 0 and a warning 1 notification presence / absence flag = 0 ( Step S832), Condition 3 satisfaction counter = 0 and Warning 3 notification presence flag = 0 (Step S833), Condition 4 satisfaction counter = 0 and Warning 4 notification presence flag = 0 (Step S834), Condition 1 & 2 release counter = Set 0 and condition 3 & 4 release counter = 0 (step S835).
[0182] 上記のステップ範囲では、ステップ S830で第 1〜第 5の凍結 ·積雪条件 2が成立(「 条件 2成立カウンタ = 5秒間(50回)」)して 、ると判断された場合 (ステップ S830: Ye s)に処理が行われる。このステップ範囲では、ステップ S830で第 1〜第 5の凍結'積 雪条件 2が「条件 2成立カウンタ = 5秒間(50回)」で成立していると判断された場合( ステップ S830 : Yes)、その他のカウンタである「条件 1成立カウンタ」、「条件 3成立力 ゥンタ」、「条件 4成立カウンタ」、「条件 1 &2解除カウンタ」および「条件 3 & 4解除力 ゥンタ」をゼロ'クリアする。何故ならば、「条件 2成立カウンタ = 5秒間(50回)」になる 前に、その他のカウンタが第 1〜第 5の凍結 ·積雪条件 1、条件 3或いは条件 4のいず れか一つの成立或いは解除をカウント( + 1インクリメント)して 、る途中の場合がある ためである。 [0182] In the above step range, if it is determined in step S830 that the first to fifth freezing / snow coverage conditions 2 are satisfied ("Condition 2 satisfaction counter = 5 seconds (50 times)") ( Processing is performed in step S830: Ye s). In this step range, if it is determined in step S830 that the 1st to 5th freezing / snow conditions 2 are satisfied as "Condition 2 Satisfaction Counter = 5 seconds (50 times)" (Step S830: Yes) The other counters, “Condition 1 Satisfaction Counter”, “Condition 3 Satisfaction Force Counter”, “Condition 4 Satisfaction Counter”, “Condition 1 & 2 Cancel Counter” and “Condition 3 & 4 Release Force Counter” are cleared to zero. . The reason is that before the “Condition 2 Satisfaction Counter = 5 seconds (50 times)”, the other counters are either one of the first to fifth frozen / snow conditions 1, Condition 3 or Condition 4. This is because there are cases where establishment or release is counted (+1 increment) and in the middle.
[0183] また、「警告 1通知有無フラグ」、「警告 3通知有無フラグ」および「警告 4通知有無フ ラグ」もゼロ .クリアする。何故ならば、このステップ範囲に遷移する以前にステップ S8 14、 S861および S877のいずれかで第 1〜第 5の凍結 ·積雪条件 1、条件 3或いは 条件 4のいずれか一つが 5秒間(50回)、成立していると判断された場合 (ステップ S8 14、ステップ S861或いはステップ S877のいずれか一つ: Yes)、ドライバーや上位 層(上位レイヤ)の経路探索、経路誘導およびハイブリッド航法に対し、警告および通 知をする(下記で詳しく後述する)と、これら「警告通知有無フラグ」の 、ずれか一つが "1"にセットされるためである。そして、その後、ステップ S836の処理へ移行する。  [0183] Also, "Warning 1 Notification Presence Flag", "Warning 3 Notification Presence Flag" and "Warning 4 Notification Presence Flag" are cleared to zero. This is because before any transition to this step range, any one of Steps S8 14, S861 and S877 is performed for 5 seconds (50 times). ), If it is determined that it has been established (Step S814, Step S861 or Step S877: Yes), for route search, route guidance and hybrid navigation of drivers and higher layers (upper layers), This is because one of these “warning notification presence / absence flags” is set to “1” when a warning and notification are made (described in detail later). Thereafter, the process proceeds to step S836.
[0184] 続いて、ステップ S862の処理が終了すると、つぎに、条件カウンタ判定部 717およ び警告通知有無フラグ判定部 718によって、条件 1成立カウンタ =0および警告 1通 知有無フラグ =0 (ステップ S863)、条件 2成立カウンタ =0および警告 2通知有無フ ラグ =0 (ステップ S864)、条件 4成立カウンタ =0および警告 4通知有無フラグ =0 ( ステップ S865)、条件 1 & 2解除カウンタ = 0および条件 3 & 4解除カウンタ = 0 (ステ ップ S866)と、それぞれ設定する。 [0184] Subsequently, when the processing of step S862 is completed, the condition counter determination unit 717 and the warning notification presence / absence flag determination unit 718 then execute a condition 1 establishment counter = 0 and a warning 1 message. Knowledge presence flag = 0 (Step S863), Condition 2 establishment counter = 0 and Warning 2 notification presence flag = 0 (Step S864), Condition 4 establishment counter = 0 and Warning 4 notification presence flag = 0 (Step S865), Condition Set 1 & 2 release counter = 0 and condition 3 & 4 release counter = 0 (step S866).
[0185] 上記のステップ範囲では、ステップ S861で第 1〜第 5の凍結 ·積雪条件 3が成立(「 条件 3成立カウンタ = 5秒間(50回)」)して 、ると判断された場合 (ステップ S861: Ye s)に処理が行われる。このステップ範囲では、ステップ S861で第 1〜第 5の凍結'積 雪条件 3が「条件 3成立カウンタ = 5秒間(50回)」で成立していると判断された場合( ステップ S861 : Yes)、その他のカウンタである「条件 1成立カウンタ」、「条件 2成立力 ゥンタ」、「条件 4成立カウンタ」、「条件 1 &2解除カウンタ」および「条件 3 & 4解除力 ゥンタ」をゼロ'クリアする。何故ならば、「条件 3成立カウンタ = 5秒間(50回)」になる 前に、その他のカウンタが第 1〜第 5の凍結 ·積雪条件 1、条件 2、或いは条件 4のい ずれか一つの成立或いは解除をカウント( + 1インクリメント)して 、る途中の場合があ るためである。 [0185] In the above step range, if it is determined in step S861 that the first to fifth freezing / snow coverage conditions 3 are satisfied ("Condition 3 satisfaction counter = 5 seconds (50 times)") ( Processing is performed in step S861: Ye s). In this step range, if it is determined in step S861 that the 1st to 5th freezing / snow condition 3 is satisfied with "Condition 3 satisfaction counter = 5 seconds (50 times)" (step S861: Yes) Other counters, “Condition 1 Satisfaction Counter”, “Condition 2 Satisfaction Force Counter”, “Condition 4 Satisfaction Counter”, “Condition 1 & 2 Cancel Counter” and “Condition 3 & 4 Cancel Force Counter” are cleared to zero. . This is because, before “Condition 3 Satisfaction Counter = 5 seconds (50 times)”, the other counters will be in either one of the first to fifth frozen / snow condition 1, condition 2, or condition 4. This is because there is a case where the establishment or release is counted (+1 increment) and in the middle.
[0186] また、「警告 1通知有無フラグ」、「警告 2通知有無フラグ」および「警告 4通知有無フ ラグ」もゼロ .クリアする。何故ならば、このステップ範囲に遷移する以前にステップ S8 14、 S830および S877のいずれかで第 1〜第 5の凍結 ·積雪条件 1、条件 2或いは 条件 4のいずれか一つが 5秒間(50回)、成立していると判断された場合 (ステップ S8 14、ステップ S830或いはステップ S877のいずれか一つ: Yes)、ドライバーや上位 層(上位レイヤ)の経路探索、経路誘導およびハイブリッド航法に対し、警告および通 知をする(下記で詳しく後述する)と、これら「警告通知有無フラグ」の 、ずれか一つが "1"にセットされるためである。そして、その後、ステップ S867の処理へ移行する。  [0186] Also, "Warning 1 Notification Presence Flag", "Warning 2 Notification Presence Flag", and "Warning 4 Notification Presence Flag" are cleared to zero. This is because before any transition to this step range, any one of the first to fifth freezing / snow conditions 1, condition 2 or condition 4 is performed for 5 seconds (50 ), If it is determined that it has been established (Step S814, Step S830 or Step S877: Yes), for route search, route guidance and hybrid navigation of drivers and higher layers (upper layers), This is because one of these “warning notification presence / absence flags” is set to “1” when a warning and notification are made (described in detail later). Then, the process proceeds to step S867.
[0187] 最後に、ステップ S878の処理が終了すると、つぎに、条件カウンタ判定部 717およ び警告通知有無フラグ判定部 718によって、条件 1成立カウンタ =0および警告 1通 知有無フラグ =0 (ステップ S879)、条件 2成立カウンタ =0および警告 2通知有無フ ラグ =0 (ステップ S880)、条件 3成立カウンタ =0および警告 3通知有無フラグ =0 ( ステップ S881)、条件 1 & 2解除カウンタ = 0および条件 3 & 4解除カウンタ = 0 (ステ ップ S882)として、それぞれ設定する。 [0188] 上記のステップ範囲では、ステップ S877で第 1〜第 5の凍結 ·積雪条件 4が成立(「 条件 4成立カウンタ = 5秒間(50回)」)して 、ると判断された場合 (ステップ S877: Ye s)に処理が行われる。このステップ範囲では、ステップ S877で第 1〜第 5の凍結'積 雪条件 4が「条件 4成立カウンタ = 5秒間(50回)」で成立して ヽると判断された場合 ( ステップ S877 : Yes)、その他のカウンタである「条件 1成立カウンタ」、「条件 2成立力 ゥンタ」、「条件 3成立カウンタ」、「条件 1 &2解除カウンタ」および「条件 3 & 4解除力 ゥンタ」をゼロ'クリアする。何故ならば、「条件 4成立カウンタ = 5秒間(50回)」になる 前に、その他のカウンタが第 1〜第 5の凍結 ·積雪条件 1、条件 2或いは条件 3のいず れか一つの成立或いは解除をカウント( + 1インクリメント)して 、る途中の場合がある ためである。 [0187] Finally, when the process of step S878 ends, the condition counter determination unit 717 and the warning notification presence / absence flag determination unit 718 then execute the condition 1 establishment counter = 0 and the warning 1 notification presence / absence flag = 0 ( (Step S879), Condition 2 Satisfaction Counter = 0 and Warning 2 Notification Presence Flag = 0 (Step S880), Condition 3 Satisfaction Counter = 0 and Warning 3 Notification Presence Flag = 0 (Step S881), Condition 1 & 2 Release Counter = Set as 0 and condition 3 & 4 release counter = 0 (step S882). [0188] In the above step range, if it is determined in step S877 that the first to fifth freezing / snow coverage conditions 4 are satisfied ("Condition 4 satisfaction counter = 5 seconds (50 times)") ( Processing is performed in step S877: Ye s). In this step range, if it is determined in step S877 that the 1st to 5th frozen snow conditions 4 are satisfied in the condition 4 satisfaction counter = 5 seconds (50 times) (step S877: Yes ), “Counter 1 Satisfaction Counter”, “Condition 2 Satisfaction Counter”, “Condition 3 Satisfaction Counter”, “Condition 1 & 2 Release Counter” and “Condition 3 & 4 Release Force Counter” are cleared to zero. To do. This is because, before “Condition 4 Satisfaction Counter = 5 seconds (50 times)”, the other counters are either 1st to 5th Freezing / Snow Covering Condition 1, Condition 2 or Condition 3. This is because there are cases where establishment or release is counted (+1 increment) and in the middle.
[0189] また、「警告 1通知有無フラグ」、「警告 2通知有無フラグ」および「警告 3通知有無フ ラグ」もゼロ .クリアする。何故ならば、このステップ範囲に遷移する以前にステップ S8 14、 S830および S861のいずれかで第 1〜第 5の凍結 ·積雪条件 1、条件 2或いは 条件 3のいずれか一つが 5秒間(50回)、成立していると判断された場合 (ステップ S8 14、ステップ S830或いはステップ S861のいずれか一つ: Yes)、ドライバーや上位 層(上位レイヤ)の経路探索、経路誘導およびハイブリッド航法に対し、警告および通 知をする(下記で詳しく後述する)と、これら「警告通知有無フラグ」の 、ずれか一つが "1"にセットされるためである。そして、その後、ステップ S883の処理へ移行する。  [0189] Also, "Warning 1 Notification Presence Flag", "Warning 2 Notification Presence Flag", and "Warning 3 Notification Presence Flag" are cleared to zero. This is because before any transition to this step range, any one of the first to fifth freeze / snow conditions 1, condition 2 or condition 3 is performed for 5 seconds (50 ), If it is determined that it has been established (Step S814, Step S830 or Step S861: Yes), for driver and higher layer route search, route guidance and hybrid navigation, This is because one of these “warning notification presence / absence flags” is set to “1” when a warning and notification are made (described in detail later). Thereafter, the process proceeds to step S883.
[0190] まず、ステップ S845の処理が終了すると、つぎに、条件カウンタ判定部 717および 警告通知有無フラグ判定部 718によって、条件 1成立カウンタ =0および警告 1通知 有無フラグ =0 (ステップ S846)、条件 2成立カウンタ =0および警告 2通知有無フラ グ =0 (ステップ S847)、条件 3成立カウンタ =0および警告 3通知有無フラグ =0 (ス テツプ S848)、条件 4成立カウンタ =0および警告 4通知有無フラグ =0 (ステップ S8 49)、条件 3 & 4解除カウンタ =0 (ステップ S850)として、それぞれ設定する。  [0190] First, when the processing of step S845 ends, the condition counter determination unit 717 and the warning notification presence / absence flag determination unit 718 then execute a condition 1 establishment counter = 0 and a warning 1 notification presence / absence flag = 0 (step S846), Condition 2 satisfaction counter = 0 and warning 2 notification presence flag = 0 (step S847), condition 3 satisfaction counter = 0 and warning 3 notification presence flag = 0 (step S848), condition 4 satisfaction counter = 0 and warning 4 notification Set as presence flag = 0 (step S8 49) and condition 3 & 4 release counter = 0 (step S850).
[0191] 上記のステップ範囲では、ステップ S844で第 1〜第 5の凍結'積雪条件 1或いは条 件 2が解除(「条件 1 & 2解除カウンタ = 5秒間(50回)」)していると判断された場合( ステップ S844 : Yes)に処理が行われる。このステップ範囲では、ステップ S844で第 1〜第 5の凍結 ·積雪条件 1或いは条件 2が「条件 1 &2解除カウンタ = 5秒間(50回) 」で解除していると判断された場合 (ステップ S844 : Yes)、その他のカウンタである「 条件 1成立カウンタ」、「条件 2成立カウンタ」、「条件 3成立カウンタ」、「条件 4成立力 ゥンタ」および「条件 3 & 4解除カウンタ」をゼロ'クリアする。何故ならば、「条件 1 &2 解除カウンタ = 5秒間(50回)」になる前に、その他のカウンタが第 1〜第 5の凍結 '積 雪条件 1、条件 2、条件 3或いは条件 4いずれか一つの解除或いは成立をカウント( + 1インクリメント)して!/、る途中の場合があるためである。 [0191] In the above step range, if the 1st to 5th frozen snow condition 1 or condition 2 is canceled in step S844 ("Condition 1 & 2 cancellation counter = 5 seconds (50 times)") If it is determined (step S844: Yes), the processing is performed. In this step range, in Step S844, the 1st to 5th freezing / snow condition 1 or 2 is set as “Condition 1 & 2 release counter = 5 seconds (50 times) ”(Step S844: Yes), the other counters“ Condition 1 Satisfaction Counter ”,“ Condition 2 Satisfaction Counter ”,“ Condition 3 Satisfaction Counter ”,“ Condition 4 Satisfaction Power Counter ”And“ Condition 3 & 4 Release Counter ”are cleared to zero. This is because the other counters are frozen 1st to 5th 'snow condition 1, condition 2, condition 3 or condition 4 before "condition 1 & 2 release counter = 5 seconds (50 times)". Count one release or establishment (+1 increment)! This is because there may be cases where you are on the way.
[0192] また、「警告 1通知有無フラグ」、「警告 2通知有無フラグ」、「警告 3通知有無フラグ」 および「警告 4通知有無フラグ」もゼロ'クリアする。何故ならば、このステップ範囲に 遷移する以前にステップ S814、 S830, S861および の!ヽずれ力で第 1〜第 5 の凍結'積雪条件 1、条件 2、条件 3或いは条件 4のいずれか一つが 5秒間(50回)、 成立していると判断された場合 (ステップ S814、ステップ S830、ステップ S861或い はステップ S877のいずれか一つ: Yes)、ドライバーや上位層(上位レイヤ)の経路探 索、経路誘導およびハイブリッド航法に対し、警告および通知をする(下記で詳しく後 述する)と、これら「警告通知有無フラグ」のいずれか一つ力 1"にセットされるためで ある。そして、その後、ステップ S851の処理へ移行する。  In addition, “Warning 1 Notification Presence Flag”, “Warning 2 Notification Presence Flag”, “Warning 3 Notification Presence Flag” and “Warning 4 Notification Presence Flag” are also cleared to zero. This is because before the transition to this step range, any one of Steps S814, S830, S861 and! If it is determined that it has been established for 5 seconds (50 times) (one of steps S814, S830, S861 or S877: Yes), the route search for the driver or higher layer (upper layer) This is because when a warning or notification is given to the search, route guidance and hybrid navigation (described later in detail), any one of these “warning notification presence / absence flags” is set to 1 ”. Thereafter, the process proceeds to step S851.
[0193] つぎは、ステップ S893の処理が終了すると、つぎに、条件カウンタ判定部 717およ び警告通知有無フラグ判定部 718によって、条件 1成立カウンタ =0および警告 1通 知有無フラグ =0 (ステップ S894)、条件 2成立カウンタ =0および警告 2通知有無フ ラグ =0 (ステップ S895)、条件 3成立カウンタ =0および警告 3通知有無フラグ =0 ( ステップ S896)、条件 4成立カウンタ =0および警告 4通知有無フラグ =0 (ステップ S 897)、条件 1 &2解除カウンタ =0 (ステップ S898)として、それぞれ設定する。  [0193] Next, after the processing of step S893 is completed, the condition counter determination unit 717 and the warning notification presence / absence flag determination unit 718 then execute a condition 1 establishment counter = 0 and a warning 1 notification presence / absence flag = 0 ( (Step S894), Condition 2 Satisfaction Counter = 0 and Warning 2 Notification Presence Flag = 0 (Step S895), Condition 3 Satisfaction Counter = 0 and Warning 3 Notification Presence Presence Flag = 0 (Step S896), Condition 4 Satisfaction Counter = 0 and Warning 4 Notification presence flag = 0 (Step S 897), Condition 1 & 2 release counter = 0 (Step S898)
[0194] 上記のステップ範囲では、ステップ S892で第 1〜第 5の凍結'積雪条件 3或いは条 件 4が解除(「条件 3 & 4解除カウンタ = 5秒間(50回)」)して ヽると判断された場合 ( ステップ S892 : Yes)に処理が行われる。このステップ範囲では、ステップ S892で第 1〜第 5の凍結 ·積雪条件 3或いは条件 4が「条件 3 & 4解除カウンタ = 5秒間(50回) 」で解除して!/ヽると判断された場合 (ステップ S892: Yes)、その他のカウンタである「 条件 1成立カウンタ」、「条件 2成立カウンタ」、「条件 3成立カウンタ」、「条件 4成立力 ゥンタ」および「条件 1 &2解除カウンタ」をゼロ'クリアする。何故ならば、「条件 3 & 4 解除カウンタ = 5秒間(50回)」になる前に、その他のカウンタが第 1〜第 5の凍結 '積 雪条件 1、条件 2、条件 3或いは条件 4のいずれか一つの解除或いは成立をカウント( + 1インクリメント)して!/、る途中の場合があるためである。 [0194] In the above step range, the 1st to 5th frozen snow conditions 3 or 4 are canceled ("Condition 3 & 4 cancellation counter = 5 seconds (50 times)" in step S892. Is determined (step S892: Yes), processing is performed. In this step range, it was determined in step S892 that the 1st to 5th freezing / snow coverage conditions 3 or 4 were canceled by "condition 3 & 4 release counter = 5 seconds (50 times)"! If (Step S892: Yes), the other counters “Condition 1 Satisfaction Counter”, “Condition 2 Satisfaction Counter”, “Condition 3 Satisfaction Counter”, “Condition 4 Satisfaction Force Counter” and “Condition 1 & 2 Cancel Counter” Clear 'zero'. Because “Conditions 3 & 4 Before the "Release Counter = 5 seconds (50 times)", the other counter counts the release or establishment of any one of the 1st to 5th frozen snow conditions 1, Condition 2, Condition 3 or Condition 4. (+1 increment)! This is because there may be cases where you are on the way.
[0195] また、「警告 1通知有無フラグ」、「警告 2通知有無フラグ」、「警告 3通知有無フラグ」 および「警告 4通知有無フラグ」もゼロ'クリアする。何故ならば、このステップ範囲に 遷移する以前にステップ S814、 S830, S861および の!ヽずれ力で第 1〜第 5 の凍結'積雪条件 1、条件 2、条件 3或いは条件 4のいずれか一つが 5秒間(50回)、 成立していると判断された場合 (ステップ S814、ステップ S830、ステップ S861或い はステップ S877のいずれか一つ: Yes)、ドライバーや上位層(上位レイヤ)の経路探 索、経路誘導およびハイブリッド航法に対し、警告および通知をする(下記で詳しく後 述する)と、これら「警告通知有無フラグ」のいずれか一つ力 1"にセットされるためで ある。そして、その後、ステップ S899の処理へ移行する。  Also, “Warning 1 Notification Presence Flag”, “Warning 2 Notification Presence Flag”, “Warning 3 Notification Presence Flag” and “Warning 4 Notification Presence Flag” are cleared to zero. This is because before the transition to this step range, any one of Steps S814, S830, S861 and! If it is determined that it has been established for 5 seconds (50 times) (one of steps S814, S830, S861 or S877: Yes), the route search for the driver or higher layer (upper layer) This is because when a warning or notification is given to the search, route guidance and hybrid navigation (described later in detail), any one of these “warning notification presence / absence flags” is set to 1 ”. Thereafter, the process proceeds to step S899.
[0196] まず、ステップ S819の処理が終了すると、つぎに、警告通知有無フラグ判定部 71 8およびドライバー通知判定部 719によって、「凍結状態か積雪状態の登坂路面を走 行中」であると判定する (ステップ S820)。また、警告 1通知有無フラグ = 1とし、ドライ バーに警告 1を通知する(ステップ S821)。このステップ範囲では、ステップ S814で 第 1〜第 5の凍結 ·積雪条件 1が成立(「条件 1成立カウンタ = 5秒間(50回)」)してい ると判断された場合 (ステップ S814: Yes)に処理が行われる。  [0196] First, when the processing of step S819 is completed, it is then determined by the warning notification presence / absence flag determination unit 718 and the driver notification determination unit 719 that the vehicle is "running on an uphill road surface in a frozen state or a snowy state". (Step S820). Also, the warning 1 notification presence flag is set to 1, and warning 1 is notified to the driver (step S821). In this step range, if it is determined in step S814 that the 1st to 5th freeze / snow condition 1 is satisfied ("Condition 1 establishment counter = 5 seconds (50 times)") (Step S814: Yes) Processing is performed.
[0197] 上記のステップ範囲では、ステップ S814で第 1〜第 5の凍結 ·積雪条件 1が「条件 1 成立カウンタ = 5秒間(50回)」で成立して 、ると判断された場合 (ステップ S814: Ye s)、ステップ S820で路面傾斜角度 Θ Pn[rad. ]の「凍結状態か積雪状態の登坂路 面を走行中」であると判定する。そして、ステップ S821でドライバーに対して音声案 内で例えば「路面が大変滑り易くなつています。注意して運転して下さい。」などと警 告を促したり、ナビ画面表示で例えば「地図上の走行中の路面色を水色や白色に変 える」などの警告を促したり、音声案内と同じ内容を文字表示にして警告を促したり、 スピーカによる音などで警告を促したりすると、「警告 1通知有無フラグ」力 '1"にセッ トされる。そして、その後、ステップ S822の処理へ移行する。  [0197] In the above step range, if it is determined in step S814 that the 1st to 5th freezing / snow coverage condition 1 is satisfied with "condition 1 establishment counter = 5 seconds (50 times)" (step S814: Ye s), and in step S820, it is determined that the road slope angle Θ Pn [rad.] Is “running on an uphill road in a frozen or snowy state”. Then, in step S821, the driver will be alerted in the voice plan by saying, for example, “The road surface is very slippery. Please drive carefully.” If you urge a warning such as `` change the road surface color to light blue or white '', prompt the warning by displaying the same content as the voice guidance, or prompt the warning with sound from the speaker, etc. The presence / absence flag “force” is set to “1”, and then the process proceeds to step S822.
[0198] つぎは、ステップ S835の処理が終了すると、つぎに、警告通知有無フラグ判定部 7 18およびドライバー通知判定部 719によって、「凍結状態か積雪状態のやや登坂 · 平坦路面を走行中」であると判定する (ステップ S836)。また、警告 2通知有無フラグ = 1とし、ドライバーに警告 2を通知する(ステップ S837)。このステップ範囲では、ス テツプ S830で第 1〜第 5の凍結 ·積雪条件 2が成立(「条件 2成立カウンタ = 5秒間( 50回)」)して 、ると判断された場合 (ステップ S830: Yes)に処理が行われる。 [0198] Next, when the processing of step S835 is completed, the warning notification presence / absence flag determination unit 7 18 and the driver notification determination unit 719 determine that the vehicle is traveling on a slightly uphill / flat road surface in a frozen state or a snowy state (step S836). Further, the warning 2 notification presence flag = 1 is set, and warning 2 is notified to the driver (step S837). In this step range, if it is determined in step S830 that the first to fifth freezing / snow coverage conditions 2 are satisfied ("Condition 2 satisfaction counter = 5 seconds (50 times)") (step S830: Processing is performed at Yes).
[0199] 上記のステップ範囲では、ステップ S830で第 1〜第 5の凍結 ·積雪条件 2が「条件 2 成立カウンタ = 5秒間(50回)」で成立して 、ると判断された場合 (ステップ S830: Ye s)、ステップ S836で路面傾斜角度 Θ Pn[rad. ]がステップ S820よりも「緩やかな登 坂路面か或いは平坦に近い登坂路面を走行中」であると判定する。そして、ステップ S837でドライバーに対して音声案内で例えば「路面が大変滑り易くなつています。 注意して運転して下さい。」などと警告を促したり、ナビ画面表示で例えば「地図上の 走行中の路面色を水色や白色に変える」などの警告を促したり、音声案内と同じ内容 を文字表示にして警告を促したり、スピーカによる音などで警告を促したりすると、「警 告 2通知有無フラグ」が" 1"にセットされる。そして、その後、ステップ S838の処理へ 移行する。 [0199] In the above step range, if it is determined in step S830 that the 1st to 5th freezing / snow coverage condition 2 is satisfied with "condition 2 establishment counter = 5 seconds (50 times)" (step S830: Ye s), in step S836, it is determined that the road surface inclination angle Θ Pn [rad.] Is “traveling on a gentle uphill road surface or a gentle uphill road surface” than in step S820. Then, in step S837, a voice message is given to the driver, for example, a warning such as “The road surface is very slippery. Please drive with caution.” `` Change the road surface color to light blue or white '', prompt the warning by displaying the same contents as the voice guidance, or prompt the warning with sound from the speaker, etc. "Is set to" 1 ". Then, the process proceeds to step S838.
[0200] 続いて、ステップ S866の処理が終了すると、つぎに、警告通知有無フラグ判定部 7 18およびドライバー通知判定部 719によって、「凍結状態か積雪状態の降坂路面を 走行中」であると判定する (ステップ S867)。また、警告 3通知有無フラグ = 1とし、ド ライバーに警告 3を通知する(ステップ S868)。このステップ範囲では、ステップ S86 1で第 1〜第 5の凍結'積雪条件 3が成立(「条件 3成立カウンタ = 5秒間(50回)」)し ていると判断された場合 (ステップ S861: Yes)に処理が行われる。  [0200] Subsequently, when the process of step S866 is completed, the warning notification presence / absence flag determination unit 718 and the driver notification determination unit 719 indicate that the vehicle is “running on a downhill road surface in a frozen state or a snowy state”. Judgment is made (step S867). Also, the warning 3 notification presence flag is set to 1, and warning 3 is notified to the driver (step S868). In this step range, if it is determined in step S86 1 that the 1st to 5th frozen snow conditions 3 are satisfied ("Condition 3 satisfaction counter = 5 seconds (50 times)") (Step S861: Yes) ) Is performed.
[0201] 上記のステップ範囲では、ステップ S861で第 1〜第 5の凍結 ·積雪条件 3が「条件 3 成立カウンタ = 5秒間(50回)」で成立して 、ると判断された場合 (ステップ S861: Ye s)、ステップ S867で路面傾斜角度 Θ Pn[rad. ]の「凍結状態か積雪状態の降坂路 面を走行中」であると判定する。そして、ステップ S868でドライバーに対して音声案 内で例えば「路面が大変滑り易くなつています。注意して運転して下さい。」などと警 告を促したり、ナビ画面表示で例えば「地図上の走行中の路面色を水色や白色に変 える」などの警告を促したり、音声案内と同じ内容を文字表示にして警告を促したり、 スピーカによる音などで警告を促したりすると、「警告 3通知有無フラグ」力 '1"にセッ トされる。そして、その後、ステップ S869の処理へ移行する。 [0201] In the above step range, if it is determined in step S861 that the 1st to 5th freezing / snow coverage condition 3 is satisfied with "Condition 3 establishment counter = 5 seconds (50 times)" (step S861: Ye s), and in step S867, it is determined that the road slope angle Θ Pn [rad.] Is “running down a frozen or snowy downhill road surface”. Then, in step S868, the driver is alerted in the voice plan, for example, “The road surface is very slippery. Please drive carefully.” `` Change the road surface color while driving to light blue or white '', or display the same content as the voice guidance in text display to prompt the warning, When a warning is urged by sound from a speaker, etc., the “warning 3 notification presence flag” power “1” is set, and then the process proceeds to step S869.
[0202] 最後に、ステップ S882の処理が終了すると、つぎに、警告通知有無フラグ判定部 7 18およびドライバー通知判定部 719によって、「凍結状態か積雪状態のやや降坂 · 平坦路面を走行中」であると判定する (ステップ S883)。また、警告 4通知有無フラグ = 1とし、ドライバーに警告 4を通知する(ステップ S884)。このステップ範囲では、ス テツプ S877で第 1〜第 5の凍結 ·積雪条件 4が成立(「条件 4成立カウンタ = 5秒間( 50回)」)して ヽると判断された場合 (ステップ S877: Yes)に処理が行われる。  [0202] Finally, when the process of step S882 is completed, the warning notification presence / absence flag determination unit 718 and the driver notification determination unit 719 then "run on a slightly downhill / flat road surface in a frozen state or a snowy state" (Step S883). Further, the warning 4 notification presence flag is set to 1, and the driver is notified of warning 4 (step S884). In this step range, if it is determined in step S877 that the first to fifth freezing / snow coverage conditions 4 are satisfied (“Condition 4 satisfaction counter = 5 seconds (50 times)”) (step S877: Processing is performed at Yes).
[0203] 上記のステップ範囲では、ステップ S877で第 1〜第 5の凍結 ·積雪条件 4が「条件 4 成立カウンタ = 5秒間(50回)」で成立して 、ると判断された場合 (ステップ S877: Ye s)、ステップ S883で路面傾斜角度 Θ Pn[rad. ]がステップ S867よりも「緩やかな降 坂路面か或いは平坦に近い降坂路面を走行中」であると判定する。そして、ステップ S884でドライバーに対して音声案内で例えば「路面が大変滑り易くなつています。 注意して運転して下さい。」などと警告を促したり、ナビ画面表示で例えば「地図上の 走行中の路面色を水色や白色に変える」などの警告を促したり、音声案内と同じ内容 を文字表示にして警告を促したり、スピーカによる音などで警告を促したりすると、「警 告 4通知有無フラグ」が" 1"にセットされる。そして、その後、ステップ S885の処理へ 移行する。  [0203] In the above step range, if it is determined in step S877 that the 1st to 5th freezing / snow coverage condition 4 is satisfied with "Condition 4 establishment counter = 5 seconds (50 times)" (step S877: Ye s), in step S883, it is determined that the road surface inclination angle Θ Pn [rad.] Is “traveling on a gentle downhill road surface or a flat downhill road surface” than in step S867. Then, in step S884, a voice message is given to the driver, for example, a warning such as “The road surface is very slippery. Please drive carefully.” Or “Now driving on the map” is displayed on the navigation screen display. `` Change the road surface color to light blue or white '', prompt the warning by displaying the same contents as the voice guidance, or prompt the warning with sound from the speaker, etc. "Is set to" 1 ". Then, the process proceeds to step S885.
[0204] まず、ステップ S850の処理が終了すると、つぎに、ドライバー通知判定部 719によ つて、「凍結状態か積雪状態の登坂路面を走行中」でないと判定する (ステップ S851 )。また、ドライバーに第 1〜第 5の凍結 ·積雪条件 1或いは条件 2のいずれか一方の 解除を通知する(ステップ S852)。このステップ範囲では、ステップ S844で第 1〜第 5の凍結 ·積雪条件 1或いは条件 2のいずれか一方が解除(「条件 1 &2解除カウンタ = 5秒間(50回)」)して ヽると判断された場合 (ステップ S844: Yes)に処理が行われ る。  [0204] First, when the processing of step S850 is completed, the driver notification determination unit 719 determines that the vehicle is not "running on an uphill road surface in a frozen state or a snowy state" (step S851). In addition, the driver is notified of the cancellation of either the first to fifth freezing / snow accumulation conditions 1 or 2 (step S852). In this step range, it is determined in step S844 that either the first to fifth freezing / snow coverage condition 1 or condition 2 is released ("Condition 1 & 2 release counter = 5 seconds (50 times)") If so (step S844: Yes), the process is performed.
[0205] 上記のステップの範囲では、ステップ S844で第 1〜第 5の凍結 ·積雪条件 1或いは 条件 2の 、ずれか一方が「条件 1 &2解除カウンタ = 5秒間(50回)」で解除して 、ると 判断された場合 (ステップ S844 : Yes)、ステップ S851で路面傾斜角度 Θ Pn[rad. ] の「凍結状態か積雪状態の登坂路面を走行中」でないと判定する。そして、ステップ[0205] Within the range of the above steps, in Step S844, one of the first to fifth freeze / snow condition 1 or condition 2 is canceled with "Condition 1 & 2 release counter = 5 seconds (50 times)". (Step S844: Yes), the road surface inclination angle Θ Pn [rad.] It is determined that the vehicle is not traveling on an uphill road surface in a frozen state or a snowy state. And step
S852でドライバーに対して音声案内で例えば「路面の凍結が解除されました。」など と解除を促したり、ナビ画面表示で例えば「地図上の走行中の路面色を元に戻す」な どの解除を促したり、音声案内と同じ内容を文字表示にして解除を促したり、スピー 力による音などで解除を促したりする。そして、その後、ステップ S853の処理へ移行 する。 In S852, the driver is prompted to cancel, for example, “The road surface has been frozen”, or the navigation screen display, for example, “Reset the road surface color on the map” is canceled. , Prompt the release with the same content as the voice guidance in text display, or prompt the release with a sound or the like. Then, the process proceeds to step S853.
[0206] つぎは、ステップ S898の処理が終了すると、つぎに、ドライバー通知判定部 719に よって、「凍結状態か積雪状態の降坂路面を走行中」でないと判定する (ステップ S8 99)。また、ドライバーに第 1〜第 5の凍結'積雪条件 3或いは条件 4のいずれか一方 の解除を通知する(ステップ S900)。このステップ範囲では、ステップ S892で第 1〜 第 5の凍結 ·積雪条件 3或いは条件 4の 、ずれか一方が解除(「条件 3 & 4解除カウン タ = 5秒間(50回)」)して 、ると判断された場合 (ステップ S892: Yes)に処理が行わ れる。  Next, when the processing of step S898 is completed, the driver notification determination unit 719 determines that the vehicle is not “running on a downhill road surface in a frozen state or a snowy state” (step S899). In addition, the driver is notified of the release of either the first to fifth frozen snow conditions 3 or 4 (step S900). In this step range, one of the first to fifth freezing / snow coverage conditions 3 or 4 is canceled in step S892 ("Condition 3 & 4 cancellation counter = 5 seconds (50 times)") If it is determined (step S892: Yes), the processing is performed.
[0207] 上記のステップ範囲では、ステップ S892で第 1〜第 5の凍結'積雪条件 3或いは条 件 4の 、ずれか一方が「条件 3 & 4解除カウンタ = 5秒間(50回)」で解除して 、ると判 断された場合 (ステップ S892 : Yes)、ステップ S899で路面傾斜角度 Θ Pn[rad. ]の 「凍結状態か積雪状態の降坂路面を走行中」でないと判定する。そして、ステップ S9 00でドライバーに対して音声案内で例えば「路面の凍結が解除されました。」などと 解除を促したり、ナビ画面表示で例えば「地図上の走行中の路面色を元に戻す」など の解除を促したり、音声案内と同じ内容を文字表示にして解除を促したり、スピーカ による音などで解除を促したりする。そして、その後、ステップ S 901の処理へ移行す る。  [0207] In the above step range, in Step S892, either 1st to 5th freezing snow conditions 3 or 4 will be canceled when "Condition 3 & 4 release counter = 5 seconds (50 times)" If it is determined (step S892: Yes), it is determined in step S899 that the road surface inclination angle Θ Pn [rad.] Is not “running down a frozen or snowy downhill road surface”. Then, in step S900, the driver is prompted to release the voice guidance, for example, “The road surface has been frozen”, or the navigation screen display, for example, “Resets the road surface color on the map. ”, Etc., the same content as the voice guidance is displayed in text, the release is urged, or the release is urged by sound from the speaker. Then, the process proceeds to step S901.
[0208] まず、ステップ S822の処理が終了すると、つぎに、ハイブリッド航法重み付け判定 部 721によって、ハイブリッド航法へ GPS航法と自立航法の重み付け 1を通知する( ステップ S823)。このステップ S823では、上記のステップ S814で第 1〜第 5の凍結' 積雪条件 1が成立(「条件 1成立カウンタ = 5秒間(50回)」)していると判断された場 合 (ステップ S814 : Yes)に処理が行われる。  [0208] First, when the process of step S822 is completed, the hybrid navigation weighting determination unit 721 notifies the hybrid navigation of weighting 1 of GPS navigation and independent navigation (step S823). In this step S823, when it is determined in the above step S814 that the first to fifth freezing / snow condition 1 is satisfied (“condition 1 establishment counter = 5 seconds (50 times)”) (step S814). : Processing is performed at Yes).
[0209] ステップ S823では、路面傾斜角度 Θ Pn[rad. ]の「凍結状態か積雪状態の登坂 路面を走行中」であるので、 GPS航法と自立航法の重み付け 1は、下記のようにして 、そのまま処理を終了する。 [0209] In step S823, the road slope angle Θ Pn [rad. Because it is “running on the road surface”, the weighting 1 for GPS navigation and autonomous navigation 1 is terminated as follows.
[0210] (重み付け 1)  [0210] (Weight 1)
ノヽイブリツド航法の定義として、ハイブリッド航法 = δ · (GPS航法) + (1— δ ) · (自 立航法)とする。但し、重み付け係数 δは、 0≤ δ≤ 1 (例えば、 δ =0. 95)とする。 その後、そのまま処理を終了する。また、それぞれの重み付け係数には例えば、「0 ≤ φ≤ μ≤π≤ δ≤1」のような関係になっている。  Hybrid navigation = δ · (GPS navigation) + (1— δ) · (self-contained navigation) as a definition of noble navigation. However, the weighting factor δ is 0≤ δ≤ 1 (eg, δ = 0.95). Thereafter, the process is terminated as it is. Each weighting coefficient has a relationship such as “0 ≤ φ≤ μ≤π≤δ≤1”.
[0211] つぎは、ステップ S838の処理が終了すると、つぎに、ハイブリッド航法重み付け判 定部 721によって、ハイブリッド航法へ GPS航法と自立航法の重み付け 2を通知する (ステップ S839)。このステップ S839では、上記のステップ S830で第 1〜第 5の凍結 •積雪条件 2が成立(「条件 2成立カウンタ = 5秒間(50回)」)して 、ると判断された場 合 (ステップ S830 :Yes)に処理が行われる。  [0211] Next, when the process of step S838 is completed, the hybrid navigation weighting determination unit 721 notifies the hybrid navigation of the weighting 2 of GPS navigation and independent navigation (step S839). In this step S839, if it is determined in step S830 above that the first to fifth frozen snow conditions 2 are satisfied ("Condition 2 establishment counter = 5 seconds (50 times)") (step S839) Processing is performed at S830: Yes).
[0212] ステップ S839では、路面傾斜角度 Θ Pn[rad. ]がステップ S823よりも「緩やかな 登坂路面か或いは平坦に近い登坂路面を走行中」であるので、 GPS航法と自立航 法の重み付け 2は、下記のようにして、そのまま処理を終了する。  [0212] In step S839, the road surface inclination angle Θ Pn [rad.] Is "running on a gentle uphill road surface or a flat uphill road surface" than in step S823. Therefore, weighting of GPS navigation and independent navigation 2 Ends the processing as it is as follows.
[0213] (重み付け 2)  [0213] (Weight 2)
ノヽイブリツド航法の定義として、ハイブリッド航法 = μ · (GPS航法) + (1— ) ·(自 立航法)とする。但し、重み付け係数 は、 0≤ ≤ 1 (例えば、 μ =0. 75)とする。 その後、そのまま処理を終了する。また、それぞれの重み付け係数には例えば、「0 ≤ ≤ μ≤π≤ δ≤1」のような関係になっている。  Hybrid navigation = μ · (GPS navigation) + (1—) · (self-contained navigation) as a definition of noble navigation. However, the weighting factor shall be 0≤ ≤ 1 (eg μ = 0.75). Thereafter, the process is terminated as it is. Each weighting coefficient has a relationship such as “0 ≤ ≤ μ≤π≤ δ≤1”.
[0214] 続いて、ステップ S869の処理が終了すると、つぎに、ハイブリッド航法重み付け判 定部 721によって、ハイブリッド航法へ GPS航法と自立航法の重み付け 3を通知する (ステップ S870)。このステップ S870では、上記のステップ S861で第 1〜第 5の凍結 •積雪条件 3が成立(「条件 3成立カウンタ = 5秒間(50回)」)して 、ると判断された場 合 (ステップ S861: Yes)に処理が行われる。  [0214] Subsequently, when the process of step S869 is completed, the hybrid navigation weight determination unit 721 notifies the hybrid navigation of the weight 3 of GPS navigation and independent navigation (step S870). In this step S870, if it is determined that the first to fifth freezing / snow cover condition 3 is satisfied ("Condition 3 establishment counter = 5 seconds (50 times)") in step S861 above (step S861). The process is performed in S861: Yes).
[0215] ステップ S870では、路面傾斜角度 Θ Pn[rad. ]の「凍結状態か積雪状態の降坂 路面を走行中」であるので、 GPS航法と自立航法の重み付け 3は、下記のようにして 、そのまま処理を終了する。 [0216] (重み付け 3) [0215] In step S870, because the road surface inclination angle Θ Pn [rad.] Is “running down a frozen or snowy downhill road surface”, weighting 3 for GPS navigation and autonomous navigation is as follows: The process is terminated as it is. [0216] (Weight 3)
ノ、イブリツド航法の定義として、ハイブリッド航法 = π · (GPS航法) + (1— π ) · (自 立航法)とする。但し、重み付け係数 πは、 0≤ π≤ 1 (例えば、 π =0. 85)とする。 その後、そのまま処理を終了する。また、それぞれの重み付け係数には例えば、「0 ≤ ≤ μ≤π≤ δ≤1」のような関係になっている。  The hybrid navigation is defined as hybrid navigation = π · (GPS navigation) + (1— π) · (self-contained navigation). However, the weighting factor π shall be 0≤ π≤ 1 (eg, π = 0.85). Thereafter, the process is terminated as it is. Each weighting coefficient has a relationship such as “0 ≤ ≤ μ≤π≤ δ≤1”.
[0217] 最後に、ステップ S885の処理が終了すると、つぎに、ハイブリッド航法重み付け判 定部 721によって、ハイブリッド航法へ GPS航法と自立航法の重み付け 4を通知する (ステップ S886)。このステップ S886では、上記のステップ S877で第 1〜第 5の凍結 •積雪条件 4が成立(「条件 4成立カウンタ = 5秒間(50回)」)して 、ると判断された場 合 (ステップ S877 :Yes)に処理が行われる。  [0217] Finally, when the processing of step S885 is completed, the hybrid navigation weighting determination unit 721 notifies the hybrid navigation of weighting 4 of GPS navigation and independent navigation (step S886). In step S886, if it is determined in step S877 that the first to fifth frozen snow conditions 4 are satisfied ("Condition 4 satisfaction counter = 5 seconds (50 times)") (step S886) Processing is performed at S877: Yes).
[0218] ステップ S886では、路面傾斜角度 Θ Pn[rad. ]がステップ S870よりも「緩やかな 降坂路面か或いは平坦に近い降坂路面を走行中」であるので、 GPS航法と自立航 法の重み付け 4は、下記のようにして、そのまま処理を終了する。  [0218] In step S886, the road surface inclination angle Θ Pn [rad.] Is “running on a gentle downhill road surface or a flat downhill road surface” than in step S870. For weight 4, the process is terminated as follows.
[0219] (重み付け 4)  [0219] (Weight 4)
ノヽイブリツド航法の定義として、ハイブリッド航法 = φ · (GPS航法) + (1— φ ) · (自 立航法)とする。但し、重み付け係数 φは、 0≤ φ≤ 1 (例えば、 φ =0. 65)とする。 その後、そのまま処理を終了する。また、それぞれの重み付け係数には例えば、「0 ≤ φ≤ μ≤π≤ δ≤1」のような関係になっている。  Hybrid navigation = φ · (GPS navigation) + (1 — φ) · (self-contained navigation) as a definition of noble navigation. However, the weighting factor φ shall be 0≤φ≤1 (for example, φ = 0.65). Thereafter, the process is terminated as it is. Each weighting coefficient has a relationship such as “0 ≤ φ≤ μ≤π≤δ≤1”.
[0220] 上記のステップ S823、 S839、 S870および S886では、今日のナビゲーシヨン装 置の自車位置認識技術の代表であるハイブリッド航法に対して、 GPS航法と自立航 法との「重み付け情報」を送ることによって、自車位置精度のさらなる向上および維持 を成し得ることがでさる。  [0220] In the above steps S823, S839, S870 and S886, “weighting information” between GPS navigation and autonomous navigation is used for hybrid navigation, which is representative of the vehicle position recognition technology of today's navigation devices. By sending it, the vehicle's position accuracy can be further improved and maintained.
[0221] なお、ノ、イブリツド航法とは、自立航法の情報を主に活用しており、その補完として 、 GPS航法の情報を活用している。これは絶対位置 (緯度、経度および高度)や絶対 方位 (二次元および三次元方位)などの情報を自立航法自身では知り得ることができ ないためである。したがって、 GPS航法の情報や地図情報 (道路形状データ)などを 自立航法の各種補正および較正などに利用する形態となって 、る。  [0221] Note that Roh and Ivritd navigation mainly uses information on self-contained navigation, and supplements information on GPS navigation. This is because information such as absolute position (latitude, longitude, and altitude) and absolute direction (two-dimensional and three-dimensional directions) cannot be obtained by self-contained navigation itself. Therefore, GPS navigation information and map information (road shape data) are used for various corrections and calibrations of self-contained navigation.
[0222] まず、ステップ S853の処理が終了すると、つぎに、ハイブリッド航法重み付け判定 部 721によって、ハイブリッド航法へ GPS航法と自立航法の重み付けの解除を通知 する(ステップ S854)。このステップ S854では、上記のステップ S844で第 1〜第 5の 凍結 ·積雪条件 1或いは条件 2のいずれか一方が解除(「条件 1 &2解除カウンタ = 5 秒間(50回)」)して ヽると判断された場合 (ステップ S844: Yes)に処理が行われる。 その後、そのまま一連の処理を終了する。 [0222] First, when the processing of step S853 is completed, the hybrid navigation weighting determination is performed. Part 721 notifies hybrid navigation of the cancellation of the weighting of GPS navigation and autonomous navigation (step S854). In this step S854, either the 1st to the 5th freezing / snow condition 1 or 2 is canceled ("Condition 1 & 2 cancellation counter = 5 seconds (50 times)"). Is determined (step S844: Yes), the process is performed. Thereafter, the series of processing is finished as it is.
[0223] ステップ S854では、ステップ S823の路面傾斜角度 Θ Pn[rad. ]の「凍結状態か積 雪状態の登坂路面」か、路面傾斜角度 Θ Pn[rad. ]がステップ S823よりも「緩やか な登坂路面か或いは平坦に近い登坂路面」か、もしくは路面傾斜角度 Θ Pn[rad. ] 力 Sステップ S839よりも「緩やかな登坂路面か或いは平坦に近い登坂路面」を走行中 でな 、ので、 GPS航法と自立航法の重み付け 1或 、は重み付け 2の!、ずれか一方の 解除を上位層(上位レイヤ)であるハイブリッド航法へ通知することにより、通常のハイ プリッド航法に戻る。 [0223] In step S854, the road slope angle Θ Pn [rad.] In step S823 is “climbing road in frozen or snowy condition”, or the road slope angle Θ Pn [rad.] Is more gradual than in step S823. Because it is not running on an uphill road surface or an uphill road surface that is close to flat, or on a road slope angle Θ Pn [rad.] Force Sstep S839, that is, a gentler uphill road surface or a near-flat road surface. By returning to the hybrid navigation, which is the upper layer (upper layer), the return to normal hybrid navigation can be made.
[0224] つぎは、ステップ S901の処理が終了すると、つぎに、ハイブリッド航法重み付け判 定部 721によって、ハイブリッド航法へ GPS航法と自立航法の重み付けの解除を通 知する(ステップ S902)。このステップ S902では、上記のステップ S892で第 1〜第 5 の凍結 ·積雪条件 3或 、は条件 4の 、ずれか一方が解除(「条件 3 & 4解除カウンタ = 5秒間(50回)」)していると判断された場合 (ステップ S892 : Yes)に処理が行われる 。その後、そのまま一連の処理を終了する。  [0224] Next, when the processing of step S901 is completed, the hybrid navigation weighting determination unit 721 notifies the hybrid navigation of the cancellation of the weighting of GPS navigation and independent navigation (step S902). In this step S902, either of the first to fifth freezing / snow coverage conditions 3 or 4 in step S892 above is canceled ("Condition 3 & 4 cancellation counter = 5 seconds (50 times)") If it is determined that it is in progress (step S892: Yes), processing is performed. Thereafter, the series of processing is finished as it is.
[0225] ステップ S902では、ステップ S870の路面傾斜角度 Θ Pn[rad. ]の「凍結状態か積 雪状態の降坂路面」か、路面傾斜角度 Θ Pn[rad. ]がステップ S870よりも「緩やか な降坂路面か或いは平坦に近い降坂路面」か、もしくは路面傾斜角度 Θ Pn[rad. ] 力 Sステップ S886よりも「緩や力な降坂路面か或いは平坦に近い降坂路面」を走行中 でな 、ので、 GPS航法と自立航法の重み付け 3或!、は重み付け 4の!、ずれか一方の 解除を上位層(上位レイヤ)であるハイブリッド航法へ通知することにより、通常のハイ プリッド航法に戻る。  [0225] In step S902, whether the road slope angle Θ Pn [rad.] In step S870 is "downhill road surface frozen or snowy" or the road slope angle Θ Pn [rad. "Slope downhill or close to flat" or road slope angle Θ Pn [rad.] Force S Step S886 "Slow downhill road or nearly flat downhill" Since it is not in the middle, weighting 3 or! Of GPS navigation and self-contained navigation is weighted 4 or!, And cancellation of one of them is notified to hybrid navigation which is an upper layer (upper layer). Return to.
[0226] まず、ステップ S814によって、第 1〜第 5の凍結'積雪条件 1が成立(「条件 1成立 カウンタ = 5秒、間(50回)」)して ヽな 、と判断された場合 (ステップ S814 :No)、つぎ に、条件カウンタ判定部 717によって、条件 1成立カウンタを + 1インクリメントする (ス テツプ S824)。その後、そのまま一連の処理を終了する。 [0226] First, if it is determined in step S814 that the first to fifth frozen 'snow cover condition 1 is satisfied ("Condition 1 is satisfied counter = 5 seconds, interval (50 times)") Step S814: No) Next, the condition counter determination unit 717 increments the condition 1 establishment counter by +1 (step S814: No). Tape S824). Thereafter, the series of processing is finished as it is.
[0227] つぎは、ステップ S830によって、第 1〜第 5の凍結 ·積雪条件 2が成立(「条件 2成 立カウンタ = 5秒間(50回)」)して!/ヽな 、と判断された場合 (ステップ S830: No)、つ ぎに、条件カウンタ判定部 717によって、条件 2成立カウンタを + 1インクリメントする( ステップ S840)。その後、そのまま一連の処理を終了する。  [0227] Next, in step S830, it was determined that 1st to 5th freezing / snow condition 2 was satisfied ("Condition 2 establishment counter = 5 seconds (50 times)")! In the case (step S830: No), the condition counter determination unit 717 increments the condition 2 satisfaction counter by +1 (step S840). Thereafter, the series of processing is finished as it is.
[0228] 続いて、ステップ S861によって、第 1〜第 5の凍結'積雪条件 3が成立(「条件 3成 立カウンタ = 5秒間(50回)」)して ヽな 、と判断された場合 (ステップ S861: No)、つ ぎに、条件カウンタ判定部 717によって、条件 3成立カウンタを + 1インクリメントする( ステップ S871)。その後、そのまま一連の処理を終了する。  [0228] Subsequently, if it is determined in step S861 that the 1st to 5th frozen snow condition 3 is satisfied ("Condition 3 establishment counter = 5 seconds (50 times)") Step S861: No) Next, the condition counter determination unit 717 increments the condition 3 satisfaction counter by +1 (step S871). Thereafter, the series of processing is finished as it is.
[0229] 最後に、ステップ S877によって、第 1〜第 5の凍結 ·積雪条件 4が成立(「条件 4成 立カウンタ = 5秒間(50回)」)して ヽな 、と判断された場合 (ステップ S877: No)、つ ぎに、条件カウンタ判定部 717によって、条件 4成立カウンタを + 1インクリメントする( ステップ S887)。その後、そのまま一連の処理を終了する。  [0229] Finally, if it is determined in step S877 that the first to fifth frozen / snow conditions 4 are satisfied ("Condition 4 establishment counter = 5 seconds (50 times)") Step S877: No) Next, the condition counter determination unit 717 increments the condition 4 satisfaction counter by +1 (step S887). Thereafter, the series of processing is finished as it is.
[0230] まず、ステップ S844によって、第 1〜第 5の凍結'積雪条件 1或いは条件 2のいず れも解除(「条件 1 & 2解除カウンタ = 5秒間(50回)」)して 、な 、と判断された場合 ( ステップ S844 :No)、つぎに、条件カウンタ判定部 717によって、条件 1 &2解除カウ ンタを + 1インクリメントする(ステップ S855)。その後、そのまま一連の処理を終了す る。  [0230] First, in step S844, the first to fifth frozen snow conditions 1 or 2 are canceled ("condition 1 & 2 cancellation counter = 5 seconds (50 times)"). (Step S844: No), the condition counter determination unit 717 increments the condition 1 & 2 cancellation counter by +1 (step S855). Thereafter, the series of processing is finished as it is.
[0231] つぎは、ステップ S892によって、第 1〜第 5の凍結'積雪条件 3或いは条件 4のい ずれも解除(「条件 3 & 4解除カウンタ = 5秒間(50回)」)して 、な 、と判断された場 合 (ステップ S892 :No)、つぎに、条件カウンタ判定部 717によって、条件 3 & 4解除 カウンタを + 1インクリメントする(ステップ S903)。その後、そのまま一連の処理を終 了する。  [0231] Next, in Step S892, the first to fifth frozen snow conditions 3 or 4 are canceled ("Condition 3 & 4 cancellation counter = 5 seconds (50 times)"). (Step S892: No), the condition counter determination unit 717 increments the condition 3 & 4 release counter by +1 (step S903). After that, the series of processing ends.
[0232] (他の実施例 1)  [0232] (Other Example 1)
また、上述した実施例と異なる他の実施例 1について説明する。図 23は、駆動タイ プの選択画面の一例を示す説明図である。図 23の表示画面 2300に示すように、選 択画面 2310を設ける。このような構成を備えることで、ナビゲーシヨン画面からユー ザ一のリモコンキー操作、タツチパネルキー操作或いは音声合成の案内と音声認識 により、運転中の車両が四輪駆動 (4WD)、後輪駆動 (FR、 MR、 RR)或いは前輪駆 動 (FF)の 、ずれか一つの駆動タイプを選択して入力する。 Another embodiment 1 different from the above-described embodiment will be described. FIG. 23 is an explanatory diagram showing an example of a drive type selection screen. As shown in the display screen 2300 in FIG. 23, a selection screen 2310 is provided. With this configuration, the user's remote control key operation, touch panel key operation or voice synthesis guidance and voice recognition can be performed from the navigation screen. By selecting one of the drive types, four-wheel drive (4WD), rear-wheel drive (FR, MR, RR) or front-wheel drive (FF) is selected and input.
[0233] また、図 24は、ホイールタイプの選択画面の一例を示す説明図である。図 24の表 示画面 2400に示すように、選択画面 2410を設ける。この画面では、ノーマルタイヤ 、ラジアルタイヤ、スノータイヤ或いはスタッドレスタイヤのいずれか一つのホイールタ イブを選択して入力する。  [0233] FIG. 24 is an explanatory diagram showing an example of a wheel type selection screen. A selection screen 2410 is provided as shown in the display screen 2400 in FIG. On this screen, select and input one of the normal tire, radial tire, snow tire or studless tire.
[0234] さらに、図 25は、タイヤチ ーン装着有無の選択画面の一例を示す説明図である。  Furthermore, FIG. 25 is an explanatory view showing an example of a selection screen for whether or not a tire chain is mounted.
図 25の表示画面 2500に示すように、選択画面 2510を設ける。この画面では、タイ ャチェーン装着中ならば「Yes」、タイヤチェーン未装着中ならば「No」のいずれか一 方を選択して入力する。  As shown in the display screen 2500 in FIG. 25, a selection screen 2510 is provided. On this screen, select either “Yes” if the tire chain is installed, or “No” if the tire chain is not installed.
[0235] 以上、図 23〜図 25に示したような機能により、第 1〜第 5の凍結 ·積雪条件 1、条件 2、条件 3或いは条件 4 (速度差、加速度差、標準偏差 1 (= 分散 1)、路面傾斜角 度差および標準偏差 2 (= 分散 2) )の 、ずれでも「パラメータの値」を変更したり、 最大で第 5までの「凍結 ·積雪条件の数」も変更したりすることができる。  [0235] By the functions as shown in FIGS. 23 to 25, the first to fifth frozen / snow condition 1, condition 2, condition 3 or condition 4 (speed difference, acceleration difference, standard deviation 1 (= Even if the variance 1), road slope angle difference and standard deviation 2 (= variance 2)) are different, the `` parameter value '' is changed and the maximum number of `` freezing / snow conditions '' up to the fifth is also changed. Can be.
[0236] さらに、外気温 Toutn[°C]の「判定基準温度」を変更したり、最大で 5秒間(50回) までの条件 1、条件 2、条件 3或いは条件 4成立カウンタおよび条件 1 &2或いは条件 3 & 4解除カウンタの「カウントの回数」も変更したりすることができる。  [0236] In addition, the “judgment reference temperature” of the outside air temperature Toutn [° C] can be changed, or the condition 1, condition 2, condition 3 or condition 4 establishment counter and condition 1 & 2 up to 5 seconds (50 times) Alternatively, the “count count” of the condition 3 & 4 release counter can be changed.
[0237] これは、凍結状態や積雪状態の登坂、降坂或いは平坦な路面では四輪駆動車と 後輪駆動車と前輪駆動車で、また、ノーマルタイヤとラジアルタイヤとスノータイヤとス タッドレスタイヤで、さらに、タイヤチェーン装着中或いは未装着中で、車速パルス速 度 VPn[mZs]の変化量(車速パルス加速度) Δ VPn[mZs2 ]への影響が違うため 、具体的には、通常 (乾燥'湿潤状態)の路面走行時に対して、車両の駆動輪の不規 則な回転や空回り、四輪の滑降や滑走などの度合がそれぞれ異なるためである。 [0237] This is a four-wheel drive vehicle, a rear wheel drive vehicle and a front wheel drive vehicle on a frozen or snowy uphill, downhill or flat road surface, and a normal tire, radial tire, snow tire and studless. Since the effect on the amount of change in the vehicle speed pulse speed VPn [mZs] (vehicle speed pulse acceleration) ΔVPn [mZs 2 ] is different between the tire and whether the tire chain is attached or not attached. This is because the degree of irregular rotation or idling of the driving wheels of the vehicle, downhill or sliding of the four wheels, etc., differs from when driving on a dry (wet or wet) road surface.
[0238] (他の実施例 2)  [0238] (Other Example 2)
さらに、他の実施例 2として、図 9〜図 11に示したフローチャートにおいて、いくつか の処理を変更してもよい。この実施例では、まず、経路誘導優先判定部 720によって 、経路探索および経路誘導に路面状況回避優先 1を通知する (ステップ S822)。こ のステップ S822では、上記のステップ S814で第 1〜第 5の凍結'積雪条件 1が成立 (「条件 1成立カウンタ = 5秒間(50回)」)して 、ると判断された場合 (ステップ S814: Yes)に処理が行われる。ここでは、上位層(上位レイヤ)である「経路探索開始時」、 「経路探索中」或いは「経路誘導中」にステップ S822の情報を送ることにより、より良 い「経路探索」或いは「経路誘導」の条件になり得る。ステップ S822では、路面傾斜 角度 Θ Pn[rad. ]の「凍結状態か積雪状態の登坂路面」を走行中であることを表す 情報を「凍結'積雪路面の回避優先 1」として、上位層(上位レイヤ)に通知する。そし て、その後、ステップ S823の処理へ移行する。 Furthermore, as another embodiment 2, some processes may be changed in the flowcharts shown in FIGS. In this embodiment, first, the route guidance priority determination unit 720 notifies the route search and route guidance of road surface avoidance priority 1 (step S822). In this step S822, the first to fifth freezing snow conditions 1 are established in step S814 above. ("Condition 1 Satisfaction Counter = 5 seconds (50 times)"), and if it is determined (step S814: Yes), processing is performed. Here, by sending the information in step S822 to the upper layer (upper layer) “starting route search”, “during route search”, or “during route guidance”, better “route search” or “route guidance” "Can be the condition. In step S822, the information indicating that the vehicle is traveling on a “frozen or snowy uphill road surface” with a road surface inclination angle Θ Pn [rad. Layer). Then, the process proceeds to step S823.
[0239] つぎに、経路誘導優先判定部 720によって、経路探索および経路誘導に路面状況 回避優先 2を通知する(ステップ S838)。このステップ S838では、上記のステップ S8 30で第 1〜第 5の凍結 ·積雪条件 2が成立(「条件 2成立カウンタ = 5秒間(50回)」) していると判断された場合 (ステップ S830 : Yes)に処理が行われる。ここでは、上位 層(上位レイヤ)である「経路探索開始時」、「経路探索中」或いは「経路誘導中」にス テツプ S838の情報を送ることにより、より良 、「経路探索」或 、は「経路誘導」の条件 になり得る。ステップ S838では、路面傾斜角度 Θ Pn[rad. ]がステップ S822よりも「 緩やかな登坂路面か或いは平坦に近い登坂路面」を走行中であることを表す情報を 「凍結'積雪路面の回避優先 2」として、上位層(上位レイヤ)に通知する。そして、そ の後、ステップ S839の処理へ移行する。  [0239] Next, the route guidance priority determination unit 720 notifies the route search and route guidance of road surface avoidance priority 2 (step S838). In this step S838, when it is determined in the above step S830 that the first to fifth frozen / snow condition 2 is satisfied (“Condition 2 satisfied counter = 5 seconds (50 times)”) (step S830 : Processing is performed at Yes). Here, it is better to send the information of step S838 to the upper layer (upper layer) “when starting route search”, “during route search” or “during route guidance”, so that “route search” or This can be a “route guidance” condition. In step S838, information indicating that the road slope angle Θ Pn [rad.] Is traveling on a “gradually uphill road surface or a nearly uphill road surface” than in step S822 is displayed as “prevention of frozen snowy road surface 2”. To the upper layer (upper layer). Then, the process proceeds to step S839.
[0240] 続、て、経路誘導優先判定部 720によって、経路探索および経路誘導に路面状況 回避優先 3を通知する(ステップ S869)。このステップ S869では、上記のステップ S8 61で第 1〜第 5の凍結 ·積雪条件 3が成立(「条件 3成立カウンタ = 5秒間(50回)」) していると判断された場合 (ステップ S861 : Yes)に処理が行われる。ここでは、上位 層(上位レイヤ)である「経路探索開始時」、「経路探索中」或いは「経路誘導中」にス テツプ S869の情報を送ることにより、より良 、「経路探索」或 、は「経路誘導」の条件 になり得る。ステップ S869では、路面傾斜角度 Θ Pn[rad. ]の「凍結状態か積雪状 態の降坂路面」を走行中であることを表す情報を「凍結'積雪路面の回避優先 3」とし て、上位層(上位レイヤ)に通知する。そして、その後、ステップ S870の処理へ移行 する。  Subsequently, the route guidance priority determination unit 720 notifies the route search and route guidance of road surface avoidance priority 3 (step S869). In this step S869, when it is determined in the above step S861 that the first to fifth freezing / snow accumulation conditions 3 are satisfied ("condition 3 establishment counter = 5 seconds (50 times)") (step S861 : Processing is performed at Yes). Here, it is better to send the information of step S869 to the upper layer (upper layer) at the time of “route search start”, “during route search” or “during route guidance”. This can be a “route guidance” condition. In step S869, the information indicating that the vehicle is traveling on a “downhill road surface in a frozen state or a snowy state” with a road surface inclination angle Θ Pn [rad.] Is set as “frozen snow road surface priority 3”. Notify the layer (upper layer). Then, the process proceeds to step S870.
[0241] 最後に、経路誘導優先判定部 720によって、経路探索および経路誘導に路面状 況回避優先 4を通知する(ステップ S885)。このステップ S885では、上記のステップ S877で第 1〜第 5の凍結 ·積雪条件 4が成立(「条件 4成立カウンタ = 5秒間(50回) 」)していると判断された場合 (ステップ S877 : Yes)に処理が行われる。ここでは、上 位層(上位レイヤ)である「経路探索開始時」、「経路探索中」或いは「経路誘導中」に ステップ S885の情報を送ることにより、より良 、「経路探索」或 、は「経路誘導」の条 件になり得る。ステップ S885では、路面傾斜角度 Θ Pn[rad. ]がステップ S869より も「緩やかな降坂路面か或いは平坦に近い降坂路面」を走行中であることを表す情 報を「凍結'積雪路面の回避優先 4」として、上位層(上位レイヤ)に通知する。そして 、その後、ステップ S886の処理へ移行する。 [0241] Finally, the route guidance priority determination unit 720 uses a road surface shape for route search and route guidance. Status avoidance priority 4 is notified (step S885). In this step S885, when it is determined in the above step S877 that the first to fifth freezing / snow accumulation conditions 4 are satisfied (“condition 4 establishment counter = 5 seconds (50 times)”) (step S877: Processing is performed at Yes). Here, by sending the information of step S885 to the upper layer (upper layer), “when starting route search”, “during route search” or “during route guidance”, the “route search” or It can be a “route guidance” condition. In step S885, information indicating that the road inclination angle Θ Pn [rad.] Is traveling on a “slower downhill road surface or a flat downhill road surface” than that in step S869 is “frozen snow road surface”. Notify the upper layer (upper layer) as “Avoidance priority 4”. Then, the process proceeds to step S886.
[0242] しかし、上位層(上位レイヤ)である「経路探索」或いは「経路誘導」にお 、て、常に 上記の情報が有効に活用されるとは限らない。例えば、目的地が「スキー場」や「屋 外スケート場」などのスノーエリアの場合或いはこれら機能を有するナビゲーシヨン装 置が使用されている地域が冬季期間中は積雪地帯、寒冷地帯であるような場合など である。よって、上記の情報を有効に活用するには上位層(上位レイヤ)である「経路 探索」或いは「経路誘導」自身の判断に委ねられる。  However, in the upper layer (upper layer) “route search” or “route guidance”, the above information is not always effectively used. For example, when the destination is a snow area such as a “ski resort” or “outdoor skating rink”, or the area where the navigation device having these functions is used is a snowy area or a cold area during the winter season. If so. Therefore, in order to effectively use the above information, it is left to the judgment of “route search” or “route guidance” itself, which is an upper layer (upper layer).
[0243] まず、経路誘導優先判定部 720によって、経路探索および経路誘導に路面状況回 避優先 1或いは優先 2のいずれか一方の解除を通知する(ステップ S853)。このステ ップ S853では、上記のステップ S844で第 1〜第 5の凍結'積雪条件 1或いは条件 2 の!、ずれか一方が解除(「条件 1 & 2解除カウンタ = 5秒間(50回)」)して 、ると判断 された場合 (ステップ S844 : Yes)に処理が行われる。ステップ S853では、ステップ S 822の路面傾斜角度 Θ Pn[rad. ]の「凍結状態か積雪状態の登坂路面」か、路面傾 斜角度 Θ Pn[rad. ]がステップ S822よりも「緩やかな登坂路面力、或いは平坦に近 い登坂路面」か、もしくは路面傾斜角度 Θ Pn[rad. ]がステップ S838よりも「緩やか な登坂路面か或!、は平坦に近!、登坂路面」を走行中でな!、ことを表す情報を「凍結 •積雪路面の回避優先 1或いは優先 2のいずれか一方の解除」として、上位層(上位 レイヤ)に通知する。そして、その後、ステップ S854の処理へ移行する。  [0243] First, the route guidance priority determination unit 720 notifies the route search and route guidance of the cancellation of either road surface avoidance priority 1 or priority 2 (step S853). In this step S853, one of the first to fifth frozen snow conditions 1 or 2 is canceled in step S844 above ("Condition 1 & 2 release counter = 5 seconds (50 times)") If it is determined (step S844: Yes), the process is performed. In step S853, the slope angle Θ Pn [rad.] Of the road surface slope in step S822 is either “frozen or snowy climbing road surface”, or the slope angle Θ Pn [rad.] Is more gradual than in step S822. The road surface slope angle Θ Pn [rad.] Is “gradual uphill road surface or near flat !, uphill road surface” than step S838. The information indicating this is notified to the upper layer (upper layer) as “freezing • cancellation of either priority 1 or priority 2 on avoiding snowy road surface”. Then, the process proceeds to step S854.
[0244] つぎに、経路誘導優先判定部 720によって、経路探索および経路誘導に路面状況 回避優先 3或いは優先 4のいずれか一方の解除を通知する(ステップ S901)。このス テツプ S901では、上記のステップ S892で第 1〜第 5の凍結 ·積雪条件 3或いは条件 4の 、ずれか一方が解除(「条件 3 & 4解除カウンタ = 5秒間(50回)」)して 、ると判断 された場合 (ステップ S892 : Yes)に処理が行われる。ステップ S901では、ステップ S 869の路面傾斜角度 Θ Pn[rad. ]の「凍結状態か積雪状態の降坂路面」か、路面傾 斜角度 Θ Pn[rad. ]がステップ S869よりも「緩やかな降坂路面力、或いは平坦に近 い降坂路面」か、もしくは路面傾斜角度 Θ Pn[rad. ]がステップ S885よりも「緩やか な降坂路面か或 、は平坦に近!、降坂路面」を走行中でな!、ことを表す情報を「凍結 •積雪路面の回避優先 3或いは優先 4のいずれか一方の解除」として、上位層(上位 レイヤ)に通知する。そして、その後、ステップ S902の処理へ移行する。 [0244] Next, the route guidance priority determination unit 720 notifies the route search and route guidance of the cancellation of either road surface avoidance priority 3 or priority 4 (step S901). This In step S901, either of the first to fifth freezing / snow coverage conditions 3 or 4 is canceled in the above step S892 ("Condition 3 & 4 cancellation counter = 5 seconds (50 times)") If it is determined (step S892: Yes), the process is performed. In step S901, the road slope angle Θ Pn [rad.] Of step S869 is “downhill road surface in frozen or snowy condition”, or the road slope angle Θ Pn [rad. `` Slope road surface force or downhill road surface close to flat '', or road slope angle Θ Pn [rad.] Is `` slower downhill road surface or near flat !, downhill road surface '' than step S885 Notifying the upper layer (upper layer) of the information indicating that the vehicle is not traveling as “freezing • canceling either of priority 3 or 4 of avoidance of snowy road surface”. Then, the process proceeds to step S902.
[0245] 以上、説明したように、本実施例によれば、高精度に走行路面状況を判断すること で、移動体の運転者の状況判断動作を補助する。したがって、運転者の負担を軽減 させることがでさる。 As described above, according to the present embodiment, the situation determination operation of the driver of the moving body is assisted by determining the traveling road surface condition with high accuracy. Therefore, the burden on the driver can be reduced.
[0246] なお、本実施の形態で説明した路面状況判断方法、経路探索方法および位置設 定方法は、あら力じめ用意されたプログラムをパーソナル 'コンピュータやワークステ ーシヨンなどのコンピュータで実行することにより実現することができる。このプロダラ ムは、ハードディスク、フレキシブルディスク、 CD— ROM、 MO、 DVDなどのコンビ ユータで読み取り可能な記録媒体に記録され、コンピュータによって記録媒体力 読 み出されることによって実行される。またこのプログラムは、インターネットなどのネット ワークを介して配布することが可能な伝送媒体であってもよい。  [0246] The road surface condition determination method, route search method, and position setting method described in the present embodiment are executed by executing a prepared program on a computer such as a personal computer or a workstation. Can be realized. This program is recorded on a recording medium that can be read by a computer such as a hard disk, flexible disk, CD-ROM, MO, or DVD, and is executed by the recording medium being read by a computer. The program may be a transmission medium that can be distributed through a network such as the Internet.

Claims

請求の範囲 The scope of the claims
[1] 移動体周辺の外気温に関する情報を取得する気温情報取得手段と、  [1] Air temperature information acquisition means for acquiring information on the outside air temperature around the moving body,
GPS信号を受信する受信手段と、  A receiving means for receiving a GPS signal;
前記 GPS信号の情報を用いて、前記移動体の第 1の速度を算出する第 1速度算出 手段と、  First speed calculating means for calculating a first speed of the moving body using the information of the GPS signal;
前記移動体に搭載されているセンサ力 前記移動体の速度に関する情報を取得 する速度情報取得手段と、  Sensor force mounted on the moving body Speed information acquiring means for acquiring information on the speed of the moving body;
前記速度に関する情報を用いて、前記移動体の第 2の速度を算出する第 2速度算 出手段と、  Second speed calculating means for calculating a second speed of the moving body using the information on the speed;
前記外気温に関する情報、前記第 1の速度、および前記第 2の速度に基づいて、 前記移動体が走行している路面の状況を判断する判断手段と、  Based on the information on the outside air temperature, the first speed, and the second speed, a determination unit that determines the condition of the road surface on which the moving body is traveling,
を備えることを特徴とする路面状況判断装置。  A road surface condition judging device comprising:
[2] 前記判断手段は、前記外気温に関する情報から外気温が所定値以下であると判 断した場合に、前記第 1の速度と前記第 2の速度との差を用いて、前記移動体が走 行している路面が凍結状態もしくは積雪状態であるか否かを判断することを特徴とす る請求項 1に記載の路面状況判断装置。 [2] The determination means uses the difference between the first speed and the second speed when the outside air temperature is determined to be equal to or less than a predetermined value from the information related to the outside air temperature. 2. The road surface condition judging device according to claim 1, wherein it is judged whether or not the road surface on which the vehicle is running is frozen or snowy.
[3] 前記第 1速度算出手段は、前記第 1の速度を算出するとともに、当該第 1の速度か ら第 1の加速度を算出し、 [3] The first speed calculating means calculates the first speed, calculates a first acceleration from the first speed,
前記第 2速度算出手段は、前記第 2の速度を算出するとともに、当該第 2の速度か ら第 2の加速度を算出し、  The second speed calculating means calculates the second speed, calculates a second acceleration from the second speed,
前記判断手段は、前記外気温に関する情報から外気温が所定値以下であると判 断した場合に、前記第 1の加速度と前記第 2の加速度との差を用いて、前記移動体 が走行して ヽる路面が凍結状態もしくは積雪状態であるカゝ否かを判断することを特徴 とする請求項 1に記載の路面状況判断装置。  The determination means uses the difference between the first acceleration and the second acceleration when the outside air temperature is determined to be less than or equal to a predetermined value from the information related to the outside air temperature. 2. The road surface condition judging device according to claim 1, wherein it is judged whether or not the road surface is frozen or snowy.
[4] 前記第 1の速度の水平方向速度および垂直方向速度を用いて、前記移動体が走 行している路面の第 1の傾斜角を算出する第 1傾斜角算出手段と、 [4] First inclination angle calculating means for calculating a first inclination angle of the road surface on which the moving body is running, using the horizontal speed and the vertical speed of the first speed;
前記移動体の加速度を検出する加速度検出手段と、  Acceleration detecting means for detecting acceleration of the moving body;
前記第 2の速度および前記加速度検出手段によって検出された加速度を用いて、 前記移動体が走行している路面の第 2の傾斜角を算出する第 2傾斜角算出手段と、 をさらに備え、 Using the acceleration detected by the second speed and the acceleration detection means, A second inclination angle calculating means for calculating a second inclination angle of the road surface on which the moving body is traveling, and further comprising:
前記判断手段は、前記外気温に関する情報から外気温が所定値以下であると判 断した場合に、前記第 1の傾斜角と前記第 2の傾斜角との差を用いて、前記移動体 が走行して ヽる路面が凍結状態もしくは積雪状態であるカゝ否かを判断することを特徴 とする請求項 1に記載の路面状況判断装置。  The determination means uses the difference between the first inclination angle and the second inclination angle when the outside air temperature is determined to be equal to or less than a predetermined value from the information related to the outside air temperature. 2. The road surface condition judging device according to claim 1, wherein the road surface condition judging device judges whether or not the road surface on which the vehicle travels is frozen or snowy.
[5] 前記移動体の加速度を検出する加速度検出手段をさらに備え、 [5] The apparatus further comprises acceleration detecting means for detecting the acceleration of the moving body,
前記判断手段は、  The determination means includes
前記第 2の速度および前記加速度検出手段によって検出された加速度を用いて、 前記移動体が走行している路面の傾斜が登りであるか下りであるかの傾斜状況を判 断し、  Using the second speed and the acceleration detected by the acceleration detecting means to determine whether the road surface on which the moving body is traveling is uphill or downhill;
前記傾斜状況に応じて、前記移動体が走行して!/、る路面の状況の判断基準を変 更することを特徴とする請求項 1に記載の路面状況判断装置。  2. The road surface condition determining apparatus according to claim 1, wherein the road surface condition determining criterion is changed according to the inclination state.
[6] 前記移動体の駆動に関する情報を取得する駆動情報取得手段をさらに備え、 前記判断手段は、前記駆動に関する情報に応じて、前記移動体が走行している路 面の状況の判断基準を変更することを特徴とする請求項 1に記載の路面状況判断装 置。 [6] Drive information acquisition means for acquiring information related to driving of the moving body is further provided, wherein the determination means determines a criterion for determining the condition of the road surface on which the moving body is traveling according to the information related to driving. The road surface condition judging device according to claim 1, wherein the road surface condition judging device is changed.
[7] 請求項 1〜6のいずれか一つに記載の路面状況判断装置と、  [7] The road surface condition judging device according to any one of claims 1 to 6,
前記路面状況判断装置による前記移動体が走行している路面の状況の判断結果 および目的地が属する地域特性に基づ!/、て、前記目的地までの経路を探索する探 索手段と、  A search means for searching for a route to the destination based on a determination result of a road surface on which the moving body is traveling by the road surface determination device and a regional characteristic to which the destination belongs;
を備えることを特徴とする経路探索装置。  A route search apparatus comprising:
[8] 請求項 1〜6のいずれか一つに記載の路面状況判断装置と、 [8] The road surface condition judging device according to any one of claims 1 to 6,
前記 GPS信号に基づいて前記移動体の位置を測位する第 1測位手段と、 前記第 2の速度を用いて前記移動体の位置を測位する第 2測位手段と、 前記第 1測位手段の測位結果および前記第 2測位手段の測位結果を用いて前記 移動体の位置を設定する設定手段と、  First positioning means for positioning the position of the moving body based on the GPS signal; second positioning means for positioning the position of the moving body using the second speed; and positioning results of the first positioning means. And setting means for setting the position of the moving body using the positioning result of the second positioning means,
を備え、 前記設定手段は、前記路面状況判断装置による前記移動体が走行している路面 の状況の判断結果に基づ!、て、前記第 1測位手段の測位結果および前記第 2測位 手段の測位結果を用いる割合を決定することを特徴とする位置設定装置。 With The setting means, based on the determination result of the road surface condition on which the moving body is traveling by the road surface condition determination device, shows the positioning result of the first positioning means and the positioning result of the second positioning means. A position setting device that determines a ratio to be used.
[9] 移動体周辺の外気温に関する情報を取得する気温情報取得工程と、 [9] An air temperature information acquisition step for acquiring information on the outside air temperature around the moving body,
GPS信号を受信する受信工程と、  A receiving process for receiving GPS signals;
前記 GPS信号の情報を用いて、前記移動体の第 1の速度を算出する第 1速度算出 工程と、  A first speed calculating step of calculating a first speed of the moving body using the information of the GPS signal;
前記移動体に搭載されているセンサ力 前記移動体の速度に関する情報を取得 する速度情報取得工程と、  A sensor force mounted on the moving body; a speed information acquiring step for acquiring information on the speed of the moving body;
前記速度に関する情報を用いて、前記移動体の第 2の速度を算出する第 2速度算 出工程と、  A second speed calculating step for calculating a second speed of the moving body using the information on the speed;
前記外気温に関する情報、前記第 1の速度、および前記第 2の速度に基づいて、 前記移動体が走行している路面の状況を判断する判断工程と、  A determination step of determining a condition of a road surface on which the moving body is traveling based on the information on the outside air temperature, the first speed, and the second speed;
を含むことを特徴とする路面状況判断方法。  The road surface condition judging method characterized by including.
[10] 移動体周辺の外気温に関する情報を取得する気温情報取得工程と、 [10] An air temperature information acquisition step for acquiring information on the outside air temperature around the moving body,
GPS信号を受信する受信工程と、  A receiving process for receiving GPS signals;
前記 GPS信号の情報を用いて、前記移動体の第 1の速度を算出する第 1速度算出 工程と、  A first speed calculating step of calculating a first speed of the moving body using the information of the GPS signal;
前記移動体に搭載されているセンサ力 前記移動体の速度に関する情報を取得 する速度情報取得工程と、  A sensor force mounted on the moving body; a speed information acquiring step for acquiring information on the speed of the moving body;
前記速度に関する情報を用いて、前記移動体の第 2の速度を算出する第 2速度算 出工程と、  A second speed calculating step for calculating a second speed of the moving body using the information on the speed;
前記外気温に関する情報、前記第 1の速度、および前記第 2の速度に基づいて、 前記移動体が走行している路面の状況を判断する判断工程と、  A determination step of determining a condition of a road surface on which the moving body is traveling based on the information on the outside air temperature, the first speed, and the second speed;
前記判断工程の判断結果および目的地が属する地域特性に基づ!、て、前記目的 地までの経路を探索する探索工程と、  Based on the determination result of the determination step and the regional characteristics to which the destination belongs, a search step for searching for a route to the destination;
を含むことを特徴とする経路探索方法。  A route search method comprising:
[11] 移動体周辺の外気温に関する情報を取得する気温情報取得工程と、 GPS信号を受信する受信工程と、 [11] An air temperature information acquisition step for acquiring information on the outside air temperature around the moving body, A receiving process for receiving GPS signals;
前記 GPS信号の情報を用いて、前記移動体の第 1の速度を算出する第 1速度算出 工程と、  A first speed calculating step of calculating a first speed of the moving body using the information of the GPS signal;
前記移動体に搭載されているセンサ力 前記移動体の速度に関する情報を取得 する速度情報取得工程と、  A sensor force mounted on the moving body; a speed information acquiring step for acquiring information on the speed of the moving body;
前記速度に関する情報を用いて、前記移動体の第 2の速度を算出する第 2速度算 出工程と、  A second speed calculating step for calculating a second speed of the moving body using the information on the speed;
前記外気温に関する情報、前記第 1の速度、および前記第 2の速度に基づいて、 前記移動体が走行している路面の状況を判断する判断工程と、  A determination step of determining a condition of a road surface on which the moving body is traveling based on the information on the outside air temperature, the first speed, and the second speed;
前記 GPS信号に基づいて前記移動体の位置を測位する第 1測位工程と、 前記第 2の速度を用いて前記移動体の位置を測位する第 2測位工程と、 前記判断工程の判断結果に基づいて、前記移動体の位置設定に用いる前記第 1 測位工程の測位結果および前記第 2測位工程の測位結果の割合を決定する決定ェ 程と、  Based on a first positioning step of positioning the position of the moving body based on the GPS signal, a second positioning step of positioning the position of the moving body using the second speed, and based on a determination result of the determination step A determination step for determining a ratio of the positioning result of the first positioning step and the positioning result of the second positioning step used for setting the position of the mobile body;
前記割合に応じた前記第 1測位工程の結果および前記第 2測位工程の結果を用 V、て前記移動体の位置を設定する設定工程と、  A setting step for setting the position of the moving body using the result of the first positioning step and the result of the second positioning step according to the ratio V, and
を含むことを特徴とする位置設定方法。  The position setting method characterized by including.
[12] 請求項 9〜: L 1のいずれか一つに記載の方法をコンピュータに実行させることを特 徴とするプログラム。 [12] Claim 9 ~: A program characterized by causing a computer to execute the method according to any one of L1.
[13] 請求項 12に記載のプログラムを記録したことを特徴とする記録媒体。  [13] A recording medium on which the program according to claim 12 is recorded.
PCT/JP2007/051516 2006-02-01 2007-01-30 Road surface condition determination device, route search device, position setting method, road surface condition determination method, route search method, position setting method, program, and recording medium WO2007088859A1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2007556871A JP4734349B2 (en) 2006-02-01 2007-01-30 Road surface condition determination device, route search device, position setting device, road surface condition determination method, route search method, position setting method, program, and recording medium

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2006024911 2006-02-01
JP2006-024911 2006-02-01

Publications (1)

Publication Number Publication Date
WO2007088859A1 true WO2007088859A1 (en) 2007-08-09

Family

ID=38327430

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2007/051516 WO2007088859A1 (en) 2006-02-01 2007-01-30 Road surface condition determination device, route search device, position setting method, road surface condition determination method, route search method, position setting method, program, and recording medium

Country Status (2)

Country Link
JP (1) JP4734349B2 (en)
WO (1) WO2007088859A1 (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017056385A1 (en) * 2015-09-29 2017-04-06 ソニー株式会社 Information processing device, information processing method, and program
US10293829B2 (en) 2015-07-16 2019-05-21 Toyota Jidosha Kabushiki Kaisha Road surface submergence estimation device
WO2020195358A1 (en) * 2019-03-28 2020-10-01 パナソニックIpマネジメント株式会社 Skid information control system and skid information control method
US11867519B2 (en) 2019-10-15 2024-01-09 Google Llc Weather and road surface type-based navigation directions
US11892314B2 (en) 2021-05-17 2024-02-06 International Business Machines Corporation Thermally efficient route selection

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004085564A (en) * 2002-08-07 2004-03-18 Nagoya Electric Works Co Ltd Method of and apparatus for determining condition of road surface
JP2004205348A (en) * 2002-12-25 2004-07-22 Matsushita Electric Ind Co Ltd Navigation device
JP2004206351A (en) * 2002-12-25 2004-07-22 Denso Corp Onboard information communication apparatus used in information communication system and information communication method using vehicle
JP2004294452A (en) * 2004-07-23 2004-10-21 Pioneer Electronic Corp Method and device for drawing out moving distance
JP2005313863A (en) * 2004-03-24 2005-11-10 Sumitomo Rubber Ind Ltd Road surface condition judging method and device, and road surface condition judging program

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004085564A (en) * 2002-08-07 2004-03-18 Nagoya Electric Works Co Ltd Method of and apparatus for determining condition of road surface
JP2004205348A (en) * 2002-12-25 2004-07-22 Matsushita Electric Ind Co Ltd Navigation device
JP2004206351A (en) * 2002-12-25 2004-07-22 Denso Corp Onboard information communication apparatus used in information communication system and information communication method using vehicle
JP2005313863A (en) * 2004-03-24 2005-11-10 Sumitomo Rubber Ind Ltd Road surface condition judging method and device, and road surface condition judging program
JP2004294452A (en) * 2004-07-23 2004-10-21 Pioneer Electronic Corp Method and device for drawing out moving distance

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10293829B2 (en) 2015-07-16 2019-05-21 Toyota Jidosha Kabushiki Kaisha Road surface submergence estimation device
WO2017056385A1 (en) * 2015-09-29 2017-04-06 ソニー株式会社 Information processing device, information processing method, and program
US20180268700A1 (en) * 2015-09-29 2018-09-20 Sony Corporation Information processing apparatus, information processing method, and program
US10692379B2 (en) 2015-09-29 2020-06-23 Sony Corporation Image processing device and image processing method
WO2020195358A1 (en) * 2019-03-28 2020-10-01 パナソニックIpマネジメント株式会社 Skid information control system and skid information control method
US11867519B2 (en) 2019-10-15 2024-01-09 Google Llc Weather and road surface type-based navigation directions
US11892314B2 (en) 2021-05-17 2024-02-06 International Business Machines Corporation Thermally efficient route selection

Also Published As

Publication number Publication date
JPWO2007088859A1 (en) 2009-06-25
JP4734349B2 (en) 2011-07-27

Similar Documents

Publication Publication Date Title
WO2023023936A1 (en) Positioning method and positioning apparatus
WO2007088859A1 (en) Road surface condition determination device, route search device, position setting method, road surface condition determination method, route search method, position setting method, program, and recording medium
JP2007328050A (en) Map display device and map display method
EP3823321A1 (en) Method, apparatus, and system for detecting joint motion
CN110515106B (en) BDS and GPS combined multi-source information fusion multi-mode vehicle positioning device and positioning method
JP6815406B2 (en) Speed calculator, control method, program and storage medium
JPH06341847A (en) Navigation apparatus
US20110319099A1 (en) Navigation or mapping system and method
WO2013094045A1 (en) Energy consumption prediction device, energy consumption prediction method, and energy consumption prediction program
JP2015200660A (en) Road map preparation system, road map preparation device, road map preparation method, and navigation system
JP2008196906A (en) Vehicle position detection system, on-board equipment and vehicle position detection method
CN107850447A (en) Guider and air navigation aid
JP2014142185A (en) On-board device, terminal unit and navigation system
WO2011079869A1 (en) Collecting driving conditions from navigation devices
JP2007102424A (en) Chain information notification device
AU2017254915B2 (en) Information processing system and information processing method
US11605233B2 (en) Apparatus and methods for determining state of visibility for a road object in real time
KR100973551B1 (en) Method for Navigation Service using of Car Driving Information and Car Navigation System of that
JP5456444B2 (en) Travel information collection system and server device
CN111735469B (en) Map navigation implementation method, storage medium and server
KR20000031712A (en) Apparatus for detecting slope and vehicle speed using gyro and acceleration meter
EP4193122A1 (en) Extended dead reckoning accuracy
JP3967178B2 (en) GUIDANCE GUIDANCE DEVICE, GUIDANCE GUIDANCE SYSTEM, METHOD THEREOF, PROGRAM THEREOF, AND RECORDING MEDIUM CONTAINING THE PROGRAM
JP4089625B2 (en) Radio wave transmission device and navigation device
JP2004108937A (en) Information transmitting apparatus, navigation apparatus, system, method, and program

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application
ENP Entry into the national phase

Ref document number: 2007556871

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 07707734

Country of ref document: EP

Kind code of ref document: A1