What are these angles for?  Can they have clearer names?  If this is the setHeadFromGyros() routine, should this stuff live in a different routine?