Small optimization of the kalman filter
Finish merging version by Alexis
Add the files of dynamical system of bidimensional elastic inverted pendulum