遥控器、App 和程序同时发指令,启元 Q1 听谁的?


设想这样一次操控。手机上的摇杆还在要求 Q1 前进,电脑里的速度程序开始发送转向指令。这时,操作者再动一下外接遥控器,机器人该听谁的?

在这里插入图片描述

只用一个入口时,操作者关心的是目标怎样发出去。几个入口同时要求机器人移动,系统就多了一项选择,当前采用谁的指令。手机还在发送,程序也已经启动,最终采用哪一路,仍要看来源规则。

启元 Q1 的探索版手册列出了 App 操控、外接遥控器与电脑调试入口,公开 SDK 则说明了连续速度输入的来源管理和仲裁规则。几个入口接到同一台机器人上,接手与退出都要沿着这套来源关系理解。

这次按官方规则推演,先给定 App 对应来源已经控制机器人,程序随后介入,遥控来源最后到达。三方使用同一连续速度入口,运动模式和来源启用条件都已满足。App 保持前进要求,程序准备发送转向要求,我们沿着这次竞争看哪一路目标被采用,不附加具体速度或切换耗时。

一、三个操作入口,怎样形成可比较的运动请求

先看 Q1 探索版手册中的 App 控制页面。遥控区位于画面下方,左右各有一个摇杆;上方还能看到模式选择和动作操作。用户面对的是一张完整页面,控制系统接到的要求却需要分开处理。

推动摇杆所表达的连续移动,与点一下姿态按钮要求切换动作,具有不同的任务含义。下面的来源比较只取连续移动这一部分,页面中的其他控件仍按各自任务理解。

Q1探索版手册中的App控制页面

图1 探索版手册中的 App 控制页,用于展示摇杆操控入口。

手机之外,探索版还有外接与开发入口。手册将 USB Type-A 的用途列为支持外接遥控器等扩展外设通信,将 RJ45 列为连接电脑调试等用途。接口位置画在机器人背部,打开拓展接口盖板后可以看到相应端口。

用户拿手机操控,开发者运行自己的程序,也可以外接遥控器。几个入口各自提出移动要求,进入共同的速度控制后,就需要按来源进行选择。插在哪个端口、程序运行在哪台设备上,都不能替代这一层选择。

Q1探索版背部拓展接口

探索版手册中的接口用途

图2 探索版背部接口及手册所列用途。

要让原厂操控和外部程序在同一设备上并存,还需要选对开发配置。官方集成指南将 Basic 基础开发定义为保留原厂业务与安全策略、允许外部指令并发接入。本文采用 Develop 运行模式下的 Basic 层级,通信沿用 SDK 默认支持的 ROS 2,并保留原厂高层运控。

开发配置按指南保存并重新上下电后生效。若启用低层运控开发并关闭原厂高层运控,控制路径就已经改变。下面讨论的是基础开发配置下的连续速度输入,机器人还应处于能够接收该输入的运动模式。

SDK 将连续移动要求汇集到 /aima/mc/locomotion/velocity。接口说明明确列举了遥控器、App 摇杆及自主导航等外部来源,消息中包含前进、侧移和转向速度。不同终端怎样组织自己的操作,到了这个入口,都需要形成可供运控系统处理的速度要求。

开发程序在这一层给出整机的移动目标,消息没有逐个列出关节角度。来源仲裁选择当前采用哪一路速度要求,后续的运动控制再处理机体怎样运动。因此,遥控器与程序的这次竞争,可以先落到共同入口上的速度请求。

对于来源选择,消息里的 source 尤其关键。前进速度告诉系统这次要求怎样移动,来源名则让这条请求与相应配置联系起来。两条请求可以要求相同的移动,也可以给出不同目标,仲裁仍然需要先知道它们分别属于谁。

官方 Python 例程把这个关系写在两个位置。注册来源时,它使用名称 node;发布速度时,又将消息的 source 填为同一个名称。下面只节选这几处赋值,完整程序见文末例程链接。

# register_input_source() 中的来源配置
request.input_source.name = "node"
request.input_source.priority = 80
request.input_source.timeout = 1000

# publish_velocity() 中的消息来源
msg.source = "node"

