Try first Ferhat's code and if it fails try the matlab's implementation of the the perfect foresight model solver.