Experimental evaluation of vehicle sideslip angle observers

IAV2004 - PREPRINTS 5th IFAC/EURON Symposium on Intelligent Autonomous Vehicles Instituto Superior Técnico, Lisboa, Portugal July 5-7, 2004


















 





































































 



























"

#

$

'

%

&

(









+













 



-

$

*

3



!

2 *

)



















4

9 (

5

4

6

7

8

*

$ 8

:

0

,

.

/

,

.

/

1

;

* >

@

@

>

4

A

A

D

E

B

F

G

7

F

8

6

G

F

G

7

0

<

=

/

<

<

/

<

?

<

/

?

<

<

.

1

,

<

C

;

*

H 3

E

I

&

#

5

#

>

?

P @

L 0

.

,

=

=

1

@

<

O

,



#

N

3

#

(

#

J

/

,

=

?

/

5

,

M

R

,

+

/

,

;

@

;

A

?

=

.

O

D

.

E 6

U

G

/

@

Q >

,

N

C

M

C

?

/

M

A

6

E

M

>

B

0

<

<

P

?

'

&

/

:

?

@ B

0

C

M

4

<

A

0

=

M

I



K

<

Q >

0

N

T

#

0

<

,

0

=

N

,

/

?

N

<

/

S

V

U

W

G

+

6

H

&

U

I

3

( #

* #

%

#

X

<

;

P A

B

Y

<

Z

A B

<

<

=

Q A

B

N

C

B

= Y

/

M

[ \

d ^

\

^

]

_

`

b

e c

f

e

_

`

f

e

e

`

i

_

g

d

^

e

h

i

`

e g

d

a

d

f

e

]

h

k

e

m

e

d

k

e

_

i

`

k

`

m

^

e n

h

_

d h

^

m

j

\

h

^

`

d ^

o

l d

h

^

a

\

e

j d

M

`

h

m

]

e

_

g

]

`

f

h

i

_

a

e

]

j \

h

^

k

e

e

e

o

f

]

e c

]

k

e

]

f

q

`

m

r

f

e

]

e

q

_

m

a

q

`

f

` g

_

`

f

e

i

_

p

j

j d

d ^

j \

h

d h

h

h

^

e

_

`

m

]

e

_

g

]

`

f

i

_

a

e

]

] c

q

`

q

e

_

a

i

s

q

`

_

e

]

i

t

_

i

]

e

_

e g

_

]

i

e

a

g

f

e

]

k

e

]

f

q

`

m

r

f

e

p

p

l u h

h

j

h

d

h

h

i

k

e

f

m

r

s

i

k

e

f

]

s

q

f

a

^

`

i

m

`

_

e

q

e

_

i

_

s

e

k

\ h

^

e

_

s

e

^

]

t

k n

` g

f

k

`

e

]

i

]

e

_

e g

_

]

i

m

p

h

q w

] c

v

e

\ h

^

d

^

m

`

f

k

[ \

h

h

^

`

`

`

a

x

t

_

e

k

^

e

y

n

e

t

k

`

]

a n

f

`

i

_

^

`

i

_

a n

`

_

m

i

q

a

`

f

]

q

e

e

k

p

{ h

h

]

e

m

]

i

_

z

i

_

_

e

d h

^

^

z g

]

t

]

e

h

d h

d h

d

^

k

i

`

a

x

t

_

^

e

e

]

k

e

]

f

q

`

m

r

f

e

]

q

c

`

q

e

_

]

i

^

] o

`

p

j \ h

h

h

h

^

i

]

e

_

e

_

g

]

a

`

m

r

e

r

g

i

i

k

_

e

]

t

^

f

]

m

]

h

h

^

q

e

i

a

i

m

^

]

_

`

m

m

r

`

]

]

t

s

q

i

m

]

p

|

}

d h

h

h

\ h

^

e n

i o

_

k

]

e b

a

f

e

k

m n

`

s

a

]

f

m

e

`

_

]

] n

^

e

s

m

v

€ ~

‚ 

ƒ

{ „

‚

i

m

f

m

`

_

]

^

] n

e

s

^

]

`

e

i

]

e

_

e g

_

]

v

€  j \ h

d

d

h

^

c

^

 ‡

A

h

^

^





0

c ]

p

e

v



`

f

i

e

n

e g

a

f

e

t

f

e

`

t

<

,

`

m

k

 M

h

j d

h ^

v

Ž

Ž

\

h

h

^

v

u h

^

]

e

s

`

m

_

`

m

]

e

_

g

]

`

f

i

_

a

e

` g

_

`

f

e

e

`

]

t

_

m

r

p

d

d h

d h

d h

h

h

^

h e c

e

a

g

f

e

]

`

r

f

a n

i

s

q

f

e

] w

] n

e

s

a

i

s

q

_

]

h

j d

h

h ^

r

]

\

h ^

m

k

e

]

f

q

`

m

r

f

e

i o

t

f

k

_

e

q

_

e

]

e

m

`

k

]

q

_

i

q

i

^

_

i

m

`

e

h ^

f

`

_

r

e

m

t

s

e

_

i

s

e

a

`

m

a

`

f

e

f

e

a

_

i

m

a

`

m

k

e

f

e

^ a

a

i

j d

h `

h

h

^

]

^

m

e

a

`

]

e

i

`

m

i

_

k

m

`

_

a n

…

`

_

`

m

^

k

s

t

]

v

v

d

\

h

h

^

d

^

^ j d

_

i

s

e

a

`

m

a

`

f

e

f

e

s

e

m

]

i c

k

e

]

a

_

e

`

f

f

e

s

i

\

\ h ^

^

^ e

g

e

_

e

i

_

e

e

i

]

e

_

e g

…

k

i

_

e

]

s

`

e

k

p

p

j d

^

s

e

d h

^

m

]

^

i

e

e g

a

f

e

m

t

s

e

_

i

t

]

s

e

`

]

t

_

e

s

e

m

]

`

m

k

v

j d

\

h

h

h ^

e

`

c

d h

h

^

`

e g

_

q n

_

e

a

]

e

s

s

i

`

m

i

]

e

_

e g

_

i

_

^

_ g

t

`

f

]

e

m

]

i

_

]

i

h

^

`

e

s

`

a

`

f

s

i

k

e

f

`

_

e

_

e

x

t

_

e

k

p

h

e

j d

\ h

^

^

]

s

j \

h

^

`

e

`

q

`

_

a

t

f

`

_

t

m

s

e

`

]

t

_

`

f

e

` g

_

`

f

e

_

i

s

d

h ^

\ h

m

e g

a

f

e

k

e

e g

f

i

q

s

e

m

m

i

f o

e

k

r

e

i

e o

e

`

v

d ^

f

` g

…



f

`

f

e

s

e

`

]

t

_

e

s

e

h

^

m

]

`

m

k

`

]

] n

e

s

s

i

k

e

f

] c

†

p

j h ^

j d

h

^

^

h

^ d

h r

_

i

t

m

k

a

i

m

`

a

i

_

a

e

]

]

s

q

i

_

`

m

e c

m

i

_

s

h

d

d h

\ h

]

`

m

`

f

r

i

j d

^ `

^

_

s

a o

…

k

e

]

a

_

e

^

]

e

s

i

e g

s

e

m

i

p

j h

j

j

h

h

h

^

^

^

h

^

^ d

i

m

]

t

]

e

t

f

i

_

]

e

a

t

_

`

a

n

t

`

i

_

]

i

_

` g

f

k

`

m

\

j

\ h

\

h

^

^

r

e

t

m

s

e

`

]

t

_

`

f

e

` g

_

`

f

e

s

e

n

`

m

]

i

h

^

]

^

`

]

a

`

f

v

j d h

d

h

h

^ j d

h e

a

g

f

e

]

s

t

f

`

i

_

]

`

m

k

i

_

`

k

` g

m

a

e

k

e g

a

f

e

a

h

^

i

m

a

i

m

a

f

t

]

i

m

]

_

i

^

s

e

s

e

`

]

t

_

e

k

m

q

^

t

]

`

m

k

i

^

t

q

t

]

…

^

^ j

_

i

f

]

] n

e

s

d

d

^ ]

h

d h

^

i

e

]

h

j \

h

h

^

] n

e

s

] c

`

f

r

i

_

s

]

`

q

q

f

a

`

f

e

i

m

f n

p

p

d

\ h ^

^

^

\

^

e

‡

\ h

^

]

] n

e

s

]

i

]

e

_

` g

f

e

\

^ p

_

`

m

r

]

] n

e

s

]

`

m

k

a

i

m

_

i

f

]

] n

e

s

]

s

t

]

e

`

f

e

†

\ ^

h

d h

^

h

d h

\

^ d

i

]

`

f

e ˆ

e

a

`

_

k

t

_

m

r

a

i

_

m

e

_

m

r

e

m

]

p

j

^

^

d

d ^

] c

…

Š

h

t

q

`

q

e

_

q

_

e

]

e

d

]

s

e

i

a

i

_

`

m

]

e g

_

]

`

f

i

_

a

e

]

]

t

a

`

]

m

a

i

_

m

e

_

m

d h

a o

t

]

e

]

s

q

