FI20195222A1 - Vehicle positioning - Google Patents

Vehicle positioning Download PDF

Info

Publication number
FI20195222A1
FI20195222A1 FI20195222A FI20195222A FI20195222A1 FI 20195222 A1 FI20195222 A1 FI 20195222A1 FI 20195222 A FI20195222 A FI 20195222A FI 20195222 A FI20195222 A FI 20195222A FI 20195222 A1 FI20195222 A1 FI 20195222A1
Authority
FI
Finland
Prior art keywords
vehicle
information
data
road
dynamic model
Prior art date
Application number
FI20195222A
Other languages
Finnish (fi)
Swedish (sv)
Other versions
FI129920B (en
Inventor
Kimmo Erkkilä
Jarmo Leino
Original Assignee
Eee Innovations Oy
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 Eee Innovations Oy filed Critical Eee Innovations Oy
Priority to FI20195222A priority Critical patent/FI129920B/en
Priority to PCT/FI2020/050189 priority patent/WO2020193861A1/en
Publication of FI20195222A1 publication Critical patent/FI20195222A1/en
Application granted granted Critical
Publication of FI129920B publication Critical patent/FI129920B/en

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Estimation 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/10—Estimation 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 vehicle motion
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Estimation 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/02—Estimation 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/06—Road conditions
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Estimation 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/12—Estimation 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 parameters of the vehicle itself, e.g. tyre models
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C22/00—Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G—PHYSICS
    • G07—CHECKING-DEVICES
    • G07C—TIME OR ATTENDANCE REGISTERS; REGISTERING OR INDICATING THE WORKING OF MACHINES; GENERATING RANDOM NUMBERS; VOTING OR LOTTERY APPARATUS; ARRANGEMENTS, SYSTEMS OR APPARATUS FOR CHECKING NOT PROVIDED FOR ELSEWHERE
    • G07C5/00—Registering or indicating the working of vehicles
    • G—PHYSICS
    • G07—CHECKING-DEVICES
    • G07C—TIME OR ATTENDANCE REGISTERS; REGISTERING OR INDICATING THE WORKING OF MACHINES; GENERATING RANDOM NUMBERS; VOTING OR LOTTERY APPARATUS; ARRANGEMENTS, SYSTEMS OR APPARATUS FOR CHECKING NOT PROVIDED FOR ELSEWHERE
    • G07C5/00—Registering or indicating the working of vehicles
    • G07C5/08—Registering or indicating performance data other than driving, working, idle, or waiting time, with or without registering driving, working, idle or waiting time
    • G07C5/0808—Diagnosing performance data
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Mathematical Physics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)

Abstract

According to an aspect, there is provided a computer-implemented method for positioning a vehicle. The method comprises applying (400) a dynamic model (106) associated with the vehicle, the dynamic model (106) having been determined by obtaining (200) status information (100) from at least one information bus of the vehicle, the status information (100) providing real-time status information about the vehicle, obtaining (202), based on vehicle identity information, vehicle dynamics information (102), obtaining (204) map data (104) representing road characteristics of roads of a geographical area, the map data (104) comprising two-dimensional road map data, three-dimensional road map data associated with the roads, and road characteristics data, analyzing (206) behavior of the vehicle based on the status information (100) and the vehicle dynamics information (102), and computing (208) the dynamic model for the vehicle by comparing the behavior of the vehicle to the map data (104); calculating (402), based on the dynamic model (106) of the vehicle, an effective travel distance of a wheel of the vehicle; calculating (404), based on the dynamic model (106) of the vehicle, a momentary track width; calculating (406), based on the effective travel distance of a wheel of the vehicle and the momentary track width, a momentary direction of the vehicle; and calculating (408), based on the effective travel distance of the wheel and the momentary direction of the vehicle, a position of the vehicle.

Description

