add findPendingCommand

Author: aler9

node_command.go

@@ -39,6 +39,24 @@ var (
 	ErrNodeTerminated = errors.New("node terminated")
 )
 
+func findPendingCommand(
+	pending map[commandKey]*pendingCommand,
+	channel *Channel,
+	systemID,
+	componentID uint8,
+	commandID uint32,
+) *pendingCommand {
+	for key, p := range pending {
+		if key.channel == channel &&
+			key.targetSystem == systemID &&
+			key.targetComp == componentID &&
+			key.commandID == commandID {
+			return p
+		}
+	}
+	return nil
+}
+
 // CommandOptions configures command sending behavior.
 type CommandOptions struct {
 	// Channel to send the command on.
@@ -337,16 +355,7 @@ func (nc *nodeCommand) onEventFrame(evt *EventFrame) {
 	}
 
 	nc.pendingMutex.RLock()
-	var pending *pendingCommand
-	for key, p := range nc.pending {
-		if key.channel == evt.Channel &&
-			key.targetSystem == evt.SystemID() &&
-			key.targetComp == evt.ComponentID() &&
-			key.commandID == commandID {
-			pending = p
-			break
-		}
-	}
+	pending := findPendingCommand(nc.pending, evt.Channel, evt.SystemID(), evt.ComponentID(), commandID)
 	nc.pendingMutex.RUnlock()
 
 	if pending == nil {