Quadcopter stabilization algorithm

kakou19:
Its working well for roll and pitch, but I have a lot of problem to stabilize on the yaw axis, did you succeed?

Can you explain how you're trying to control yaw?