注册名与消息中的 source 对应起来,后续速度包便能按该来源的属性参与比较。优先级和超时保存在来源配置中,消息持续更新移动目标,无须每包重填这两个属性。

node 是例程的自定义名称。SDK 要求自定义来源先注册,并避开 rc、app_proxy 等内置标识。两个任务若需要独立启停和退出,就应当使用可以分别管理的来源;都填写同一个名称,消息里的这个字段便无法区分它们。窗口有几个、程序运行在哪台电脑上,都不能替代这一步来源划分。

程序部署在哪里,也不能单独决定它的级别。官方 SDK 支持开发程序运行在 PC、运控板或大脑板,通过 ROS 2 接口访问机器人能力。程序挪到另一块计算板上,并不会让 source 自动变成另一类终端;这段例程如何登记自己,仍然取决于它提交的名称及属性。

按 SDK 的来源分类,本次推演将 App 对应来源记为 app_proxy,实体遥控来源记为 rc,程序沿用例程的 node。这些名称取自文档,接口图本身不说明某款遥控器的具体接收协议。

一开始,App 对应来源已经控制 Q1,它的前进要求正被采用。电脑程序还没有送出有效速度指令,暂时没有加入这次竞争。

二、有人已经在控制,较高优先级怎样接手

SDK 的具体预设表将 app_proxy 列为 60,官方速度例程则把自己的 node 配为 80。用这两个值进入当前过程,手机对应来源已经占用,程序也完成注册,但还没有开始发布速度。

这段间隔在例程里确实存在。程序先处理来源注册,随后才从终端读取前进、侧移与转向的输入,确认参数后启动发布。人在键盘上输入目标时,注册请求已经可以结束,真正的速度流仍然要等后面的发布过程开始。

文档规定,抢占在有效指令到达时发生。注册完成只是程序加入了来源配置,转向要求仍需在接下来的发布过程中送出。

现在让程序开始发布。新消息携带 source="node",对应的来源优先级为 80;正在控制的 app_proxy 为 60。按照 SDK 的高优先级规则,新的有效指令可以抢占当前较低优先级来源,系统改为采用程序送来的速度要求。

此时,程序的转向请求被采用,App 的前进请求仍可继续发送。两份要求同时存在,系统按来源规则选中了其中一路。

高优先级来源到来前后的对照

图3 较高优先级来源接手,原来源仍可发送。

程序接手之后,App 仍可继续发送,其来源记录也无须一并删除。当前采用的目标来自 node,另一个入口仍然存在。

App 更早发来过有效请求,也确实是这段推演中的原占用者。这一次,后来到达的 node 具备更高优先级,因而能够接手。等到两个来源级别相同,已有占用关系才会按另一条规则影响结果。

从操作者的角度看,这种区别很容易影响判断。仍能操作界面,只说明人还在通过那个入口提出要求;机器人采用的可能已经是另一来源。若只顺着手机页面看,容易把控制结果都归到手机自身的操作与连接状况,忽略程序已经介入了同一个移动任务。

程序计算出新目标后,仍可沿 node 发送。它更新自己的消息,无须重新创建来源;另一来源想接手,才需要进入当前的仲裁关系。

连续速度消息给出了前进、侧移与转向几个分量,来源标识则将这条要求归入同一来源。阅读来源选择规则时,应当沿着完整请求看它的归属。不能自行把手机的某个分量与程序的另一分量拼成新的要求,文档给出的来源仲裁并没有描述这种组合方式。

这次竞争涉及的三项配置如下。

本次过程中的来源文档或例程中的标识采用的优先级
App 对应来源app_proxy60
官方速度例程node80
实体遥控来源rc80

其中,node 的值来自例程的显式设置,另外两项来自内置来源具体预设表。它们用于本文的规则比较,实际设备应以当前配置为准。同页的优先级区间参考与具体预设表口径并不完全对应,这里保留具体表的取值,不把两表合成一套终端等级。

程序在这个入口上拥有多少优先级,由注册配置决定,无法单凭它运行在电脑上就判断它必然低于所有手动终端。一个系统中可以存在多个开发程序,来源名及其属性才是这次比较能够使用的条件。

