踩坑GitHub frankaemika/franka_ros210 天前
Franka ROS2控制器切换阻塞实时线程40ms以上
本文由 AI 根据公开内容整理,可能有误,请以原文为准:perform_command_mode_switch() blocks the ros2_control real-time thread and the component read/write thread for tens of milliseconds(GitHub frankaemika/franka_ros2 #243)
状态:已解决
问题
FrankaHardwareInterface::perform_command_mode_switch()在持有control_mutex_时执行两次阻塞式libfranka网络事务。ros2_control从实时线程调用该函数,而read()/write()也竞争同一锁,导致每次控制器切换时1kHz实时循环停止44-47ms,期间无法读取FCI状态或写入指令,即使配置is_async=true无效。
环境
Mobile Fr3 Duo,franka_ros2 jazzy分支v3.6.1之前版本,ros2_control框架,libfranka驱动。
解决办法
- 将franka_ros2升级至jazzy分支v3.6.1或更高版本。
- 新版本在read()/write()中获取control_mutex_时改用std::try_to_lock,避免在模式切换期间阻塞实时读写线程。
- 激活及切换后写入操作被门控,强制等待一次新的read()完成后再执行,确保状态同步安全。
讨论原作者:@MikeWrock 等,版权归原作者所有。
外部来源
本页事实对应的公开页面,以原文为准。(点击将离开本站)