Move galvo globals, add some debug prints (M602)