通过服务修改的来源属性只在当前运行内存中生效,不回写配置文件,重启后恢复预设。同一来源在另一轮启动中采用什么值,需要重新核对当前配置,不能直接沿用上一次调试时的印象。

例程里的80是一项具体配置,其他应用仍需结合已接入的来源决定取值,尤其要看哪些来源会与它同级。

例程开始发布后,会在循环经过约一秒时查询一次当前来源,输出名称、优先级与超时,留下这个时点的来源记录。这里的一秒是程序安排查询的时刻,没有规定控制权必须等到一秒才改变。

程序接手之后,手机对应来源的 60 已经无法解释下一次竞争了。此时操作者使用遥控器,SDK 具体预设中的 rc 也是 80。新的比较不再有高低之分,当前谁已经控制,开始影响结果。

三、优先级相同,后来者为什么没有接管

沿着刚才的过程,保持程序 node 已经占用,而且仍在持续发送有效指令。现在加入 rc 的有效指令,两边都是 80。

SDK 对同级情况规定了已有占用者保持的规则。在当前来源继续有效发送的条件下,后来进入的同级来源不会仅凭到达较晚就将它覆盖。因此,这一段过程继续采用 node,遥控来源的介入没有满足高优先级抢占的比较条件。

在这组配置下,遥控器作为手动入口,也按相同的优先级参与比较。两个 80 之间的接管关系,需要遵循同级保持规则。

将进入顺序交换,结果便更容易理解。另设遥控来源 rc 已经占用且持续有效发送,再让同样为 80 的 node 进入。此时按同一规则保持的是 rc。来源名称与数值都没有改,改变的条件只有谁先取得了当前控制。

同级来源交换进入顺序的对照

图4 同级竞争中,已有占用关系影响结果。

两组的优先级相同,当前占用者不同,继续采用的来源也随之不同。同级竞争需要同时看配置和当前占用状态,单列数值无法给出这一次的结果。

node 继续控制时,仍然可以更新自己的速度目标。下一包沿用相同来源名,前进或转向要求却可以改变。来源保持期间,机器人接收的目标并没有因此被冻结在第一包消息上。

官方例程提供了一个具体做法。它先读取用户输入的速度,启动发布后,在约五秒的程序循环中使用这些成员变量填写消息。目标值没有在每个循环里重新向用户询问,发布却通过定时器继续进行。

定时器设为 20 ms,属于程序安排发布的周期;来源另有 1000 ms 的超时配置,属于指令流中断后的处理条件。两个参数出现在不同位置,一个维持发送过程,一个约束当前来源中断后的占用。

增加发布次数不会自行提高来源的优先级。只要 node 仍满足有效发送条件,后来进入的同级 rc 就仍按同级规则处理,不会单凭消息更密而替换当前采用者。

即使应用暂时没有计算出一个不同的速度值,它仍然可能需要继续提供当前有效要求。若把连续速度接口当成只在数值变化时通知一次的接口,程序的输入习惯就会与来源超时机制产生冲突。

同级保持依赖当前来源继续有效发送。这段控制一旦遇到指令中断,就要转向超时规则;若更高优先级来源介入,仍按抢占规则比较。

这里的先后指向当前这一段控制。哪台终端更早开机,或哪个程序更早启动,都不能直接决定此后的所有同级竞争。需要带入的是此刻已经获得控制、仍在有效发送的来源。

如果实际应用希望手动操作能够打断某个程序,配置就应当明确表达这种关系。只保留与例程相同的优先级,又期待手动终端每次都自然接管,便与这里采用的同级保持条件不一致。这个问题需要在来源设计时解决,不能仅靠界面上标着“遥控”来回答。

调整配置也要同时考虑任务结束后的安排。让某个来源更容易接手,只处理了进入竞争的那一刻;程序完成任务后怎样退出,仍然需要另外说明。一个一直保持有效发送的来源,会继续出现在后续比较中。

现在回到 node 已占用的主线。程序已经完成这次移动,准备让操作者继续使用 Q1。它先要处理的,是自己还在发送的速度要求。

四、这次移动结束后,控制怎样交接

