JP5916540B2 - Speed calculation device, speed calculation method, speed calculation program, and recording medium - Google Patents

Description

  The present invention relates to a speed calculation device, a speed calculation method, a speed calculation program, and a recording medium.

  Conventionally, a navigation device mounted on a moving body such as a vehicle has a vehicle speed output from the vehicle at a time interval proportional to GPS information from a GPS (Global Positioning System) satellite, an output shaft of a transmission, and a rotation speed of a tire. In addition to the signal, the speed is calculated using various signals output from various sensors.

  The vehicle speed signal may not be used depending on the situation in use and the model of the navigation device. For example, in a vehicle equipped with ABS (Anti Lock Brake System), when traveling at low speed, the vehicle speed sensor cannot determine whether the wheel is locked or rotating, and the vehicle speed sensor does not output a vehicle speed signal. There is. In view of this, a technique has been proposed in which the speed can be detected during low-speed traveling (for example, see Patent Document 1 below).

  In addition, portable portable products called PND (Portable Navigation Device) are widely used in navigation devices. For example, the PND calculates the speed of the vehicle when the user brings it into the vehicle and installs it at a predetermined position. Since the PND is brought into the vehicle by the user, various information from the vehicle cannot be acquired, and in particular, a vehicle speed signal cannot be acquired. Therefore, when calculating the speed, the speed is calculated using, for example, a built-in acceleration sensor.

JP 2003-322533 A

  However, the above-described prior art has a problem that it is not possible to always calculate a stable and accurate speed. Specifically, the technique of Patent Document 1 described above is premised on a configuration capable of acquiring a vehicle speed signal. If the vehicle speed signal cannot be used for some reason, such as a vehicle speed sensor failure, the speed is set. The problem that it cannot be calculated is an example.

  Also, for example, in a simple product such as PND, if the speed is calculated using only the acceleration sensor, the vehicle's acceleration is integrated to calculate the speed, so the inclination angle when traveling on the slope is accumulated. Various errors are accumulated at the time of calculation, such as an error at the time of correction and an error of a midpoint voltage that varies with a change in power supply voltage. As a result, there is a problem that the speed cannot be calculated with high accuracy.

  In order to solve the above-described problems and achieve the object, a speed calculation device according to the invention of claim 1 includes a vertical speed detection means for detecting a vertical speed of a vertical component, and a pitch angle indicating a front-to-back inclination of the moving body. First, the moving speed of the moving body in the direction along the inclined surface is calculated based on the vertical speed and the pitch angle without using the angle detection means to detect and the acceleration in the traveling direction of the moving body. 1 calculating means.

  According to a fourth aspect of the present invention, there is provided a speed calculation method for use in a speed calculation apparatus for calculating a speed, the speed calculation apparatus comprising: a vertical speed detection step for detecting a vertical speed of a vertical component; An angle detection step for detecting a pitch angle indicating the front-rear inclination of the moving body, and along the inclined surface based on the vertical velocity and the pitch angle without using the acceleration in the traveling direction of the moving body. And a calculating step of calculating a moving speed of the moving body in the direction.

  According to a fifth aspect of the present invention, a speed calculation program causes a computer to execute the speed calculation method according to the fourth aspect.

  According to a sixth aspect of the present invention, there is provided a recording medium in which the speed calculation program according to the fifth aspect is recorded so as to be readable by a computer.

It is a block diagram which shows an example of a functional structure of the speed calculation apparatus concerning this Embodiment. It is explanatory drawing which shows the coordinate system centering on a vehicle. It is a flowchart which shows an example of the speed calculation process sequence of the speed calculation apparatus concerning this Embodiment. It is a block diagram which shows an example of the hardware constitutions of the navigation apparatus concerning a present Example. It is a flowchart which shows an example of the speed calculation process sequence of a navigation apparatus. It is explanatory drawing which shows an example of the moving speed of the vehicle on the conditions which cannot receive GPS information. It is explanatory drawing which shows an example of the display screen displayed on a display.

  Exemplary embodiments of a speed calculation device, a speed calculation method, a speed calculation program, and a recording medium according to the present invention will be explained below in detail with reference to the accompanying drawings.

