Update SFApp.cpp

A different approach to A*