Some adjustments, FPU enabled

FPU is enabled, fuzzy controller code is used directly from where its
created