Added pitch and roll to the mixing

Getting it ready to test on the pi