Position and attitud controllers diagram

The final goal is to come up with a diagram like this one, but with LPE and Q-estimator.