本页面介绍了外部系统将如何通过Control Bus 协议与底盘进行通讯。

本页内容

简介

SLAMWARE Core模块与外部系统通过Control Bus低速总线连接。通过Control Bus总线协议，SLAMWARE Core可以获取外部系统的状态参数，例如外部系统的电池电量信息，是否在充电状态，外部系统的电机转速，传感器状态等信息。同时，SLAMWARE Core也通过Control Bus总线协议控制外部系统的电机运动，从而实现完整的室内定位导航功能。
Control Bus总线协议是运行在串口上的，波特率为115200bps，外部系统必须实现此总线协议才可以使SLAMWARE Core正常工作。
SLAMWARE Core Control Bus通讯协议使用的是Inter-chip通讯协议的扩展模式。Inter-chip通讯协议是SLAMTEC专门为底层电子系统，诸如微控制器之间、微控制器与宿主系统、微控制器与设备之间相互通讯而设计的协议。它以数据包为单位在通讯媒介上传递数据，通讯包中包含了数据校验机制以及帧同步机制，可以实现可靠的通讯链路。目前该协议广泛用于SLAMTEC的机器人系统、传感器和模块设备中，并可在USART、USB、I²C、TCP以太网中使用。

Ctrl Bus协议和Inter-chip协议关系示意图

功能概览

内部模块框图和使用方法

下图描述了SLAMWARE Core和外部系统之间的通信连接框图。

SLAMWARE Core内部模块框图

SR001 SLAMWARE Control Bus Protocol

Inter-chip通讯协议规范

Inter-chip通讯协议简介

通讯特性

本协议所假设的通讯介质是以点对点或者总线方式组织的网络，其中同一时间最多只有2个通讯端点(Peer)可以相互之间通讯，但是如果通讯介质网络允许实现广播，则可以允许由一个通讯端点同时向多个其他端点单向的发送消息。
通讯介质本身可以是基于字节流模式的信道，比如USART、TCP以太网，也可以是基于数据包的信道，比如USB、I2C。Inter-chip Protocol并不要求通讯介质实现数据包的同步机制，协议本身可以利用每个数据包头部的同步信号自动实现同步。
当通讯发生时，传输在通讯介质上的消息永远是以具有固定格式的数据包形式存在的。每个数据包允许承载不同长度的数据，但在数据包头部均具有长度一致、数据结构定义一致的数据，该数据用语描述数据包自身的信息以及期望接收端采取的处理方式。

数据传输顺序

Inter-chip Protocol要求信道传输数据时遵循FIFO原则，并且要求使用小字端传输数据包中协议所定义的公共数据结构，如包头部的描述数据。

协议子模式

基于不同应用场合的需求，Inter-chip Protocol包含了几个具体的子模式(sub-profile)。不同的子模式定义了各自的网络通讯方式、具体采用的包头数据结构等信息。在当前的实现中，Standard Profile是协议默认使用的子模式。它定义了一种采用请求-应答机制的通讯网络。

Inter-chip通讯协议规范

数据包结构纵览

每个Inter-chip Protocol规范的数据包均符合如下的格式定义。

其中，底色为灰色的字段为可选字段。不同的Sub-Profile会使用这些可选字段的某些部分。其它字段是所有Inter-chip Protocol规范的数据包均会带有的。后文将就单个字段进行描述。

Flag字段

该字段为一个数据包的起始标识，占用一个字节。随着Sub-Profile的不同，其取值有着不同的定义。其每个标志位的具体解释如下：

SR001 SLAMWARE Control Bus Protocol

Len与LenH字段

该字段用于表示本数据包携带的数据长度信息。其定义为Payload字段和CMD字段长度的总和，即：

由于Len字段为一个字节，因此当只有Len字段出现时，当前的数据包只能携带至多254字节的Payload数据。

当Flag字段的LongFrame位设置为1时，LenH字段也将出现在数据包中，并与Len字段构成一个16bit的联合字段。此时数据包可以携带65534字节的数据。

