Trashed A*, start of own implementation