Fixing up G28.2. G28.3 still broken, but better. (?)
Added G28.3 (set origin) callback to main controller loop. G28.3 appears to work.