Create fpcs.hpp

Implementation of algorithm 4PCS