stochastic extended lqr implementation