注意：当Len/LenH字段设置为0时，本数据包将被视为无效数据包而被协议栈丢弃。

CMD字段

该字段带有期望协议栈或者接收方处理程序对本数据包执行操作的命令信息。不同的Sub-Profile会保留一部分的CMD取值用于实现协议栈自身的通讯机制。例如在Standard Profile下，0x0至0xF被用于协议栈占用。其具体含义请参考本文的后续章节。

Payload字段

该字段记录了数据包发送方希望携带的有效信息负载。其数据长度由Len/LenH字段表示。如果发送方没有任何需要传输的信息时，该字段将被省略。

CHKSUM字段

当Flag中CheckSumEn位被设置为1时，该字段将附加在数据包的末尾，用于记录对数据包中正确数据的校验和。其计算方式如下：

其中， Packet表示即将发送的当前数据包去除CHKSUM字段的其他所有部分。Packet[N]表示即将发送的当前数据包的第N个字节。

当CHKSUM字段启用后，接收方协议栈将会在完成一个数据包接收后，重新计算一个新的CHKSUM并和数据包中附带的原始CHKSUM字段进行对比。如果不匹配，协议栈将丢弃当前数据包，并按照Sub-Profile所定义的行为，进行额外的处理。

CHKSUM[7..0]MSB+7+0LSBCHKSUM:
<ac:structured-macro ac:name="anchor" ac:schema-version="1" ac:macro-id="15dcbfc4-37a5-49e6-8fcd-c47003f56ca9"><ac:parameter ac:name="">_Toc465950221</ac:parameter></ac:structured-macro><span style="color: #44546a"><em>图表</em></span> <span style="color: #44546a"><em>3-7</em></span> <span style="color: #44546a"><em>Inter-chip Protocol</em></span> <span style="color: #44546a"><em>CHKSUM字段格式说明</em></span>
<span style="color: #262626">当Flag中CheckSumEn位被设置为1时，该字段将附加在数据包的末尾，用于记录对数据包中正确数据的校验和。其计算方式如下：</span>
<span style="color: #262626">CHKSUM0..7=0 xor Packet0</span> <span style="color: #262626">xor Packet1</span> <span style="color: #262626">xor...xor</span> <span style="color: #262626">PacketN</span>
<span style="color: #262626">其中，Packet表示即将发送的当前数据包去除CHKSUM字段的其他所有部分。PacketN表示即将发送的当前数据包的第N个字节。</span>
<span style="color: #262626">当CHKSUM字段启用后，接收方协议栈将会在完成一个数据包接收后，重新计算一个新的CHKSUM并和数据包中附带的原始CHKSUM字段进行对比。如果不匹配，协议栈将丢弃当前数据包，并按照Sub-Profile所定义的行为，进行额外的处理。</span>

ExFlag[N]字段

