SLIDE 1 Distributed localization and control
- f a group of underwater robots
using contractor programming
- L. Jaulin, S. Rohou, J. Nicola,
- M. Saad, F. Le Bars and B. Zerr.
SLIDE 2
SWIM’15 Prague, June 9-11, 2015 ENSTA Bretagne, OSM, LabSTICC. Video of the presentation https://youtu.be/q6F7WDCcf2A
SLIDE 3
1 Scout project
SLIDE 4
Goal : (i) coordination of underwater robots ; (ii) collabo- rative behavior.
SLIDE 5 Supervisors: L. Jaulin, C. Aubry, S. Rohou, B. Zerr, J. Nicola, F. Le bars Compagny: RTsys (P. Raude) Students: G. Ricciardelli, L. Devigne, C. Guillemot, S. Pommier, T. Viravau, T. Le Mezo, B. Sultan, B. Moura,
- M. Fadlane, A. Bellaiche, T. Blanchard, U. Da rocha, G.
Pinto, K. Machado.
SLIDE 6
SLIDE 7
SLIDE 8
SLIDE 9
SLIDE 10
2 Controller
SLIDE 11
SLIDE 12
3 Localization problem
SLIDE 13
Range only Based on interval analysis Robust with respect to outliers Distributed computation Low rate communication We propose here to use a contractor programming ap- proach
SLIDE 14
4 Matrices and contractors
SLIDE 15 linear application → matrices L :
γ = h − 5a → A =
3 1 −5
- We have a matrix algebra and Matlab.
We have: var(L) = {a, h}, covar(L) = {α, γ} . But we cannot write: var(A) = {a, h}, covar(A) = {α, γ}.
SLIDE 16
constraint → contractor a · b = z →
SLIDE 17 Contractor fusion
→ C1 b + c = d → C2 Since b occurs in both constraints, we fuse the two con- tractors as: C = C1 × C2⌋(2,1) = C1|C2 (for short)
SLIDE 18
SLIDE 19
5 Localization with contractors
SLIDE 20 xj
h+1 = f(xj h, uj h), h ∈ {k − ¯
h, . . . , k} The observer: Ck,j
x
=
h∈{k−¯ h,...,k} Cj
x(h)
var(Ck,j
x ) =var(Ck,j x(h)) =
k−¯ h, . . . , xj k, xj k+1
SLIDE 21 zj
h = h(xj h)
Observer RSO: Ck,j
x,z = Ck,j x ∩ {q1}
h∈{k−¯ h,...,k}
x |Ch,j
z
SLIDE 22
To get an outer approximation of set(Ck,j
x,z), we need a
paver. We can also obtain an inner approximation using separators [SMART 2015].
SLIDE 23
t = 0
SLIDE 24
t = 0.1
SLIDE 25
t = 0.2
SLIDE 26
t = 0.3
SLIDE 27
t = 0.4
SLIDE 28
t = 0.5
SLIDE 29
t = 0.6
SLIDE 30
t = 0.7
SLIDE 31
t = 0.8
SLIDE 32
t = 0.9
SLIDE 33
t = 1.0
SLIDE 34
t = 1.1
SLIDE 35
t = 1.2
SLIDE 36
t = 1.3
SLIDE 37
t = 1.4
SLIDE 38
6 Distributed localization
SLIDE 39
yj,ℓ
h = g(xj h, xℓ h)
SLIDE 40 Observer: Ck,j
x,z
= Ck,j
x
∩
{q1}
h∈{k−¯ h,...,k}
x |Ch,j
z
{q2}
h∈{k−¯ h,...,k}
x |Ch,j,ℓ
y
SLIDE 41
7 Singularity
SLIDE 42
SLIDE 43
SLIDE 44
SLIDE 45
8 Test case
SLIDE 46
QT/C++ code available at http://www.ensta-bretagne.fr/jaulin/easibex.html
SLIDE 47
9 Tests
SLIDE 48