f

e

j \

i

k

e

f

]

`

m

k

`

a

e

^

_

` m

m

t

h

_

e

]

e

m

a

e

i

`

a

`

_

i

s

e

`

]

t

_

e

s

e

m

]

m

^

h q

e

h

^

e

s

v

\

^

m

h

^ r

v

j d

h

_

]

h

e o

s

i

k

‰

d

^

h e

h

^

m

s

e

_

`

m

r

f

e

_

e

i

_

]

i

m

`

^ f

i

_

k

e

i

e

\ h

^

_

^

]

s

h

^

`

e

q

`

_

a

t

f

`

_

t

m

s

e

`

]

t

_

`

f

e

` g

_

… v

‹ \ h

h

h

h

d h

^

d h

^ \

e

f w

q n

_

i

k

t

a

e

]

`

m

`

f

r

m

m

r

i

_

x

t

e

a o

s

i

h

d h

h

`

f

e

] b

…

k

e

]

f

q

`

m

r

f

e

e c

\ h

^ k

^

f

e

_

`

t

_

e

k

e

]

a

_

e

]

]

e g

…

p

l d

h

h

d h

h

Πd

h

^

h

h

^ j \

e

]

e

i

_

r

m

`

f

e o

e

f

k

_

e

a

i

m

e c

k

e

_

e

m

a

e

h

h

]

e

_

`

f

i

]

e

_

e

_

g

]

i

_

]

k

e

]

f

q

`

m

r

f

e

i

_

e

` w

s

q

f

e

p

p

d

\ h

h

 |

`

_

`

a

e

_

e ˆ

k

` n

m

`

m

r

f

e

m

i

m o

`

]

z

]

v

h

^

a

‘

k

e

]

f

q

`

h

| h

 ’

ƒ h

h

~

“

“



”

| h

m

e

m

a

e

m

e

m

a

e

`

m

k

`

i

_

e

m

a

e

…

†

†

d

l h

h

h

h

h

h

h

^

r

f

e

z c

]

]

`

]

r

m

a

`

m

d h

^

]

r

m

`

f

m

k

e

^

e

_

s

m

m

r

e

p

275

†

v

†

¿ 

€

 h



 h

h

^

Ê `

m

e k

f

]

e

m

q

_

e

]

e

m

]

f

m

e

`

_

`

m

k

m

i

m

f

m

…

v

Ä Ž

Å

Ä

Ã

Æ

Ã

É

È

À

Ç Á

\

\ h

} h

Ç

d

Ë e

`

_

i

]

e

_

e g

_

]

t

]

m

r

`

a

a n

f

e

s

i

k

e

f

e

m

i

e

m

g

]





Ì

p

Ž Ê



 }

d

€

\ ~

“

“

l |

“

^

Í e

m

i

e g

m

]

`

m

k

`

`

t

]

e

]

`

`

f

s

`

m

f

e

Å

Í

É

_

Ã

Ã È Î

À v

v

Ç

Â

Ë

j d h

h Ì

i

_

`

f

m

e

`

_

e g

a

f

e

s

i

k

e

f

p

d

\ h ^

] c

j d ^

e c

q

_

e

]

e

^

m

j \

t

k

q n

_

e

]

e

t

k

t n

]

e

d h ^

]

i o

a

a n

f

e

s

i

k

e

f

]

^

a

i

o

m

^

]

`

m

d

^

]

h

^

]

^

m

]

i

t

_

i

]

e

_

e g

_

]

i

e

Πh

u

h

\ h

h

h

^

a

d h

h

h

i

_

m

e

_

m

r

]

m

e

]

]

i

k

e

f

]

`

_

e

k

e

]

a

_

e

k

m

f

m

e

`

_

\ h

^

^

p e

a

g

f

e

]

k

e

]

f

q

`

m

r

f

e

` g

p

f

k

`

e

]

i

]

e

_

e g

_

]

i

m



j h

h ^

i

h

\ h

^

d

^

_

m

i

m

f

m

e

`

_

^

]

^

`

e

]

q

`

a

e

i

_

s

t

f

`

i

m

\ h

^

p e

q w

e

_

s

e

m

`

f

k

`

`

`

a

x

t

_

e

k

e n

y

e

t

k

`

]

a n

f

`

…

[

{ h

^

i

_

h

^

`

i

_

a n

`

_

m

i

^

q

a

`

f

]

q

e

e

k

]

e

m

]

i

_

z

i

_

_

e

z g

p

h

d h

^

]

t

]

e

h

h

^

k

i

`

a

x

t

_

^

e

e

]

k

e

]

f

q

`

m

r

f

e

a

i

s

q

`

_

e

]

2 + F

p

>

9

A

B

+

3



=

<

,

/

Y

.

<

S

M

j \

\

^

_

e

]

t

]

i

i

]

e

_

e

_

g

]

i

^

m

i

_

o

i

t

m

k

j

e

e g

f

i

f

`

i

^

t

]

e

_

`

f

`

a

a

e

f

e

_

h ^

`

i

m

i o

^

`

^

o

Πd

h ^

f

d h

^

f

e c

k

e

_

e

^

m

m

i

` Ï

j d

h

h

^

h

^

^

^

^

…

h

d

h

h ^

i

m

]

`

_

e

m

k

a

e

m

g p

h ^

h

e

`

]

]

t

s

q

i

m

i

a

i

_

m

e

_

m

r

`

a

i

m

]

`

m

•

^

`

e

k

m

e

`

q

q

e

m

k w

d h

h

^

]

q

e

e

k

h

h

^

] o

s

`

f

f

]

e

e

_

m

r

`

m

r

f

e

`

m

k

]

k

e

]

f

q

`

m

r

f

e

p

v

d

v

h

h

^

e

f

m

e

`

_

s

i

k

e

f

] b

Ñ Ð











Ò

¸



 ª

u

—

˜

™

ƒ

{

}

™

˜

™

‚ u

ƒ

™

˜

y

Ž

p

–





˜

d

‘







h

–

d h



\

¸

h

^




Ø

Ø

Ø h

^

ß `

e

_

`

f

e

a

g

f

e

k

m

`

n

s

a

]

`

]

e

e

m

]

t

k

e

k

]

m

a

e Õ Õ

 d h

¼



 Ó

Ô




Ö

×

 ×

 Ú

Ú Ù

Ù ^

o ¸ ¸

¸

v

 d š

› 

~

“

š

~

“

š

à Ý

v



•

Û

• Þ

^

^

á

á

Ü e

]

m

p

d

e



r

e

e

s

i

k

e

f

e

f

q

_

e

]

e

m

e

k

`

v

j d

^

f

r

–

d h

a

e

–

h

e g

f

j h

^

_ o

e

e

k

e

r

_

e

e

]

i

_

e

e

k

i

s

m

Ä

Í

æ

Ä

æ

Ä

æ

Í

È

h

^

^

_

k

e

_

i

k

e

]

a

_

e

f

Ç

Ç

^

`

e

_

`

f

s

i

e g

s

e

m

]

m

a

f

t

k

m

r

_

i

f

È

Î

h

ð

Ç

è ç

i

Í

æ

ã

\ h

è ç

è ç

è ç

f

í

Ç

Í ë

ì

Ë

Ë

é

é

j Ì h

Ì

h

^

^ ê

`

m

k

` n

_ o

i

f

f

s

i

e g

s

e

m

]

m

e

r

f

e

a

e

k

`

]

s

q

f

ê

e

ä ñ

Å

p



v â

ä

d

\

\

h

h

i

k

e

f

m

i

m o

`

ñ

h

^

s

^

] e

a z

a n

f

e

s

i

k

e

f

z

]

i

`

m

e

k Ä

Ä

Í

Ä Í

Ä

å

Í

ë æ

È

æ

È

Í

Í

ì

æ

Í

ë

È

ì

æ

ò

È

Î

†

p

Ç Ç

è ç

j d h

]

s

i

k

e

è ç

è ç

h ^

c

Ç

è ç

j

h

f

]

a

t

_

_

e

^

m

f

t n

]

e

k

i

_

^

]

t

k

e

]

i

f

`

e

_

`

f

î

î

Ë

Ì

ï

 d h



h

e g

a

f

e

k

m n

`

h

s

a

]

` n

` o

m

k

k

e

]

ï

ï

ï

[

h

]

h

f

q

m

i

m

f

m

e

`

_

p

j d

h ^

_

e

q

_

e

]

e

^

m

\ h

d h

h

^

`

i

m

i

e

a

a n

f

e

s

i

k

e

f

]

]

i

m o

m

2 F

# F

>

>

A

> B

9

A

#

5

+

3

0

J h

<

=

<

=

.

=

=

<

,

/

Y

.

<

~

r

t

_

e M

‘

p

d h

^

h

e

e

^

e w

m

k

e

k

m

i

m

f

m

e

`

_

s

i

k

e

f

f

δ §

¦

¦

i

m

r

t

k

m

`

f

v

β

ž £

h

^

m



ž

Ÿ

j

l d h

h

^

i

_

a

e

]

`

m

k

e

\ h

_

_

\ h

^

^

]

k

e

_

^

