Entropy-Based Environment Exploration and Stochastic Optimal Control