Update compass_test_v0_0_1.ino

correct and clean up formulas for roll and pitch