Ender 3 Marlin bugfix 1.1.x BLtouch.

I followed the youtube guide by Teaching Tech, I can't post link yet so the youtube video id is sUlqrSq6LeY

Problem:
G29 return:
Recv: Bilinear Leveling Grid:
Recv: 0 1 2
Recv: 0 +0.548 +0.520 +0.478
Recv: 1 +0.570 +0.415 +5.478
Recv: 2 +5.570 +0.500 +0.435
Recv:
Recv: X:235.00 Y:234.00 Z:9.56 E:0.00 Count X:18800 Y:18720 Z:4000Recv: ok

When it probes, it only does 7 points instead of 9 (3x3 grid), it does pause at the unprobe points but the BLTouch pin nerver extends.
I guess the two unprobe points are +5.570 and +5.478 . When the nozzle prints near those position it moves way above and print from there which make the print a mess.
Please help!