` g

e

]

g

e

a

d h

i

s

e

d h

^

]

`

e

h

^

` g

ψ

_

`

f

e

]

`

_

o

`

m

k

i

s

` o

f

k

¨

m n

`

s

a

] c

†

a

`

m

p

ž

Ÿ

j \

§

j h

h

^ ¨

h

h

^

h

^

¢ e

t

]

e

k

i

_

e

]

s

`

m

r

f

i

m

r

t

k

m

`

f

i

_

a

e

]

`

]

m

v

δ

ž

Ÿ



  ~

` ¡

“

” “

n

ž

Ÿ v

p

¤  

¥

ψ



δ 

d

\ ^

e

ž

c

^

]

^

`

e

e g

a

i

_

e

a

i

s

e

] b

œ

Ÿ

¢

 °  Ÿ


¼ ó

Ó

ö °

Õ Ó ö 

Ó Ô

µ

µ

µ

µ

d h

^

^

œ `  

¸

m

k

e

m

q

t

ô

õ



õ

 Ö



õ õ

^

e g

a

i

_ b

¸

í

¿

Å

ù

ë

h

‡ ~

ì

÷ ÷

÷

ë

ÿ

ì

÷

÷

Î h û

ø r

a

a

f

n

e

s

i

k

e

ü

ý

û

ú

þ

ü

ý

ø

f

þ

Ç É

À

‘

p

p

À é

ê

À

÷

À




Ä

Ä

À ì

ë

ë æ

ÿ

÷

È

j \

h

h

d

^

Ç h

^

÷

ý

ø

h

ÿ



þ

þ

Ç

ø

Ç

è ç

^

ì



À

l h

Ç

À

i

s

e

]

s

q

f

a

`

i

m

]

`

_

e

`

` g

f

`

f

e

i

_

]

]

t

k n

÷

À

ø –

p

À

÷

À

{

Πh

h

\ h

^

^


‡

^

^

^

^ Í

Í

À

i

_

m

e

_

m

r

]

m

e

]

]

]

`

e

m

i

e

a

i

m

]

`

ë

m

t

ì

æ

÷

ë

È

Î

ì





÷

Î

À ý



þ †

þ

p Ç è ç À

÷

À

ø Œ h

h

h

d h

^

h

^

^ À

a

i

_

m

e

_

m

r

]

m

e

]

]

m

a

_

e

`

]

e

]

_

e

o

q

_

e

]

]

t

_

e

À

p

À

À

d

d

j d

^

^

^

d

^

^

^ À

e

m

e

a

`

_

t

_

m

]

e

s

`

]

]

_

`

m

]

e

_

i

m

i

e

e

í

w

À …

Å

‰

v ù

ë

÷

÷

ì



÷

ë

ÿ

÷

ì



÷

À

ý

þ

ý 

ú

þ



ø

Ç À

þ

Ç

Ç

É

 d

©

h

d

h

^

^

^

^

÷ À

e

_

m

`

f

e o

e

f

]

m

a

_

e

`

]

e

]

_

e

q

_

e

]

]

t

_

e

m

e

q

`

m é

ø

À

p



ê

–

À ÷


À Ä  A 



ª

h

d

j d

h

0

^

^

,

]

]

i

m o

Ä

\ ë

^

ì

æ À

<

`

i

_

k

i

t

f

e

f

`

m

ÿ

Ž

ë

ì

È

û ø

ü

ÿ

ý þ

þ

Ç è

ç

v

÷

÷

Î

e

À

M

ø

Ç

Ç

v

÷ Á

ø

°

d 

•



«

“



Œ ® h

h

^

^ ¯

a

`

m

r

e

`

`

m

k

÷

¬

a

i

_

m

e

_

m

r

]


… Í Ž

v

­

Í

v ë

ì

æ

÷

ë

ì

È

Î



÷

÷

Î

û

ü

ý

þ

þ




Ç è

ç

Ç

± d

h

h ^

~



^ ÷ À

m

e

]

]

` g

_

`

i

m

]

`

_

e

f

e

]

]

`

m

ø

À

p

À

À

À

À

² j

d

h

d h

} h

÷ í

h

À

_ c

e

_

i

`

k

i

_

a

e

]

`

_

e

r

f

m n

i

m

f

m

e

`

_

`

_

i




t

]

Å Ä

Í

Í

Í

À ù

ë

÷

È

÷

ì



ë

ÿ

È

ì

æ

÷

È

p Î

ý À




ú

ø

þ

Ç É

Ç è

ç

À

î j d ^

÷

j \

^

^ À

e

e

o

f

r

_

i

t

m

k

a

i

m

`

a

i

_

a

e

s

i

k

e

f

]

`

_

e

i

e

i

t

m

ø

k ï

ï

À …

÷

À




Ä

Ä

Ä

À ë È d h

h

h

^

^

\

h

h

ì

æ

ÿ

÷

ë

È

^ û

ø e

f

e

_

`

t

_

e

m

a

f

t

k

m

r

`

a

i

s

q

`

_

]

i

ì



ÿ

Î

^

À

m

m

e

e o

e

ý

ø

Ç è

ç

ü

þ

m

Ç

À

÷ v

À ø

À

 Œ

d

\

h

^

©

^

d

©

d

h

^

^

Å

^

^ À ÷

_

e

e

k

e

_

e

m

s

i

k

e

f

]

e n

q

`

m

m

e

q

`

÷

m

À

–

ú



É –

À

À

 A 

Å

j d



0

h

÷

^



^ À

<

,

m

]

q

`

q

e

_

_

`

m

]

e g

_

]

`

f

i

_

a

e

]

`

_

e 

É À

M

v

Ž

Ž

p



v

À

Å

À ÷

\ ^

d h

h

h

^

÷

\ h

^ À

`

e

m

i

e

f

m

e

`

_

] c

`

]

]

t

s

q

i

m

]

_

e

`

]

i

m

`

f



e

É

À

†

p

Å Â

÷

j d

d

d

h ^

e

m

o

f

^

`

e

_

`

f

`

a

a

e

f

e

_

h

`

i

m



 d

h

^

^

i

e

e g

a

f

e

]

f

e

]

É

]

`

m

ë

ì 





³ 

˜

d 



{

~ ^

´

e

a

m

e

_

i

­

v

j

Ž

\

_

a

e

]

a

`

]

e

x

t

e

^

m

f

_

`

n

p

m

]

e g

_

]

`

f

v

h ^

i

m

m

e

^

_ o

e

m

`

] b

‚ ‡

ª

¶ ¶

¶

™



}

™



}



[ „

˜

™

‚ €



½ c

¹ µ

 ¼



~

… ~

p

¸

–

–



–

–

–

¸

» º

­

¾

Ž

·

[ j



h ^

e

`

_

`

m

k

_

i

m

h

j h

h

^

e

]

k

e

]

f

q

`

m

r

f

e

]

`

_

e

a

`

f

a

t

f

`

e

k k

e

]

a

_

i

m

q b

_

e

]

e

m

e

k

m

i

h

t

_

h

^

e

]

^

]

e

a

i

m

p

276

\ h

^

i

d h

]

Πh

^

q

^

`

j d

h ^

^

_

k

e

_

e

m

i

]

e

_ g

e

_

]

]

2 +

d 9

H

-

+

B

<

,

/

.

N

<

/



<

j d

h ^

e

]

c =

e

a

i

m

k

h

e

q

d

h

^

]

^

] e

q

_

e

k

^

a

i

m

^

i

e

m

e

^

^

] w

`

e

/

S v M

j d

d h

^

_

i

^

s

e

q

_

e

i

t

g

]

^

]

h

^

`

e

`

m

^

k

e

s

e

`

]

t

_

e

k

m

q

t

p

d

j \

h

d

˜ h

\

^

e c

f

m

e

`

_

i

]

e

_

e g

_

e

`

t

_

e

k

e

_

e

]

`

t

e

m

e

_

r

e

_ 



!





"











 ~

¯

¸

  €

| \

h

h





 h

° !

h

¾

Ž

^

i

]

e

_

e g

e _

m

a

e

`

m

k

e

f

]

e

m ]

†



v

Ž

p

`

q

q

f

e

k



 ª

^

^

i

]

]

e

n

s

p

j d h

h

h

^

e

a

c

i

` g

_

`

m

a

e

s

^

`

_

i

^

]

w

h

^

`

e

e

^

]

s

`

i

m

t

m

a

e

_

…

¿

Ó









h Ò

h

^

^

¸ `

m

] n

b

À

À








À

¸ Á

Õ !

,







Õ

-

,

Û





 $



 ~

ª

¯ š

Ò



Ò

¸





Ó












Ò

° !








Ò

¸

À

À



 d

d h

d h

^

^

^

^

| h

^

À



e

_

c






k

]

e

q

]

i

a

`

f

a

t

f

`

e

e

`

f

s

`

m

r

`

m

Â

¸

j

`

s

`

j d

h ^

s

h

h

_ w

i

d

h

^

_

^

s

e

f

m

e

`

_

^

` ˆ

i

m

^

i e

s

e

