Используйте G53 вместо G28