correct fatal error with reversed gyro, increase control sensitivity
tidy up, add scope for I term on z drift