Refactored the FDM code. It should be easier to add new flight dynamics models.