Successful Mavlink Communication and first working Estimator without sonar