Fixed z probe averaging code.
Z probe averaging fixed.  Loop timer added (try M122).  Code reverted to the point where it worked...