`

]

t

_

e

s

e

m

h ^

_ w

b





2 5



F

A

B

5

9 H

+
















³ ~

¯

.

=

=

<

,

/

.

N

<

/



<

/ ´ ¸

M ° !



d h

\ h

] c

m

i

m

f

m

e

`

_

\

i

]

e

_

e g

_

a

i

t

f

¾




™

k

e

a

`

f

f

e

k

`

m w

…

Õ

˜

\

\ h

^

Õ

. ^

,





,

m

k

e

k

t

e

m

e

_

r

e

_

i

]

e

_

e g

_

]

`

q

q

f

e

k



¯

e

°

 h

^





%

 ~

¯

š

¯ Ò

i

¸

p

 ° !

 ™

€

˜

° !



u

³

p

d h

d h

h

^

e

q

c

_

e

k

a

i

m

q

`

]

e

] b

¿

 Ó













¸

¾ À







À !




 










.
















 ~

•


¯

À

¯ Ò

´ ¸ ¸

Á

° !



° !

° !

¾

 •







 Ó


































Ò

¸

À

¾

¾

j d h

À

h

h

^



^

^

h

^

^

 e

a

c

i

`

_

g

`

m

a

e

s

`

_

i w

]

`

e

e

]

s

`

i

m

t

m

a

e

_

À

 

… 






Â

¸

\ h

^

^

`


















m

e

a

n

i

s

e

] b

j


h

h

h !

^

 `

m

k

`

_

e

m

i

m

f

m

e

`

_

t

m

a

i

m

]



, m

/

.







,

” ~

¯

¸ ¾

° !

[

j

h ^

h

^

]

^

`

e

`

m

k

m

q

h ^

t

e

_

f

m

e

`

_

^

` ˆ

° !

d h

^

i

m

`

_

i

t

m

k

e

p

h

\ h

^

e

d

^

]

s

\ h

^

`

e

k

` g

_

`

f

e

e

e

_

_

i

_

k

m n

`

s

a

a

i

t

f

k

e d

™

l |

h

^

e c

v

d h

^

e

m

w

k

e

k

`

f

s

`

m

d

^

f

e

_

]

t

]

e

k

^

e o

h ^

^

_ o

e

m

`

]

 b ™

€

˜



u

³

p

 















 ”

 ë

ì

÷ ÷

ë

ÿ

ì



Ç

÷



ë

ì

ÿ



ë

ì

÷

÷

÷

Ç

Ç





÷

÷





d

d

h



Å

ù ÷

^

^

h

h

h

^

\ h

^

^

2 (

`

q

i

f

e

q

f

`

a

e

s

e

m

e

a

m

x

t

e

]

q

i

]

]

f

e



A

V

i

> B

> B

=

‰

0

Y

(

-

.

<

.

N

<

/



<

9 H

3

/

v

M

h

j d

h

q

i

]

e

e

_

_

i

_

k

m n

`

s

a

]

d

h ^

s

e

]

c

^

] n

e

s

s

^

`

_

e i

w

p

 d

f

i

]

e

k

f

i

i

q

]

^

] n

e

d h

^

a

s

`

]

a

i

m

^

]

`

^

m

q

i

f

e

]

]

m

a



e



e

—

‡

\

h ^



^

d 

^

h

h

^

… _

i

s

e

_

_

t

x

t

e

`

m

k

`

_

i

]

m

k

v

‘

\

v

Ž

Ž

v

†

\ h ^

i

]

e

_

e g

_

]

]

`

f

j e

j \

d

h

h

d h ^

i

i

]

e

_

e g

_

]

t

]

e

t

f

e o

m

i

_

o

m

r

_ o

e

k

t

a

e

k

p

†



 

 j \ h

l

h

h

h

^

i 



]

e

_

^

` g



i

m

e

_

_

i

_

k

m

`

n

s

a

]

i

_

`

^

m

e

s

e

a

i

m

…
































v





¾ 

j ¾ 




\

j \ ^




e g

_

r

e

m

a

e

i

_

`

f

f

i

]

e

_

`

f

g

e

\

^

]

^

`

e

]

`

m

k

i

_

_

i

t

]

…

v

 h

h

^

m

j d h

d

h ^

e c

r

`

m

s

\

_

]

t

m

k

e

_

q

`

_

`

s

d h

^

e

e

_

`

_

g

^

`

i

m

]

^

_

e

o

]

q

e

^

a

i

^

i w

]

\ h

^

`

e

e

i

]

e

_

e g

_

]

a

`

f

a

t

f

`

e

k n

b  h

h ^

a

i

m

k

i

m

]

p



 











 






 



























“

¸

¾

¾ 







¿

 Ó













¸

¾ À

À

 








À

¸ Á 

 

d h

d

^

Õ

 

Õ

 



° 



h

^ ¯

e o

q

]

e

t

k

i

m

e g

_

]





e

~ ¸



… 

­





½

 Ó

















1





Ò

2

´

3

¸

$ À

4

¾

À





À

 








Â

¸



#

>

>



2 

A

9

A

#

0



K

0

J

<

=

<

,

Y

,

=

<

/

M

i

e g

_

 { d

h ^

a

 Œ

d

i c

a

^

\ h



e

_

m

r

e

e

]

`

_

`

i

 h

h

\ h

e



Ž



v



7

h ^

h t

^

m

d

t

½

^ l |

~ ^

a

v

d



^

`

½

j

a

i

m

2

´

3

]

2

´

3

5

`

_

a

`

6

m

5

8

¸

e c

`

f

s

`

m

f

e

_

]

t

]

e

k

`

m

k

k

e

]

a

_

e

k

m

s

`

m n

$

4

$

4 Ž

j

_

u

e

e

_

e

m

a

e

]

i

p

_

e

` w

q

f

[ d

e

h

i

m

e

_

`

m

k

m

k

_

e

] o

 [

d

k

v

 u

s

‘

h

~

“

“

\ ª ^

i

m

k

e

_

`

m

k

m

r

t

]

q

_

e

]

e

m

`

_

i

`

k

v

j

l |

h

h ^

i

e g

_

e g

i o

`

f

s

`

m

f

e

_

m

r



4 7

9

p

<

Y

,

/

N

M

Ï h

d h

^

e g

m

`

]

^

] n

h

e

s

^

s o

e

`

]

t

_

e

k

m

q

t b

[

j h

h

h

^

f

 "











f

s

i

k

e

f

]

e o

_

e

s

q

f

e

s

e

^

m

e

k

m

`

k

]

a

_

e

e

i

_

s

Û #

Ò

¸ ° !

¾ d h

[ u

[ ˜

j ‡

d

^

o

 



$ #



h

] c

~ h

^



^

i

` o

_

e

e c

]

`

s

q

f

m

r

_

`

e

]

 ~

p 

Ò

¸

s

 








]

% #

p

Ò

´ ¸

¾ d h

h ^

e c

m

i

m

f

m

e

`

_

`

m

k

e

^

e w

m

k

e

k

m

i

m

f

m

e

`

_

]

] n

e

s

]

`

_

e

°

l d

ó 

d h

^

^

¯

t

m

k

e

m

e

k

e o

m

¬

j

^

^

e

_

d

^

]

™

| h

h

^

]

e

q

e

h

­ ^

]

i

f

m

e

`

m

q

_

`

a

a

e

e

_

e

d

^

i

2

¸ ô

l d

_

e ˆ

p



e

° ‘

j \

h

d h

ó ~

¯

] h

i

f

g

d h

^

e

^

t

i

m

e

x

t

i

m

`

_

i

t

m

^

k

`

q

_

i

f

e

s

i

k

e g

_

r

e

m

a

e

e o

m

¬

2

h

^

`

e

e

^

]

s

^

`

e

k

]

^

`

e

`

m

: k

; ­

p

°

d

d h

~

h

h

^ d h

^

¯ ^ e

e

m

q

m

]

q

e

e

k

]

f

e

]

]

`

m

¬

2

]

k

e

]

f

q

`

m

r

f

e

t

‰

­

Πd ^

e



 '

e

a

d

Å

) ë ÷

ì

i

m

e

h

e g

a

f

e

k

m n

`

s

 '

) ë ÷

ÿ

ì

ë

ì í

í d ^

& &

a

& &

i

s

q

`

_

]

i

m

i

^

e

^

n

` o

_

`

e

& &



÷



+ p



277

h

a

(

*

ÿ

h



h

h

\ h

^

]



( Å

â

v

]

`

_

e

m

e

r

f

r

f

e

m

V

4

9

<

Y

,

/

N

M

j d

e

h h

h

^ ^

^

e c

s ]

i `

m

i

f

d h

e

_

`

f

`

a

a

e

f

e

_

i `

j \ h

h

^ ^

`

h

m

t

]

e

k

m

]

h ^

q

`

q

e

_

]

k

e

k

t

a

e

k

_

i

s

f

m

e `

_

a

a n

f

e

s

i

k

e

f

p

\

i

t

f



h ^

a

k

e

^

_ o

e

m

`

] b

Ø C

Ø

D

D

D

Ø

Ø

C

C

» \

h

h

ß

d h

^

h

ß

!

^

×

r

y

e

t

k

`

]

a n

f

`

i

_

`

i

_

e n

q

e

w

_

s

e

m

`

f

e

