Found major bug in my hardware!I found that I have no YAW cahnge at all. Started to check the board. And finally foun that the 20 pin of isz-500 was cold soldered. I soldered it once more. After it the YAW started to work correct. Still didn't checked it in the air.