(Embodiment)
(Functional configuration of speed calculation device)
The functional configuration of the speed calculation apparatus according to the embodiment of the present invention will be described with reference to FIG. FIG. 1 is a block diagram illustrating an example of a functional configuration of the speed calculation device according to the present embodiment. The speed calculation device 100 is intended for a simple navigation device that cannot acquire a vehicle speed signal detected at a time interval proportional to the rotation speed of a tire. For example, a PND (Portable Navigation Device), a smartphone, a mobile phone Realized by electronic devices such as

  The speed calculation device 100 calculates the speed of the moving body. The moving object is mainly intended for three or more automobiles including auto three-wheelers, ordinary automobiles, and large automobiles, but is not limited thereto, and may be a vehicle that travels on rails such as a railway vehicle.

  In FIG. 1, a speed calculation device 100 includes a vertical speed detection unit 101, an angle detection unit 102, a first calculation unit 103, an output unit 104, an acquisition unit 105, an acceleration detection unit 106, and a second calculation unit. 107 and a correction unit 108. The vertical speed detection unit 101 has a function of detecting the vertical speed of only the vertical component. The vertical speed detector 101 detects the speed in the z-axis direction, where the horizontal direction of the vehicle is the x-axis, the right-and-left direction is the y-axis, and the vertical direction is the z-axis. .

  For example, the vertical velocity detection unit 101 detects the velocity in the z-axis direction by integrating z-axis acceleration, which is a detection result of an acceleration sensor capable of measuring z-axis acceleration in the z-axis direction. The vertical velocity detection unit 101 is not limited to this, and uses information output from an atmospheric pressure sensor that measures atmospheric pressure, or uses GPS information received by a GPS (Global Positioning System) receiver. The speed in the z-axis direction may be detected.

  Here, a coordinate system centered on the vehicle will be described with reference to FIG. FIG. 2 is an explanatory diagram showing a coordinate system centered on the vehicle. In FIG. 2, with the vehicle 200 as the center, the horizontal direction of travel of the vehicle is the x axis, the right and left directions are perpendicular to the direction of travel and the left and right directions are the y axis and the vertical direction is the z axis.

  The rotation angle around the x axis is called a roll angle, the up and down swing angle around the y axis is called a pitch angle, and the left and right swing angle around the z axis is called a yaw angle. Specifically, the roll angle indicates the left / right inclination of the vehicle 200, for example, the inclination of the vehicle during turning. The yaw angle indicates an angle when the vehicle 200 turns, for example, an angle obtained by turning a handle. The pitch angle indicates the forward / backward inclination of the vehicle 200. The front and rear of the vehicle 200 are the front and rear of the vehicle. The pitch angle indicates the degree of inclination of the vehicle forward or backward, and specifically corresponds to the inclination angle of the slope with respect to the horizontal direction.

  Returning to FIG. 1, the angle detection unit 102 has a function of detecting a pitch angle indicating the front-rear inclination of the vehicle. Specifically, the pitch angle corresponds to the gradient (inclination angle) of the slope on which the vehicle travels. The pitch angle differs between positive and negative when the vehicle moves downhill and when the vehicle moves uphill. The angle detection unit 102 detects the pitch angle by, for example, a pitch angle gyro sensor (for example, a three-axis gyro sensor), but is not limited thereto, and is output from an x-axis acceleration sensor or a z-axis acceleration sensor. It is also possible to detect using information or using GPS information received by a GPS receiver.

  The first calculation unit 103 calculates the moving speed of the vehicle in the direction along the inclined surface based on the vertical speed detected by the vertical speed detection unit 101 and the pitch angle detected by the angle detection unit 102. The first calculation unit 103 calculates a moving speed based on the vertical speed and the pitch angle on an inclined road, and does not calculate the moving speed based on the vertical speed and the pitch angle on a horizontal road.

  The output unit 104 outputs the moving speed calculated by the first calculating unit 103 as a moving speed with respect to the road surface of the vehicle. The output unit 104 outputs, for example, the moving speed as a display or a voice.

Here, the calculation method of the moving speed in the direction along the inclined surface calculated by the first calculation unit 103 will be specifically described. If the vertical speed is α, the pitch angle is θ, and the moving speed of the vehicle along the inclined surface is β,
sin θ = α / β (1) That is, the moving speed β in the direction along the inclined surface is
β = α / sinθ
Can be expressed as: As described above, in the present embodiment, the moving speed β in the direction along the inclined surface can be calculated by obtaining the vertical speed α and the pitch angle θ.

  In addition, most slopes in urban areas have a slight inclination such that the inclination angle is less than several degrees, and the first calculation unit 103 according to the present embodiment can calculate the actual speed with a slight inclination. Considering what can be done, the moving speed of the vehicle traveling on the slope can be regarded as the speed of only the horizontal component. For this reason, the first calculation unit 103 may calculate the moving speed of the vehicle having only the horizontal component as the moving speed in the direction along the inclined surface.