a

g

f

e b

× @

×

×

× Ú Ù

Ù

Ú Ù

¯ Ú

Ú Ù

Ú Ù

H A !

‘

p

Ž

p ·

B F

¯ G

Ý

Û [ 

[ ƒ

Û

Û Þ

E

E E Ü

Ü

Ü

c

I

K

– °

³

™

<

—

™



u

™

[ €

˜

[ u

™

c

[ 

˜

c l d h





e

a

c

i

_

[ 

_

e

^

] g

[ ƒ

e

m

]

i

_

]

e

k

w

i

m

h

( A

B

:

' 4

q

_

t

m

r

s

`

]

f

c

f

t

s

m

^

`

e

]

i

j h

^

@

]

h

e

c

A B

e

j d

–

# V

j d

h ^

p

J

h

^

k

e

^

]

]

t

_

`

a

e

]

m

_

i

m

p

' %

0

j J

O

<

/

Y

<

=

,



<

?

<

d

=

d ^

i e

_

e

`

_

^

\

h

^

_

_

Πd

h

h

^

S

r

e

i

a

c

i

s

q

`

_

^

e e

k

e

_

e

m

i

M …

p

d ^

]

[ 

[ ƒ

d h

˜

\

h

e

_

e

_

g

d

^

]

^

i

e

s

e

`

]

t

_

e

s

e

^

^

y

e

t

k

`

]

a n

_

e

`

_

_

r

h

]

k

e

]

f

q

^ j

\

e

h ^

e

›

^

] c

d h

^

m

`

i

_

`

i

_

] n

e

]

d

^

`

m

r

f

e

m

e

e

d

h

^

e g

k

i

e

a

`

f

a

t

f

h

^

`

e

k

e c

…

e

q w

_

e

]

]

i

m

i

]

–

p

{ d h

h

< >

h

^

h

^

^

d h

^

^  h

a

f

e

`

_

b

i

e

m

`

m

`

e

]

`

e

a

`

_

e

x

t

q

q

e

k



\ h

|

€ h

h



m

r

f

e

]

k

e

]

a

_

e

k

`

]

e

m

a

e

`

m

k

e

f

]

e

m

†

t

v

Ž

j \

m



o

`

`



M

s

e

_

i

]

e

m

]

i

_

]

N ö

ö  

ö



°

d h

p



ö

O

^ Ò

L o

b ¸

ö

Ï —

d h

h

h ^

? b

e g

a

f

e

f

i

a

`

f

` ˆ

i

m

–

[ h

h

^

?

a

a

e

f

e

_

i

s

^

e

e

_

f b

i

m

^

r

t

k

m

`

f

f

`

e

_

`

f

`

m

k

e g

_

… U v

@

@

F D

D

I »

Ý

I

Y

K

K

G S

R V

h

W

X

P

R

P

Q

T

Þ

^

¯ D a

`

f D

D D

Z

I »

K ö

S

P

R

P

Q

B

]

T

¯

@

F ‚

j

^

^

j d

h ^

d D

^ Ý

D

I

G

I

k

i

s

e

_ n

_ b

i

`

i

m

]

q

e

e

k

]

i

e

i

t

_

e o

e

f

Y

K

K

\

[ S

!

?

]

X V

P T

R Q

P T

Þ

D

D



Z

 [ ‡

]

e

m

]

i

_

]

–

Ï d h ^

?

_ n

i

s

^

e

e

_ b

` n

_

i

o

f

f

`

m

k

^

q

a

_

`

e

] d

h

ó h

^

]

e

q w

_

e

]

]

i

j d

h

^

m

m

]

v

a

`

f

a

t

f

^

`

e

k

`

]

e

s

e

`

m

i

ô



v

h ^

?

e

e

_

m

r

`

m

r

f

e

j d h ^

e

f

i

m

d

^

r

t

k

m

`

f

]

q

e

e

k

]

j

d

h

^

^

i

e

i

_

o

e

`

_

e o

e

f

]

i

_

–

{ h ^

?

i

_

_

e

e

m

g

]

i

_ d

\

\

h

d

^

\ h

^

e

f

m

e

`

_

i

]

e

_

e

_

g

i

_

e

m

n

i

m

f

m

e

`

_

i

]

e

_

e g

_

]

–

p

—

d h

h

]

t

]

e

i

m

d

Ó

Ô

h ^

^

f o

h

h

^

]

¼ d

Ï

^

e c

^

^

^

r

t

k

m

`

f

`

m

k

f

`

e

_

`

f

`

e c

a

]

k

e

]

f

q

`

m

r

f

e

^

`

m

k

e

` n

_

`

o

e

`

_

e

…

–

Œ

\ d h ^

^

^

d

^

h

^

^

e

f

e

_

`

i

m

i

_

`

a

e

e

q

`

`

m

d

^

\

h

^

^

^

a a

k

i

k

e

e

_

s

m

`

f

a

t

f

`

e

k

e

k

n

e

e

_

e

m

i

]

e

_

e g

_

]

p

d

d

d

^

e

h

d

d h

h

h ^

_

e

e

a

g

f

e

_

e

`

j d

h

a

e

]

f

m

]

e

]

c

q

e

e

k

`

_

`

q

q

_

i

s w

`

i

m

j h

^

s

e

d

^

f

h

^

e o

h

^

i

e

a

e

^

m

e

_

i

r

_

`

]

g

n

a

`

f

…

p

j d

^

a

t

f

e

k

`

j d

^

`

h

h

^

]

e

s

e

`

m

^

i

e

f

i

m

r

t

k

m

`

f

]

q

e

e

k

]

i

™

<

š

—

™



u

[

™

€

˜



™

„

˜

c

p

 d

c



–

–



d

^

^

^

e

i o

_

e

`

_

e o

e

f

]

i

k

i

s

e

_ n

p

K 7

> B

-

0

/

0

N

/

.

C

=

,

.

C

S

M

h

d

š

~ ^

r

t

_

e

q

‘

_

e

]

e

d

^

m

d

^

]

e

q

h

^

`

`

m

^

k

e

`

a

a

e

f

e

_

`

i

m

p

* V

F

B 0

.

/

/

<



N

<

=

N

.

/

j M

d

h

d

`

r

_

`

s

l d

h

^

k

\

^

i

e

e g

a

f

e

`

f

i

m

^

r

e

_

^

]

_

i

t

m

k

`

i

t

p

\

j

d

d

~

h

^

`

f

c

d

³ 



h

]

i

] o

e

s

`

s w

t

s

s

e

`

]

t

_

e

k

`

f

g

t

e

]

i

_

h ^

e

]

c

e

`

m

i

m

a

i

^

m

`

^

a

i

^

q

a

`

f

]

e

m

]

i

_

s

i

t

m

e

k

…

Πd

\

h

h

^ –

d

^

d

^

^

v

e

k

e

_

e

m

` g

_

`

f

e

]

`

f

i

m

r

e

q

`

p

[ 

[ ƒ

j d

d

^

i

m

i c

–

d

^

m

e

]

q

_

t

m

r

s

`

]

]

i

e

a

`

_

e c

v

p



\ ~

\

u ~

h

^ ³ 

d



h

d h

^ ` c

e

m

]

i

_

q

_

i

k

e

g

]

r

f

`

a

n

a

t

_

`

e

s

e

`

]

t

_

f

i e

t

m

k

`

i

t

`

s w

t

s

` g

f

e …

…

…

–

…

p

–

j d h

h

h

h ^

h

^

m

i

k

]

`

m

a

e

]

q

e

e

k

`

m

k

`

a

a

e

f

e

_

^

h

^ t

e

h

^ j

^

s

`

i

m

_

e

]

f

e

]

i

_

_

e

`

_

_

r

]

k

e

]

f

q

`

m

r

f

e

f

`

e

_

`

f

q

v

v

v

j

{

Ï

h j d

h

^ ³ 

^



^ `

`

m

r

f

e

k

_

`

m

r

f

e

`

m

k

` n

` o

m

r

f

e

e

e

c

a

a

e

f

e

_

`

i

m

` n

_

`

o

e

`

m

k

]

q

e

e

k

i

m

…

… v

v

p

h

i

_

t

]

e

]

q

_

i

e g

m

i

–

^

q

a

`

f

a

i

_

_

e

f

–

d h

^

]

^

`

i

^

m

e

a

m

i

f

i

r

i n

Í

ë

ì

ë

ì

Ê

é

_

ë

é

_

`

é

_

Í

ì Ã

Ë

`

ë

ì a

`

é

_

`

b

Ì

É

d

m

]

t

_

\ h

^

e

^

e

e

s

i

h

^

]

`

a

a

t

_

`

e

q

i

]

]

f

e

]

r

m

`

f

_

e

q

_

e

]

e

m

Ä

Ä

Í

…

c

c

f

f

e

é

d

d h

^

d h

^

d h

^

` i

m

d h

e

a

m

i

f

i

r

m

a

n

i

_

q

i

_

é

e

d

d

h

^

] c

f

e

^

`

e

]

` r

m

e

m

g

h

j

 í

g



j



í

í

…

p

i

h

d h

d

^

^

]

f n

]

i

t

_

a

d

h

^

r

h

^

e

^

`

