Calculation of Pitch and Roll

Hello, I added two methods for the calculation of pitch and poll, which are commonly used with heading.