grbl ne supporte pas la commande M6 (tool change).

Voici donc une façon de faire : Générer un gcode par outil. Une fois le premier gcode terminé, amener la fraise au dessus de la sonde Z.