ErikZalm Marlin Issue 935: matrix bug

Rolling in a fix committed to the parent Marlin branch, proposed by some
users as a correction for auto level behavior:
https://github.com/ErikZalm/Marlin/commit/cf325ba240b574baab41ed0d5a990827d2fe9cbf