APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE...

20
APPLICATION OF GEOMETRICAL APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL PURSUIT-AVOIDANCE DIFFERENTIAL GAME GAME Ginzburg Pavel and Slavnaya Lyudmila Supervisory by Dr. Mark Moulin
  • date post

    22-Dec-2015
  • Category

    Documents

  • view

    216
  • download

    1

Transcript of APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE...

Page 1: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

APPLICATION OF GEOMETRICAL APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED EXTRAPOLATION METHOD BASED

HYBRID SYSTEM CONTROLLER ON HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL PURSUIT-AVOIDANCE DIFFERENTIAL

GAMEGAME

Ginzburg Pavel and Slavnaya Lyudmila

Supervisory by Dr. Mark Moulin

Page 2: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

List of contents:

Optimal control and Hamiltonian formalism Hybrid control Intuitive Geometrical Controller Circle Extrapolation Controller Second Order Approximation in Geometrical

Extrapolation Nonlinear Heading Estimator The Supper Hybrid Controller Conclusion

Page 3: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Hamiltonian Formalism

Page 4: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

System representation

Page 5: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Solutions of Backward Reachable Set

Capture radius 5Linear velocities 5

Angular velocities 1

Capture radius 5Linear velocities 5

Angular velocity Evader 2Angular velocity Pursuer 1

Capture radius 5Linear velocities 5

Angular velocity Evader 1Angular velocity Pursuer 2

Page 6: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Open loop via closed loop control

Open loop:+ Safe for initial condition check - Sensitive to measurement noise - Non flexible to task changing - Slow and massive calculation (offline ) - And more…

Closed loop: + Safe control + Online and fast calculations - Non optimal

Page 7: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Intuitive Geometrical Controller

Plane division to provide control signal

Problematic situation for Simple Controller

Page 8: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Results of Intuitive Geometrical Controller

Initial conditions (-2, 2, π/2)

Initial conditions (-2, 2, π/3) Control signal output

Control signal output

Page 9: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Circle Extrapolation Controller

Red Cross – estimated positionBlue Star – measurement data, stored in controller memory

Assumptions:

- The opponent control signal unchanged during the sampling

Principe:

- 3 points define the only one circle

- Forth point is the opponent estimated position

-Controller chooses the optimal output depends on the estimated position

- Each step correction provided (like Kalman filter measurement correction)

Page 10: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Results of Circle Extrapolation Controller

Initial conditions (-2, 2, π/2) Control signal output

Initial conditions (-2, 2, π/3) Control signal output

Page 11: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Second Order Approximation in Geometrical Extrapolation

Page 12: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Results Geometrical Extrapolation Controller

Initial conditions (-2, 2, π/3)

Initial conditions (-2, 2, π/2) Control signal output

Control signal output

Page 13: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Geometrical Extrapolation Controller used by both players

Border point (0, 3.44, -π)Applied control signals

Applied control signalsBorder point (2, 1.42, -π/2)

(0, 3, -π)

(1.6, 1, -π/2)

Page 14: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Results Geometrical Extrapolation Controller with “arctan”

“Sign” function replaced by “Arctangent”

Initial conditions (-2, 2, π/2) Control signal output

Control signal output Initial conditions (-2, 2, π/3)

Page 15: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Noise in coordinate measurement

1 variance noiseBorder point (2, 1.42, -π/2)

0.1 variance noiseBorder point (2, 1.42, -π/2)

Page 16: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Nonlinear Heading Estimator Assumptions: - The opponent heading signal unchanged during the sampling Principe: - 5 points is a trade off between noise filtering and device flexibilityController provides the most fitted line (MSE)

Red points – measurement dataBlue lines – calculated slopes, the estimator output

Page 17: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Performances of Nonlinear Heading Estimator

Constant control input (0), noisy case (0.01 variance)

no noise exist

Constant control input (0.1), noisy case (0.01 variance).

Page 18: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

The Supper Hybrid Controller

Idea:- fitting noisy data to estimated orbit - verify the noise level by R-condition checking - choose more successful controller

implementation

Travels between hybrids controllers (double hybridism exists)

Page 19: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Conclusions

Advantages of Hybrid Control Implementation The geometrical extrapolation method in

Hybrid system provides wise plane division Noise filtering using The Method More levels in Hybrid Implementation

Page 20: APPLICATION OF GEOMETRICAL EXTRAPOLATION METHOD BASED HYBRID SYSTEM CONTROLLER ON PURSUIT-AVOIDANCE DIFFERENTIAL GAME Ginzburg Pavel and Slavnaya Lyudmila.

Directions

Non linear filtering (fit the surface to measurement data)

Analytical approximated solution of HJB equations

More complex differential games General case