I finally got this code, actually the one that got merged into Marlin baseline, and also got my new proximity sensor working good. Here is my topology report. I am not sure what I need to do to fix this on my Prusa i3. Any ideas?

Recv: +-----------+
Recv: |...Back....|
Recv: |Left..Right|
Recv: |...Front...|
Recv: +-----------+
Recv: +0.12169 -0.41244 -1.00194
Recv: +0.43792 +0.01525 -0.49263
Recv: +0.70117 +0.39496 +0.23601
Recv:
Recv: planeNormal x: 0.005914 y: 0.005028 z: 1.000000
Recv:
Recv:
Recv: Bed Level Correction Matrix:
Recv: +0.999983 +0.000000 -0.005914
Recv: -0.000030 +0.999987 -0.005028
Recv: +0.005914 +0.005028 +0.999970