原型用 Python，热路径再下沉。写清 ROS 版本。