diff --git a/Marlin/Marlin_main.cpp b/Marlin/Marlin_main.cpp
index 7f7e623d1..80f9e91eb 100644
--- a/Marlin/Marlin_main.cpp
+++ b/Marlin/Marlin_main.cpp
@@ -2643,7 +2643,8 @@ inline void gcode_G28() {
       #else // !DELTA
 
         // solve lsq problem
-        double *plane_equation_coefficients = qr_solve(abl2, 3, eqnAMatrix, eqnBVector);
+        double plane_equation_coefficients[3];
+        qr_solve(plane_equation_coefficients, abl2, 3, eqnAMatrix, eqnBVector);
 
         mean /= abl2;
 
diff --git a/Marlin/qr_solve.cpp b/Marlin/qr_solve.cpp
index 4202db067..45f054182 100644
--- a/Marlin/qr_solve.cpp
+++ b/Marlin/qr_solve.cpp
@@ -260,7 +260,7 @@ double r8mat_amax ( int m, int n, double a[] )
   return value;
 }
 
-double *r8mat_copy_new ( int m, int n, double a1[] )
+void r8mat_copy( double a2[], int m, int n, double a1[] )
 
 /******************************************************************************/
 /*
@@ -294,12 +294,9 @@ double *r8mat_copy_new ( int m, int n, double a1[] )
     Output, double R8MAT_COPY_NEW[M*N], the copy of A1.
 */
 {
-  double *a2;
   int i;
   int j;
 
-  a2 = ( double * ) malloc ( m * n * sizeof ( double ) );
-
   for ( j = 0; j < n; j++ )
   {
     for ( i = 0; i < m; i++ )
@@ -307,8 +304,6 @@ double *r8mat_copy_new ( int m, int n, double a1[] )
       a2[i+j*m] = a1[i+j*m];
     }
   }
-
-  return a2;
 }
 
 /******************************************************************************/
@@ -726,14 +721,13 @@ void dqrank ( double a[], int lda, int m, int n, double tol, int *kr,
   int j;
   int job;
   int k;
-  double *work;
+  double work[n];
 
   for ( i = 0; i < n; i++ )
   {
     jpvt[i] = 0;
   }
 
-  work = ( double * ) malloc ( n * sizeof ( double ) );
   job = 1;
 
   dqrdc ( a, lda, m, n, qraux, jpvt, work, job );
@@ -750,8 +744,6 @@ void dqrank ( double a[], int lda, int m, int n, double tol, int *kr,
     *kr = j + 1;
   }
 
-  free ( work );
-
   return;
 }
 /******************************************************************************/
@@ -1845,7 +1837,7 @@ void dswap ( int n, double x[], int incx, double y[], int incy )
 
 /******************************************************************************/
 
-double *qr_solve ( int m, int n, double a[], double b[] )
+void qr_solve ( double x[], int m, int n, double a[], double b[] )
 
 /******************************************************************************/
 /*
@@ -1895,34 +1887,22 @@ double *qr_solve ( int m, int n, double a[], double b[] )
     Output, double QR_SOLVE[N], the least squares solution.
 */
 {
-  double *a_qr;
+  double a_qr[n*m];
   int ind;
   int itask;
-  int *jpvt;
+  int jpvt[n];
   int kr;
   int lda;
-  double *qraux;
-  double *r;
+  double qraux[n];
+  double r[m];
   double tol;
-  double *x;
 
-  a_qr = r8mat_copy_new ( m, n, a );
+  r8mat_copy( a_qr, m, n, a );
   lda = m;
   tol = r8_epsilon ( ) / r8mat_amax ( m, n, a_qr );
-  x = ( double * ) malloc ( n * sizeof ( double ) );
-  jpvt = ( int * ) malloc ( n * sizeof ( int ) );
-  qraux = ( double * ) malloc ( n * sizeof ( double ) );
-  r = ( double * ) malloc ( m * sizeof ( double ) );
   itask = 1;
 
   ind = dqrls ( a_qr, lda, m, n, tol, &kr, b, x, r, jpvt, qraux, itask );
-
-  free ( a_qr );
-  free ( jpvt );
-  free ( qraux ); 
-  free ( r );
-
-  return x;
 }
 /******************************************************************************/
 
diff --git a/Marlin/qr_solve.h b/Marlin/qr_solve.h
index b38086aad..2ec8a8ea9 100644
--- a/Marlin/qr_solve.h
+++ b/Marlin/qr_solve.h
@@ -17,6 +17,6 @@ int dqrsl ( double a[], int lda, int n, int k, double qraux[], double y[],
   double qy[], double qty[], double b[], double rsd[], double ab[], int job );
 void dscal ( int n, double sa, double x[], int incx );
 void dswap ( int n, double x[], int incx, double y[], int incy );
-double *qr_solve ( int m, int n, double a[], double b[] );
+void qr_solve ( double x[], int m, int n, double a[], double b[] );
 
 #endif