I need some help in setting up yaw PID's. My TBS Discovery with APM2.6 has a poor yaw performance. It seems not very locked and what is most annoying it is slowly oscillating which is most visible in onboard video footage.
To get to the root of the problem I did some log analysis and found that actual_yaw is indeed tracking nav_yaw but leaves some +-3 degrees slow oscillations. Please have a look at this log screen and my current PID's. Any ideas where to start or how to systematically set up the yaw PID's?