f

f

t

s

m

^

`

e

i

i

i

j

^

]

^

e

e

]

]

t

_

`

a

e

v

d

d h

h

\ h

^

a

]

o

i

^

q

a

`

f

f

k

d

^

e

n

e

a

h

^

e

k

e n

]

e

m

]

i

_ g

`

`

acceleration at the CG

Roundabout 1 − vehicle path d h

^

q

`

]

e

i

4

h

^

i o

^

q

a

`

f

r

_

^

`

m

r

]

] n

e

s

…

600 p

3 transversal (m.s−2)

580

(m)

560 540 520

2 1 0 −1 −2

500

−3

480 −1150 −1100 −1050 −1000 −950 (m)

³



h

−900

\

−2

d ~

^

r

i

t

m

k

`

i

0 2 longitudinal (m.s−2)

h

^

t

q

^

`

`

m

k

`

a

`

a

a

e

f

e

_

`

e

f

e

_

`

i

m

…

‘

p

p

h

k

`

r

_

`

s

l d

ª

³ h



j \

^

i

{ h

^

_

e

_

d

^

]

_

i

t

m

k

`

i

h

^

t

`

m

k

_

i

^

s

e

a

i

m



^ ‘

r

i

_

_

e

] g

e

m

]

i

_

…

‘

p

p

–

h

h ^

k

`

r

_

`

s

v

f

278

`

h

³ 

e

d

^

_

`

f

`

a

a

e

f

e

_

`

i

m

]

t

m

k

e

_

p

r

p

c

e

d

j

d d

h

h

h

a

f

e

_

e

`

a

e

e

f

m

e

`

_

_

e

]

q

i

m

]

e

k

i

s

`

m

_ n

j

e r

e

`

]

]

t

s

t

h

_

i

m

i

f

m

e

`

_

f

]

d

h h

i

h

^

q

e

e

_

e

]

t

Πd

^

] o

h

^

f

]

^

i

e

k

e

\ h

e

_

`

f

i

_

a

e

]

]

e g

_

e

e

m

_

e

`

_

d

^

`

_

‘

l

h

j d

^

i

p

j h ^

c

d

^

]

d

” h

^

e g

k _

^

r

]

k

e

]

f

q

`

m

r

f

e

i

]

e

_

e g

_

]

`

f

i

m

r

e

]

e

a

i

m

k

p

l \

j ” h

h

^

_

d

h

š

j d

^

r

t

_

e

]

i

e

_

e

]

t

]

t

m

k

`

i

^

t

_

p

i

s

r

t

_

e

x

‘

t

`

^

f

i n

_

e

]

t

f

]

]

v

h

^

f

i

Πd

^

] o

^

i e

k

e

_

e

m

_

e

`

_

‘

d h

\

h

h

l d

^

_

^

r

]

k

e

]

f

q

`

m

r

f

e

i

]

e

_

e g

_

]

`

f

i

m

Rear right sideslip angle Roundabout 2

^

r

e

_

]

_

i

t

m

k

…

Correvit LO NLO SMO EKF

\ ^

`

i

t

p

4 Rear right sideslip angle Roundabout 1

3 Rear right sideslip angle (˚)

1.5

1

Rear right sideslip angle (˚)

0.5

0 Correvit LO NLO SMO EKF

0.5

2

1

0

1

1

2 1.5

50

60

70

80

90 t (s)

100

110

120

130

2 ”



h

\



d h

h

^

r

i

t

m

k

`

i

h

^

t

e

`

_

_

r

]

k

e

]

f

q

`

m

r

f

e

…

385

390

395

400

405

410 t (s)

415

420

425

430

‘

p

435

p

h



\

š

Ž

^

_

 ~

d h

h

^

e

]

t

f

]

h

^ j

\ h

d

d ^

r

i

t

m

k

`

i

t

e

`

_

_

r

]

k

e

]

f

q

`

m

r

f

^

e

r

i

i

k

i

_

m

i

m

f

m

e

`

_

i

]

e

_

e

_

g

]

e

m

o

e

f

`

e

_

`

f

…

‘

p

p

^ h

h

\



š

h

^ _

e

]

t

f

h

^

^

^

]

`

a

a

e

f

e

_

`

i

m

]

t

m

k

e

_

r

t

]

k

e

e

_

i

_

`

e

k

p

d

d h

^

e

^

m

o

e

f

h

d



•

^

`

e

_

`

f

`

a

a

e

f

e

_

`

i

m

]

i

e

_

g

r

d

d

d

h

h

^

( 7

>

F

>

m

e

`

_

i

]

e

_

e

h -

_

g

_

e

`

a

h

e

^ ^

]

e

f

e c

p p

\ h

f

s

e

] o

m

f

`

e

_

`

f

³ 

^ 0

` <

?

.

=

/

.

C

=

,

.

a

a

e

f

e

_

`

i

m

]

i

e

_

g

C

r

p

p

M

d

h

š ^

r

t

_

e

q

‘

p

_

e

]

e

d

^

m

d

^

]

e

q

h

^

`

`

m

^

k

e

`

a

a

e

f

e

_

`

i

m

Ž

* 7

-



A

B

0

.

j d

d

h

Y

O

,

/

N

.

=

0

<

l

<

<

=

/

<

N

C

N

d h

^

^

M k

`

r

_

`

s

i

e

e g

a

f

e

`

f

i

m

r

e

]

e

a

i

m

k

_

i

t

m

k

…

\

\

d

d

^

`

i

h

^

t

`

f

c

e

]

p

i

] o

e

s

`

s w

t

s

s

e

`

]

t

_

e

k

Ž 

Πd h

t

e

]

i

\ h

^

f

d

^

_

e

k

e

_

e

` g

_

`

f

e

]

`

f

i

m

]

t

^

f

]

q

_

e

]

e

h

h

^

m

e

k

h

^

m

]

]

e

a

i

m

`

_

e

m

i

_

s

`

f

e

k

ˆ

d

^

m

d h

^

e

j

` g

^

r

e

q

`

p d

\

\ ^

e

_

_

i

_

e c

s

e

`

m

`

m

k

s

`

e w

_

_

i

_

]

e

e

e

o

m

i

…

p

\



\

u h

^  { h ` c

f

e

i

t

m

k

`

i

t

`

s

t

w

s

` g

^ f

…

Ž

p

]

e

…

_

e

_

g

]

`

m

k

s

e

`

]

t

_

e

]

i

_

_

e

^

`

g

n

_ o

`

e

r

_ n

i

s

Ž …

v

j d h

h

h

^

^ j

t

e

]

i

_

_

e

`

_

_

r

]

k

e

]

f

q

`

m

r

f

e

f

`

e

_

^

`

f

^

e

e

_

f

{

 Ï

^

`

e

_

`

f

`

a

a

e

f

e

_

i

s

e

e

_

]

q

e

e

k

i

s

e

`

]

t

_

e

v

v

j

{

v

Ï

h ^

^

a

a

e

f

e

_

`

i

m

` n

_ o

`

e

`

m

k

]

q

e

e

k

j

\

d

h `

d

h

^

`

_

e

m

i

_

s

`

f

e

k

ˆ

h

^

i

e

s

n

`

s

t

w

s

` g

f

t

e

i

e

`

_

g

… v

\

u

Œ

\

h

h

d h

^

`

Í

f

e

`

s

t

w

s

`

_

g

`

f

e

`

f

g

t

e

]

`

f

i

m

^

r

e

k

e

_

e

m

Í p

ë

ì

ë

ì

Ê

é

_

ë

ì Ã

Ë

`

é

_

`

é

_

ë

ì a

`

é

_

`

b

Ì

É

d

Ä

\ h

^

q

Ä

^

`

]

`

_

e

q

_

e

]

e

~

^

m

e

k

m

`

f

e

]

`

m

k

Í

c

c

f

f

e

é

d

é

í

p

e

d

h

Ž f

e

d

í

 h

 k

k

j

l d

j

l d

h



^

i

i

^

h

^

i e

_

c

]

f

m

e

i

r

j

t

_

e

q

_

e

]

e

j \

m

]

e

m

i

e

`

m

e

_

_

i

_

i

i

]

e

_

e g

_

_

s

`

f

]

i

e ˆ

k

{ d

^

s

Ï

^

_

e

` n

_

`

o

e

`

m

k

acceleration at the CG ‚

l

j “

h

h

h

^

]

q

e

e

k

m

r

t

_

^

e

]

p

i

_

f

^

`

e

_

`

f

`

a

a

e

f

e

_

`

i

m

v

8 d h

h

d h

h

^

`

m

k

_

e

`

_

_

r

]

k

e

]

f

q

`

m

r

f

e

e

]

c

e

a

i

m

k

f

m

e

]

p

Roundabout2 − Vehicle path

d ^

0

q

_

e

]

e

h

d h

^

m

^

]

e

m

i

_

s

`

f

e

k

ˆ

s

`

s

t

w

s

e

_

_

i

_

]

6

−20

j d

^

d

^

e

_

e

]

t

\

^

f

]

i

p



`

m

^

e

i o

_

i

t

m

k

`

i

t

z

_

