[ozrien]

I just noticed your third screenshot. Pull out "Sensor Position" from the "unbundle by name" object instead of "Quad Position". Section 16.9 explains it better, but "Sensor Position" is what is used in the internal closed-loop.