A specific description will be given of a calculation method in the case of calculating the moving speed of the vehicle having only the horizontal component calculated by the first calculating unit 103 as the moving speed in the direction along the inclined surface. If the vertical speed is α, the pitch angle that is the slope angle of the slope is θ, and the moving speed of only the horizontal component is γ,
tan θ = α / γ (2) can be expressed as equation (2). That is, the moving speed γ of only the horizontal component is
γ = α / tan θ
Can be expressed as: Thus, in the present embodiment, the moving speed γ of only the horizontal component can be calculated by acquiring the vertical speed α and the pitch angle θ. The output unit 104 outputs the moving speed γ as a moving speed with respect to the slope.

  Note that, when the tilt angle is equal to or greater than a predetermined threshold, the above-described equation (1) may be used, and when the tilt angle is less than the predetermined threshold, the above-described equation (2) may be used. That is, the above equation (2) may be used only when the moving speed of the vehicle having only the horizontal component may be regarded as the moving speed with respect to the slope.

  The acquisition unit 105 acquires vehicle position information. Specifically, the acquisition unit 105 acquires latitude / longitude information from the GPS receiver at a predetermined timing. The first calculation unit 103 calculates the moving speed of the vehicle using the position information under conditions where the acquisition unit 105 can acquire the position information. For calculating the movement speed using the position information, a known technique may be used, and the description thereof is omitted here.

  Further, the first calculation unit 103 uses the above formula (1) or (2) based on the vertical speed and the pitch angle under the condition that the position information cannot be acquired by the acquisition unit 105. Then, the moving speed of the vehicle is calculated. Specifically, the conditions under which position information cannot be acquired are situations where GPS information is difficult to receive, such as in tunnels, multistory parking lots, underpasses, and underpasses.

  Moreover, the acceleration detection part 106 detects the acceleration of the advancing direction of a vehicle. The acceleration in the traveling direction of the vehicle is acceleration in the x-axis direction (x-axis acceleration). The acceleration detector 106 detects an x-axis acceleration using an acceleration sensor.

  The second calculation unit 107 calculates a moving speed in the traveling direction of the vehicle (hereinafter referred to as “second calculation speed”) based on the x-axis acceleration detected by the acceleration detection unit 106. The second calculation unit 107 detects the velocity in the x-axis direction by integrating the x-axis acceleration that is the detection result of the acceleration sensor. The second calculation unit 107 can calculate the second calculation speed on the slope and the horizontal road.

  Since the second calculation unit 107 calculates the speed by accumulating the x-axis acceleration, a difference occurs due to an error when accumulating the inclination angle when the vehicle travels on the slope or a change in the power supply voltage. Various errors may accumulate during calculation, such as point voltage errors. Therefore, the correction unit 108 corrects the second calculation speed.

  Specifically, the correction unit 108 corrects the second calculated speed based on the amount of deviation between the second calculated speed and the first calculated speed. Specifically, the correction unit 108 performs correction to bring the second calculation speed closer to the first calculation speed. For example, when the second calculation speed is 10 m / s and the first calculation speed is 12 m / s, the correction unit 108 sets 2 m / s corresponding to the difference between the second calculation speed and the first calculation speed to the second value. A correction is made to add to the calculation speed.

  The output unit 104 outputs a first calculated speed as the moving speed of the vehicle with respect to the road surface when the vehicle is moving on the slope. The output unit 104 outputs the second calculated speed corrected by the correction unit 108 when the vehicle is moving on a horizontal road.

