Applied Optimal Control Optimization, Estimation and Control