Update SPFA.cpp