I would consider instead of changing the fuzzy controller adding another loop around the model. Remove the step input and put a summing junction there with a gain. Instead of trying to control position directly this new outer loop will control the motor speed to obtain the position desired.
Something like this where the step goes from 1 to 2 radians and I set the gain, Kp, to 1200 simply by observation of what worked well.
