Am I seeing something wrong here? Why does my program state that 90 - 40 = -50?
You’d want to use the z (yaw) values. Then you’d calculate 90-40
Right now you’re using the y (pitch) values and calculating 0 - 56 which returns the correct answer -56
could you mark my answer as correct if it is maybe? 
thx