Implentation of AugKF_dpe

Implemented a new algo closely related to AugKF that takes the diffusion as a contribution of ER.

The governing equation is now :

\dot{B} = A(B)U + ER

This algo is intended to replace the previous AugKF where the computation of diffusion is not scientifically right.