Skip to content

Probe Compensation Note

Jump to bottom Edit New page
Demitrios V edited this page Mar 21, 2020 · 24 revisions

Probe Compensation Note

The Monoprice MP Mini Delta 3d printer uses the nozzle and three (3) switches attached to the printer's build plate to implement a Z-probe function. This function is used to automatically calibrate the printer and to create its automatic bed leveling mesh.

It's a simple way to use the nozzle as a z-probe, but the probe's z offset varies with the probe's x,y position. Marlin firmware, though, assumes that the probe's z-offset is constant and knows nothing about this type of probe.

My thought was that we could modify Marlin firmware to more accurately model this printer's z-probe mechanism with the goal to improve the firmware's auto-calibration command (G33) and to improve its auto bed leveling command (G29). Here are some notes about the implementation.

[spoiler alert!]

It didn't work well -- only a marginal improvement. Definitely a work-in-progress.

Probe Patch

The Monoprice MP Mini Delta 3d printer employs three (3) mechanical switches under its build plate to detect the nozzle's contact with the build plate. This ability gives the Mini Delta a means for automatic calibration and bed-leveling, by "tapping" the build plate to determine a height (z-axis) value. The technique is flawed, though, as the build plate tilts during the measurement process. Here we provide an extremely naive model of the measurement error associated with the "tapping" process. The reasoning is as follows:

  • Normally, the build plate rests on top of three micro-switches.

  • The nozzle presses on the build plate until any one of the three switches makes contact. At this point, the current z-axis position is the build plate height (for a given x and y position).

  • There are seven possible orientations of the build plate in which at least one switch is depressed. We make the (probably wrong) simplifying assumption that any swith is at one end of its travel or the other (i.e. the z-axis position at the location of the switch is either zero or its full travel position, nothing in-between).

  • All three switches may make contact at the center (x,y = 0,0) of the build plate. The code below uses the radius of the probe's position to the center of the build plate to identify the "all three switches depressed" orientation of the build plate. Otherwise, the angle of the probe's position around the z-axis determines which of the remaining six orientations to use. There are three small regions where two of the three switches are depressed, and three remaining regions where only one of the three switches is depressed.

  • The code computes a plane for each orientation. Once the orientation is selected (from the probe's x, y position), the code computes the "expected" z-axis value, z = f(x,y), where f() is the equation of a plane for the selected orientation. This z value represents the measurement (height) error due to the tilt of the build plate.

  • Finally, we remove the switch travel from the result to normalize the (height) error to zero at (x:0,y:0). This last step is to mimic an "ideal" probe where the offset is uniform across the bed AND in such a way that is backward compatible with the existing calibration procedure for our firmware.

Derivation

With a little assist from maxima, we can derive the plane equations and a probe model, that is, the action of the nozzle tapping on the build plate.

Switch Locations

/* (effective) radius of bed switches in opened and closed states (mm) */

{\it ENDCAP_RADIUS}=65.0

{\it SWITCH_RADIUS}=50.0

/* switch travel (mm) */

\mathit{SWITCH_ TRAVEL}=-0.5

/* center area where 3 switches are depressed (radius, mm) */
/* Note: this value is more or less a "guess". */

\mathit{CENTER_ RADIUS}=25.0

/* ± area where 2 switches are depressed (angle, degrees) */
/* Note: this value is more or less a "guess". */

\mathit{SWITCHx2_ AREA}=10.0

/* orientation of the three bed switches around the z-axis (°) */

{{\theta }_A}=90

{{\theta }_B}=210

{{\theta }_C}=330

\operatorname{rad}\left( \theta \right) :=\frac{\pi}{180}, \theta

\X\left( r,\theta \right) :=r \cos{\left( \rad\left( \theta \right) \right) }

\Y\left( r,\theta \right) :=r \sin{\left( \rad\left( \theta \right) \right) }

/* coordinates for each bed switch when opened, R = ENDCAP_RADIUS */

{A_{\mathit{opened}}}=[\X\left( \mathit{ENDCAP_ RADIUS},{{\theta }_A}\right) ,\Y\left( \mathit{ENDCAP_ RADIUS},{{\theta }_A}\right) ,0.0]

{B_{\mathit{opened}}}=[\X\left( \mathit{ENDCAP_ RADIUS},{{\theta }_B}\right) ,\Y\left( \mathit{ENDCAP_ RADIUS},{{\theta }_B}\right) ,0.0]

{C_{\mathit{opened}}}=[\X\left( \mathit{ENDCAP_ RADIUS},{{\theta }_C}\right) ,\Y\left( \mathit{ENDCAP_ RADIUS},{{\theta }_C}\right) ,0.0]

/* coordinates for each bed switch when closed, R = SWITCH_RADIUS */

{A_{\mathit{closed}}}=[\X\left( \mathit{SWITCH_ RADIUS},{{\theta }_A}\right) ,\Y\left( \mathit{SWITCH_ RADIUS},{{\theta }_A}\right) ,\mathit{SWITCH_ TRAVEL}]

{B_{\mathit{closed}}}=[\X\left( \mathit{SWITCH_ RADIUS},{{\theta }_B}\right) ,\Y\left( \mathit{SWITCH_ RADIUS},{{\theta }_B}\right) ,\mathit{SWITCH_ TRAVEL}]

{C_{\mathit{closed}}}=[\X\left( \mathit{SWITCH_ RADIUS},{{\theta }_C}\right) ,\Y\left( \mathit{SWITCH_ RADIUS},{{\theta }_C}\right) ,\mathit{SWITCH_ TRAVEL}]

Bed Orientations

/* three (generic) points to define a plane */

A=\left[ {\it Ax} , {\it Ay} , {\it Az} \right]

B=\left[ {\it Bx} , {\it By} , {\it Bz} \right]

C=\left[ {\it Cx} , {\it Cy} , {\it Cz} \right]

/* an equation for a plane in x, y, z from vectors, u-w and v-w */

\P\left( w,v,u\right) :=\ev\left( n\mathit{ . }[x,y,z]-n\mathit{ . }w=0,n=\express\left( \left( u-w\right) \mbox{\sim }\left( v-w\right) \right) \right)

/* PLANE: a x + b y + c z + d = 0 */

\tag{PLANE} a x+b y+c z+d=0

where

\begin{align*}a=\left( \mathit{Bz}-\mathit{Az}\right) , \left( \mathit{Cy}-\mathit{Ay}\right) -\left( \mathit{By}-\mathit{Ay}\right) , \left( \mathit{Cz}-\mathit{Az}\right) \end{align*}

\begin{align*}b=\left( \mathit{Bx}-\mathit{Ax}\right) , \left( \mathit{Cz}-\mathit{Az}\right) -\left( \mathit{Bz}-\mathit{Az}\right) , \left( \mathit{Cx}-\mathit{Ax}\right) \end{align*}

\begin{align*}c=\left( \mathit{By}-\mathit{Ay}\right) , \left( \mathit{Cx}-\mathit{Ax}\right) -\left( \mathit{Bx}-\mathit{Ax}\right) , \left( \mathit{Cy}-\mathit{Ay}\right) \end{align*}

\begin{align*}d = & -\mathit{Ax}, \left( \left( \mathit{Bz}-\mathit{Az}\right) , \left( \mathit{Cy}-\mathit{Ay}\right) -\left( \mathit{By}-\mathit{Ay}\right) , \left( \mathit{Cz}-\mathit{Az}\right) \right)\ &-\mathit{Ay}, \left( \left( \mathit{Bx}-\mathit{Ax}\right) , \left( \mathit{Cz}-\mathit{Az}\right) -\left( \mathit{Bz}-\mathit{Az}\right) , \left( \mathit{Cx}-\mathit{Ax}\right) \right)\ &-\mathit{Az}, \left( \left( \mathit{By}-\mathit{Ay}\right) , \left( \mathit{Cx}-\mathit{Ax}\right) -\left( \mathit{Bx}-\mathit{Ax}\right) , \left( \mathit{Cy}-\mathit{Ay}\right) \right) \end{align*}

/* seven (7) possible plane orientations for the bed */

{P_{\mathit{XY}}}\left( w,v,u\right) :=\ev\left( \rhs\left( \first\left( \solve\left( \P\left( w,v,u\right) ,z\right) \right) \right) ,\mathit{expand},\mathit{numer}\right)

{P_0}\left( x,y\right) :={P_{\mathit{XY}}}\left( {A_{\mathit{closed}}},{B_{\mathit{closed}}},{C_{\mathit{closed}}}\right)

{P_1}\left( x,y\right) :={P_{\mathit{XY}}}\left( {A_{\mathit{closed}}},{B_{\mathit{opened}}},{C_{\mathit{opened}}}\right)

{P_2}\left( x,y\right) :={P_{\mathit{XY}}}\left( {A_{\mathit{closed}}},{B_{\mathit{closed}}},{C_{\mathit{opened}}}\right)

{P_3}\left( x,y\right) :={P_{\mathit{XY}}}\left( {A_{\mathit{opened}}},{B_{\mathit{closed}}},{C_{\mathit{opened}}}\right)

{P_4}\left( x,y\right) :={P_{\mathit{XY}}}\left( {A_{\mathit{opened}}},{B_{\mathit{closed}}},{C_{\mathit{closed}}}\right)

{P_5}\left( x,y\right) :={P_{\mathit{XY}}}\left( {A_{\mathit{opened}}},{B_{\mathit{opened}}},{C_{\mathit{closed}}}\right)

{P_6}\left( x,y\right) :={P_{\mathit{XY}}}\left( {A_{\mathit{closed}}},{B_{\mathit{opened}}},{C_{\mathit{closed}}}\right)

Simple Probe Model

The three (3) bed switches are wired in parallel, so any single switch closure signals that the probe (i.e., the nozzle) has touched the bed. With only one switch closure the bed can be in one of three orientations. Here is a simple model of this only one switch closed idea.

/* simple bed switch model where only one switch is depressed */

\begin{align*}{{\mathit{PROBE}}_S}\left( x,y\right) :=\min\left( {P_1}\left( x,y\right) ,{P_3}\left( x,y\right) ,{P_5}\left( x,y\right) \right) \end{align*}

Simple

Improved Probe Model

Watching the printer, it's pretty clear that the "one switch closed, two switches fully open (no switch travel)" assumption is not correct -- that in somes cases, more than one switch may be closing (or close to closing). To approximate this condition, we use bed orientations that include 1, 2, or 3 switch closures in the model. Of course, this too is not correct since any one switch closure signals that the probe has touched the build plate. The hope here is that including all orientations that have at least one switch closure provides a better model than the simple model. Here is the improved model.

/* bed switch model where 1, 2, or 3 switches are depressed */

\begin{align*}{PROBE}\left( x,y\right) & :=\ &/* evaluate \enspace sequentially /\ &{P_0}\left( x,y\right) \quad{if}\quad \sqrt{{{y}^{2}}+{{x}^{2}}}\lt \mathit{CENTER_ RADIUS}\ &{P_4}\left( x,y\right) \quad{if}\quad \atan2\left( x,y\right) \leq-\rad\left( 180.0-\mathit{SWITCHx2_ AREA}\right)\ &{P_3}\left( x,y\right) \quad{if}\quad \atan2\left( x,y\right) \leq -\rad\left( 60.0+\mathit{SWITCHx2_ AREA}\right)\ &{P_2}\left( x,y\right) \quad{if}\quad \atan2\left( x,y\right) \leq -\rad\left( 60.0-\mathit{SWITCHx2_ AREA}\right)\ &{P_1}\left( x,y\right) \quad{if}\quad \atan2\left( x,y\right) \leq -\rad\left( 0.0\right)\ &{P_4}\left( x,y\right) \quad{if}\quad \atan2\left( x,y\right) \geq +\rad\left( 180.0-\mathit{SWITCHx2_ AREA}\right)\ &{P_5}\left( x,y\right) \quad{if}\quad \atan2\left( x,y\right) \geq +\rad\left( 60.0+ \mathit{SWITCHx2_ AREA}\right)\ &{P_6}\left( x,y\right) \quad{if}\quad \atan2\left( x,y\right) \geq +\rad\left( 60.0-\mathit{SWITCHx2_ AREA}\right)\ &{P_1}\left( x,y\right) \quad{if}\quad \atan2\left( x,y\right) \geq +\rad\left( 0.0\right) \end{align}

Improved

Results

We test the firmware's auto-calibration and the probe compensation on a 3d printer fitted with a glass plate. We use the AUTO_CALIBRATE.gcode command in the setup_gcode directory on the micro SD card. This command performs the G33 auto-calibration plus then the G29 auto bed leveling, and then uses the custom G29 C1 to fit a plane to the existing bed level data. The output of these commands is written to the CALIBRAT.TXT file on the micro SD card.

In the first test, the M111_S128.gcode disables the probe compensation.

Test#1 - calibration without probe compensation
/setup_gcode/M502_FACTORY.gcode    ; restore to factory settings
/setup_gcode/M111_S128.gcode       ; debug, disable probe compensation
/setup_gcode/AUTO_CALIBRATE.gcode  ; writes results to /CALIBRAT.TXT
bed level probe least square plane fit
bed with probe fix bed with probe fix

(more here)

Test#2 - calibration with probe compensation
/setup_gcode/M502_FACTORY.gcode    ; restore to factory settings
/setup_gcode/AUTO_CALIBRATE.gcode  ; writes results to /CALIBRAT.TXT
bed level probe least squares plane fit
bed with probe fix bed with probe fix

(more here)

Add a custom footer
mpmd_marlin_1.1.x
 

Marlin logo

 
Clone this wiki locally