【LSM6DSOX的FSM有限状态机理解】--编程模块简介

上一帖中介绍了LSM6DSOX的FSM中一共有16个完全独立并资源相同的状态机程序块，那么每个程序块长什么样子呢？

一个状态机程序块中包含了输入选择器和状态机代码块两部分。

输入选择器能够将传感器信号或者内部计算的数据信号中选择输入信号源，所支持的信号如下：

• LSM6DSOX加速度计数据、加速度和  矢量的模。
• LSM6DSOX陀螺仪角速度数据、角速度和 矢量的模。
• 外部传感器(比如磁力计)数据，磁力和 矢量的模。
• 内部计算的角度、角度和 矢量的模(这是个什么量..)
• 正确配置的机器学习模块的输出。
  

其中，上述空间物理量和 矢量的模计算方法如公式：

怎么选择输入FSM信号源呢？这里就涉及到了一个命令“SINMUX”，用这个命令就可以配置不同的数据到FSM的数据源端了，具体用法我会在指令介绍中讲解~

  状态机代码块就是我们实现自己状态机的功能模块了，如下图所示，状态机代码块由固定变量、可变变量、指令程序组成：

固定变量区位于程序块的最前端，长度固定6字节，一共6个变量，根据配置系统自动更新，无需自己更改。

可变变量区位于固定变量区之后，长度随使用而改变，最长36字节，一共24个变量，随用随设置。

指令程序区位于可变变量区之后，由条件和命令组成，控制输入选择器的命令“SINMUX”就在这个区域内设置。

在Unico的主界面左侧，点开FSM模块，可以看到界面中一共有三个标签栏，Configuration，Interrupt，Debug

默认的界面就是状态机设置、编程的界面，如下图所示。

在这个界面中我们可以看到有很多的按键和输入框，参考Unico上FSM使用.pdf文件中，我标注了8个红框区域，逐一来看：

1、StateMachine Selection，状态机选择，这个下拉菜单中一共有16个选项，对应的就是前面讲的16个独立的状态机程序块。

2、FSM_ODR,FSM频率(Output Data Rate)，这个值在限制了加速度/角速度数据传输到代码块的最高频率，建议是将加速度/角速度的输出频率高于这个值，也就是在Unico主界面的Opitions中Accelerater output data rate和Gyrocope Output data rate值高于FSM ODR的值，避免欠采样问题发生。

3、Long_Counter,16位计数器，一个最大可以计数65535的全局计数器，也就是所有状态机程序块公用。Max Value是设置计数器的最大溢出值，16位数据形式标志（例如65525填写FFFF),底下两个勾选可以设置计数器溢出时是否产生INT1/INT2外部中断。计数器的值可以从程序中使用“INCR”来增加。

4、Converter,格式转换，由于FSM中用的都是半精度浮点数HFP，所以在这给我们提供了32位浮点数转16位浮点数、16位转32位的小工具。

5、SMx status,状态机x状态设置，这个区域有三个选项，Enabled用于启动状态机x，只有勾选Enabled该状态机程序块才会工作。INT1 INT2分别将状态机的中断路由到INT1、INT2外部中断上，16个状态机可以独立设置启动与否，绑定外部中断。

6、SMx Fixed Data Section,状态机x固定变量区，显示了6个变量和2个开关：

• ConfigA和configB中储存了程序所使用的的资源量
• Size 显示的是状态机总的字节数，图中由于没有配置任何资源，所以显示的6字节为固定变量区大小。
• Setting中保存了当前程序状态，选择的掩码，选择的阈值，输入信号等等。
• Reset Pointer(RP)复位点，储存了条件指令中返回判断(RESET)为真所跳转的地址。
• Program Pointer(PP)当前运行程序点，储存了当前采样时间内正在执行的指令的地址。
• Hysteresis ，回滞变量开关，启动该选项后，下方的Hysteresis回滞变量可以设置。
• Decimation，降频变量开关，启动该选项后，下方的dest降频变量可以设置。
  

上面的固定变量，在用UnicoGUI的时候这六个变量都是跟随编程操作自动更改的，无需自行更改。

当我们想要直接使用LSM6DSOX在自己的项目中的时候，则需要考虑设置其中的值。

7、SMx Variable Data Section,状态机x可变变量区，其中显示了24个变量，共计36个字节，当我们用不到某些变量的时候，Unico就不会配置该变量到状态机程序块中，也就不占用内存。

其中黑色字体的就是可以设置的变量

• Thresh1-3，阈值，在条件指令中，用来比较输入信号对应轴的数据是否到达阈值。
• Hysteresis，回滞参数，当设置了回滞参数后，在对某轴进行阈值比较时，会将比较值增加回滞参数变成一个比较区间，如下图所示。
  

• MasksA-C，轴选择掩码，用于指定输入数据的哪个轴进行阈值条件或过零条件判断。
• Timer1-3，定时器值，在条件指令中，设置的定时器比较的时间值。
• Dest，降频因子，用来降低状态机处理传感器数据的频率，将该状态机处理数据的频率降为FSM ODR/Dest。
• Decision Tree，机器学习决策树接口，通过“CHKDT”命令检查机器学习核心内部的决策树结果，当FSM和机器学习结合的时候就需要用到这个参数。
  

8、SMx Instructions Section,程序指令区，上图中这个区域只有四个按键，分别是

• Add State 增加状态指令
• Import State Machine导入状态机指令
• Export State Machine导出状态机指令
• Reset State Machine重置状态机指令
  

当点击Add State按键后，就可以增加一条状态指令，如下图所示

• S0  状态号，随着状态指令增加，状态号依次递增
• 0x06 状态地址，也是随着状态指令增加而增长，Reset Pointer(RP)复位点和Program Pointer(PP)当前运行程序点中的数据就是指这个地址，首状态地址随前面固定变量和可变变量总长度而定，图中由于只有6个固定长度，因此状态S0地址为0x06。
• RNC，Reset/Next conditions，选择该条状态为条件指令
• CMD，Commands，选择该条状态为命令指令
• 指令选择框，选择需要的指令
• 16进制指令码，所选指令的16进制形式
• Add，增加状态按钮，在此状态前增加状态
• Remove，删除状态按钮，删除此条状态。
  

在FSM模块的Interrupt界面下，分成了两个区域，如图所示。

左侧为输入加速度、角速度、输出外部中断INT1/INT2的波形图。

右侧为16个状态机的输出寄存器OUT_Sx的数据，通过点击read，可以读取当前的值。

在FSM模块的Debug界面下，也是分成了两个区域，如下图所示。

左侧为我们写的状态机图，通过分析它可以很清楚的看到我们的状态机状态是如何改变的。

右侧为调试区域，通过导入采集的输入数据集，可以对左边的状态机进行仿真调试，这里就先不细说了。