For informed help, please read and follow the directions in the "How to use this forum" post.
Post your code, using code tags, and explain what it does versus what it should do.
Keep in mind that there are SIX different definitions of yaw, pitch and roll (Euler) angles, and a great deal of incorrect code to be downloaded. Here is a simplified overview.