Path finding thingy but better