(Speed calculation processing procedure of the speed calculation device)
Next, the speed calculation processing procedure of the speed calculation apparatus 100 will be described with reference to FIG. FIG. 3 is a flowchart illustrating an example of a speed calculation processing procedure of the speed calculation apparatus 100 according to the present embodiment.

  In the flowchart of FIG. 3, the speed calculation device 100 determines whether or not it has been activated (step S301). The speed calculation device 100 waits until starting (step S301: No), and when started (step S301: Yes), for example, using the measurement result of the acceleration sensor capable of measuring the z-axis acceleration, the speed calculation device 100 calculates the vertical speed. It detects (step S302). The speed calculation device 100 detects the pitch angle using, for example, a pitch angle gyro sensor (step S303).

  Then, the speed calculation device 100 calculates the moving speed of the vehicle by using the above-described expression (1) or (2) (step S304). Next, the speed calculating device 100 outputs the calculated moving speed as a moving speed with respect to the road surface of the vehicle (step S305), and ends a series of processes according to this flowchart.

  As described above, the speed calculation device 100 according to the present embodiment calculates and outputs the moving speed of the vehicle in the direction along the inclined surface based on the vertical speed and the pitch angle. Therefore, it is possible to calculate a moving speed close to the actual moving speed during traveling on an inclined road without using a vehicle speed signal, and to present an accurate speed to the user.

  Further, in the present embodiment, based on the vertical speed and the inclination angle, even if the moving speed of the vehicle with only the horizontal component is regarded as the moving speed of the vehicle in the direction along the inclined surface, Under conditions where position information cannot be received, an accurate value can be presented on an inclined road with a small inclination angle.

  Furthermore, in the present embodiment, under the condition where the position information of the vehicle can be acquired by the GPS receiver, the moving speed of the vehicle is calculated using the position information, and under the condition where the position information cannot be acquired, If the moving speed of the vehicle is calculated based on the vertical speed and the pitch angle, it is possible to present an accurate moving speed according to the reception status of the position information.

  In the present embodiment, the second calculated speed is based on the amount of deviation between the second calculated speed calculated using the x-axis acceleration and the first calculated speed calculated using the vertical speed and the pitch angle. The corrected second calculated speed may be output when the vehicle is moving on a horizontal road. Thereby, when various errors are accumulated during the calculation of the movement speed by the second calculation unit 107, the second calculation speed can be brought close to the actual movement speed, and the movement speed on the horizontal road can be made accurate. it can.

  Examples of the present invention will be described below. In the present embodiment, an example in which the speed calculation device 100 configured by a navigation device is implemented will be described. The navigation device used in the present embodiment is a simple type (PND) that cannot acquire a vehicle speed signal detected at a time interval proportional to the rotational speed of the tire.

