Ardu copter 3.1.1

Pitch and Roll changes