Controller functions

adding new folder for controller specific functions. So far I have added the tuning of the pitch PI controller with pole placement