message: Check for valid axis ID before handling message...
diff: @@ -24,11 +24,15 @@ void CANSimple::handle_can_message(CAN_message_t& msg) {
  Axis* axis = nullptr;
  + bool validAxis = false;
  for (uint8_t i = 0; i < AXIS_COUNT; i++) {
  if (axes[i]->config_.can_node_id == nodeID) {
  axis = axes[i];
  + validAxis = true;
  }
  }
  +
  + if (validAxis) {
  switch (cmd) {
  case MSG_CO_NMT_CTRL:
  break;
  @@ -107,6 +111,7 @@ void CANSimple::handle_can_message(CAN_message_t& msg) {
  break;
  }
  }
  +}
  void CANSimple::nmt_callback(Axis* axis, CAN_message_t& msg) {
  // Not implemented
  