Fix things related to FBW stabilizer, APMultiplexer and PID.

Implement winding in PID, so that the value -1 is actually very close to 1.