(Hardware configuration of navigation device)
The hardware configuration of the navigation apparatus 400 according to the present embodiment will be described with reference to FIG. FIG. 4 is a block diagram illustrating an example of a hardware configuration of the navigation device 400 according to the present embodiment.

  In FIG. 4, a navigation device 400 includes a CPU 401, a ROM 402, a RAM 403, a magnetic disk drive 404, a magnetic disk 405, an optical disk drive 406, an optical disk 407, an audio I / F (interface) 408, and a speaker 409. An input device 410, a video I / F 411, a display 412, a communication I / F 413, a GPS unit 414, and various sensors 415. Each component 401 to 415 is connected by a bus 420.

  The CPU 401 governs overall control of the navigation device 400. A rewritable nonvolatile memory such as the ROM 402 or the flash ROM records various programs such as a boot program, a current location calculation program, a route search program, a route guidance program, and a speed calculation program. The RAM 403 is used as a work area for the CPU 401.

  The current location calculation program is a program for calculating the current location of the vehicle (the current location of the navigation device 400) based on output information from various sensors 415 such as the GPS unit 414 and the acceleration sensor 421, for example.

  The route search program is a program for searching for an optimum route from the departure point to the destination point using map data, route calculation data, and the like recorded on the magnetic disk 405. The optimum route is the shortest (or fastest) route to the destination point or the route that best meets the conditions specified by the user. Further, not only the destination point but also a route to a stop point or a rest point may be searched. The searched guidance route is output to the audio I / F 408 and the video I / F 411 via the CPU 401.

  The route guidance program includes guidance route information searched by executing the route search program, information on the current location of the vehicle calculated by executing the current location calculation program, and a map read from the magnetic disk 405. This is a program for generating real-time route guidance information based on data and the like. The generated route guidance information is output to the audio I / F 408 and the video I / F 411 via the CPU 401.

  The speed calculation program calculates the moving speed of the vehicle in the direction along the inclined surface based on the vertical speed and the pitch angle detected by the various sensors 415, or GPS information indicating the current position received by the GPS unit 414. This is a program for calculating the moving speed of the vehicle based on the above.

  The magnetic disk drive 404 controls the reading / writing of the data with respect to the magnetic disk 405 according to control of CPU401. The magnetic disk 405 records data written under the control of the magnetic disk drive 404. As the magnetic disk 405, for example, HD (hard disk) or FD (flexible disk) can be used. Map data, route calculation data, and the like are recorded on the magnetic disk 405.

  The optical disk drive 406 controls the reading / writing of the data with respect to the optical disk 407 according to control of CPU401. The optical disc 407 is a detachable recording medium from which data is read according to the control of the optical disc drive 406. As the optical disc 407, a writable recording medium can be used. In addition to the optical disk 407, the removable recording medium may be an MO, a memory card, or the like.

  The audio I / F 408 is connected to the speaker 409. Audio information is output from the speaker 409. Examples of the input device 410 include a remote controller including a plurality of keys for inputting characters, numerical values, various instructions, a keyboard, a mouse, a touch panel, and the like. The input device 410 may be realized by any one of a remote controller, a keyboard, a mouse, and a touch panel, or may be realized by a plurality of forms.

  The video I / F 411 is connected to the display 412. Specifically, the video I / F 411 includes, for example, a graphic controller that controls the entire display 412, a buffer memory such as a VRAM (Video RAM) that temporarily records image information that can be displayed immediately, and a graphic controller. Based on the output image data, the display 412 is configured by a control IC or the like.

  The display 412 displays icons, cursors, menus, windows, or various data such as characters and images. As the display 412, for example, a CRT, a TFT liquid crystal display, a plasma display, or the like can be adopted.

  The communication I / F 413 is connected to a communication network such as the Internet via wireless and functions as an interface between the communication network and the CPU 401. The GPS unit 414 receives radio waves from GPS satellites and outputs GPS information indicating the current location of the vehicle. The GPS information is information for specifying one point on the map data such as latitude / longitude and altitude. The output information of the GPS unit 414 is used when the CPU 401 calculates the current position of the vehicle and the moving speed.

  The various sensors 415 include an acceleration sensor 421, a gyro sensor 422, and the like, and output information that can determine the position and behavior of the vehicle. The acceleration sensor 421 can measure accelerations in the x-axis direction indicating the traveling direction of the vehicle, the y-axis direction indicating a direction perpendicular to the traveling direction and horizontal, and the z-axis direction indicating the vertical direction 3 It is an axial acceleration sensor. The navigation device 400 can calculate the velocity in each direction by integrating the acceleration in each direction. The acceleration sensor 421 may be any sensor that can detect at least the x-axis acceleration in the x-axis direction and the z-axis acceleration in the z-axis direction.

  The gyro sensor 422 outputs an azimuth change amount, and in particular, a sensor that can detect a pitch angle is used. In this embodiment, the gyro sensor 422 is a three-axis gyro sensor that can detect the angular velocity of the roll angle, the yaw angle, and the pitch angle. The output values of the various sensors 415 are used by the CPU 401 to calculate the current location of the vehicle and the speed. Note that since the navigation device 400 is a simple PND, the various sensors 415 do not include a vehicle speed sensor that detects the moving speed of the vehicle.

  The vertical velocity detection unit 101, the angle detection unit 102, the first calculation unit 103, the output unit 104, the acquisition unit 105, and the acceleration detection unit included in the velocity calculation apparatus 100 according to the present embodiment illustrated in FIG. 106, the second calculation unit 107, and the correction unit 108 cause the CPU 401 to execute various programs using programs and data recorded in the ROM 402, the magnetic disk 405, and the like in the navigation device 400 illustrated in FIG. By realizing the function.