ExFlagN[6..0]MSB+7+0LSBExFlag[N]:ExtBit
<ac:structured-macro ac:name="anchor" ac:schema-version="1" ac:macro-id="2e8b7da4-5ed7-4007-899c-af2a44751d9c"><ac:parameter ac:name="">Toc465950222</ac:parameter></ac:structured-macro><span style="color: #44546a"><em>图表</em></span> <span style="color: #44546a"><em>3-8</em></span> <span style="color: #44546a"><em>Inter-chip Protocol</em></span> <span style="color: #44546a"><ac:structured-macro ac:name="unmigrated-wiki-markup" ac:schema-version="1" ac:macro-id="0a3eec14-53da-44bf-b674-3956bb3e63ce"><ac:plain-text-body><![CDATA[_ExFlag[N]字段格式说明

每一个字节ExFlag中的ExtBit位用于表示是否还存在一个额外的ExFlag字节紧跟在本ExFlag字节之后。当设置为0时，表示当前的ExFlag字节即是整个ExFlag[N]字段的终结。请参考具体Sub-Profile的定义了解本字段具体位定义。

<ac:structured-macro ac:name="anchor" ac:schema-version="1" ac:macro-id="5b8ba3c4-6d51-4798-920f-67e1f1b353a8"><ac:parameter ac:name="">_Toc390031739</ac:parameter></ac:structured-macro>Addr与ExAddr[N]字段

Addr[6..0]MSB+7+0LSBAddr:ExtBitExAddrN[6..0]ExAddr[N]:ExtBit
<ac:structured-macro ac:name="anchor" ac:schema-version="1" ac:macro-id="0548a352-ddb1-4d47-8506-0ff9cacaf322"><ac:parameter ac:name="">OLE_LINK7</ac:parameter></ac:structured-macro><ac:structured-macro ac:name="anchor" ac:schema-version="1" ac:macro-id="2319e6e3-8941-4da7-883e-5575e7228ba8"><ac:parameter ac:name="">OLE_LINK8</ac:parameter></ac:structured-macro><ac:structured-macro ac:name="anchor" ac:schema-version="1" ac:macro-id="decf2606-30de-43c1-a37c-d832449d789d"><ac:parameter ac:name="">Toc465950223</ac:parameter></ac:structured-macro><span style="color: #44546a"><em>图表</em></span> <span style="color: #44546a"><em>3-9</em></span> <span style="color: #44546a"><ac:structured-macro ac:name="unmigrated-wiki-markup" ac:schema-version="1" ac:macro-id="d2f6c670-e2b1-4eb6-b549-c1ca20fae6bc"><ac:plain-text-body><![CDATA[_Inter-chip Protocol Addr和ExAddr[N]字段格式说明

当Flag中AddrEn位被设置为1时，数据包中将包含一个Addr字段，用于记录本数据包需要发送的目标设备地址。不同的Sub-Profile实现下，协议栈将对该字段的数据作出不同的处理。

在Addr字段中，使用了7个bit的区域用于表示0-127个设备地址号。如果希望使用更长的设备地址，则可以将Addr字段的ExtBit设置为1，此时，更多的地址数据位将被使用。它们将存储在后续的ExAddr[N]字段当中。

当Addr以及每个ExAddr[N]字段字节中的ExtBit设置为1时，表示当前字节后将紧跟一个ExAddr字节，直到ExtBit为0时为止。

Standard Profile

Inter-chip Protocol的Standard Profile定义了一种基于应答请求通讯模式的可靠点对点包交换网络。并且预留了一定的CMD取值用于协议栈内部实现通讯机制。

通讯模式和术语

Standard Profile要求网络中同一时刻只有2个通讯端点相互进行通讯。并且，其中一方将始终首先向另一方发送数据。另一方将始终在接收到发送数据方的数据包后做出回应，发送对应的回应数据。
这里定义上述始终首先发送数据的通讯端点为宿主(Master)，而始终先接收数据再发出回应数据包的通讯端点为从机(Slave)。
Standard Profile使用了相同的格式用于Master以及Slave发出的数据包，即Flag字段的定义一致。不过根据通讯角色的不同，其发送的数据包的某些字段具有不同的含义。
对于由Master发出的数据包被称为请求命令数据包（简称请求命令），而由Slave发出的数据包被称为应答数据包（简称应答）。
请求命令与应答必须是成对出现的，每个应答总对应与一个请求命令。而Master必须在发送一个请求命令后，在接收到Slave发送应答数据包或者通讯超时后，方可进行下一个请求命令的发送。
MasterSlave请求命令1应答1请求命令2应答2
图表 3-10基于Inter-chip Protocol的Master和Slave通讯规则

Flag字段定义

0MSB001000+7+0LSBStandard:0101000Long Frame:00
图表 3-11 Inter-chip Protocol Flag字段格式说明
Standard Profile允许使用如下2种Flag字段的数据包格式：

图表 3-12 Inter-chip Protocol Flag数据包格式说明
采用Standard Profile的协议栈必须支持Standard类型的数据包。而当协议栈支持Long Frame模式的数据包时，Master和Slave在通讯过程中均可以随意的按照实际需要选择Standard或者Long Frame模式的数据包进行发送。

请求命令数据包

0x10Len[7..0]CMDPayload[n]CHKSUMu8u8u8u8[n]u8Standard:Long Frame:
0x50Len[15..0]CMDPayload[n]CHKSUMu8u16u8u8[n]u8
<ac:structured-macro ac:name="anchor" ac:schema-version="1" ac:macro-id="7709d76a-816f-4bc2-8f96-ee3122afbc61"><ac:parameter ac:name="">_Toc465950227</ac:parameter></ac:structured-macro><span style="color: #44546a"><em>图表</em></span> <span style="color: #44546a"><em>3-13</em></span> <span style="color: #44546a"><em>Inter-chip Protocol</em></span> <span style="color: #44546a"><em>请求命令数据包格式说明</em></span>
<span style="color: #262626">由Master发送的请求命令数据包采用如上2种固定的数据包结构。其中，CMD字段的大部分取值可由应用程序使用。用于对Slave具体功能的调用或者数据请求。其具体取值请参考对应的设备文档。</span>
<span style="color: #262626">符合Standard Profile规范的协议栈将保留如下的CMD字段取值，用于完成协议栈本身的处理任务：</span>

图表 3-14 Inter-chip Protocol 保留的CMD说明
应用程序需要避免使用上述保留的CMD字段取值。

Standard Profile规范对Payload[n]的使用不做出假设。但具体的Slave设备会要求在不同的CMD字段取值情况下，对Payload[n]字段的数据格式做出假设。

应答数据包

0x10Len[7..0]RespPayload[n]CHKSUMu8u8u8u8[n]u8Standard:Long Frame:
0x50Len[15..0]RespPayload[n]CHKSUMu8u16u8u8[n]u8
<ac:structured-macro ac:name="anchor" ac:schema-version="1" ac:macro-id="47aebbc6-79be-4940-9d13-a07b13023382"><ac:parameter ac:name="">_Toc465950229</ac:parameter></ac:structured-macro><span style="color: #44546a"><em>图表</em></span> <span style="color: #44546a"><em>3-15</em></span> <span style="color: #44546a"><em>Inter-chip Protocol应答数据包格式说明</em></span>
<span style="color: #262626">由Slave发送的应答数据包满足上述2种格式。其中，CMD字段被用于对Slave先前收到的请求命令处理情况的回应。其取值必须为如下的几种：</span>

图表 3-16 Inter-chip Protocol保留的Resp说明

Payload[n]字段在应答数据包中用于存放Slave对先前Master发来的请求命令的执行结果。当本次应答的Resp为<OK>时，Paylaod[N]包含的具体数据定义与相关的请求命令有关。请参考具体的Slave设备手册了解详情。

当Resp为<Error> (0x03)或者<Invalid>(0xFF)时，Payload[N]将存放一个16bit的错误码，描述出错情况。Standard Profile规范要求协议栈保留如下的错误码取值，请含义见下表。Slave上的应用程序也可以定义更多的错误代码。

图表 3-17 Inter-chip Protocol错误码说明

SLAMWARE CORE 协议命令

SLAMWARE CORE CTRL BUS通讯协议

SLAMWARE CORE CTRL BUS通讯协议使用Inter-chip通讯协议的扩展模式。
它的数据包类型域为标识SLAMWARE CORE CTRL BUS扩展模式的0xF8。在此扩展模式下，数据负载的格式为请求/应答通讯模式，应答数据包格式与标准Inter-chip通讯协议一致。根据数据包长度的类型分为如下两种格式：
格式一：
同步标志字节
(0x50)数据包长度
u16请求命令
u8数据负载
…校验字节
u8SLAMWARE CORE CTRL BUS扩展模式
协议栈数据协议栈数据0xF8
格式二：
同步标志字节
(0x10)数据包长度
u8请求命令
u8数据负载
…校验字节
u8SLAMWARE CORE CTRL BUS扩展模式
协议栈数据协议栈数据0xF8
图表 4-1 SLAMWARE CORE CTRL BUS 通讯协议数据包格式
SLAMWARE CORE和外部系统之间的CTRL BUS通讯协议设计为单向通讯模式，始终由SLAMWARE CORE发起数据包请求。
外部系统SLAMWARE CORE主系统请求命令1应答1请求命令2应答2
图表 4-2 SLAMWARE CORE CTRL BUS 请求应答通讯模式说明
外部系统需要及时回应SLAMWARE CORE的请求命令，否则SLAMWARE CORE将认为外部系统连线中断，可能停止正常工作。
请求命令与应答必须是成对出现的，每个应答总对应于一个请求命令。SLAMWARE CORE在发送一个请求命令后，总会在接收到外部系统发送应答数据包或者通讯超时后，才会进行下一个请求命令的发送。
SLAMWARE CORE也可以接受外部系统的控制命令，但由于单向通讯的模式，外部系统只能在SLAMWARE CORE定期发送外部系统控制命令查询请求的时候才可以发送控制命令。但外部系统可以通过#CMD信号通知SLAMWARE CORE尽快发送外部系统控制命令查询请求。

SLAMWARE CORE 请求命令

SLAMWARE CORE室内定位导航模块会发送以下请求命令，外部系统可以根据需要响应请求命令，否则SLAMWARE CORE CTRL BUS协议栈会做默认响应。标*的命令为外部系统必须响应的请求命令。否则SLAMWARE CORE将不能正常工作。

图表 4-3 SLAMWARE CORE 请求命令列表

外部系统连接请求(CONNECT_BASE)

SLAMWARE CORE室内定位导航模块在准备好后会一直发送外部系统连接请求确认外部系统已正常工作。直到外部系统响应此请求后SLAMWARE CORE才会开始正常工作。

• 请求数据包：

0x10命令代码负载数据u8协议版本

• 应答数据包：

<span style="color: #262626"><OK></span>应答代码<span style="color: #262626">固件版本</span><span style="color: #262626">硬件版本</span>version负载数据u16u16<span style="color: #262626">型号</span><span style="color: #262626">序列号</span>u8[12]u32[3]

图表4-4外部系统连接请求与应答数据域描述

外部系统参数获取请求(GET_BASE_CONF)

SLAMWARE CORE室内定位导航模块在与外部系统连接后会发送参数获取请求以获得外部系统的基本结构信息，包括尺寸类型，尺寸半径，轮组类型以及传感器安装位置信息等。目前版本SLAMWARE CORE只支持圆形和方形尺寸以及两轮差动轮组。

• 请求数据包：

0x20命令代码

• 应答数据包：

<span style="color: #262626"><OK></span>应答代码<span style="color: #262626">尺寸半径</span><span style="color: #262626">轮组类别</span>负载数据u32<span style="color: #262626">尺寸类别</span><span style="color: #262626">触碰传感器数量</span>
u8u8<span style="color: #262626">触碰传感器安装位置</span>u8pos[8]<span style="color: #262626">距离传感器数量</span><span style="color: #262626">距离传感器安装位置</span>u8pos[8]

图表 4-5 外部系统参数获取请求的应答数据域描述
注：当使用0x20底盘配置指令时，最多可支持8组距离传感器；当使用0x21 Binary Config指令配置时，最多可支持16组距离传感器
目前支持的尺寸类型有：

图表 4-6 外部系统所支持的外部系统尺寸类型
目前支持的轮组类型有：

图表 4-7 外部系统所支持的轮组类型
传感器安装位置的pos数据表示为：

图表 4-8外部系统传感器安装位置pos数据

外部系统配置获取请求(GET_BINARY_CONF)

这是上述0x20指令的升级指令，SLAMWARE CORE模块会优先使用该指令获取外部系统的配置信息，如果外部系统返回Not Support的话才会选择去调用0x20指令。
这个指令相对于0x20指令来说提供了更多的功能，如雷达安装位置的配置等。

• 请求数据包：

0x21命令代码

• 应答数据包：

<OK>应答代码负载数据外部系统配置数据u8*n
外部系统的配置数据由SDK中所附的Slamware Configuration Tool自动生成。只需将生成的.c文件加入到工程项目中，将其中的slamware_config变量作为外部系统配置数据字段数据即可。
注：当使用0x21 Binary Config指令配置时，请将 0x20底盘配置指令中的所有传感器数据设置为0。

外部系统状态获取请求(GET_BASE_STATUS)

SLAMWARE CORE室内定位导航模块在准备好后会一直发送外部系统连接请求确认外部系统已正常工作。直到外部系统响应此请求后SLAMWARE CORE才会开始正常工作。SLAMWARE CORE正常工作后将不断轮询获取外部系统的状态，外部系统应当在规定的时间内给予答复。否则SLAMWARE CORE将认为外部系统断开连接。

• 请求数据包：

0x30命令代码

• 应答数据包：

<OK>应答代码电池充电状态负载数据u8电池电量百分比u8

图表 4-9 外部系统状态获取请求的应答数据域描述

外部系统轮组状态获取请求(GET_BASE_MOTOR_DATA)

SLAMWARE CORE室内定位导航模块正常工作后将不断轮询获取外部系统的轮组状态，外部系统应当在规定的时间内给予答复。否则SLAMWARE CORE将认为外部系统断开连接。

• 请求数据包：

0x31命令代码

• 应答数据包：

<OK>应答代码负载数据左轮电机累计里程右轮电机累计里程 s32s32

图表 4-10 外部系统轮组状态获取请求的应答数据域描述
备注：该命令支持的轮组类型为两轮。

外部系统距离传感器数据获取请求(GET_BASE_SENSOR_DATA)

SLAMWARE CORE室内定位导航模块正常工作后将不断轮询获取外部系统的距离传感器数据，外部系统应当在规定的时间内给予答复。
如果在系统参数获取请求时外部系统告知没有配置距离传感器，SLAMWARE CORE将不会发送此请求。

• 请求数据包：

0x32命令代码

• 应答数据包：

<span style="color: #262626"><OK></span>应答代码负载数据<span style="color: #262626">距离传感器数据</span>u32[16]

图表 4-11 外部系统距离传感器数据获取请求的应答数据域描述

外部系统触碰传感器数据获取请求(GET_BASE_BUMPER_DATA)

SLAMWARE CORE室内定位导航模块正常工作后将不断轮询获取外部系统的触碰传感器数据，外部系统应当在规定的时间内给予答复。
如果在系统参数获取请求时外部系统告知没有配置触碰传感器，SLAMWARE CORE将不会发送此请求。

• 请求数据包：

0x33命令代码

• 应答数据包

<OK>应答代码负载数据触碰传感器数据u8

图表 4-12 外部系统碰撞传感器数据获取请求的应答数据域描述

外部系统自动回充数据获取(GET_AUTO_HOME_DATA)

SLAMWARE CORE室内定位导航模块在试图进行自动回充时，会通过该指令获取自动回充相关的信息。当前主要用于获得对接灯塔Beacon信息。

• 请求数据包：

0x34命令代码负载数据数据类型u8

图表 4-13 外部系统自动回充数据获取请求的请求数据域描述

• 应答数据包（当数据类型为0时）

<span style="color: #262626"><OK></span>应答代码负载数据<span style="color: #262626">信标数量</span>u8<span style="color: #262626">接收头数量</span>u8<span style="color: #262626">接收头数据</span>u8[n]

图表 4-14 外部系统自动回充数据获取请求的应答数据域描述

外部系统运动控制请求(SET_BASE_MOTOR)

SLAMWARE CORE室内定位导航模块通过发送运动控制请求控制外部系统运动。外部系统需要根据请求数据包的内容准确控制系统运动才能使SLAMWARE CORE正常工作。

• 请求数据包：

<span style="color: #262626">0x40</span>命令代码负载数据s32[4]<span style="color: #262626">运动速度</span>

• 应答数据包

<OK>应答代码

图表 4-15外部系统运动控制请求的请求数据域描述

外部系统设置速度及获取Deadreckon数据请求(SET_V_AND_GET_DEADRECKON)

该指令用于设置外部系统运动速度。

• 请求数据包：

0x41命令代码负载数据s32X轴向速度量Y轴向速度量角速度量s32s32

• 应答数据包

<OK>应答代码负载数据X轴向位移Y轴向位移角度位移s32s32s32

图表 4-16外部系统设置速度及获取Deadreckon数据请求的数据域描述
备注: 此处的坐标轴是以机器人自身为中心的右手坐标系, 机器人正前方为x轴。
以两轮差动机器人为例，当机器人收到该指令时，应当：

1. 根据左右轮的里程累积计算三个位移量（dx, dy, dyaw）；
2. 将指令中提供的速度量（vx, vy, omega）转换成左右轮的线速度（vl, vy）；
3. 返回第一步中的计算结果

通过里程累积计算三个位移量的方法：

1. 变量定义：

   变量名称	定义	单位
   dl	左轮位移，机器人向前为正	m
   dr	右轮位移，机器人向前为正	m
   dx	机器人正方向位移，机器人前方为正	m
   dy	机器人侧向位移，机器人左侧为正	m
   dyaw	机器人角位移，逆时针为正	rad

2. 计算公式：

dyaw=dr-dl2R
dx=dl+dr2cos⁡(dyaw)
dy=dl+dr2sin⁡(dyaw)
注：R是机器人轮距半径，单位为m，下文同。

1. 代码示例

   base_set_velocity_request_t req = (base_set_velocity_request_t)request->payload; float speed_l_mm = (float)req->velocity_x_q16 * 1000.0 / (1 << 16); float speed_r_mm = speed_l_mm; float line_speed_mm = (float)req->angular_velocity_q16 / (1 << 16) * robot_radius_mm; speed_l_mm -= line_speed_mm; speed_r_mm += line_speed_mm;

   根据速度量计算左右轮线速度的方法：

2. 变量定义

   变量名称	定义	单位
   vx	机器人正向线速度，前进方向为正	m/s
   vy	机器人侧向线速度，向左为正, 对于二轮差动机器人，该值为0	m/s
   omega	机器人角速度，逆时针为正	rad/s
   vl	机器人左轮线速度，机器人向前为正	m/s
   vr	机器人右轮线速度，机器人向前为正	m/s

3. 计算公式(以二轮差动模型为例)

vl=vx-omega*R
vr=vx+omega*R

1. 代码示例

   base_set_velocity_request_t req = (base_set_velocity_request_t)request->payload; float speed_l_mm = (float)req->velocity_x_q16 * 1000.0 / (1 << 16); float speed_r_mm = speed_l_mm; float line_speed_mm = (float)req->angular_velocity_q16 / (1 << 16) * robot_radius_mm; speed_l_mm -= line_speed_mm; speed_r_mm += line_speed_mm;

   外部系统命令查询请求(POLL_BASE_CMD)

   SLAMWARE CORE室内定位导航模块可接受外部系统的命令，但由于单向通讯的模式，外部系统只能在SLAMWARE CORE发送外部系统控制命令查询请求的时候才可以发送控制命令。SLAMWARE CORE会定期向外部系统查询控制命令。对于外部系统希望SLAMWARE CORE尽快响应的控制命令可以通过#CMD信号通知SLAMWARE CORE尽快发送外部系统控制命令查询请求。在#BUSY信号置高电平的时候表示SLAMWARE CORE正处于忙碌状态，无法响应外部系统的控制命令。但外部系统仍需及时响应SLAMWARE CORE发送的请求命令。请注意，SLAMWARE CORE不会应答外部系统的命令，当SLAMWARE CORE接受外部系统的命令后，外部系统可以检测到#BUSY信号的脉冲。外部系统必须在应答外部系统命令查询请求后拉低#CMD信号，否则系统将会工作在未知状态。

• 请求数据包：

0x50命令代码

• 应答数据包

<OK>应答代码负载数据外部系统命令代码u8

图表 4-17外部系统命令查询请求的应答数据域描述

图表 4-18外部系统命令代码列表

外部系统命令回应请求(POLL_BASE_ANS_CMD

SLAMWARE CORE在处理完外部系统的命令请求后会给予回应，回应请求总是与外部系统命令查询请求成对出现。
SLAMWARE CORE支持的外部系统命令代码暂未定义。

• 请求数据包：

0x5F命令代码

• 应答数据包

<OK>应答代码负载数据应答数据u8

图表 4-19外部系统命令回应请求的应答数据域描述

SLAMWARE CORE系统事件通知命令(SEND_EVENT)

SLAMWARE CORE室内定位导航模块会不定期的向外部系统发送系统事件通知。外部系统可以根据系统事件通知作出相应反应。
注意，SLAMWARE CORE支持的系统事件代码可能会增减。

• 请求数据包：

0x60命令代码负载数据系统事件代码u8

• 应答数据包

<OK>应答代码

图表 4-20 SLAMWARE CORE的系统事件通知命令的请求数据域描述
目前支持的系统事件代码有：

图表 4-21 SLAMWARE CORE支持的系统事件代码

外部系统健康管理命令请求(HEALTH_MGMT)

SLAMWARE CORE室内定位导航模块会不定期的向外部系统发送健康管理相关的命令请求。外部系统可以根据具体的命令请求作出相应的反应。具体支持的事件代码如下：

图表4-22 SLAMWARE CORE 健康管理命令支持的事件代码

HEALTH_GET_HEALTH

• 请求数据包：

0x90命令代码0x01

• 应答数据包

<OK>应答代码Health_flagError_countu8u8

图表4-23 HEALTH_GET_HEALTH命令数据域描述

图表4-24HEALTH_GET_HEALTH命令中Health_flag定义

HEALTH_GET_ERROR

• 请求数据包：

0x90命令代码0x02error idu8

• 应答数据包

<OK>应答代码error_codeError_messageu32u8[32]

图表4-25 HEALTH_GET_ERROR 命令数据域描述

图表4-26 HEALTH_GET_ERROR 命令中返回数据error_code定义
Sample:

HEALTH_CLEAR_ERROR

• 请求数据包：

0x90命令代码0x03error codeu32

• 应答数据包

<OK>应答代码

外部系统辅助定位数据获取请求（GET_AUXILIARY_ANCHOR）

SLAMWARE CORE室内定位导航模块会不定期的向外部系统发送获取辅助定位数据相关的命令请求。

• 请求数据包：

0x35命令代码

• 应答数据包

<span style="color: #262626"><OK></span>应答代码负载数据<span style="color: #262626">Flag</span><span style="color: #262626">Anchors</span>u8u8[*]

图表4-27 GET_AUXILIARY_ANCHOR命令数据域描述

图表4-28 GET_AUXILIARY_ANCHOR命令数据域描述

AnchorInfo[0]

AnchorInfo[1]

AnchorInfo[n]

第0个AnchorInfo第1个AnchorInfo第n个AnchorInfo注：n 为辅助传感器数量。
图表4-29 GET_AUXILIARY_ANCHOR命令中AnchorInfo的数据格式

…

u8[n]