z

k

z

_

z

−40 Ž

−80 −100 −120 −140

p

4

transversal (m.s−2)

−60 (m)

] o

~

^

_

i

[ \

h

h ^

f

f

i

]

e

_

e g

_

]

r

e g

r

i

i

k

_

e

]

t

f

]

m

s

e

`

m

e

_

_

i

_

p

± „

± j

³

2

d

k

e

_

i

^

_

j d

e

` n

{ d

^

j

~

^

m

_

`

o

e

`

m

k

t

m

k

e

_

i

_

Ï

^

e

]

q

e

e

k

i

e

p

0

−160 −180

Πd

\

d

h

^

e

k

c

−60

−40 (m)

−20

−2

0

e

_

e

m

a

e

h

^

e

e o

d

e

^

e

f

^

e

i o

e

q w

e

e

_

`

f

`

a

a

e

f

e

_

_

\

s

e

m

]

d

^

`

h

^

m

h

^

d

]

h

^

`

i

m

t

m

k

e

_

r

i

m

e

e n

e g

a

f

e

p

d h

^

_

−4

i

^

s

e

e

_

_

i

_

s

e

`

m

i

m

f

^

`

e

_

`

f

`

a

a

e

f

e

_

`

i

m

`

‘

−2

\ h

0 2 longitudinal (m.s−2)

f

f

v

h

h

h ^

m

i

m

f

m

e

`

_

i

]

e

_

e g

_

]



r

±

e g

`

q

q

_

i

s

`

w

e g

f

] n

`

s

e

]

t

e

 d

š

\ h

d h

^

_

^

f

]

`

_

i

t

m

k

e c

f

m

e

`

_

i

]

e

_

e

_

g

]

e

p

h



\

•

d ^

h

^

^ j \

d

^ r

i

t

m

k

`

i

t

q

`

`

m

k

`

a

a

e

f

e

_

`

i

d h

^

^

^

m

f

e

`

]

e

a

`

t

]

e

i

e

e

m

_

`

m

a

e

]

e

x

t

e

m

a

e

m

e

…

‘

p

p

Ž

h

\

d h

h

^ k

`

r

_

`

_

i

t

m

k

`

i

t

]

i

p

l d

j \

^

^

_

e

_

d

^

]

_

i

t

m

k

`

i

`

m

k

_

i

m

_

e

f

m

e

`

_

`

_

_

r

]

k

e

f

q

`

m

r

f

e

`

‘

]

e

f

f

v

h

i

]

_

e

_

g

]

h

r

e g

`

m

i

_

s

`

f

e ˆ

k

s

e

`

m

e

_

_

i

_

h

^

t

i

_

\ h

m

i

h

^

s

^

s

e

`

a

a

e

f

e

_

`

i

m

± \

”

‘

~

^

e

e o

e

m

`

m

k

Ž

h

h ^

k

`

r

_

`

s

f

³

h



`

e

_

`

f

`

a

a

e

f

e

_

`

i

m

]

i

e

_

g

r

v

d

p

d

^

p

p

j d

h

e c

h

h

^

e g

a

f

e

e

a

e

w

e

k

]

e

f

m

e

`

_

_

e

]

q

i

m

]

e

k

i

s

j d

`

m

i

j

h

^

h h

^

^ * 7

_ n

e

e c

`

]

]

t

s

q

i

m

i

f

m

e

`

_

f

`

e

_

`

f

i

_ a

e

]

A

V

B

]

.

=

?

C

N

.

=

p

M

j d

\ h

d

^

`

f

]

e

e c

`

a

a

e

f

e

_

d h

^

`

i

m

t

m

k

e

_

r

i

m

e

e n

e

a

g

f

e

p

h



[ \

š

š

š

d

“

h

`

_

i

t

m

k

r

e

e o

e

m

`

m

k

]

p



e

a

i

Ž

\ š

“

” ~

~

m

k

]

m

]

k

j d

h ^

^

]

Œ

i g

e

_

p

r

e

d

h

^

]

c

t

k

k n

e

`

f

]

\

t

_

k

e

e

e

m

`

m

k

]

e

a

i

_

l d

e

m

e g

h

a

f

e

h

]

k

e

]

f

d ^

o

h

^

i o

q

p

š

^

m

k

` ]

m

r

f

e

i

]

e

_ g

e

_

]

p

c

p

279

e

_

]

d

q

^

`

_

`

^

]

q

_

e

]

e

m

e

^

k

e

[ ”

{

‚

|

€

˜

Ï

™

ƒ

u

™

€

c

gyro

VG

z

5 NLO SMO EKF LO

‰

–

NLO SMO EKF

0.8

d

\

h

h

3 2

] c

h

^

]

t

k

`

n

]

o

k

i

m

e

m

a

i

f

f

`

i

_

d

ƒ

}

i

m

e

]

e

`

_

a

a

e

r

_

i

t

q

z

`

r

m

i

^

e o

[

©

h ^

d

^

`

0.6 _

d

h

^

error mean (%)

4 error mean (%)

p

1

d

©

h

^

]

a

e

e

a

t

f

e

]

`

m

g

a

e

]

z



0.4 l \

d

— h

h

h

d h

^

m

`

m

k

d

^

e

a

n

`

_

k

e

_

e

r

i

m

`

m

k

d

^

e

e

o

f

q

v

1

0.2

0

0

j



[

™

{



²

ƒ

²



d

r2

r1

q

r2r

b

o

]

o

o

e

_

`

a

k

a

j

j

`

s

m o

e

i o

_

v



d

h

^

_

s

p

[ d

^

e

i

…

p

d

h

^ ^

…

–

r1

d h

^

i

d

^

i

e

z

a

i

m

k

e

e

a

e

_

a

e

q

i

t

_

†

{

‚ © h

l ©

h

m

e

m

k

e

]

e

a

t

_

]

e

e

z

q

_

i

e

^

a

m

error max (%)

error max (%)

10

—



™

a

e

k

e n

ƒ

q

_

c

i

r

_

`

s



p

1 

™

™



{

™

€

™

‘

r1

m

2

5 0

`

v

NLO SMO EKF

3

15

d

^

t

4 NLO SMO EKF LO

20

\

Š

^

t

0

r2

r1

r2 ‡

–

u

h

h

^

t

h

^

f

e

`

t

_

`

m

i

]

`

a

x

t

e

]

`

m

e

`

_

e

`

k

…

v

‘

v



–

u

©

v

–





Ï \ h





^

‚

j \

 h

`

^

r

]

e

_

e

_

g

]

_

e

]

t

s

s

`

_

`

m

k

e

`

]

e

m

f

`

]

e

_

^

f

]

i

_

` n

_

`

o

e

`

m

k

]

q

e

e

k

–

p

Ž

Ž

p

p

‘

‘

© h

©

d

h

© h ^

j

{

Ï €

z

s

h

i

i

_

s

`

f

e

k

ˆ

s

e

`

m

`

m

k

s

`

e

_

w

_

i

i

k

e

f

e

m

i

m

f

m

e

`

_

e

k

e

]

e

a

g

t

f

e

]

^

e

e

t

k

e

_

…

h

h ^

k

e

]

h

\ h

^

]

t

^

`

i

m

]

e

m

f

©

h

e

k

e

E

h

^

s

^

]

`

f

e

z

/

.

?

p

* &

' K

F

G

5

G

M

K

F

0

accy

22 ,

δ

12

4

d

\

NLO SMO EKF LO

15

error mean (%)

error mean (%)

6

N

/

,

=

?

<

R

 {

8

<

R

20 NLO SMO EKF LO

10

=

p



h



\



‘

~

h

^

`

_

`

i

t

z

i

]

e

_

` g

e

t

_

]

`

s

i

k

e

]

r

f

]

]

…

v

–

Ž

©

p

© h

‘

^

]

`

© h

^

m

]

k

e

k

e

]

`

t

] w

^

] n

e

s

e

]

q

i

]

]

e

k

`

m

k

e

]

]

m

…

© h

10

›

\

t

f

`

’ h

^

r

“

%

A

^

_

e

]

k

i

]

e

_

0

` g

i

m

z

.

C

/

=

<

<

N

.

?

.

/

,

<

N

p

'

>

T

: B

0

A

K

0

C

.

Y

,

”

C

<

.

5

C

.

C

N

<

/

R

,

=

?

<

R

p

2 |

[ „

h

 ’

ƒ



h

~

“

j

” “

\ h ^

e

0

r1

0

r2

m

a

e

`

†

r1

v

m

k

`

p

z

p

i

]

e

_

` g

i

m

i

p

r2 * d h

A

h

^

f

#

E

0

`

e

_

`

f

e

a

g

f

e

k

m

`

n

s

a

]

z

.

=

/

.

=

0

/

,

?

;

p

 B

M



•



~

³ ~

š

~

~

š



0

?

<

–

v

NLO SMO EKF LO

NLO SMO EKF LO

80 error max (%)

error max (%)

40 30 20

 |

„ h

m

a

e

e

`

o

m

€

k

`

_



h



]

e

f

]

e



'



m

C

.

Y

.

;

†

v

Ž

A B

0

<

?

.

/

.

N

1

