Added FPI algorithm