Optimal Control and Estimation