Integration of simulation-tested controller functions. not properly tested yet. maybe some problems with attitude control. rate controller seems to work.