(Speed calculation processing procedure of the navigation device 400)
Next, the speed calculation processing procedure of the navigation device 400 will be described with reference to FIG. FIG. 5 is a flowchart illustrating an example of the speed calculation processing procedure of the navigation device 400. In the flowchart of FIG. 5, the navigation apparatus 400 determines whether or not it has been activated (step S501). The navigation device 400 waits until it starts (step S501: No), and when it starts (step S501: Yes), it determines whether GPS information is received (step S502).

  When GPS information is not received (step S502: No), that is, for example, when the vehicle is traveling in a tunnel, a multilevel parking lot, an underpass, an underpass, or the like, the navigation device 400 detects the vertical speed. (Step S503). The vertical velocity is detected by the navigation device 400 integrating the z-axis acceleration measured by the acceleration sensor 421.

  Then, the navigation device 400 detects the pitch angle using the gyro sensor 422 (step S504). Next, the navigation apparatus 400 determines whether or not the pitch angle is “0” (step S505). Note that the determination in step S505 is specifically a determination of whether or not the vehicle is traveling on an inclined road, and is not limited to the determination of whether or not the pitch angle = “0”, but the vertical speed = “0”. It may be determined whether or not. Further, in order to determine with high accuracy whether or not the vehicle is traveling on an inclined road, in the determination in step S505, it is determined whether or not the pitch angle = “0” and the vertical speed = “0”. You may do it.

  When the pitch angle is not “0” (step S505: No), that is, when the vehicle is traveling on an inclined road, the navigation device 400 calculates the moving speed of the vehicle using the vertical speed and the pitch angle ( Step S506). For calculating the moving speed of the vehicle, the above-described equation (2) is used, but the above-described equation (1) may be used (see the embodiment).

  The navigation apparatus 400 stores a correction value indicating an error between the movement speed calculated by integrating the x-axis acceleration detected by the acceleration sensor 421 and the movement speed calculated in step S506 in the RAM 403 (step S507). ). Note that the process of calculating the moving speed by integrating the x-axis acceleration is not shown, but may be performed between step S504 and step S505, for example. Then, the navigation device 400 outputs the calculated moving speed (step S508), and ends a series of processes according to this flowchart.

  In step S505, when the pitch angle is “0” (step S505: Yes), that is, when traveling on a horizontal road, the navigation device 400 integrates the x-axis acceleration detected by the acceleration sensor 421. To calculate the moving speed (step S509). Then, it is determined whether or not the correction value is stored in the RAM 403 (step S510). If the correction value is not stored (step S510: No), the navigation apparatus 400 proceeds to the process of step S508.

  When the correction value is stored (step S510: Yes), the navigation apparatus 400 corrects the moving speed using the correction value (step S511), and shifts to the process of step S508. If GPS information is received in step S502 (step S502: Yes), the navigation apparatus 400 calculates the moving speed of the vehicle using the GPS information (step S512), and shifts to the processing of step S508.

  By the above-described processing, it is possible to calculate a moving speed close to the actual moving speed by traveling on the slope even under conditions where GPS information cannot be received such as in a tunnel. In the case of the navigation device 400 capable of acquiring a vehicle speed signal from the vehicle speed sensor, the speed can be calculated with high accuracy even under conditions where the vehicle speed signal cannot be used, such as when the vehicle speed sensor fails. Can do. Thereby, while being able to show an exact speed to a user, the exact arrival time to the destination can be shown.

  In the case of the navigation device 400 capable of acquiring a vehicle speed signal from the vehicle speed sensor, it is determined whether or not it is an emergency in which the vehicle speed sensor cannot be used. The moving speed may be calculated based on the y-axis acceleration. According to such a configuration, it is possible to present an accurate movement speed by the vehicle speed sensor in a normal time, and it is possible to present an accurate movement speed based on the roll angle, the yaw angle, and the y-axis acceleration in an emergency. .

  Further, in the above-described processing, since the moving speed of the vehicle in the direction along the inclined surface is calculated based on the vertical speed and the inclination angle, the slope with a small inclination angle under conditions where GPS information cannot be received. Accurate values can be presented while driving. If the vehicle moving speed in the direction along the inclined surface is calculated based on the vertical speed and the pitch angle, a more accurate moving speed can be presented.

  Further, in the above-described processing, the vehicle moving speed is calculated using the GPS information under the condition where the GPS information of the vehicle can be acquired, while the vertical speed and the pitch are calculated under the condition where the GPS information cannot be acquired. The moving speed of the vehicle is calculated based on the angle. Therefore, an accurate moving speed can be calculated according to the reception status of GPS information.

  In this embodiment, the correction value is used to correct the movement speed calculated using the x-axis acceleration, and the corrected movement speed is output when the vehicle is moving on a horizontal road. I did it. As a result, when various errors are accumulated when calculating the moving speed using the x-axis acceleration, the moving speed calculated using the x-axis acceleration can be brought close to the actual moving speed, and the moving speed can be accurately determined. It can be. Therefore, an accurate speed can be presented even on a horizontal path.

  In the above-described processing, the correction value is sequentially updated when the movement speed based on the vertical speed and the pitch angle is calculated. Thereby, a correction value can be made more accurate and an accurate speed can be presented on a horizontal path.

