First complete version ready to be tested. Including attitude estimator, attitude controller and emergency landing