Modeling, Estimation and Control