N

<

Y

q

 ˜

d

—

0

=

—

40

p

h

0



ƒ

p





m

r

e

_

–

p



h

_

[

~ ^

e

a

m

e

_

`

m

e

f

z

m

`

f

]

e

n

k

t

a

i

s

q

i

_

e

…

v

Ž

20

©

d

h

0

r2

p

h

e

^

m

k

m n

`

s

x

t

e

k

e

]

e

a

g

©

t

f

e

]

›

_

©

r2

k

e

b

e g

f

i

q

q

e

s

e

i

t

e

_

]

f

d

^

r1

© h

^

s

r1

˜

0

e

60

10 0

p

e

r

e

_

]

h

^

m

k

t

m

e

s

e

i

k

i

f

i

r

e

`

q

…

© h

‘

©

© h

h

— h

d

ƒ

d

^

q

f

x

t

e

e

`

f

`

]

e

a

t

h

^

_

e

q

_

s

`

_

e

z

e

]

]

p

‚ h

h ^

r

]

e

_

e g

_

]

_

e

]

t

^

f

]

i

_

f

^

`

e

_

`

f

`

a

a

e

f

e

_

`

i

m ©

™ ‘

p

p

j \

“

˜

p ^

a

i

f

e

a

e

m

_

`

f

e

k

e

i

m

n

p

d h

h

€ h

h

^

`

m

k

_

e

`

_

_

r

]

k

e

]

f

q

`

m

r

f

e

i

_

s

`

f

e ˆ

k

… u

Ï d

m

k

e

_

_

v

e

`

m

`

m

k

s

`

e w

_

_

i

[

–

[

—

h

i

s

e

`

f

o

`

m

k

m

p

k

_

e

] o

m

r

t

]

p

_



 ~

“



“

ª

 A

A

@

0

,

Y

,

>

B

B

0

=

<

/

=

0

0

<

.

/

1

,

=

O

/

,

?

?

<

p

—

p

d h

^

_ l h

d

h

d h

s

q

f

e

k

e

a

g

f

e

s

i

k

e

f

e

m

a

e

^

]

e

]

e

a

i

m

k

q

`

f

e p

v

j — h ^

e \

f

^

_

v

Πh

`

d

^

]

™ h

_

_

t

x

t

h

— h

‡ h

\

^

^

e

f

_

k

`

m

k

e

`

m

e

_

_

e

`

_

i

h

^

^

^ …

k

e

_

e

m

i

]

e

_

e

_

g

]

q

e

w

_

s

e

m

`

f

s

`

e

_

`

f

]

`

_

e v

‰



p



 

( A



> B

>

A

B

B

B

B

0

= d

d

h ^

q

_

e

]

e

^

m

e

k

m

^

e

_

k

i

m

e

`

m

k

_

e

]

t

f

]

i

m

i o

Ž

Ž

m

k

`

i

]

h ^

k

e

o

<

?

.

=

/

.

=

<

=

0

=

<

<

/

=

0

_

p

a

e

p

f

e

e

_

m

a

j

h

^

t

.

ƒ

`

t

Πd

h ^

i

Y

^

u

\

_

0

h

^

_

e

h

^

m

f

e

e

f

g

^

i

_

e

n

]

i

f

a

` †

†

v



p

…

 

˜



 ~

“

j

” “

h

h ^

` j h

h

m

m

p

]

^

q

e

`

t

_

`

z

m

i

m

f

m

e

`

_

_

e

i

_

a

e

e

]

h

^

i

n

j

h

^

i

s

i

k

e

f

f

m

r

`

]

]

t

s

^

q

i

m

i

f

…

`

e

_

`

f v

p

p



j h ^

³ 

\ h

h

h

^

s

h

l

h

h

h

^

`

i

m

`

m

k

_

i

`

k

_

h

^

a

i

m

k

e

^

m

a

`

i

m b

h

^

`

a

a

e

f

e

_

`

i

m

t

m

k

e

_

r

m

i

m

f

m

e

`

_

i

]

e

_

e g

_

]

r

e g

p

' h

h

h

B

^

s d h

^

r

i

i

k

_

e

]

t

h



t

f

f

]

e o

m

`

a

a

e

f

e

_

`

i

m

]

i

e

_

g

r

e c

p

i

e

`

_

i

]

`

m

k

e

q w

e

_

s

e

0

m

]

z

0

C

–

.

Y

,

?

,

p



\

d h

^

m

m

p

˜

\ h

f

^

`

d •

^

e

_

e g

_

m

e

e

k

i

e

t

]

e

k



˜

~



~



~

“

~

^

ª

ª

–

m o



j d

h

^

]

e

_

`

s

e v

p

…

 u



˜ ~

“

d

š

•

h

h

h

^

e j d h

r

e

f

^

z

e

i

_

a

`

f

q

_

e

k

a

i

m

`

m

k

e w

h

^

^ …

i

_

o

i

]

`

]

]

t

s

q

i

m –

†

v

p

p

p

p

j \

h

h

^

q

e

_

s

e

^

m

`

f

]

d

t

]

\

^

`

`

`

i

s

i

m

i

e

_

e

]

q

i

f

^

e

i

i

m

]

e

i

E h

^

t

^

h

^

e

^

m

j d

h

^

^

]

e

e

_

m

r

a

i

m

_

i

f

z

/

.

?

,

C

;

p

-

A

Q >

B

B

B

B

Y

.

<



N

.

=

0

.

@

B

0

.

M

Q @

B

0

<

=

0

A B

0

N

C

.

Y

<

?

,

=

?

,

B

<

=

0

=

<

<

/

N

p [ —

—

•

™

€

ƒ

<

‚ €

[

‚

c

€

c

… [

© p





–

d

ƒ

h

h

h

^

e

q

`

m

i

–

v

`

m

m

f



e

`

_

`

`

m

k

i

s

m

x

t

e

j



h

f

ˆ

_

v



h

e

`

n



 u

z

Ž

Ä

{

d

^

Ž

i

_

a

e

s

i

k

e

f

a

i

s

q

`

_

]

i

m

i

m

p

Í

Ä

æ

u

v

ë

ì

x





p

y

{

p

m f ü o

r



o

s o

r t

r

û

ü

r

o



o



ý w

r 

ý

ý z

_ d

j d

^

è ç

n q

^

d e

e o

e

f

r

_

i

t

m

k

a

i

d h

^

m

`

a

i

_

e g

a

f

e

k

m n

`

s

…

ë |

}

~





…

ì

u p

s

û

o

t

é E h

&

#

#

#

&

A

A

@ B

0

a

]

z

/

.

?

0

=

<

0

<

( A

B

™

=

<

?

<

1

Y

O

.

;

p

M

Ä

ë €







v

„



u

p

ü 

„

u

p

w

ƒ

s 

ü

û o

r

v

„

ì y

p

r 

ü o



r

r

t

s o

r …

B

A

A

B ™



‚ N

C

Y <

/

N

,

<

N

;

p

Ä

ë €

}

v

„



u

„

u

p

s o

ý 

r ‡

ý o

s

ü

û o

r

v

„

ì y

p

r 

ü o



r t

r

s o

…

r [

©

d

{ d

h

^

ƒ h

h

^

† e

q

`

m

i

–

Ä

v

`

m

m

f n



`

_

`

_

`

`

m

k

i

s

m

x

t

e

v

Í

ë È

ˆ

‰

„

v

p





p

ü m

ü o

ì

p



r o

s

s o

r

ý

Š

s

û 



r é

u



h



e q

e ˆ



ª

h

f

z

Ž

\

]

h

k

e

]

f

q

`

m

r

f

e

i

]

e

_

e g

_

]

z

p

p

Ä ë Ë

‹



„

„

ì



p

p f

r Œ

r

ü

û

r

r 

ü o

w

s o

‡



é

e E

Ì

* #

* A

Q

*

0

d /

.

?

C

/

.

O

<

,

=

.

=

/

.

.

=

<

/

<

=

?

<

,

Y

;

;

M

ë Æ ‹



ì

v

{

p

r

r o



s w



r w

z

_ -

> B

/

0

<

p

ë à Ž

u



v

r



û

r



v

ý

r



ì

v

ý

s Œ



{

r w

z

 _ }

e

d

—

m

i

e g

m

|

]

y

`

c

m

€

k

`

_



\

f

`

~

“

“

d “

`

z

h

e g

…

v

Ä

p



p

p

Í

ë Ã u

v





v



ì

v

{

p

m

ü o



r o

s o

r t

r

ý

r

ý

s Œ



r w

z

_ l h

h

h

^

n q

a

f

e

k

m

`

n

s

a

]

e

h

]

^

s

`

^

i

m

t

]

m

r

`

f

s

`

m

f

†

Í

ë 

u

u

v





v



ì

v

{

p

o

r

s o

o

w

r

r

t

ý

r

ý Œ

s 

w

r z

_ @

( A

B

%

™

B

˜

š

~

” ~

~



³

0

<

?

<

1

N

<

Y

1

=

,

Y

?

N

–

v

Ä ë

ì



{ p f s t

o

s

r z

_

e

É d

280

_

]

z

p

Í

Ã

Ê

e

p