diff --git a/Grbl_Esp32/src/Machine/Gang.cpp b/Grbl_Esp32/src/Machine/Gang.cpp
index 8d23f7f2..bd440d0e 100644
--- a/Grbl_Esp32/src/Machine/Gang.cpp
+++ b/Grbl_Esp32/src/Machine/Gang.cpp
@@ -20,6 +20,7 @@
 
 #include "../Motors/Motor.h"
 #include "../Motors/NullMotor.h"
+#include "Axes.h"
 #include "Endstops.h"
 
 namespace Machine {
@@ -35,8 +36,8 @@ namespace Machine {
     }
 
     void Gang::init() {
-        if (strcmp(_motor->name, "null_motor") != 0) {
-            bitnum_istrue(Axes::motorMask, _axis + 16 * i);
+        if (strcmp(_motor->name(), "null_motor") != 0) {
+            bitnum_istrue(Machine::Axes::motorMask, _axis + 16 * _gang);
         }
         _motor->init();
         if (_endstops) {