Applied Optimal Control: Optimization, Estimation and Control