VEHICLE POSITIONING
TECHNICAL FIELD The present application relates to the field of computer systems, and more particularly to a computer-implemented method and an apparatus for determining a position of a vehicle.
BACKGROUND Vehicle positioning is an important service for various users. The positioning may be based on utilizing satellites that provide positioning signals for a receiver installed in a vehicle. Based on the received positioning signals it is possible to establish a current location of the vehicle and to display the location for a driver, for example, by using a map application. One of the problems associated with the satellite based positioning service is that the positioning is not very accurate and the accuracy varies depending on the surrounding conditions (for example, tall buildings may reduce the accuracy). Further, satellite based positioning works well only outdoors, therefore making it unusable indoors. Based on the above, there is a need for a positioning solution for a vehicle that would provide enhanced accuracy.
SUMMARY This summary is provided to introduce a selection of concepts in a simplified form that are further described below in the detailed description. This summary is not intended to identify key features or essential features of the claimed subject matter, nor is it intended o 25 to be used to limit the scope of the claimed subject matter. & g It is an object of the invention to provide a solution that would enable accurate positioning a of a vehicle. Tr a N 30 This objective is achieved by the features of the independent claims. Further embodiments io and examples of the invention are apparent from the dependent claims, the description > and the figures. 1
According to a first aspect, a computer-implemented method for positioning a vehicle is provided.
The method comprises applying a dynamic model associated with the vehicle, the dynamic model having been determined by obtaining status information from at least one information bus of the vehicle, the status information providing real-time status information about the vehicle, obtaining, based on vehicle identity information, vehicle dynamics information, obtaining map data representing road characteristics of roads of a geographical area, the map data comprising two-dimensional road map data, three- dimensional road map associated with the roads, and road characteristics data, analyzing behavior of the vehicle based on the status information and the vehicle dynamics information, and computing a dynamic model for the vehicle by comparing the behavior of the vehicle to the map data; calculating, based on the dynamic model of the vehicle, an effective travel distance of a wheel of the vehicle; calculating, based on the dynamic model of the vehicle, a momentary track width; calculating, based on the effective travel distance of a wheel of the vehicle and the momentary track width, a momentary direction — of the vehicle; and calculating, based on the effective travel distance of the wheel and the momentary direction of the vehicle, a position of the vehicle.
In an implementation form of the first aspect, the status information comprises at least one of a motor power, tyre speeds, a steering wheel position, vehicle system information, traction control information, vehicle stabilization system information and anti-lock braking system information.
In a further implementation form of the first aspect, obtaining, based on vehicle identity information, vehicle dynamics information comprises obtaining initial vehicle dynamics o 25 information associated with a model or type of the vehicle from at least one external data N Source. & N In a further implementation form of the first aspect, obtaining, based on vehicle identity E information, vehicle dynamics information comprises obtaining supplemental vehicle N 30 — dynamics information based on real-time vehicle dynamics data obtained from the io vehicle.
The vehicle identity information may be the real vehicle identification number > (VIN) information of the vehicle, or plain unigue reference which can be used to match the vehicle history and calibration values together. 2
In a further implementation form of the first aspect, the road characteristics data comprises at least one of road quality data, road irregularity data and data about local deviations associated with the road.
In a further implementation form of the first aspect, the method further comprises combining the dynamic model with the road characteristics data to enhance the calculation of the position of the vehicle.
In a further implementation form of the first aspect, the three-dimensional road data comprises road inclination data, and the method further comprises combining the dynamic model with the road inclination data to enhance the calculation of the position of the vehicle. According to a second aspect, an apparatus for positioning a vehicle is provided. The apparatus comprises at least one processor and at least one memory connected to the at least one processor. The at least one memory stores program instructions that, when executed by the at least one processor, cause the apparatus to apply a dynamic model associated with the vehicle, the dynamic model having been determined by obtaining status information from at least one information bus of the vehicle, the status information providing real-time status information about the vehicle, obtaining, based on vehicle identity information, vehicle dynamics information, obtain map data representing road characteristics of roads of a geographical area, the map data comprising two-dimensional road map data, three-dimensional road map associated with the roads, and road characteristics data, analyzing behavior of the vehicle based on the status information and o 25 — the vehicle dynamics information, and computing a dynamic model for the vehicle by N comparing the behavior of the vehicle to the map data; calculate based on the dynamic 3 model of the vehicle, an effective travel distance of a wheel of the vehicle; calculate, N based on the dynamic model of the vehicle, a momentary track width; calculate, based on E the effective travel distance of a wheel of the vehicle and the momentary track width, a N 30 momentary direction of the vehicle; and calculate, based on the effective travel distance io of the wheel and the momentary direction of the vehicle, a position of the vehicle.
N In an implementation form of the second aspect, the status information comprises at least one of a motor power, tyre speeds, a steering wheel position, vehicle system information, 3 traction control information, vehicle stabilization system information and anti-lock braking system information.
In a further implementation form of the second aspect, obtaining, based on vehicle identity information, vehicle dynamics information comprises obtaining initial vehicle dynamics information associated with a model or type of the vehicle from at least one external data source.
In a further implementation form of the second aspect, obtaining, based on vehicle identity information, vehicle dynamics information comprises obtaining supplemental vehicle dynamics information based on real-time vehicle dynamics data obtained from the vehicle. The vehicle identity information may be the real vehicle identification number (VIN) information of the vehicle, or plain unique reference which can be used to match the vehicle history and calibration values together.
In a further implementation form of the second aspect, the road characteristics data comprises at least one of road quality data, road irregularity data and data about local deviations associated with the road.
In a further implementation form of the second aspect, the at least one memory stores program instructions that, when executed by the at least one processor, cause the apparatus to combine the dynamic model with the road characteristics data to enhance the calculation of the position of the vehicle.
o 25 Ina further implementation form of the second aspect, the three-dimensional road data N comprises road inclination data, and the at least one memory stores program instructions 3 that, when executed by the at least one processor, cause the apparatus to combine the N dynamic model with the road inclination data to enhance the calculation of the position E of the vehicle.
N 30 O According to a third aspect, a computer program is provided. The computer program > comprises program code which when executed by at least one processor, performs the method of the first aspect. 4
According to a fourth aspect, a computer-readable medium is provided. The computer- readable medium comprises a computer program comprising program code which when executed by at least one processor, performs the method of the first aspect.
According to a fifth aspect, an apparatus for positioning a vehicle is provided. The apparatus comprises means for applying a dynamic model associated with the vehicle, the dynamic model having been determined by obtaining status information from at least one information bus of the vehicle, the status information providing real-time status information about the vehicle, obtaining, based on vehicle identity information, vehicle — dynamics information, obtain map data representing road characteristics of roads of a geographical area, the map data comprising two-dimensional road map data, three- dimensional road map associated with the roads, and road characteristics data, analyzing behavior of the vehicle based on the status information and the vehicle dynamics information, and computing a dynamic model for the vehicle by comparing the behavior — of the vehicle to the map data; means for calculating based on the dynamic model of the vehicle, an effective travel distance of a wheel of the vehicle; means for calculating, based on the dynamic model of the vehicle, a momentary track width; means for calculating, based on the effective travel distance of a wheel of the vehicle and the momentary track width, a momentary direction of the vehicle; and means for calculating, based on the effective travel distance of the wheel and the momentary direction of the vehicle, a position of the vehicle.
According to a sixth aspect, an apparatus for positioning a vehicle is provided. The apparatus comprises at least one processor configured to apply a dynamic model o 25 — associated with the vehicle, the dynamic model having been determined by obtaining N status information from at least one information bus of the vehicle, the status information 3 providing real-time status information about the vehicle, obtaining, based on vehicle N identity information, vehicle dynamics information, obtaining map data representing road E characteristics of roads of a geographical area, the map data comprising two-dimensional N 30 road map data, three-dimensional road map associated with the roads, and road io characteristics data, analyzing behavior of the vehicle based on the status information and > the vehicle dynamics information, and computing a dynamic model for the vehicle by comparing the behavior of the vehicle to the map data; calculate based on the dynamic model of the vehicle, an effective travel distance of a wheel of the vehicle: calculate, 5 based on the dynamic model of the vehicle, a momentary track width; calculate, based on the effective travel distance of a wheel of the vehicle and the momentary track width, a momentary direction of the vehicle; and calculate, based on the effective travel distance of the wheel and the momentary direction of the vehicle, a position of the vehicle.
BRIEF DESCRIPTION OF THE DRAWINGS In the following examples are described in more detail with reference to the attached figures and drawings, in which: FIG. 1 illustrates a block diagram representing information based on which it is possible to determine and model behavior of a vehicle. FIG. 2 illustrates a flow diagram of a method for modelling dynamics of a vehicle. FIG 3 illustrates calculation of the change of wheel normal load caused by the road longitudinal inclination in front and rear axles. FIG. 4 illustrates a computer-implemented method for positioning a vehicle. FIGS SA and 5B illustrate graphs associated with a turning vehicle. FIG. 6 illustrates a system diagram depicting an exemplary apparatus according to an aspect. o 25 In the following identical reference signs refer to identical or at least functionally N eguivalent features.
O <Q
N DETAILED DESCRIPTION E In the following description, reference is made to the accompanying drawings, which N 30 form part of the disclosure, and in which are shown, by way of illustration, specific io aspects and examples in which the present invention may be placed. It is understood that > other aspects may be utilized and structural or logical changes may be made without departing from the scope of the present invention. The following detailed description, 6 therefore, is not to be taken in a limiting sense, as the scope of the present invention is defined be the appended claims. For instance, it is understood that a disclosure in connection with a described method may also hold true for a corresponding device or system configured to perform the method and vice versa. For example, if a specific method step is described, a corresponding device may include a unit or other means to perform the described method step, even if such unit is not explicitly described or illustrated in the figures. On the other hand, for example, if a specific apparatus is described based on functional units, a corresponding method may include a step performing the described functionality, even if such step is not explicitly described or illustrated in the figures. Further, it is understood that the features of the various exemplary aspects described herein may be combined with each other, unless specifically noted otherwise.
FIG. 1 illustrates a block diagram representing information based on which it is possible to determine and model behavior of a vehicle. Vehicle status information 100 refers to information that can be obtained from the vehicle itself, for example, via one or more information buses of the vehicle while the vehicle is in use. The vehicle status information comprises, for example, at least one of motor power, tyre speeds, a steering wheel — position, vehicle system information, traction control information, vehicle stabilization system information and anti-lock braking system information.
Vehicle dynamics information 102 may be obtained based on vehicle identity information, for example, from one or more external data sources. If no vehicle specific o 25 dynamics information is not available, it is possible to use vehicle dynamics information N that is common for this vehicle type. When the vehicle is used, the vehicle dynamics 3 information may be updated based on analysis of the behavior of the vehicle. Further, N vehicle dynamics information determined for a specific vehicle may be used as E preliminary knowledge for other similar vehicles. The vehicle identity information may N 30 be the real vehicle identification number (VIN) information of the vehicle, or plain unique io reference which can be used to match the vehicle history and calibration values together.
N Map data 104 may represent road characteristics of roads of a geographical area, and the map data 104 may comprise two-dimensional road map data, three-dimensional road map 7 data associated with the roads, and/or road characteristics data. The three-dimensional road map data may comprise information, for example, about road height data and road inclination data. The road characteristics data may comprise at least one of road quality data, road irregularity data and data about local deviations associated with the road. The road characteristics data may comprise, for example, other typical dynamic behaviour changes that can be statistically recognized by various vehicles at the same locations. For example, if a road is rutted, a weight transfer of a vehicle can be considered as “normal” if several different vehicles experience the same weight transfer. Similarly, pits, rail locations or other road imperfections of a road are characteristics that have an effect on how a vehicle should behave based on a current dataset associated with the vehicle. Based on the vehicle status information 100, vehicle dynamics information 102 and the map data 104 it is possible to determine a dynamic model for the vehicle. The dynamic model may then enable an estimation of the performance of the vehicle, observation of — changes associated with the vehicle and observation of changes in driving conditions of the vehicle. FIG. 2 illustrates a computer-implemented method for modelling dynamics of a vehicle. The vehicle may be any vehicle travelling on a road, for example, an autonomous vehicle, a passenger car, a truck, a motorcycle etc. At 200, status information is obtained from at least one information bus of the vehicle, the status information providing status information or real-time status information about the vehicle. O 25 N At 202, vehicle dynamics information representing vehicle dynamics is obtained based 3 on vehicle identity information.
N E At 204, map data representing road characteristics of roads of a geographical area, the N 30 map data comprising two-dimensional road map data, three-dimensional road map io associated with the roads, and road characteristics data is obtained.
N At 206, behavior of the vehicle is analyzed based on the status information and the vehicle dynamics information. 8
At 208, a dynamic model for the vehicle is calculated by comparing the behavior of the vehicle to the map data.
The dynamic model of the vehicle can be used in various applications in which an accurate vehicle representation is needed. For example, based on the dynamic model, it is possible to calculate a presumed behavior of the vehicle in various driving conditions. If an actual behavior of the vehicle deviates from the presumed behavior of the vehicle, this is caused either by changes in driving conditions or changes in the vehicle.
The dynamic model of the vehicle may define a set of vehicle-specific calibration parameters. These calibration parameters may represent how the vehicle behaves in various driving situations.
— The dynamics model of the vehicle may involve a set of various parameters or calibration parameters, for example, one or more of the following: 1) a mass of the vehicle, 2) powertrain efficiency coefficient or map, 3) a track width, 4) a wheelbase, 5) location of the center of gravity, 6) the moment of inertia along different axes of the vehicle and the moment of inertia associated with rotating masses, 7) effective rolling circumferences of the wheels, 8) an effect of the circumferential force of a wheel to the rolling circumferences, and 9) overall flexibility in longitudinal and lateral directions in weight of the transition situations caused, for example, by the wheels, the car chassis structure and the car body.
o 25 — The mass of the vehicle may be obtained from an external data source, it can be manually N input or a mass estimation may be used based on the vehicle type. When calculating the 3 dynamic model of the vehicle, the mass of the vehicle can be made more accurate by a comparing the effect of the energy produced by a motor of the vehicle to state of motion E of the vehicle, taking into account also, for example, at least one of changes in vehicle N 30 speed, altitude changes, the amount of work performed by the motor of the vehicle, io efficiencies, driving resistances and road quality factors.
R In the equations below, the following parameters are used: 9 m = mass PE = engine power up = powertrain coefficient t= time A = frontal area Cw = airdrag coefficient v = speed s = distance v2 = speed at point 2 vi = speed at point 1 g = gravity ho = altitude at point 2 hi = altitude at point 1 ur = rolling resistance na = PACw The mass of the vehicle may be estimated as follows: Wy = Way + Wan + Wp + Wy Pg x ppt = mv; — vi)? + mg(hy — hy) + MIURS + HAv?S + = 1 1 PalppUAV*S * 27 3 m(va — vi)” + mg(h, — hi) + MJURS =m (Gm, — vi)” + g(h, —hy) + guxS) PElpritav?Sis o TS TOR tglha-hi)+tgurs N PElprPACY VS 3 TS In(va- vi)? +g(ha hi) tours N 25 E Powertrain efficiency information may be obtained from one or more external data N sources, manually or based on the vehicle type. Later, the information may be made more io accurate by multivariate analysis or statistical analysis.
N 10
Track width information may be obtained from one or more external data sources, manually or based on the vehicle type. Later, the information may be made more accurate by multivariate analysis or statistical analysis.
Wheelbase information may be obtained from one or more external data sources, manually or based on the vehicle type. Later, the information may be made more accurate by multivariate analysis or statistical analysis.
Information about the location of the center of gravity may be obtained from one or more — external data sources, manually or based on the vehicle type. Later, the information may be made more accurate by multivariate analysis or statistical analysis. Information about the moment of inertia along different axes of the vehicle and the moment of inertia associated with rotating masses may be obtained from one or more — external data sources, manually or based on the vehicle type. Later, the information may be made more accurate by multivariate analysis or statistical analysis. Effective rolling circumferences of the wheels may be calculated for each wheel by comparing the travelled distance to each other and to map data in chosen periods. For — each wheel a computational dependency tied to the normal force of the wheel is generated. A momentary normal force of the wheel takes into account a dynamic mass shift of the vehicle, also taking into account road characteristics, for example, road inclinations to different directions. The effect of speed may also be taken into account. o 25 The effect of the circumferential force of a wheel to the rolling circumferences of the N wheels is estimated by comparing speed of rotation differences with each other with 3 different tractive forces. The estimation may also take into account road quality a characteristics and friction. Tr a N 30 Flexibility of the wheels and the chassis in longitudinal and lateral directions in weight io transition situations may be determined for each and for each wheel type by using initial > values or by searching the values from a library for a similar vehicle and wheel type. The effects of the weight transition in longitudinal and lateral directions are estimated separately because a wheel of the vehicle and chassis structures act differently with forces 11 having different directions.
Coefficients representing the dynamics indicate both the change caused by the weight shift to the effective travelling device of each wheel and changes caused by the flexibility to the effective travelling distance of the wheel.
The location of the effective contact point affects, for example, to the track width and wheelbase.
When computing dynamic coefficients, the map data is utilized, for example, by comparing a turning degree of the vehicle according to the dynamic model in a curve to an expected turning degree based on the map data.
FIG. 3 illustrates calculation of the change of wheel normal load caused by the road longitudinal inclination in front and rear axles.
Based on FIG. 3, the following equations can be formed: Fr «WB = mg = (CF + Sc) Fp = e Sc=hxtan(y) Fr = ÄÄ = Sc) Fp = | ER F, = mR — 1-10 0) Fyr = cos(y) * Fg Fyr = cos(y) * Fr Cr = Scc-r Cr = Scc-r oO > In an embodiment, also lateral inclination and longitudal and lateral accelerations ay be & 25 calculated similarly. : I FIG. 4 illustrates a computer-implemented method for positioning a vehicle.
The vehicle + may be any vehicle travelling on a road, for example, an autonomous vehicle, a passenger N car, a truck, a motorcycle etc. 2 30 N At 400, a dynamic model associated with a vehicle discussed above is applied.
As already discussed, the dynamic model has been determined by obtaining status information from 12 at least one information bus of the vehicle, the status information providing real-time status information about the vehicle, obtaining, based on vehicle identity information, vehicle dynamics information, obtaining map data representing road characteristics of roads of a geographical area, the map data comprising two-dimensional road map data, three-dimensional road map associated with the roads, and road characteristics data, analyzing behavior of the vehicle based on the status information and the vehicle dynamics information, and computing a dynamic model for the vehicle by comparing the behavior of the vehicle to the map data. At 402, an effective travel distance of a wheel of the vehicle is calculated based on the dynamic model of the vehicle. At 404, a momentary track width is calculated based on the dynamic model of the vehicle. At 406, a momentary direction of the vehicle is calculated based on the effective travel distance of a wheel of the vehicle and the momentary track width. At 408, a position of the vehicle is calculated based on the effective travel distance of the wheel and the momentary direction of the vehicle.
When using the dynamical model of the vehicle, it is possible to calculate an effective travel distance of the wheel of the vehicle in various changing driving conditions. If the dynamical model is not used, wheel transformations and changes in measurements used in the position determination are not taken into account, resulting in an inaccurate position o 25 — determination. & g The three-dimensional map data may comprise also road inclination. When the dynamic N model and the road inclination data are combined, the position determination can be made E more accurate. For example, an effect of the road inclination to a projection of the track N 30 — width can be taken into account.
N 3 In the following, exemplary equations are presented for the rear axle. Equations for the front axle may be formed similarly. 13
A starting value for a wheel speed difference between left and right sides by a wheel travel is SR _ sA% Savg Vicor = VL VL *SA% Vrcor = VR — Vp * SA% A starting value for wheel speed change per speed can be represented as follows: VLcorz = Vicor — Vicor * Speedcor% Vrcor2 = Vrcor — Vrcor * Speedcor% The mass detection may be performed using the previously presented equations for the mass of the vehicle. The following parameters may be obtained from a library to be used as starting values: - TW = track width - h = mass center height - WB = wheelbase - mass center location in x/y directions - turning inertia over x/y/z axles - TF = tyre and suspension flex in x direction (side flex) - TFC = type and suspension flex in z directon (compression flex) The following equations can be formed, when reviewed together with FIGS. SA and 5B: TWayn = TW + ATWayn o > 25 ATWayn = Friar * TF — Frr1at * TF ! TWa . 3 F N mgl- SY hsin(0)) « cos( ) « Scc-p+htan(y) LO NRLSTAT — TWayncos(&) — VIE vB
N TWa . E F _ mg 59% -hsin (29) « Scc-p+htan(r) NRLSTAT = TWayntcos(&) WB
N N -F *COs(«K)=h*Scc- F xh N = LAT CC-F LONG 0 FNRLDYN TT TWageWE tws O — +FLAr*cos(x)*h*Scc-r | Frong*h N FNRLDYN = TT TWageWE tws Vrayn = VicorzoyN — (Fyre + Tre * Vicor2) 14
Vrdyn = VRCOR2DYN € (Fare * Tec * Vrcor2) Rc = HT * TWayn * COS(0) Vayn = e Far = Po Frone = dyn *m s = Van” t por Sa = J2RB? — 2R?cos(B) 0=2XB Xpos = 2 sin(0) * s, cos(y) Ypos = 2 Cos(0) * s, cos(y) In the above eguations, the following parameters were used: - y=roadlongitudinal inclination - Rc = turning circle - «=road side inclination - Sccr = distance from axle to mass center - Fiar= lateral force - Fron = longitudinal force - s=driving distance - B=turning/direction change - sa = position change distance between A and B 2 - 0 = direction A - Xpos = position on X axis 0 25 - Ypos = position on Y axis I - TWayn = dynamic track width = - Fwrisrar = tyre normal force without speed (rear left) N - Fwrrrsrar = tyre normal force without speed (rear right) 2 - Fxrupyn = tyre normal force with dynamic weight transfer (rear left) N 30 - Fxrroyw = tyre normal force with dynamic weight transfer (rear right) - — Vidyn = left wheel speed after dynamic corrections 15
- — VRdyn = right wheel speed after dynamic corrections The illustrated solution for determining the position accurately may be used in vehicle navigation and especially in real-time navigation and in real-time three-dimensional navigation. The illustrated solution can also be utilized in locations where a satellite position based signal, for example, a GPS signal, is weak on non-existent. These locations may include, for example, closed parking lots, blind spots due to buildings, tunnels and quarries. Further, the illustrated solution may provide a location service in applications in which a single location signal is not sufficient, for example, in autonomous vehicles, — metros and trains.
FIG. 6 illustrates a system diagram depicting an exemplary apparatus 600 including a variety of optional hardware and software components, shown generally at 612. Any components 612 in the apparatus can communicate with any other component, although not all connections are shown, for ease of illustration. The apparatus 600 can be any of a variety of computing devices (for example, a computer, a cloud based server etc.) and can allow two-way communications with one or more communications networks, such as the Internet.
The illustrated apparatus 600 can include one or more controllers or processors 602 (e.g., signal processor, microprocessor, ASIC, or other control and processing logic circuitry) for performing such tasks as signal coding, data processing, input/output processing, power control, and/or other functions. An operating system 608 can control the allocation and usage of the components 612 and support for one or more application programs 610.
o 25 The application programs can include common computing applications (e.g., server N software), or any other computing application. & N The illustrated apparatus 600 can include a memory 604. The memory 604 can include E non-removable memory and/or removable memory. The non-removable memory can N 30 include RAM, ROM, flash memory, a hard disk, or other well-known memory storage io technologies. The removable memory can include flash memory or other well-known > memory storage technologies. The memory 604 can be used for storing data and/or code for running the operating system 608 and the applications 610. Example data can include web pages, text, images, sound files, video data, or other data sets to be sent to and/or 16 received from one or more network servers or other devices via one or more wired or wireless networks.
The apparatus 600 can further include at least one physical connector, which can be a USB port, IEEE 1394 (FireWire) port, and/or RS-232 port etc.
The illustrated components 612 are not required or all-inclusive, as any components can deleted and other components can be added.
— The apparatus 600 may be configured to implement the various features, examples and embodiments illustrated in FIGS. 1-4 partially or completely. The functionality described herein can be performed, at least in part, by one or more computer program product components such as software components. According to an example, the processor 602 may be configured by the program code which when executed performs the examples and embodiments of the operations and functionality described. Alternatively, or in addition, the functionality described herein can be performed, at least in part, by one or more hardware logic components. For example, and without limitation, illustrative types of hardware logic components that can be used include Field-programmable Gate Arrays (FPGAs), Program-specific Integrated Circuits (ASICs), Program-specific Standard — Products (ASSPs), System-on-a-chip systems (SOCs), Complex Programmable Logic Devices (CPLDs), Graphics Processing Units (GPUs).
Further, one or more of the disclosed elements or components of the apparatus 600 may constitute means for applying a dynamic model associated with the vehicle, the dynamic o 25 model having been determined by obtaining status information from at least one N information bus of the vehicle, the status information providing real-time status g information about the vehicle, obtaining, based on vehicle identity information, vehicle N dynamics information, obtain map data representing road characteristics of roads of a E geographical area, the map data comprising two-dimensional road map data, three- N 30 dimensional road map associated with the roads, and road characteristics data, analyzing io behavior of the vehicle based on the status information and the vehicle dynamics > information, and computing a dynamic model for the vehicle by comparing the behavior of the vehicle to the map data; means for calculating based on the dynamic model of the vehicle, an effective travel distance of a wheel of the vehicle; means for calculating, based 17 on the dynamic model of the vehicle, a momentary track width; means for calculating, based on the effective travel distance of a wheel of the vehicle and the momentary track width, a momentary direction of the vehicle; and means for calculating, based on the effective travel distance of the wheel and the momentary direction of the vehicle, a position of the vehicle.
The functionality of the apparatus 600 may be implemented by program instructions stored on a computer readable medium.
The program instructions, when executed, cause the computer, processor or the like, to perform the disclosed steps or functionality.
The — computer readable medium can be any medium, including non-transitory storage media, on which the program is stored such as a Blu-Ray disc, DVD, CD, USB (flash) drive, hard disc, server storage available via a network, a ROM, a PROM, an EPROM, an EEPROM or a Flash memory having electronically readable control signals stored thereon which cooperate or are capable of cooperating with a programmable computer — system such that an embodiment of at least one of the inventive methods is performed.
An embodiment of the invention comprises or is a computer program comprising program code for performing any of the methods described herein, when executed on a computer.
Another example of the invention comprises or is a computer readable medium comprising a program code that, when executed by a processor, causes an apparatus to perform any of the methods described herein.
In one embodiment, the apparatus 600 comprises a vehicle navigator apparatus.
The vehicle navigator device may receive the status information from at least one information bus of the vehicle.
Then, the vehicle navigator device may comprise the dynamical model o 25 — of the vehicle, and the dynamical model may calculate the actual direction and speed of N the vehicle based on the vehicle dynamics information and the map data.
By applying the 3 illustrated solution, the vehicle navigator apparatus always stays on a correct driving lane.
N Further, the illustrated solution may also remove the problem of determining of a correct E direction, for example, when driving in cities.
N 30 O Although the subject matter has been described in language specific to structural features > and/or acts, it is to be understood that the subject matter defined in the appended claims is not necessarily limited to the specific features or acts described above.
Rather, the specific features and acts described above are disclosed as examples of implementing the 18 claims and other equivalent features and acts are intended to be within the scope of the claims.
It will be understood that the benefits and advantages described above may relate to one example or may relate to several examples. The examples are not limited to those that solve any or all of the stated problems or those that have any or all of the stated benefits and advantages. It will further be understood that reference to 'an' item may refer to one or more of those items.
The steps of the methods described herein may be carried out in any suitable order, or simultaneously where appropriate. Additionally, individual blocks may be deleted from any of the methods without departing from the spirit and scope of the subject matter described herein. Aspects of any of the examples described above may be combined with aspects of any of the other examples described to form further examples without losing — the effect sought.
The term 'comprising' is used herein to mean including the method, blocks or elements identified, but that such blocks or elements do not comprise an exclusive list and a method or apparatus may contain additional blocks or elements.
Although the invention and its advantages have been described in detail with reference to specific features and embodiments thereof, it is evident that various changes, modifications, substitutions, combinations and alterations can be made thereto without departing from the spirit and scope of the invention as defined by the appended claims.
o 25 — The specification and drawings are, accordingly, to be regarded simply as an illustration N of the invention as defined by the appended claims, and are contemplated to cover any 3 and all modifications, variations, combinations or equivalents that fall within the scope LO . . N of the present invention.
I a a
N N N LO O O
N 19

