A Star implemented on path finding