P position loop, fuzzy speed loop