An Efficient Motion Planning Algorithm for Stochastic Dynamic Systems with Constraints on Probability of Failure