Beruflich Dokumente
Kultur Dokumente
Abstract— The paper reports on an affordable platform for The capabilities and potentials of the proposed platform
indoor experimental verification of algorithms for distributed are demonstrated on platooning experiments using two of the
control of platoons of vehicles. The platform is based on most popular platoon control schemes: predecessor following
commercially available racing slot cars (by Carrera) equipped
with an on-board 32-bit microcontroller-based control system. and leader following. Some technical parameters of the
The assembled PCB board was provided by Freescale Semi- platform as well as design experience are shared in the
conductor, Rožnov pod Radhoštěm, Czech Republic, within report. The motivation for writing this paper was to share
their Freescale Race Challenge 2012 competition of individual the experience with the chosen technology and encourage
autonomous slot cars organized for student teams in Czech and other teams to go for the same experimenting and eventu-
Slovak republics. The documentation is freely available online.
Some extra components such as an infrared range sensor and a ally organize some indoor vehicular platooning competition.
wireless communication module have been added to the original Real-size competitions in this domain have already been
system. The capabilities and potentials of the proposed platform organized, namely Grand Cooperative Driving Challenge
are demonstrated on platooning experiments using two of the (GCDC) (http://www.gcdc.net) organized by TNO
most popular platoon control schemes: predecessor following for the first time in May 2011 in the Netherlands.
and leader following. Some technical parameters of the platform
as well as design experience are shared in the report. It is The work presented in this paper offers yet another exper-
hoped to encourage other teams to build a similar setup and imentation platform in addition to the LEGO Mindstorms
possibly expose their new distributed control algorithms to an NXT vehicular platoons reported by the authors in [1]. An
experimental competition. interested reader is also referred to that paper for some more
I. INTRODUCTION general background in control in vehicular platoons including
a richer list of references.
The objective of the work presented in this paper was to
build a cheap and friendly yet realistic platform for indoor
experimental verification of advanced control and communi- II. TECHNICAL DESCRIPTION
cation schemes in the domain of vehicular platooning.
The proposed platform is based on commercially avail-
A. Carrera racing slot cars
able racing slotcars produced by Carrera and equipped by
the authors with a specialized control system based to a The experimental platform is based on the the popular
large extent on the electronics provided kindly by Freescale commercially available Carrera Evolution set. The sets in
Semiconductor, Rožnov pod Radhoštěm, Czech Republic. this series feature the tracks scaled at 1:24 and offer the total
They provided a fully assembled PCB board (see Fig.1) track length ranging from 4 m to 6 m, and two cars scaled at
within their Freescale Race Challenge 2012 competition 1:32. The cost of the basic sets ranges between USD 150 and
of individual autonomous slot cars organized for student 200. Additional cars have been bought separately, each for
teams in Czech and Slovak republics. The web page http: about USD 50. In total, 5 cars were available for the exper-
//hw.cz/FRC2012 contains not only the race information iments described in this report but platooning experiments
(unfortunately in Czech only) but also full documentation to with 10 cars are under way at the time of writing this report.
the control unit (including standard datasheets in English). The particular type of a vehicle is Ford Capri RS Tuner 3
The same race has been organized in Romania too and their shown in Fig.2. Since the controller printed circuit board
web page (shortened address) http://goo.gl/WQkyP (PCB) provided by Freescale Semiconductor (see below)
reads English. turned out not to fit into the interior of the chosen car
Some extra components such as an infrared range sensor (the car dimensions are not readily available before buying),
and a wireless communication module have been added to the plastic corpus of the car had to be adjusted (cut). This
the original system. leaves the cars a bit ugly with holes on their sides. Certainly
This work was supported by Ministry of Education of the Czech Republic different (larger) cars could be bought, but we wanted to use
within the bilateral project AMVIS ME10010 and by Grant Agency of the the available cars already purchased. Alternatively, the layout
Czech Republic withing the project GACR P103-12-1794. of the PCB board could also be modified so that it fits into the
D. Martinec is a graduate student at the Faculty of Electrical Engineering,
Czech Technical University in Prague, 16627 Prague, Czech Republic chosen car, but with several assembled PCB boards available
dan.martinec@fel.cvut.cz. for free from Freescale Semiconductor, it was decided to...
Z. Hurák and M. Šebek are with the Department of Control Engi- cut. When purchasing another type of a car, it may be useful
neering, Faculty of Electrical Engineering, Czech Technical University
in Prague, 16627 Prague, Czech Republic hurak@fel.cvut.cz, to consider the shape of the front fender for easy attachment
michael.sebek@fel.cvut.cz. of the infrared proximity sensor.
167
140 11 Filtered current
High peaks
130 3
11 Low peaks
7
120 3
Fig. 6. Structure of the XBee packet.
110
Pole switch Pole switch Pole switch
Current [mA]
Pole switch
100
1
90 9 1
A packetized communication has several advantages. It
2 5
80 5
contains the packet length, the source address and the packet
2
identifier (used to determine the purpose of the packet).
70 12 8
4 Moreover, the module retries to send the packet if the
10 12
60
10
4 receiver does not acknowledge reception.
50 6 There are two possibilities how to communicate between
7610 7615 7620 7625 7630 7635 7640
Time [ms] the cars, either using one-to-one or one-to-all (broadcast)
communication. The former way was chosen since the exper-
Fig. 5. Periodicity in the filtered current. iment is supposed to simulate conditions where the broadcast
communication is not possible (e.g. due to large distances
between cars).
The velocity is then measured using an IR reflectance sen- 2) Wireless configuration: The module is designed to
sor QRE1113 from Fairchild Semiconductor (bought from communicate with the processor via the UART serial inter-
Sparkfun). The sensor is oriented against a small piece of face. A converter such as XBee Explorer USB is required
paper patterned with black and white stripes. This way a to enable the connection between the wireless module and a
simple low resolution rotary encoder was built. The output computer USB port. This device allows an easy configuration
of the sensor is connected to the Input capture pin of the of the XBee module.
processors timer making it possible to detect the black- There are a few configuration settings that have to be
white threshold and to measure the time from the previous in place before the first use of the module. Those are a)
threshold detection. There are 4 black and 4 white stripes on a module address which has to be unique for all modules, b)
the paper, the wheel radius is r=10 mm and the timer runs at the modules Interface Data Rate and the processors SCI Baud
the frequency finput capture =3 MHz. The car velocity in mm/s rate have to set to the same value of communication speed, c)
is then API option has to be enabled. Besides of these settings there
2πrfinput capture 23.56 × 106 are several others that keep communication more secure.
v= ≈ , (1)
8Cn Cn
where Cn is the number of pulses in the timer value. The im- H. Programming of the car
plemented rate limiter limits the maximum velocity change The code for the car’s onboard microcontroller is created
from the previous measurement to 200 ms. This precaution in the C language. In particular, CodeWarrior Development
minimizes velocity measurement errors. Additionally, the Studio for Microcontrollers v6.3 from Freescale was used.
velocity is smoothed with a 8-sample moving average filter. A template for a project is available at [2]. Uploading a
A classical disadvantage of an incremental sensor like this compiled code to the microcontroller is via the USB.
is that its sampling frequency depends on the velocity of
the car. The slower the car, the longer the intervals between III. CONTROL OF A SINGLE CAR
two pulses arrivals. Assuming the average car velocity of
A. Model of dynamics of a single car
800 mm/s, the interval between measurements is 9.8 ms.
Due to spatial constraints, the mathematical model
F. Distance measurement of a single car is not detailed here. One-dimensional
The distance to the vehicle ahead is measured by the translational dynamics is modeled although the cars
analog infrared Sharp GP2D120 with the measurement range travel on a curved track. Most parameters of the
from 5 cm up to 50 cm. The sensor output is connected to model can be obtained by direct measurement. Useful
the A/D converter of the processor. The measured distance guidance on parameters of the motors can be found at
in mm is calculated from voltage as d = 133/U , where the http://slotcarnews.blogspot.com/2007/02/
measured voltage U is in Volts. slot-car-news-motor-list.html.
168
Fig. 7. Cascade structure of the feedback controllers: current, velocity, position/distance.
5
Bode Diagram B. Distributed control of the platoon
0 A regulation error for a distance controller uses the regu-
−5
lation error defined as
−10
−20
−45
Current closed loop
Velocity closed loop
transform) as
Distance closed loop
−50 −2
10
0
10 10
2
10
4 ˆ z) − dref = x̂(s, z)(z −1 − 1) − dref ,
ê(s, z) = d(s, (6)
Frequency (Hz)
169
a disturbance to the vehicle control system. Of course, a 140
high. At the time of writing the report, some extra parts were 100
about 3 m. 60
Simulated distance
120 Car 3 − Car 4
velocity of the platoon leader (v0ref ) is changed without Reference distance
100
notifying other cars. 80
40
Fig.9 shows a change of inter-vehicle distances after 120 125 130 135 140 145
Time t[s]
150 155 160 165 170
750
Measured
between vehicles [mm]
700
Measured distance
150
650
100 122 124 126 128 130 132 150 152 154 Car 156
0 (leader)
158 160
TimeCar
t[s]1
Car 2
Car 3
actual velocity [mms−1]
50 800
Car 4
Reference velocity
40 42 44 46 48 50 52 54 56
Time t[s] 750
Simulated
Car 0 − Car 1
Car 1 − Car 2
between vehicles [mm]
Car 3 − Car 4
Reference distance 650
122 124 126 128 130 132 150 152 154 156 158 160
100 Time t[s]
50
Fig. 12. Velocities of cars in response to the change in v0ref for the PFA.
40 42 44 46 48 50 52 54 56
Time t[s]
Fig. 9. Inter-vehicle distances in response to the changes in dref for PFA. Fig. 14 and 15 in comparison with Fig. 9 and 10 show that
the reaction of the cars is faster for the Leader following
algorithm making the velocity peaks higher but regulating
900 the inter-car distances faster.
actual velocity [mms−1]
800
Fig.16 shows that in the case of a leader accelerat-
Measured
700
ing/decelerating the only changing inter-vehicle distance is
600
500
Car 0 (leader)
Car 1
the one between the leader and the first follower. The reason
400
Car 2
Car 3
for that is explained in Fig.17. All the following cars change
38 40 42 44 46 48 50 52 54 56
Time t[s] Car 4
Reference velocity
their velocities in the same manner, keeping the distances
900 between followers.
actual velocity [mms−1]
800
Simulated
700
VI. SUGGESTIONS FOR IMPROVEMENTS
600
170
1400
700 1200
Measured
Measured
600
1000
500
800
400
49 50 51 52 58 59 60 61 62
Time t[s] Time t[s]
Simulated
Simulated
Fig. 13. Platoon of Carrera slotcars speeding on a circular track. Car 4
600 Reference velocity
1000
500
800
140
between vehicles [mm]
400
49 50 51 52 58 59 60 61 62
Measured distance
100
80 Fig. 15. Velocities of cars in response to the changes in dref for LFA.
60
40
48 50 52 54 56 58 60 62
Time t[s] Car 0 − Car 1
Car 1 − Car 2
140 Car 2 − Car 3
between vehicles [mm]
Simulated distance
Car 3 − Car 4
120
Reference distance
100
60 Measured distance
100
40
48 50 52 54 56 58 60 62
Time t[s] 80
60
Fig. 14. Inter-car distances in response to the changes in dref for LFA. 45 50 55
Time t[s]
60 65 70 75
Car 0 − Car 1
Car 1 − Car 2
between vehicles [mm]
Car 3 − Car 4
possible solution is to limit the increment of the measured 100
Reference distance
Car 2
R EFERENCES 750
Car 3
Car 4
Simulated
Reference velocity
[1] D. Martinec and Z. Hurák, “Vehicular platooning experiments with
LEGO MINDSTORMS NXT,” in 2011 IEEE International Conference 700
171