Użyj polecenia G53 zamiast G28