简介

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 通讯协议

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 通讯协议返回顶部

Len与LenH字段

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

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

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

CMD字段

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

Payload[n]字段

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

CHKSUM字段

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

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

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

ExFlag[n]字段

当Flag中ExtBit位被设置为1时，数据包中将包含一个或多个字节的ExFlag字段。该字段包含了额外的标志位用于描述数据包本身的信息或者Sub-Profile所额外定义的内容。同时，用户应用程序也可以将额外的信息附加在本字段中。
每一个字节ExFlag中的ExtBit位用于表示是否还存在一个额外的ExFlag字节紧跟在本ExFlag字节之后。当设置为0时，表示当前的ExFlag字节即是整个ExFlag[N]字段的终结。请参考具体Sub-Profile的定义了解本字段具体位定义。

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时为止。

SR001 SLAMWARE Control Bus 通讯协议返回顶部

Standard Profile

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

通讯模式和术语

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

Flag字段定义

Standard Profile允许使用如下2种Flag字段的数据包格式：

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

请求命令数据包

由Master发送的请求命令数据包采用如上2种固定的数据包结构。其中，CMD字段的大部分取值可由应用程序使用。用于对Slave具体功能的调用或者数据请求。其具体取值请参考对应的设备文档。
符合Standard Profile规范的协议栈将保留如下的CMD字段取值，用于完成协议栈本身的处理任务：

应用程序需要避免使用上述保留的CMD字段取值。

应答数据包

由Slave发送的应答数据包满足上述2种格式。其中，CMD字段被用于对Slave先前收到的请求命令处理情况的回应。其取值必须为如下的几种：

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

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

SR001 SLAMWARE Control Bus 通讯协议返回顶部

SLAMWARE Core 协议命令

SLAMWARE Core Ctrl Bus通讯协议

SLAMWARE Core Ctrl Bus通讯协议使用Inter-chip通讯协议的扩展模式。
它的数据包类型域为标识SLAMWARE Core Ctrl Bus扩展模式的0xF8。在此扩展模式下，数据负载的格式为请求/应答通讯模式，应答数据包格式与标准Inter-chip通讯协议一致。根据数据包长度的类型分为如下两种格式：
格式一：

格式二：

SLAMWARE Core和外部系统之间的Ctrl Bus通讯协议设计为单向通讯模式，始终由SLAMWARE Core发起数据包请求。

外部系统需要及时回应SLAMWARE Core的请求命令，否则SLAMWARE Core将认为外部系统连线中断，可能停止正常工作。
请求命令与应答必须是成对出现的，每个应答总对应于一个请求命令。SLAMWARE Core在发送一个请求命令后，总会在接收到外部系统发送应答数据包或者通讯超时后，才会进行下一个请求命令的发送。
SLAMWARE Core也可以接受外部系统的控制命令，但由于单向通讯的模式，外部系统只能在SLAMWARE Core定期发送外部系统控制命令查询请求的时候才可以发送控制命令。但外部系统可以通过#CMD信号通知SLAMWARE Core尽快发送外部系统控制命令查询请求。

返回顶部SR001 SLAMWARE Control Bus 通讯协议

SLAMWARE CORE 请求命令

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

外部系统连接请求(CONNECT_BASE)

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

该命令数据域描述如下：

SR001 SLAMWARE Control Bus 通讯协议返回顶部

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

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

该命令数据域描述如下：

目前支持的尺寸类型有：

目前支持的轮组类型有：

传感器安装位置的pos数据表示为：

SR001 SLAMWARE Control Bus 通讯协议返回顶部

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

这是上述0x20指令的升级指令，SLAMWARE Core模块会优先使用该指令获取外部系统的配置信息，如果外部系统返回Not Support的话才会选择去调用0x20指令。

这个指令相对于0x20指令来说提供了更多的功能，如雷达安装位置的配置等。

外部系统的配置数据由SDK中所附的Slamware Configuration Tool自动生成。只需将生成的.c文件加入到工程项目中，将其中的slamware_config变量作为外部系统配置数据字段数据即可。

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

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

SR001 SLAMWARE Control Bus 通讯协议返回顶部

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

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

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

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

