IEEE Robotics & Automation Magazine - September 2011 - 52

Mode Estimator Implementation
We use a discrete time form of the estimator proposed in the
"Problem Solution" section. Since the driver decides to switch
the mode to brake or accelerate once the human-driven vehicle crosses DP , the mode estimator running on the autonomous vehicle uses the
* continuous state measureThe human-driver interface ments of the humandriven vehicle after it
P
comprises a steering wheel crosses D . The instance
n ¼ 0 corresponds to the
time step when the humanand two pedals for throttle
driven vehicle crosses this
decision point. We take
and brake commands.
N ¼ 20 and consider
* n > N: At the nth time
step after the humandriven vehicle crosses the human-decision point, the estimate
^ ¼ (1=n À 1)Rn a(k).
is calculated by using the formula: b(n)
k¼2
Hence, n time steps after the human-driven vehicle crosses
the decision point, y(n) is given by y(n) ¼ yA if
^ À b j > c d,
 y(n) ¼ yB if jb(n)
 and
^ À b j > c d,
jb(n)
B
B
A
A
y(n) ¼  otherwise.
Control Map Implementation
We introduce the following discretization of system H
given in (1) and (2) (employing forward Euler approximation) with step size dT > 0, i 2 f1, 2g, and index
j: pi ½j þ 1Š ¼ pi ½jŠ þ F1i (vi ½jŠ, ai ½jŠ) and vi ½j þ 1Š ¼ F i (vi ½jŠ,
ai ½jŠ), where F1i ¼ dT vi ½jŠ, F i (vi ½jŠ, ai ½jŠ) ¼ vi ½jŠ þ dTc
(vi ½jŠ, ai ½jŠ), c(vi , ai ) :¼ ai if vi þ ai dT < vmax and vi þ
ai dT > vmin , c(vi , ai ) :¼ (vmax À vi )=dT if vi þ ai dT >
vmax , and c(vi , ai ) :¼ (vmin À vi )=dT if vi þ ai dT < vmin .
We define the notation for a sequence of constant
inputs ai for i 2 f1, 2g: F i, 0 (vi , ai ) :¼ vi and F i, kþ1
(vi , ai ) :¼ F i (F i, k (vi , ai ), ai ) with k 2 N. The value of
pi ½kŠ starting from initial conditions (pi , vi ) can be calcuP
i  i, j
lated as pi ½kŠ ¼ pi þ kÀ1
j¼0 F1 (F (vi , ai ), ai ): Since Bad ¼
½L1 ,U1 Š 3 R 3 ½L2 ,U2 Š 3 R, define for i 2 f1;2g the sequenP
i  i,j
k
ces Lk1 (v1 ,a1 ):¼L1 À kÀ1
1 ,a1 ):¼
j¼0 F1 (F (v1 ,a1 ),a1 ), U1 (vP
PkÀ1 i i,j
kÀ1 i
k
U1 À j¼0 F1 (F (v1 ,a1 ),a1 ), L2 (v2 ,max(a2 )):¼L2 À j¼0
F
PkÀ1 1i
i,j
k
(F (v2 ,max(a2 )),max(a2 )), U2 (v2 ,min(a2 )):¼U2 À j¼0 F1
i,j
(F (v2 ,min(a2 )),min(a2 )), where max(a2 )¼ bq þcq d and
min(a2 )¼bq Àcq d when ^q ¼q, while max(a2 )¼bA þcA d
and min(a2 )¼bB ÀcB d when ^q¼fA,Bg. Then, one can
È
show that Pre(^q, Bad)u ¼ x 2X j9k!0 s:t: Lk1 (v1 , a1 )p1 , since the sequences fLk1 gk!0 ,fU1k gk!0 ,
fLk2 gk!0 , and fU2k gk!0 are strictly decreasing [20]. Thus,
we only need to make a finite number of computations.
To implement the feedback map p^(^q, x) of the "Problem
Solution: Computational Tools" section, we need to track
when the continuous flow hits the boundary of the relevant
set Pre(.,.). In discrete time, we consider the continuous
state to be on the boundary of Pre(.,.) when it is outside it
while its prediction forward in time is inside it. To make
this procedure robust to both communication and actuator
delays, we consider ten forward predictions in time instead
of only one.
Experimental Results
The cumulative time for which the trials were conducted is
3,479 s, resulting in a total of 97 instances of collision
avoidance in which the autonomous vehicle applied control to avoid a collision. In doing so, the autonomous vehicle entered the capture set in three such instances and
resulted in a collision in one such instance, resulting in an
overall success rate of 96.9%. During the total duration of
the experiments, the mode was estimated as A (acceleration) 102 times, as B (braking) 45 times, and remained at
fA, Bg (acceleration or braking) nine times. These results
are presented in Table 1. All mode estimations are correct.
Figure 4 shows a collision-avoidance instance when the
human-driven vehicle mode was identified as A.
Discussion and Conclusions
In this article, we have illustrated the application of a formal
hybrid control approach to design semiautonomous multivehicle systems that are guaranteed to be safe. Our experimental results illustrate that, in a structured task, such as
driving, simple human-decision models can be effectively
learned and employed in a feedback control system that
enforces a safety specification. They also highlight how the
incorporation of these models in a safety control system
makes the control actions required for safety less conservative. In fact, by virtue of the mode estimate, the current
(mode-dependent) capture set to avoid guaranteeing safety
is considerably smaller than the capture set to be avoided
when the mode estimate is not available. This is essential for
the practical applicability of cooperative active safety systems. In our data set, the flow entered the capture set only
3% times. These failures are mainly due to communication
delays between the vehicles and the workstation. These
delays, when significant, cause the calculated capture set to
be different from the actual one and hence may cause to
enforce control too late. These delays, in future work,
should be formally accounted for in the models and in the
safety control algorithm.
More complex models of human decisions in the
proximity of an intersection and the incorporation of additional details, such as weather conditions and road geometry, offer the potential for reducing the conservatism of safe
control actions even further. Future work will also consider



Table of Contents for the Digital Edition of IEEE Robotics & Automation Magazine - September 2011

IEEE Robotics & Automation Magazine - September 2011 - Cover1
IEEE Robotics & Automation Magazine - September 2011 - Cover2
IEEE Robotics & Automation Magazine - September 2011 - 1
IEEE Robotics & Automation Magazine - September 2011 - 2
IEEE Robotics & Automation Magazine - September 2011 - 3
IEEE Robotics & Automation Magazine - September 2011 - 4
IEEE Robotics & Automation Magazine - September 2011 - 5
IEEE Robotics & Automation Magazine - September 2011 - 6
IEEE Robotics & Automation Magazine - September 2011 - 7
IEEE Robotics & Automation Magazine - September 2011 - 8
IEEE Robotics & Automation Magazine - September 2011 - 9
IEEE Robotics & Automation Magazine - September 2011 - 10
IEEE Robotics & Automation Magazine - September 2011 - 11
IEEE Robotics & Automation Magazine - September 2011 - 12
IEEE Robotics & Automation Magazine - September 2011 - 13
IEEE Robotics & Automation Magazine - September 2011 - 14
IEEE Robotics & Automation Magazine - September 2011 - 15
IEEE Robotics & Automation Magazine - September 2011 - 16
IEEE Robotics & Automation Magazine - September 2011 - 17
IEEE Robotics & Automation Magazine - September 2011 - 18
IEEE Robotics & Automation Magazine - September 2011 - 19
IEEE Robotics & Automation Magazine - September 2011 - 20
IEEE Robotics & Automation Magazine - September 2011 - 21
IEEE Robotics & Automation Magazine - September 2011 - 22
IEEE Robotics & Automation Magazine - September 2011 - 23
IEEE Robotics & Automation Magazine - September 2011 - 24
IEEE Robotics & Automation Magazine - September 2011 - 25
IEEE Robotics & Automation Magazine - September 2011 - 26
IEEE Robotics & Automation Magazine - September 2011 - 27
IEEE Robotics & Automation Magazine - September 2011 - 28
IEEE Robotics & Automation Magazine - September 2011 - 29
IEEE Robotics & Automation Magazine - September 2011 - 30
IEEE Robotics & Automation Magazine - September 2011 - 31
IEEE Robotics & Automation Magazine - September 2011 - 32
IEEE Robotics & Automation Magazine - September 2011 - 33
IEEE Robotics & Automation Magazine - September 2011 - 34
IEEE Robotics & Automation Magazine - September 2011 - 35
IEEE Robotics & Automation Magazine - September 2011 - 36
IEEE Robotics & Automation Magazine - September 2011 - 37
IEEE Robotics & Automation Magazine - September 2011 - 38
IEEE Robotics & Automation Magazine - September 2011 - 39
IEEE Robotics & Automation Magazine - September 2011 - 40
IEEE Robotics & Automation Magazine - September 2011 - 41
IEEE Robotics & Automation Magazine - September 2011 - 42
IEEE Robotics & Automation Magazine - September 2011 - 43
IEEE Robotics & Automation Magazine - September 2011 - 44
IEEE Robotics & Automation Magazine - September 2011 - 45
IEEE Robotics & Automation Magazine - September 2011 - 46
IEEE Robotics & Automation Magazine - September 2011 - 47
IEEE Robotics & Automation Magazine - September 2011 - 48
IEEE Robotics & Automation Magazine - September 2011 - 49
IEEE Robotics & Automation Magazine - September 2011 - 50
IEEE Robotics & Automation Magazine - September 2011 - 51
IEEE Robotics & Automation Magazine - September 2011 - 52
IEEE Robotics & Automation Magazine - September 2011 - 53
IEEE Robotics & Automation Magazine - September 2011 - 54
IEEE Robotics & Automation Magazine - September 2011 - 55
IEEE Robotics & Automation Magazine - September 2011 - 56
IEEE Robotics & Automation Magazine - September 2011 - 57
IEEE Robotics & Automation Magazine - September 2011 - 58
IEEE Robotics & Automation Magazine - September 2011 - 59
IEEE Robotics & Automation Magazine - September 2011 - 60
IEEE Robotics & Automation Magazine - September 2011 - 61
IEEE Robotics & Automation Magazine - September 2011 - 62
IEEE Robotics & Automation Magazine - September 2011 - 63
IEEE Robotics & Automation Magazine - September 2011 - 64
IEEE Robotics & Automation Magazine - September 2011 - 65
IEEE Robotics & Automation Magazine - September 2011 - 66
IEEE Robotics & Automation Magazine - September 2011 - 67
IEEE Robotics & Automation Magazine - September 2011 - 68
IEEE Robotics & Automation Magazine - September 2011 - 69
IEEE Robotics & Automation Magazine - September 2011 - 70
IEEE Robotics & Automation Magazine - September 2011 - 71
IEEE Robotics & Automation Magazine - September 2011 - 72
IEEE Robotics & Automation Magazine - September 2011 - 73
IEEE Robotics & Automation Magazine - September 2011 - 74
IEEE Robotics & Automation Magazine - September 2011 - 75
IEEE Robotics & Automation Magazine - September 2011 - 76
IEEE Robotics & Automation Magazine - September 2011 - 77
IEEE Robotics & Automation Magazine - September 2011 - 78
IEEE Robotics & Automation Magazine - September 2011 - 79
IEEE Robotics & Automation Magazine - September 2011 - 80
IEEE Robotics & Automation Magazine - September 2011 - 81
IEEE Robotics & Automation Magazine - September 2011 - 82
IEEE Robotics & Automation Magazine - September 2011 - 83
IEEE Robotics & Automation Magazine - September 2011 - 84
IEEE Robotics & Automation Magazine - September 2011 - 85
IEEE Robotics & Automation Magazine - September 2011 - 86
IEEE Robotics & Automation Magazine - September 2011 - 87
IEEE Robotics & Automation Magazine - September 2011 - 88
IEEE Robotics & Automation Magazine - September 2011 - 89
IEEE Robotics & Automation Magazine - September 2011 - 90
IEEE Robotics & Automation Magazine - September 2011 - 91
IEEE Robotics & Automation Magazine - September 2011 - 92
IEEE Robotics & Automation Magazine - September 2011 - 93
IEEE Robotics & Automation Magazine - September 2011 - 94
IEEE Robotics & Automation Magazine - September 2011 - 95
IEEE Robotics & Automation Magazine - September 2011 - 96
IEEE Robotics & Automation Magazine - September 2011 - 97
IEEE Robotics & Automation Magazine - September 2011 - 98
IEEE Robotics & Automation Magazine - September 2011 - 99
IEEE Robotics & Automation Magazine - September 2011 - 100
IEEE Robotics & Automation Magazine - September 2011 - 101
IEEE Robotics & Automation Magazine - September 2011 - 102
IEEE Robotics & Automation Magazine - September 2011 - 103
IEEE Robotics & Automation Magazine - September 2011 - 104
IEEE Robotics & Automation Magazine - September 2011 - 105
IEEE Robotics & Automation Magazine - September 2011 - 106
IEEE Robotics & Automation Magazine - September 2011 - 107
IEEE Robotics & Automation Magazine - September 2011 - 108
IEEE Robotics & Automation Magazine - September 2011 - 109
IEEE Robotics & Automation Magazine - September 2011 - 110
IEEE Robotics & Automation Magazine - September 2011 - 111
IEEE Robotics & Automation Magazine - September 2011 - 112
IEEE Robotics & Automation Magazine - September 2011 - 113
IEEE Robotics & Automation Magazine - September 2011 - 114
IEEE Robotics & Automation Magazine - September 2011 - 115
IEEE Robotics & Automation Magazine - September 2011 - 116
IEEE Robotics & Automation Magazine - September 2011 - 117
IEEE Robotics & Automation Magazine - September 2011 - 118
IEEE Robotics & Automation Magazine - September 2011 - 119
IEEE Robotics & Automation Magazine - September 2011 - 120
IEEE Robotics & Automation Magazine - September 2011 - 121
IEEE Robotics & Automation Magazine - September 2011 - 122
IEEE Robotics & Automation Magazine - September 2011 - 123
IEEE Robotics & Automation Magazine - September 2011 - 124
IEEE Robotics & Automation Magazine - September 2011 - 125
IEEE Robotics & Automation Magazine - September 2011 - 126
IEEE Robotics & Automation Magazine - September 2011 - 127
IEEE Robotics & Automation Magazine - September 2011 - 128
IEEE Robotics & Automation Magazine - September 2011 - 129
IEEE Robotics & Automation Magazine - September 2011 - 130
IEEE Robotics & Automation Magazine - September 2011 - 131
IEEE Robotics & Automation Magazine - September 2011 - 132
IEEE Robotics & Automation Magazine - September 2011 - 133
IEEE Robotics & Automation Magazine - September 2011 - 134
IEEE Robotics & Automation Magazine - September 2011 - 135
IEEE Robotics & Automation Magazine - September 2011 - 136
IEEE Robotics & Automation Magazine - September 2011 - Cover3
IEEE Robotics & Automation Magazine - September 2011 - Cover4
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2023
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2023
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2023
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2023
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2022
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2022
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2022
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2022
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2021
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2021
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2021
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2021
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2020
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2020
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2020
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2020
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2019
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2019
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2019
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2019
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2018
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2018
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2018
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2018
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2017
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2017
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2017
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2017
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2016
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2016
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2016
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2016
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2015
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2015
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2015
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2015
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2014
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2014
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2014
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2014
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2013
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2013
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2013
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2013
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2012
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2012
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2012
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2012
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2011
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2011
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_june2011
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_march2011
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_december2010
https://www.nxtbook.com/nxtbooks/ieee/roboticsautomation_september2010
https://www.nxtbookmedia.com