Refactor edge action handling: use edge.action metadata instead of node-name inference

[Copilot]

Navigation actions were being inferred from node naming conventions (e.g., "ca" → goal_align, "WayPoint" → outside edge) rather than the explicit edge.action field already defined in topological map metadata. This was fragile, map-specific, and semantically incorrect.

Changes

Core Refactor

• get_goal_align_if() - Now returns edge.action directly as source of truth instead of parsing node name tokens from edge IDs
• get_navigation_area_from_edges() - New method using edge action metadata for area detection (row_traversal → inside polytunnel, goal_align → transition)

Backward Compatibility

• Legacy node-name patterns preserved as fallback for maps without explicit edge actions
• Deprecated constants (GOAL_ALIGN_INDEX, ROW_START_INDEX, etc.) documented with TODOs

Performance Instrumentation

• Added [TIMING] logs to identify behavior-switch latency sources (preempt, goal cancellation, server wait)

Tests

• 11 unit tests covering edge-action-driven behavior

Before/After

# Before: inferred from node names
def get_goal_align_if(self, edge_id, current_action, next_edge_id=None):
    edges = edge_id.split("_")
    goal_stage = goal.split("-")
    if goal_stage[1] in self.ACTIONS.GOAL_ALIGN_INDEX:  # "ca"
        return self.ACTIONS.GOAL_ALIGN
    return current_action

# After: edge.action is source of truth
def get_goal_align_if(self, edge_id, current_action, next_edge_id=None):
    return current_action  # Use edge.action directly

Remaining Legacy Patterns

Agricultural-specific row operation handling (handle_row_operation, robot harvesting status detection) still uses node-name patterns. These require domain metadata additions to topological maps and are documented for future refactoring.

Original prompt

---

This section details on the original issue you should resolve

<issue_title>[ISSUE]: Refactor edge action handling: stop inferring actions from node names and use topological map edge metadata</issue_title>
<issue_description>### Description

Problem Statement

The current navigation/action logic infers behaviours and actions from node naming conventions, which is fragile and incorrect.
Actions such as goal alignment, row traversal, row operation, etc., are currently derived purely from string patterns in node names (e.g. "ca", "cb", "WayPoint"), rather than from the explicit action definitions already present on topological map edges.

This affects logic spread across the following files and needs coordinated refactoring:

• edge_action_manager2.py
• actions_bt.py
• localisation2.py
• navigation2.py

---

Current Implementation (Issue)

In actions_bt.py, actions are hard-coded and inferred from node name tokens:

self.ROW_TRAVERSAL = "row_traversal"
self.ROW_OPERATION = "row_operation"
self.ROW_RECOVERY = "row_recovery"
self.ROW_CHANGE = "row_change"
self.GOAL_ALIGN = "goal_align"

self.GOAL_ALIGN_INDEX = ["ca"]
self.GOAL_ALIGN_GOAL = ["cb"]

self.ROW_START_INDEX = "a"
self.ROW_COLUMN_START_INDEX = "c"
self.ROW_COLUMN_START_NEXT_INDEX = "b"
self.OUTSIDE_EDGE_START_INDEX = "WayPoint"

This leads to logic such as:

• If node name contains "ca" → trigger goal_align
• If node starts with "WayPoint" → treat as outside edge
• If node index matches certain letters → infer row behaviour

This approach is:

• brittle
• map-specific
• hard to extend
• semantically incorrect (node names should not encode behaviour)

---

Expected / Correct Behaviour

Actions must be derived from the topological map edges, not inferred from node names.

The topological map already defines explicit action metadata on each edge.
This metadata must be treated as the single source of truth.

Example (existing, correct data already available):

edges:
  - action: row_traversal
    action_type: geometry_msgs/PoseStamped
    edge_id: r13.7-ca_r13.7-cb
    fluid_navigation: true
    goal:
      target_pose:
        header:
          frame_id: $node.parent_frame
        pose: $node.pose
    node: r13.7-ca
    fail_policy: fail
    restrictions_planning: robot_short
    restrictions_runtime: obstacleFree_1

From this:

• The action (row_traversal)
• The goal type
• The behavioural constraints
• The recovery configuration

are all already explicitly defined.

The system should:

• Read the selected edge
• Extract edge.action
• Drive BT selection, navigation mode, localisation mode, and recovery behaviour from that value
• Never infer behaviour from node naming patterns

---

Required Refactor

1. Action Source of Truth

• Replace all node-name-based action inference with edge metadata parsing

• edge.action must determine:

  • Behaviour Tree branch
  • Navigation mode
  • Goal handling
  • Recovery behaviour

2. File-level Expectations

edge_action_manager2.py

• Select and propagate the active edge
• Expose the edge’s action, action_type, and config cleanly

actions_bt.py

• Remove all logic tied to:

  • "ca", "cb", "WayPoint", index letters, etc.

• Map BT actions directly from edge.action

navigation2.py

• Trigger navigation behaviours based on edge action
• Do not inspect node names for behaviour switching

localisation2.py

• Ensure localisation strategy changes (if any) are driven by edge action, not node identity

---

Additional Investigation Required

There is a noticeable long pause / wait when:

• Switching actions
• Changing behaviours
• Transitioning between BT states

This needs investigation:

• Is the delay caused by:

  • BT reloading?
  • Action server teardown/recreation?
  • Navigation goal cancellation?
  • Blocking localisation resets?

• Identify where the blocking occurs and reduce or eliminate unnecessary waits

---

Acceptance Criteria

• No behaviour depends on node naming conventions
• All actions are derived exclusively from topological map edge metadata
• BT transitions are driven by edge.action
• Behaviour switching latency is understood and reduced
• Code paths across the four files are consistent and maintainable

---

Motivation

This change is critical to:

• Support multiple maps with different naming schemes
• Make behaviour semantics explicit and debuggable
• Avoid hidden coupling between map naming and navigation logic
• Enable future extension without renaming nodes

---

Notes for Copilot / PR Implementation

• Assume node names are arbitrary identifiers
• Treat edges as first-class behavioural entities
• Prefer explicit data over inferred heuristics
• Keep refactor incremental but remove legacy inference paths entirely
  </issue_description>

<agent_instructions>Refactor edge action handling so behaviours are...

• Fixes [ISSUE]: Refactor edge action handling: stop inferring actions from node names and use topological map edge metadata #218

---

💬 We'd love your input! Share your thoughts on Copilot coding agent in our 2 minute survey.

[ibrahimhroob]

looks to be working, now the actions are taken from the edge_action