该命令数据域描述如下：

SR001 SLAMWARE Control Bus 通讯协议返回顶部

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

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

该命令数据域描述如下：

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

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

0x34命令代码请求数据包中数据域定义如下：

SR001 SLAMWARE Control Bus 通讯协议返回顶部

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

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

该命令数据域描述如下：

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

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

示例

以两轮差动机器人为例，当机器人收到该指令时，应当：

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-dl)/2R

   dx=cos(dyaw)×(dl+dr)/2

   dy=sin(dyaw)×(dl+dr)/2

   Note
   title 注意
   R是机器人轮距半径，单位为m，下文同。

   
   

3. 示例代码

   Code Block
   language text title base_set_velocity_request linenumbers true
   float d_yaw = (d_dist_r_mm_f - d_dist_l_mm_f)/2.0f/robot_radius_mm; float displacement = (d_dist_l_mm_f + d_dist_r_mm_f)/2.0f; float dx = cos(d_yaw)*displacement; float dy = sin(d_yaw)*displacement; ans_pkt->base_dx_mm_q16 = (_32)(dx*(1<<16)) ans_pkt->base_dy_mm_q16 = (_32)(dy*(1<<16)) ans_pkt->base_dtheta_degree_q16 = (_32)(d_yaw/M_PIF*180*(1<<16))

   
   

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

1. 变量定义

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

   
   

2. 计算公式(以二轮差动模型为例)
   vl=vx-omega*R
   vr=vx+omega*R
   

3. 示例代码

   Code Block
   language cpp title base_set_velocity_request linenumbers true
   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;

   SR001 SLAMWARE Control Bus 通讯协议返回顶部

外部系统命令查询请求(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信号，否则系统将会工作在未知状态。

该命令数据域描述如下：

SLAMWARE Core支持的命令代码如下：

SR001 SLAMWARE Control Bus 通讯协议返回顶部

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

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

该命令数据域描述如下：

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

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

该命令数据域描述如下：

目前支持的系统事件代码有：

SR001 SLAMWARE Control Bus 通讯协议返回顶部

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

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

HEALTH_GET_HEALTH

Health flag定义如下：

HEALTH_GET_ERROR

Error code定义如下：

示例代码

// sensor errors
#define BASE_SENSOR_FATAL_CONTROLLER_DOWN	(SLAMWARECORE_HEALTH_ERROR_FATAL | BASE_COMPONENT_SENSOR | 0x0000u) 
#define BASE_SENSOR_WARN_BUMPER_DOWN		(SLAMWARECORE_HEALTH_ERROR_WARN  | BASE_COMPONENT_SENSOR | 0x0100u) 
#define BASE_SENSOR_ERROR_BUMPER_DOWN		(SLAMWARECORE_HEALTH_ERROR_ERROR | BASE_COMPONENT_SENSOR | 0x0100u) 
#define BASE_SENSOR_FATAL_BUMPER_DOWN		(SLAMWARECORE_HEALTH_ERROR_FATAL | BASE_COMPONENT_SENSOR | 0x0100u) 
#define BASE_SENSOR_WARN_CLIFF_DOWN			(SLAMWARECORE_HEALTH_ERROR_WARN  | BASE_COMPONENT_SENSOR | 0x0200u) 
#define BASE_SENSOR_ERROR_CLIFF_DOWN		(SLAMWARECORE_HEALTH_ERROR_ERROR | BASE_COMPONENT_SENSOR | 0x0200u) 
#define BASE_SENSOR_FATAL_CLIFF_DOWN		(SLAMWARECORE_HEALTH_ERROR_FATAL | BASE_COMPONENT_SENSOR | 0x0200u) 
#define BASE_SENSOR_WARN_SONAR_DOWN			(SLAMWARECORE_HEALTH_ERROR_WARN  | BASE_COMPONENT_SENSOR | 0x0300u)

HEALTH_CLEAR_ERROR

SR001 SLAMWARE Control Bus 通讯协议返回顶部

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

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

Flag字段定义如下：

AnchorInfo数据格式如下：

AnchorInfo数据域定义如下：

SR001 SLAMWARE Control Bus 通讯协议返回顶部