(Example of vehicle moving speed under conditions where GPS information cannot be received)
Next, an example of the moving speed of the vehicle under conditions where GPS information cannot be received will be described with reference to FIG. FIG. 6 is an explanatory diagram showing an example of the moving speed of the vehicle under conditions where GPS information cannot be received. In the graph 600 of FIG. 6, the vertical axis indicates the speed and the tilt angle, and the horizontal axis indicates time.

  Here, a case where the detection results of various sensors 415 are acquired and the speed is calculated every second will be described as an example. The road is horizontal until point T before reaching point A, and the inclination angle (pitch angle) is 0 °. Up to the point T, the moving speed is calculated using the x-axis acceleration. Up to point T, for example, the calculated moving speed of 13 m / s is output. The actual speed described in a supplementary manner is 11.5 m / s, and there is a difference of 1.5 m / s from the output moving speed.

  It is assumed that the pitch angle (tilt angle) θ = 1 ° is detected by the gyro sensor 422 at the point A. Further, it is assumed that a vertical velocity α = 0.2 m / s is detected at point A.

When the expression (2) (tan θ = α / γ) shown in the embodiment is used,
The moving speed γ (m / s) of only the horizontal component is
γ = α / tan θ≈11.5
Is calculated as

  At point A, 11.5 m / s is output as the moving speed. At point A, there is a divergence of 1.5 m / s between the moving speed 13 m / s calculated using the x-axis acceleration and the moving speed 11.5 m / s based on the vertical speed and the tilt angle. Is determined.

  For this reason, the movement speed calculated based on the vertical speed and the inclination angle cannot be calculated after point B at which the inclination angle becomes 0 °, but the movement calculated based on the x-axis acceleration using a deviated value of 1.5 m / s. Speed can be corrected. As a correction method, for example, a difference may be added to the moving speed calculated using the x-axis acceleration, and specifically, 1.5 m / s may be reduced. Not limited to this, other methods may be used.

  In the present embodiment, even when the vehicle is traveling on a short slope with a small slope angle, even if it is not a steep slope or a long slope, the actual moving speed while traveling on the slope can be calculated. That is, when traveling on an inclined road having a slight inclination angle, the actual movement speed during traveling can be calculated based on the vertical speed and the inclination angle. Further, on a horizontal road after traveling on an inclined road, the moving speed can be calculated using the correction value. The correction value can be updated every time the vehicle travels on an inclined road, and an accurate moving speed can be output even on a horizontal road.

  Further, for example, the correction value is stored for each road mode such as each curvature of the curve or each right curve or left curve, and the correction value corresponding to the road mode is used on the horizontal road. Good. Thereby, a moving speed can be corrected according to a road mode, and a more accurate moving speed can be output on a horizontal road.

  In the present embodiment, the speed is calculated using the GPS information under the condition that the GPS information can be received. That is, when GPS information is used, the speed is calculated with high accuracy with little deviation from the actual speed. As described above, in this embodiment, when calculating the speed, the GPS information is used under the condition where the GPS information can be received, and the vehicle travels on the slope under the condition where the GPS information cannot be received. The vertical velocity and the inclination angle are used. Therefore, an accurate speed can be output regardless of the reception state of the GPS information.

  It should be noted that even when traveling on an inclined road under conditions where GPS information can be received, the moving speed of the vehicle is calculated using the vertical speed and the tilt angle, and is calculated using the x-axis acceleration. By comparing with the moving speed, the amount of deviation may be updated as a correction value each time. This makes it possible to obtain a correction value without traveling on an inclined road under conditions where GPS information cannot be received, for example, correcting the moving speed of a horizontal road immediately after entering a tunnel. Can output an accurate speed. Specifically, the movement speed calculated using the x-axis acceleration can be corrected before the point A is reached, and an accurate speed can be output.

  In addition, the calculation of the moving speed using GPS information is suitable for high-speed driving at a predetermined speed or higher, but considering that errors are likely to occur at low speeds lower than the predetermined speed, it is possible to receive GPS information. However, when traveling at low speed, the moving speed may be calculated based on the vertical speed and the inclination angle. With such a configuration, it is possible to improve the accuracy of the moving speed during low-speed traveling.

  FIG. 6 shows only the case where the inclination angle is positive and the inclination angle is positive when going uphill, but the inclination angle becomes negative when traveling downhill. When traveling downhill, the inclination angle is negative, and the same processing as that for calculating the moving speed when traveling uphill may be performed.

