Skip to content

add error checking and diagnostics#10

Open
YaraShahin wants to merge 2 commits intomasterfrom
feat/add-error-check
Open

add error checking and diagnostics#10
YaraShahin wants to merge 2 commits intomasterfrom
feat/add-error-check

Conversation

@YaraShahin
Copy link
Collaborator

Changes:

  • Added error checking in read() to deactivate if any alarms
  • Added diagnostics of which alarm got invoked in clear_alarms function
  • Added how to run the sim or robot from the pc to readme
  • Moved cleaning alarms and initial read & write of states to activate. Why? because the error clearing function was getting called before the non-blocking connect() finished. See log:
[ros2_control_node-1] [INFO] [1767351297.093788604] [b_controlled_box_cm.hardware_component.system.kassow]: Connecting to Kassow Kord robot at ip 10.23.23.205 | port 28284 | session id 1
[ros2_control_node-1] [INFO] [1767351297.266910966] [b_controlled_box_cm.hardware_component.system.kassow]: CLEAR_HALT command sent with token: 2453781960341095
[ros2_control_node-1] [INFO] [1767351298.273370677] [b_controlled_box_cm.hardware_component.system.kassow]: CLEAR_HALT command status: 5
[ros2_control_node-1] [INFO] [1767351298.273448433] [b_controlled_box_cm.hardware_component.system.kassow]: UNSUSPEND command sent with token: 2453782966881580
[ros2_control_node-1] [INFO] [1767351298.289316316] [b_controlled_box_cm.hardware_component.system.kassow]: UNSUSPEND command status: 0
[ros2_control_node-1] [INFO] [1767351298.289386521] [b_controlled_box_cm.hardware_component.system.kassow]: CONTINUE_INIT command sent with token: 2453782982818500
[ros2_control_node-1] [INFO] [1767351299.297763195] [b_controlled_box_cm.hardware_component.system.kassow]: CONTINUE_INIT command status: 5
[ros2_control_node-1] [INFO] [1767351299.297862173] [b_controlled_box_cm.hardware_component.system.kassow]: CBUN_EVENT command sent with token: 2453783991278328
[ros2_control_node-1] [INFO] [1767351299.305396311] [b_controlled_box_cm.hardware_component.system.kassow]: CBUN_EVENT command status: 0
[ros2_control_node-1] [INFO] [1767351299.305454673] [b_controlled_box_cm.hardware_component.system.kassow]: KassowKordHardwareInterface configured and connected
[ros2_control_node-1] [INFO] [1767351299.305463433] [resource_manager]: Successful 'configure' of hardware 'kassow'
[ros2_control_node-1] [INFO] [1767351299.305473995] [resource_manager]: 'activate' hardware 'kassow' 
[ros2_control_node-1] [INFO] [1767351299.305477091] [b_controlled_box_cm.hardware_component.system.kassow]: Successfully activated!
[ros2_control_node-1] [INFO] [1767351299.305481900] [resource_manager]: Successful 'activate' of hardware 'kassow'
[ros2_control_node-1] [INFO] [1767351299.305530302] [b_controlled_box_cm]: Registering statistics for : kassow
[ros2_control_node-1] [INFO] [1767351299.305592637] [b_controlled_box_cm]: Resource Manager has been successfully initialized. Starting Controller Manager services...
[ros2_control_node-1] [WARN] [1767351299.308636786] [b_controlled_box_cm]: AsyncFunctionHandler is configured with DETACHED scheduling policy. This means that the async callback may not be synchronized with the main thread. 
[ros2_control_node-1] [INFO] [1767351299.308676225] [b_controlled_box_cm]: AsyncFunctionHandler: Resuming the async callback thread.
[ros2_control_node-1] [2026-01-02 11:54:57.093509] [INFO] KORD API version: 3.0.1, sha: c7e8f9b144a8ab16c7dcb8b737548cfd871ae621
[ros2_control_node-1] [2026-01-02 11:54:57.093527] [INFO] KORD Protocol version: 3.0.1, sha: ac0403806ad361304dcd8834eac1842abe1b764e
[ros2_control_node-1] [2026-01-02 11:54:57.266845] [INFO] Connected to CBun, version: 3.0.1, API version: 3.0.1

@YaraShahin YaraShahin self-assigned this Jan 2, 2026
@YaraShahin YaraShahin marked this pull request as draft January 2, 2026 11:03
@YaraShahin YaraShahin marked this pull request as ready for review January 12, 2026 14:27
@YaraShahin YaraShahin requested a review from destogl January 12, 2026 14:27
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

1 participant