官方例程的正常收尾很短。它先调用 clear_velocity(),再发布一次消息,然后调用 release_input_source()。省略日志后,与本文有关的顺序如下。

node.clear_velocity()
node.publish_velocity()
node.release_input_source()

第一步清零的是程序中保存的前进、侧移和转向目标。第二步把这些值填进消息并发送,消息仍然沿用 node 这个来源。数值变了,归属没有随之自动改名。

零速度消息表达当前来源要求的速度目标。应用可以在同一控制任务里把目标调为零,之后再给出新的目标;来源是否继续参与,则由来源管理另外处理。把零速度直接当成来源删除,会混淆这两个对象。

例程随后调用的释放函数,才向设置服务提交 DELETE 请求,以名称 node 指向要删除的来源。请求处理结果也需要核对。清零消息与删除请求采用不同的接口含义,单从发出了其中一个,不能替另一个补出结果。

这次删除指向程序登记的 node。从注册、发布到退出,例程始终用同一个名称定位自身来源,收尾也就落到了明确的管理对象上。

程序知道任务已经结束,就可以主动更新目标、处理来源,无需故意等到指令中断超时。正常收尾应当由应用自己安排。

例程中的五秒循环与来源超时也各有对象。前者限制这次程序安排的运行阶段,循环结束后还要执行清零、发布和释放;后者处理指令流中断。五秒到了,并不会在代码中自动替代那次来源删除请求。只有把任务自己的结束条件接到具体收尾操作,这段程序才交代了它怎样结束控制。

但程序也可能没有走到正常收尾。进程退出、通信中断等情况,都可能使后续指令停止到来。对于来源控制,能直接观察到的共同变化,是当前指令流不再继续更新。这时,文档约定的超时机制开始起作用。

SDK 将超时放在每个来源的属性里,单位为毫秒。文档给出默认 1000 ms,例程也显式提交了 1000。当前主控来源的指令中断超过相应阈值后,规则要求释放控制权,并按优先级降序查找已就绪的候补来源。

前面保持 node 控制的条件是持续有效发送。现在指令流中断,达到超时条件后就要释放,不能无限延续先前的占用。

主动结束与指令中断超时的分支

图5 主动结束与超时退出的处理路径。

图中从同一个当前来源分出两条路径,上方主动收尾,下方处理消息中断。两者是不同分支,清零、DELETE 和超时无须在每次结束时依次全部发生。

候补还需要满足“已就绪”这一条件。文档明确按优先级降序查找,没有进一步说明同级候补之间怎样选择。前面的同级保持规则针对已经占用且持续有效发送的来源,不能直接套到释放后的候补选择上。

在这条超时支路里,App 曾经控制过机器人,只说明较早一段过程的归属。此刻的候补选择仍有自己的条件,不能直接把早先的占用经历延续过来,安排 App 恢复旧速度。

1000 ms 描述来源指令中断的配置阈值。机器人实际停止移动还涉及机体运动过程,不宜把这个数直接写成从通信中断到停稳的耗时。

交接时,可以用 GetCurrentInputSource 观察来源归属。它返回名称、优先级和超时属性,没有末次速度包的接收时刻;文档还允许原来源因超时停动后,在新的合法抢占者出现前继续返回旧名称。因此,看到 node 时,应结合刚发生的中断来理解,不能只凭名称认定程序仍在持续发送。接手时关注归属是否转到自己,交出时还需核对来源管理请求的结果,把这两类信息放回交接过程读取。

回看遥控来源刚介入的那一刻,只要 node 仍在有效发送,同级的 rc 就没有使当前来源改变。这一次,Q1 采用的仍是程序给出的转向目标。程序完成任务后,应当处理自身来源的退出;下一段控制再按当时的来源条件建立,不能把操作入口可用直接当成已经接手。

更多 SDK 与开发资料可在启元机器人开发者社区查阅和交流。

参考资料

Logo

DAMO开发者矩阵,由阿里巴巴达摩院和中国互联网协会联合发起,致力于探讨最前沿的技术趋势与应用成果,搭建高质量的交流与分享平台,推动技术创新与产业应用链接,围绕“人工智能与新型计算”构建开放共享的开发者生态。

更多推荐