There was a bug in position_estimator_mc. Solved
Topic has been changed for quaternion-based attitude controller.
Bug in so3 estimator related to R matrix
Merge pull request #367 from limhyon/master

Bug resolved & new data for setpoint topic.