Improved initialisation order. Stopped calling pidInit before gyro detected (#4218)