replaced matlab barycentric code with a call to mex
mdp discretization is good enough for now, but could definitely be faster if we vectorize the calls to dynamics and cost
added comment