Modeling, identification, and trajectory planning for a model-scale helicopter.