I’ve replied about the yaw (or maybe we can say attitude) problem in the dedicated thread:
Here I’m trying to understand which parameters I have to tune to have a fast controller response without overshoot and oscillations. I’m curious to see if resolving the attitude problems also fixes the oscillations on the target position. I’ll get back with new results here if someone encounters the same problem.