Distributed localization and control of a group of underwater robots - - PDF document

distributed localization and control of a group of
SMART_READER_LITE
LIVE PREVIEW

Distributed localization and control of a group of underwater robots - - PDF document

Distributed localization and control of a group of underwater robots using contractor programming L. Jaulin, S. Rohou, J. Nicola, M. Saad, F. Le Bars and B. Zerr. SWIM15 Prague, June 9-11, 2015 ENSTA Bretagne, OSM, LabSTICC. Video of the


slide-1
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
SLIDE 2

SWIM’15 Prague, June 9-11, 2015 ENSTA Bretagne, OSM, LabSTICC. Video of the presentation https://youtu.be/q6F7WDCcf2A

slide-3
SLIDE 3

1 Scout project

slide-4
SLIDE 4

Goal : (i) coordination of underwater robots ; (ii) collabo- rative behavior.

slide-5
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 6
slide-7
SLIDE 7
slide-8
SLIDE 8
slide-9
SLIDE 9
slide-10
SLIDE 10

2 Controller

slide-11
SLIDE 11
slide-12
SLIDE 12

3 Localization problem

slide-13
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
SLIDE 14

4 Matrices and contractors

slide-15
SLIDE 15

linear application → matrices L :

  • α = 2a + 3h

γ = h − 5a → A =

  • 2

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
SLIDE 16

constraint → contractor a · b = z →

slide-17
SLIDE 17

Contractor fusion

  • a · b = z

→ 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 18
slide-19
SLIDE 19

5 Localization with contractors

slide-20
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)) =

  • xj

k−¯ h, . . . , xj k, xj k+1

  • .
slide-21
SLIDE 21

zj

h = h(xj h)

Observer RSO: Ck,j

x,z = Ck,j x ∩ {q1}

h∈{k−¯ h,...,k}

  • Ck,j

x |Ch,j

z

  • .
slide-22
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
SLIDE 23

t = 0

slide-24
SLIDE 24

t = 0.1

slide-25
SLIDE 25

t = 0.2

slide-26
SLIDE 26

t = 0.3

slide-27
SLIDE 27

t = 0.4

slide-28
SLIDE 28

t = 0.5

slide-29
SLIDE 29

t = 0.6

slide-30
SLIDE 30

t = 0.7

slide-31
SLIDE 31

t = 0.8

slide-32
SLIDE 32

t = 0.9

slide-33
SLIDE 33

t = 1.0

slide-34
SLIDE 34

t = 1.1

slide-35
SLIDE 35

t = 1.2

slide-36
SLIDE 36

t = 1.3

slide-37
SLIDE 37

t = 1.4

slide-38
SLIDE 38

6 Distributed localization

slide-39
SLIDE 39

yj,ℓ

h = g(xj h, xℓ h)

slide-40
SLIDE 40

Observer: Ck,j

x,z

= Ck,j

x

{q1}

h∈{k−¯ h,...,k}

  • Ck,j

x |Ch,j

z

{q2}

h∈{k−¯ h,...,k}

  • Ck,j

x |Ch,j,ℓ

y

slide-41
SLIDE 41

7 Singularity

slide-42
SLIDE 42
slide-43
SLIDE 43
slide-44
SLIDE 44
slide-45
SLIDE 45

8 Test case

slide-46
SLIDE 46

QT/C++ code available at http://www.ensta-bretagne.fr/jaulin/easibex.html

slide-47
SLIDE 47

9 Tests

slide-48
SLIDE 48