(Example of display screen displayed on display 412)
Next, an example of a display screen displayed on the display 412 will be described with reference to FIG. FIG. 7 is an explanatory diagram illustrating an example of a display screen displayed on the display 412. In FIG. 7, display screens 701 and 702 indicate a state where the vehicle is traveling in a tunnel where GPS information cannot be received. A display screen 701 shows a screen when traveling on a horizontal road, and a display screen 702 shows a screen when traveling on an inclined road.

  The display screen 701 displays a traveling map screen, a current speed (movement speed) calculated using the x-axis acceleration, and a destination arrival time calculated using the current speed. Specifically, the display screen 701 displays a current speed before reaching the point A shown in FIG. 6 and a destination arrival time calculated using the current speed. Although the actual speed of the vehicle is 41 km / h, it is displayed as 47 km / h on the display screen 701.

  The display screen 702 displays a traveling map screen, a current speed (movement speed) calculated based on the vertical speed and the inclination angle, and a destination arrival time calculated using the current speed. ing. Specifically, the display screen 702 displays the current speed after reaching point A shown in FIG. 6 and the destination arrival time calculated using the current speed. Note that the actual speed of the vehicle is 41 km / h, which is also displayed as 41 km / h on the display screen 702.

  Thus, according to the present embodiment, the moving speed of the vehicle can be calculated with high accuracy and presented to the user. Note that when the moving speed is calculated based on the vertical speed and the inclination angle and the current speed is changed from 47 km / h to 41 km / h, a notification such as “current speed has been corrected” may be issued. Good. Thereby, the user can know that the present speed to be presented has been changed. In addition, if the user knows that GPS information cannot be received in the tunnel, the user can know that the current speed has been corrected by some process without using the GPS information. Can be improved.

  As described above, according to the speed calculation device, the speed calculation method, the speed calculation program, and the recording medium of the present invention, a movement speed close to the actual movement speed can be calculated without using a vehicle speed signal. Thereby, an accurate speed can be presented to the user, and the reliability of the speed to be presented can be improved.

  The speed calculation method described in this embodiment can be realized by executing a program prepared in advance on a computer such as a personal computer or a workstation. This program is recorded on a computer-readable recording medium such as a hard disk, a flexible disk, a CD-ROM, an MO, a DVD, or a memory card, and is executed by being read from the recording medium by the computer. The program may be a transmission medium that can be distributed via a network such as the Internet.

DESCRIPTION OF SYMBOLS 100 Speed calculation apparatus 101 Vertical speed detection part 102 Angle detection part 103 1st calculation part 104 Output part 105 Acquisition part 106 Acceleration detection part 107 2nd calculation part 108 Correction | amendment part 400 Navigation apparatus 412 Display 414 GPS unit 415 Various sensors 421 Acceleration sensor 422 Gyro sensor

Claims (6)

A vertical speed detecting means for detecting the vertical speed of the vertical Ingredients,
Angle detecting means for detecting a pitch angle indicating the front-rear inclination of the moving body;
Without using the acceleration in the traveling direction of the moving body, and the vertical velocity, before SL based on the pitch angle, and a first calculating means for calculating a moving speed of the movable body in a direction along the inclined surface,
A speed calculation device comprising: Further comprising an acquisition means for acquiring position information of the mobile body;
The first calculation unit calculates a moving speed of the moving body using the position information under a condition in which the acquisition unit can acquire the position information.
2. The speed according to claim 1, wherein the moving speed of the moving body is calculated based on the vertical speed and the pitch angle under a condition in which the position information cannot be acquired by the acquiring unit. Calculation device. Acceleration detecting means for detecting acceleration in the traveling direction of the moving body;
Based on the previous SL acceleration, a second calculating means for calculating a moving speed of the moving direction of the moving body (hereinafter referred to as "second calculation speed"),
The second calculation speed calculated by the second calculation means when the moving body is moving on an inclined road, and the movement speed calculated by the first calculation means (hereinafter referred to as “first calculation speed”). Correction means for correcting the second calculation speed based on the difference between
The time of pre Symbol movable body is moving ramps and outputs the first calculated speed, the second calculation speed corrected by the correcting means when the moving body is moving in the horizontal path Output means for outputting ,
The speed calculation device according to claim 1 , further comprising:   A speed calculation method used in a speed calculation device for calculating speed,
  The speed calculation device includes:
  Vertical growthMinA vertical speed detection step for detecting the vertical speed;
  An angle detection step of detecting a pitch angle indicating the front-rear inclination of the moving body;
  Without using the acceleration in the traveling direction of the moving body,The vertical velocity and,PreviousA calculation step of calculating a moving speed of the moving body in a direction along the inclined surface based on the pitch angle;
The speed calculation method characterized by performing.   A speed calculation program for causing a computer to execute the speed calculation method according to claim 4.   6. A computer-readable recording medium in which the speed calculation program according to claim 5 is recorded.

Images