» Download Article

Authors
Sahlholm, Per; Jansson, Henrik; Kozica, Ermin; Johansson, Karl Henrik

Identifier
10.3182/20070820-3-US-2918.00010

Index Terms
road grade estimation,digital maps,GPS,Kalman filter,sensor fusion

Abstract
Emerging driver assistance systems, such as look-ahead cruise controllers for heavy duty vehicles, require high precision digital maps. This contribution presents a road grade estimation algorithm for fusion of GPS and vehicle real-time sensor data, with measurements from previous runs over the same road segment. The resulting road grade estimate is thus enhanced using measurements from additional traversals of known roads. Distributed data fusion is utilized to ensure that the storage requirement of known roads does not increase when additional measurements are processed. The implemented algorithm, which is based on extended Kalman filtering and smoothing, is described in detail. Experiments on a Scania test vehicle show the advantages and some of the challenges with the proposed approach.

References

[1] Bae, H. S., J. Ruy and J. Gerdes (2001). Road
    grade and vehicle parameter estimation for
    longitudinal control using GPS. In: Proceedings
     of IEEE Conference on Intelligent
    Transportation Systems. San Francisco, CA.
[2] Brüntrup, R., S. Edelkamp, S. Jabbar and
    B. Scholz (2005). Incremental map generation
    with GPS Traces. In: Proceedings of IEEE
    Intelligent Transportation Systems. Vienna,
    Austria.
[3] Fröberg, A. and L. Nielsen (2007). Fuel optimal
    speed profiles. Accepted to 5th IFAC Symposium
     on Advances in Automotive Control.
    Monterey Coast CA, USA.
[4] Fröberg, Anders, Erik Hellström and Lars Nielsen
    (2006). Explicit fuel optimal speed profiles for
    heavy trucks on a set of topographic road
    profiles. number 2006-01-1071 In: SAE World
    Congress 2006.
[5] Gustafsson, F. (2000). Adaptive filtering and
    change detection. John Wiley & Sons, LTD,
    Chichester.
[6] Haykin, S. (2001). Adaptive Filter Theory. Prentice
     Hall.
[7] Hellström, E., M. Ivarsson, J. Åslund and
    L. Nielsen (2007). Look-ahead control for
    heavy trucks to minimize trip time and fuel
    consumption. Accepted to 5th IFAC Symposium
     on Advances in Automotive Control.
    Monterey Coast CA, USA.
[8] Hellström, Erik, Anders Fröberg and Lars Nielsen
    (2006). A real-time fuel-optimal cruise controller
     for heavy trucks using road topography
    information. number 2006-01-0008 In: SAE
    World Congress 2006.
[9] Kailath, T., A.H. Sayed and B. Hassibi (2000).
    Linear estimation. Upper Saddle River, NJ.
[10] Kiencke, U. and L. Nielsen (2003). Automotive
     Control Systems. Springer Verlag, Berlin.
[11] Lattemann, F., K. Neiss, S. Terwen and T. Connolly
      (2004). The predictive cruise control-a
     system to reduce fuel consumption of heavy
     duty trucks. SAE Technical Paper Series.
[12] Lingman, P. and B. Schmidtbauer (2001). Road
     slope and vehicle mass estimation using
     Kalman filtering. In: Proceedings of the 19th
     IAVSD Symposium. Copenhagen, Denmark.
[13] Schroedl, S., K. Wagsta(r), S. Rogers, P. Langley
     and C. Wilson (2004). Mining gps traces for
     map refinement. Data Mining and Knowledge
     Discovery 9, 59-87.
[14] Terwen, S., M. Back and V. Krebs (2004). Predictive
      powertrain control for heavy duty trucks.
     In: Proceedings of IFAC Symposium on Advances
      in Automotive Control. Salerno, Italy.
[15] Vahidi, A., A. Stefanopolou and H. Peng (2005).
     Recursive least squares with forgetting for
     online estimation of vehicle mass and road
     grade: Theory and experiments. Journal of
     Vehicle System Dynamics 43, 31-57.