Claims (16)

1. A computer-implemented method for positioning a vehicle, the method comprising: applying a dynamic model associated with the vehicle, the dynamic model having been determined by obtaining status information from at least one information bus of the vehicle, the status information providing real-time status information about the vehicle, obtaining, based on vehicle identity information, vehicle dynamics information, obtaining map data representing road characteristics of roads of a geographical area, the map data comprising two-dimensional road map data, three-dimensional road map associated with the roads, and road characteristics data, analyzing behavior of the vehicle based on the status information and the vehicle dynamics information, and computing a dynamic model for the vehicle by comparing the behavior of the vehicle to the map data; calculating, based on the dynamic model of the vehicle, an effective travel distance of a wheel of the vehicle; calculating, based on the dynamic model of the vehicle, a momentary track width; calculating, based on the effective travel distance of a wheel of the vehicle and the momentary track width, a momentary direction of the vehicle; and calculating, based on the effective travel distance of the wheel and the momentary direction of the vehicle, a position of the vehicle.
2. A method of claim 1, wherein the status information comprises at least one of a motor power, tyre speeds, a steering wheel position, vehicle system information, traction control information, vehicle stabilization system information and anti-lock o 25 — braking system information.
& g 3. A method of claim 1 or 2, wherein obtaining, based on vehicle identity N information, vehicle dynamics information comprises obtaining initial vehicle dynamics E information associated with a model or type of the vehicle from at least one external data N 30 source.
O 9 4. A method of claim 1 or 3, wherein obtaining, based on vehicle identity information, vehicle dynamics information comprises obtaining supplemental vehicle 20 dynamics information based on real-time vehicle dynamics data obtained from the vehicle.
5. A method of any of claims 1 - 4, wherein the road characteristics data comprises at least one of road quality data, road irregularity data and data about local deviations associated with the road.
6. A method of any of claim 5, wherein the method further comprises combining the dynamic model with the road characteristics data to enhance the calculation of the position of the vehicle.
7. A method of any of claims 1 - 6, wherein the three-dimensional road data comprises road inclination data, and the method further comprises combining the dynamic model with the road inclination data to enhance the calculation of the position — of the vehicle.
8. An apparatus for positioning a vehicle, the apparatus comprising: at least one processor; at least one memory connected to the at least one processor; wherein the at least one memory stores program instructions that, when executed by the at least one processor, cause the apparatus to: apply a dynamic model associated with the vehicle, the dynamic model having been determined by obtaining status information from at least one information bus of the vehicle, the status information providing real-time status information about the vehicle, o 25 obtaining, based on vehicle identity information, vehicle dynamics information, obtaining N map data representing road characteristics of roads of a geographical area, the map data 3 comprising two-dimensional road map data, three-dimensional road map associated with N the roads, and road characteristics data, analyzing behavior of the vehicle based on the E status information and the vehicle dynamics information, and computing a dynamic N 30 model for the vehicle by comparing the behavior of the vehicle to the map data; io calculate based on the dynamic model of the vehicle, an effective travel distance > of a wheel of the vehicle: calculate, based on the dynamic model of the vehicle, a momentary track width; 21 calculate, based on the effective travel distance of a wheel of the vehicle and the momentary track width, a momentary direction of the vehicle; and calculate, based on the effective travel distance of the wheel and the momentary direction of the vehicle, a position of the vehicle.
9. An apparatus for of claim 8, wherein the status information comprises at least one of a motor power, tyre speeds, a steering wheel position, vehicle system information, traction control information, vehicle stabilization system information and anti-lock braking system information.
10. — An apparatus of claim 8 or 9, wherein obtaining, based on vehicle identity information, vehicle dynamics information comprises obtaining initial vehicle dynamics information associated with a model or type of the vehicle from at least one external data source.
11. Anapparatus of claim 8 or 10, wherein obtaining, based on vehicle identity information, vehicle dynamics information comprises obtaining supplemental vehicle dynamics information based on real-time vehicle dynamics data obtained from the vehicle.
12. An apparatus of any of claims 8 - 11, wherein the road characteristics data comprises at least one of road quality data, road irregularity data and data about local deviations associated with the road. o 25 13.
An apparatus of any of claim 12, wherein the at least one memory stores N program instructions that, when executed by the at least one processor, cause the 3 apparatus to: N combine the dynamic model with the road characteristics data to enhance the E calculation of the position of the vehicle.
N 30 O 14. — An apparatus of any of claims 8 - 13, wherein the three-dimensional road > data comprises road inclination data, and the at least one memory stores program instructions that, when executed by the at least one processor, cause the apparatus to 22 combine the dynamic model with the road inclination data to enhance the calculation of the position of the vehicle.
15. — A computer program comprising program code which when executed by atleast one processor, performs the method of any of claims 1 — 7.
16. — Acomputer-readable medium comprising a computer program comprising program code which when executed by at least one processor, performs the method of any of claims 1 — 7. oO
O
N Se)
I
LO al
I a a
N
N
N
LO
O
O
N 23
FI20195222A 2019-03-25 2019-03-25 Vehicle positioning FI129920B (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
FI20195222A FI129920B (en) 2019-03-25 2019-03-25 Vehicle positioning
PCT/FI2020/050189 WO2020193861A1 (en) 2019-03-25 2020-03-25 Vehicle positioning

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
FI20195222A FI129920B (en) 2019-03-25 2019-03-25 Vehicle positioning

Publications (2)

Publication Number Publication Date
FI20195222A1 true FI20195222A1 (en) 2020-09-26
FI129920B FI129920B (en) 2022-10-31

Family

ID=72611112

Family Applications (1)

Application Number Title Priority Date Filing Date
FI20195222A FI129920B (en) 2019-03-25 2019-03-25 Vehicle positioning

Country Status (2)

Country Link
FI (1) FI129920B (en)
WO (1) WO2020193861A1 (en)

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2541203B8 (en) * 2011-06-30 2015-10-21 Furuno Electric Company Limited Road map feedback server for tightly coupled gps and dead reckoning vehicle navigation
WO2014145018A2 (en) * 2013-03-15 2014-09-18 Levant Power Corporation Active vehicle suspension improvements
US9165477B2 (en) * 2013-12-06 2015-10-20 Vehicle Data Science Corporation Systems and methods for building road models, driver models, and vehicle models and making predictions therefrom

Also Published As

Publication number Publication date
WO2020193861A1 (en) 2020-10-01
FI129920B (en) 2022-10-31

Similar Documents

Publication Publication Date Title
Leung et al. Road vehicle state estimation using low-cost GPS/INS
FI129919B (en) Condition monitoring of a vehicle
CN102529976B (en) Vehicle running state nonlinear robust estimation method based on sliding mode observer
Oh et al. Vehicle velocity observer design using 6-D IMU and multiple-observer approach
US20140371990A1 (en) Sensor system comprising a vehicle model unit
Melendez-Pastor et al. A data fusion system of GNSS data and on-vehicle sensors data for improving car positioning precision in urban environments
DE102014116922A1 (en) Apparatus and method for estimating a road grade using an acceleration sensor
CN109791049A (en) Method for determining the posture of vehicle
Beal Rapid road friction estimation using independent left/right steering torque measurements
Jiang et al. Real-time estimation and prediction of tire forces using digital map for driving risk assessment
Van Gennip et al. Parameter identification and validation for combined slip tire models using a vehicle measurement system
Jo et al. Distributed vehicle state estimation system using information fusion of GPS and in-vehicle sensors for vehicle localization
WO2020193860A1 (en) Modelling dynamics of a vehicle
Choi et al. Position estimation in urban u-turn section for autonomous vehicles using multiple vehicle model and interacting multiple model filter
FI129920B (en) Vehicle positioning
Xia et al. Vehicle sideslip angle estimation considering the tire pneumatic trail variation
FI129942B (en) Enhancement of map data
Coyte et al. Decision tree assisted EKF for vehicle slip angle estimation using inertial motion sensors
Herzfeld et al. Collision avoidance by utilizing dynamic road friction information
DE10221900A1 (en) Determination of the radius of curvature of a road uses vehicle speed and yaw measurements in mathematical models to generate output for vehicle control
Jiang et al. Estimation and prediction of vehicle dynamics states based on fusion of OpenStreetMap and vehicle dynamics models
Wang et al. Nonlinear observers of tire forces and sideslip angle estimation applied to road safety: Simulation and experimental validation
US20180178809A1 (en) Method for determining a dangerous driving indicator of a vehicle
Gao et al. Vehicle localization with vehicle dynamics during gnss outages
Bechtloff Fast identification of a detailed two-track model with onboard sensors and GPS

Legal Events

Date Code Title Description
FG Patent granted

Ref document number: 129920

Country of ref document: FI

Kind code of ref document: B