# 卡尔曼滤波建模

在目标追踪领域中，最常用的状态估计算法就是卡尔曼滤波，当目标短暂被遮挡的时候，为了估测遮挡期间目标的状态以及遮挡之后避免ID SWITCH的问题，需要利用卡尔曼滤波去估测短暂丢失的目标，本文介绍一种在图像目标追踪中的卡尔曼滤波模型。



## 状态转移建模

状态方程：$x_k = Ax_{k-1} + Bu_{k-1} + w_{k-1}$

系统状态 $X = [x,y,w,h,dx,dy]$

状态转移矩阵 $A = \begin{pmatrix} 1 & 0 & 0 & 0 & 1 & 0 \\ 0 & 1 & 0 & 0 & 0 & 1 \\ 0 & 0 & 1 & 0 & 0 & 0 \\ 0 & 0 & 0 & 1 & 0 & 0 \\ 0 & 0 & 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 0 & 0 & 1 \\ \end{pmatrix}$

x: box中心y坐标

y: box中心y坐标

w: box宽

h: box 高

dx: 中心点x坐标变化量 (速度)  $x_{t} - x_{t-1}$

dy：中心点y坐标变化量(速度) $y_{t} - y_{t-1}$

$AX$的结果，即$x_{t+1} = x_{t-1} + dx_{t-1}$

B: 控制输入矩阵 ， 直接为零矩阵，没有控制外力

$w_{k-1}$: 过程噪声，不可测量，直接认为成高斯分布的噪声 分布概率为 $p(w) - N(0,Q)$, $u = 0, \sigma^{2} = Q $表示方差，*Q* 表示高斯分布的方差，它控制了分布的宽度。如果 *Q* 较小，分布将非常窄，表明数据点紧密地围绕均值0分布；如果 *Q* 较大，分布将较宽，表明数据点在均值0周围有较大的离散性。*μ*=0，即分布的中心位于原点

## 观测建模

观测方程 : $z_k = Hx_{k} + v_k$

t时刻的最优估计值与t+1时刻所有框，IOU最大的为t+1时刻的观测值

状态观测矩阵:$H = \begin{pmatrix} 1 & 0 & 0 & 0 & 0 & 0 \\ 0 & 1 & 0 & 0 & 0 & 0 \\ 0 & 0 & 1 & 0 & 0 & 0 \\ 0 & 0 & 0 & 1 & 0 & 0 \\ 0 & 0 & 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 0 & 0 & 1 \\ \end{pmatrix}$

$v_k$：表示观测过程中的噪声 ， $p(v) - N(0,R)$

卡尔曼滤波在图像目标追踪的应用

# 802.11协议与控制帧介绍

一些缩写：

- IBSS（Independent Basic Service Set）独立基本服务集
- BSSID（Basic Service Set Identifier）基本服务集标识符（为AP的MAC地址）
- DA（Destination Address）目的地址
- SA（Sender Address）源地址
- RA（Receiver Address）接收端地址
- TA（Transmission Address）发送端地址
- WDS（Wireless Distribution System）无线分布式系统

通用帧格式

![image-20220522170350421.png](/static/img/835d5b527f212455c565a688aa23b9c4.image-20220522170350421.webp)





其中 address1 是接收端 48bit mac地址， address2 是发送端。

最重要的就是头部的帧控制序列

## 帧开头字段

![image-20220522170816604.png](/static/img/30039546544141bfb089c6d8d2e17b00.image-20220522170816604.webp)


![v2-fb1ba1c10ae01f655f329e97f18124c4_720w.jpg](/static/img/520c68fcb2a15942a15ba4bfad7dab8d.v2-fb1ba1c10ae01f655f329e97f18124c4_720w.webp)


![v2-b76594d269316082742e6928a7ff5403_720w.jpg](/static/img/49d8ef53906b874e1b1d209dbd8ad086.v2-b76594d269316082742e6928a7ff5403_720w.webp)


在图中我们接下来要用到的就是deauth攻击，其中发送的帧的控制序列当中 类型和子类型对应便是00 1100

在网络攻击当中，我们不需要关心MAC帧当中的数据帧，而是MAC Header.

一般可以将MAC帧划分为控制帧，管理帧和数据帧。

**Type（类型）**：用以区分帧类型

- 管理帧的Type值为00
- 控制帧的Type值为01
- 数据帧的Type值为10

**To DS 与From DS** ：分别表示无线链路向无线工作站（如AP）发送的帧和无线工作站向无线链路发送的帧。这两位用于表示来源或目的地是否为分布式系统（distribution system，DS），地址字段也会受到这两个位的影响。

**Retry（重试）**：有时候可能需要重传帧。任何重传的帧会将此bit 设定为1，以协助接收端剔除重复的帧。

**Power Management（电源管理）**：此bit 用来指示、完成当前的帧交换过程后，发送端的电源管理状态。
为1表示STA处于Power_save模式，为0表示STA处于active模式。

**More Data（尚有数据）**：More Data bit 只用于管理数据帧，在控制帧中此bit 必然为0。

**Protected Frame（受保护帧）**：为1表示帧体部分包含加密处理过的数据，为0则表示没有进行加密处理。

**Order（次序）**：帧与帧片段可依序传送，不过发送端与接收端的MAC必须付出额外的代价，对帧片段进行严格编号。一旦进行“严格依序”传送，此bit被设定为1。

## 帧剩余部分分析

**Duration（持续时间）**： 位用来记载网络分配矢量NAV得值。访问介质时间限制是由NAV所指定。当第15 个bit被设定为0时，Duration/ID位就会被用来设定NAV。此数值代表目前所进行的传输预计使用介质多少微秒。工作站必须监视所收到的任何帧头，并据以更新NAV。



![image-20220522173650131.png](/static/img/a83dd9fa4db00d7424c5f65fe0fd7a24.image-20220522173650131.webp)


**Seq-Ctl（顺序控制位）**： 此位占16bit位，用来重组帧片段以及丢弃重复帧。它由4个bit的fragment number（片段编码）位以及12个bit的sequence number（顺序编号）位所组成。

​	**fragment number**（片段编号）在上层封包被切割处理时使用，第一个片段的编号为0。其后每个片段依序累加1，方便帧进行重组。所有帧片段都会具有相同的顺序编号，如果是重传帧，则顺序编号不会有任何改变。

​	**sequence number**（顺序编号）位的作用，相当于已传帧的计数器取4096 的模（modulo）。此计数器由0 起算，MAC 每处理一个上层封包就会累加1。

![image-20220522173911960.png](/static/img/375068482dd9159eab2d3ebaf1a018b8.image-20220522173911960.webp)



**管理帧**是网络攻击的核心，其主要服务于扫描、认证和连接的过程。Beacon(信标)帧也属于管理帧。管理帧如下图所示：



![image-20220522172009479.png](/static/img/3fc52dcc6625881c53337b60bb4e85fb.image-20220522172009479.webp)


管理帧的类型：

```
Association Request(关联请求)
Association Response (关联响应)
Reassociation Request(重关联请求)
Reassociation Response(重关联响应)
Probe Request(探测请求)
Probe Response(探测响应)
Beacon(信标帧)
ATIM(通知传输指示信息)
Disassociation(解除关联)
Authentication(身份验证)
Deauthentication(解除身份验证)
```



## 常见的一些无线网络攻击工具：

aircrack-ng、fluxion、wifiphisher、driftnet、ettercap、mitmf

注意一下 ：信息系统安全三要素CIA（完整性、保密性、可用性）

### 攻击方式：

**Deauth（认证攻击）**：向选中的wifi接入点的客户端发送认证帧和解离帧，通过deauth的方式指定wifi中断，如果第一个扫描网络那里没有勾选客户端的话，在攻击这里，deauth发送的报文将作为广播的形式发送。

**beacon（洪水攻击）apfake**：克隆出的垃圾wifi接入点具有与所选的wifi接入点相似SSID的信标帧，上面wifi中断后，克隆出大量相似的信标帧

**radom**：列出与列表中所有的SSID相似的垃圾信标帧

**probe-request**：对隐藏wifi请求洪水攻击。如果某AP的SSID是隐藏的，通常手机发送的普通的probe request包是无法获取到隐藏的SSID，就像上面，有些SSID手机根本就探测不到，esp8266就能

802.11协议与控制帧介绍

### 例子：融合GPS和IMU数据的卡尔曼滤波

#### 背景

假设我们有一个移动机器人，配备了GPS和IMU（包括加速度计和陀螺仪）。GPS提供位置和速度信息，但其更新率较低（例如每秒1次）且可能受遮挡影响。IMU提供高频率的加速度和角速度数据，但存在漂移和累积误差。我们希望通过卡尔曼滤波来融合这两种传感器的数据，以获得更精确和稳定的位置信息。




#### 步骤

1. **状态定义**： 定义状态向量$\mathbf{x}$包含位置、速度和姿态（例如 $[x,y,z,v_x,v_y,v_z,θ,ϕ,ψ]$）。

2. **系统模型**： 定义状态转移方程：

   $x_{k+1}=F_kx_k+B_ku_k+w_k$

   其中 $\mathbf{F}_k $是状态转移矩阵，$\mathbf{B}_k$ 是控制输入矩阵,通常就是0矩阵，$\mathbf{u}_k$ 是控制输入，一般也是无，$\mathbf{w}_k$ 是过程噪声协方差矩阵。

3. **测量模型**： 定义观测方程：

   $\mathbf{z}_k = \mathbf{H}_k \mathbf{x}_k + \mathbf{v}_k$

   其中 $\mathbf{H}_k$ 是观测矩阵，$\mathbf{v}_k$ 是测量噪声。

4. **初始化**： 设置初始状态估计$\mathbf{x}_0$ 和初始协方差矩阵 $\mathbf{P}_0$。

5. **卡尔曼滤波循环**： 对于每个时间步 k 执行以下步骤：

   * **预测**： 预测下一时刻的状态和协方差矩阵：

     $\mathbf{\hat{x}}_{k|k-1} = \mathbf{F}_{k-1} \mathbf{\hat{x}}_{k-1} + \mathbf{B}_{k-1} \mathbf{u}_{k-1}$

     $\mathbf{P}_{k|k-1} = \mathbf{F}_{k-1} \mathbf{P}_{k-1} \mathbf{F}_{k-1}^T + \mathbf{Q}_{k-1}$

   * **更新**： 结合新的测量数据更新状态估计和协方差矩阵：

     $\mathbf{K}_k = \mathbf{P}_{k|k-1} \mathbf{H}_k^T (\mathbf{H}_k \mathbf{P}_{k|k-1} \mathbf{H}_k^T + \mathbf{R}_k)^{-1}$

     $\mathbf{\hat{x}}_{k|k} = \mathbf{\hat{x}}_{k|k-1} + \mathbf{K}_k (\mathbf{z}_k - \mathbf{H}_k \mathbf{\hat{x}}_{k|k-1})$

     $\mathbf{P}_{k|k} = (\mathbf{I} - \mathbf{K}_k \mathbf{H}_k) \mathbf{P}_{k|k-1}$

   其中，$\mathbf{Q}_{k-1}$ 是过程噪声协方差矩阵，$\mathbf{R}_k$ 是测量噪声协方差矩阵，$\mathbf{K}_k$ 是卡尔曼增益。

#### 示例实现

假设机器人以固定时间步长 $\Delta t$运行。为了简化，我们仅考虑二维平面上的位置和速度，状态向量为 [][x, y, v_x, v_y]$[x,y,v_x,v_y]$。

1. **状态定义**：

   $\mathbf{x}_k = \begin{bmatrix} x_k \\ y_k \\ v_{xk} \\ v_{yk} \end{bmatrix}$

2. **状态转移矩阵**：

   $\mathbf{F} = \begin{bmatrix} 1 & 0 & \Delta t & 0 \\ 0 & 1 & 0 & \Delta t \\ 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 1 \end{bmatrix}$

3. **观测矩阵（GPS测量位置）**：

   $\mathbf{H}_{\text{GPS}} = \begin{bmatrix} 1 & 0 & 0 & 0 \\ 0 & 1 & 0 & 0 \end{bmatrix}$

   观测矩阵 $\mathbf{H}$的作用是将状态向量映射到测量向量。**由于测量向量只有位置信息，观测矩阵只需要提取状态向量中的位置部分**$[x,y]$。

4. **过程噪声和测量噪声**： 设过程噪声协方差矩阵$\mathbf{Q}$ 和测量噪声协方差矩阵 $\mathbf{R}_{\text{GPS}}$为已知。

5. **初始化**：

   $\mathbf{\hat{x}}_0 = \begin{bmatrix} x_0 \\ y_0 \\ v_{x_0} \\ v_{y_0} \end{bmatrix}, \quad \mathbf{P}_0 = \mathbf{I} \text{（初始协方差矩阵）}$



#### 对应的代码

```python
import numpy as np

# 定义初始状态和协方差矩阵
x_hat = np.array([0, 0, 0, 0])  # 初始状态 [x, y, v_x, v_y]
P = np.eye(4)  # 初始协方差矩阵

# 定义状态转移矩阵
dt = 1  # 时间步长
F = np.array([[1, 0, dt, 0],
              [0, 1, 0, dt],
              [0, 0, 1, 0],
              [0, 0, 0, 1]])

# 定义观测矩阵
H_GPS = np.array([[1, 0, 0, 0],
                  [0, 1, 0, 0]])

# 定义过程噪声协方差矩阵和测量噪声协方差矩阵
Q = np.eye(4) * 0.1
R_GPS = np.eye(2) * 5

# --------- 以下代码就是计算一次最优估计的过程------------
# 预测步骤
x_hat_prior = F @ x_hat
P_prior = F @ P @ F.T + Q

# 假设有一个新的GPS测量值 [x_GPS, y_GPS]
z_GPS = np.array([5, 5])

# 计算卡尔曼增益
K = P_prior @ H_GPS.T @ np.linalg.inv(H_GPS @ P_prior @ H_GPS.T + R_GPS)

# 更新步骤
x_hat = x_hat_prior + K @ (z_GPS - H_GPS @ x_hat_prior)
P = (np.eye(4) - K @ H_GPS) @ P_prior

print("更新后的状态估计：", x_hat)
print("更新后的协方差矩阵：", P)

# 每次有观测值，将观测值输入到卡尔曼的五个方程组当中得到最优估计，多组数据就是循环，案例代码未循环，只写了一次采样更新过程。

```



#### 拓展观测矩阵

你提到的通过两次采样间接计算速度的方法是一个合理的思路。这种方法确实可以利用GPS测量的位置数据来计算速度，并将其纳入卡尔曼滤波的观测模型中。让我们详细讨论这种情况。

### 使用GPS计算速度
假设我们通过连续的GPS位置测量来计算速度。我们可以用以下公式计算速度：
$[ v_x \approx \frac{x_{\text{GPS}}(k) - x_{\text{GPS}}(k-1)}{\Delta t} ]$
$[ v_y \approx \frac{y_{\text{GPS}}(k) - y_{\text{GPS}}(k-1)}{\Delta t} ]$
其中，$(x_{\text{GPS}}(k))$ 和 $(y_{\text{GPS}}(k))$ 是时刻 $k$ 的GPS位置测量值，$\Delta t$ 是两个GPS测量之间的时间间隔。

### 拓展观测矩阵
在这种情况下，我们可以扩展观测向量包含速度信息，并使用一个 $4 \times 4$ 的观测矩阵。具体步骤如下：

1. **状态向量**：
   仍然定义为 $(\mathbf{x} = [x, y, v_x, v_y]^T)$，维度为 4。

2. **测量向量**：
   包含位置和速度信息，定义为 $\mathbf{z}_{\text{GPS}} = [x_{\text{GPS}}, y_{\text{GPS}}, v_{x_{\text{GPS}}}, v_{y_{\text{GPS}}}]$，维度为 4。

3. **观测矩阵**：
   在这种情况下，观测矩阵是 $4 \times 4$ 的单位矩阵：
   $\mathbf{H}_{\text{GPS}} = \begin{bmatrix}
   1 & 0 & 0 & 0 \\
   0 & 1 & 0 & 0 \\
   0 & 0 & 1 & 0 \\
   0 & 0 & 0 & 1
   \end{bmatrix}$
   这个矩阵表明测量值直接对应状态向量的各个分量。

### 卡尔曼滤波实现

假设我们有一个方法来计算速度测量值（如上所述），我们可以将其纳入卡尔曼滤波的观测模型中。

#### 示例代码：

```python
import numpy as np

# 定义初始状态和协方差矩阵
x_hat = np.array([0, 0, 0, 0])  # 初始状态 [x, y, v_x, v_y]
P = np.eye(4)  # 初始协方差矩阵

# 定义状态转移矩阵
dt = 1  # 时间步长
F = np.array([[1, 0, dt, 0],
              [0, 1, 0, dt],
              [0, 0, 1, 0],
              [0, 0, 0, 1]])

# 定义观测矩阵
H_GPS = np.eye(4)  # 4x4 单位矩阵

# 定义过程噪声协方差矩阵和测量噪声协方差矩阵
Q = np.eye(4) * 0.1
R_GPS = np.eye(4) * 5

# 预测步骤
x_hat_prior = F @ x_hat
P_prior = F @ P @ F.T + Q

# 假设有一个新的GPS测量值 [x_GPS, y_GPS, v_x_GPS, v_y_GPS]
z_GPS = np.array([5, 5, 1, 1])  # 位置和速度测量值

# 计算卡尔曼增益
K = P_prior @ H_GPS.T @ np.linalg.inv(H_GPS @ P_prior @ H_GPS.T + R_GPS)

# 更新步骤
x_hat = x_hat_prior + K @ (z_GPS - H_GPS @ x_hat_prior)
P = (np.eye(4) - K @ H_GPS) @ P_prior

print("更新后的状态估计：", x_hat)
print("更新后的协方差矩阵：", P)
```

### 总结

采用 $4 \times 4$ 的观测矩阵是可行的，前提是测量向量包含了位置和通过位置计算得出的速度信息。这种方法能够充分利用GPS数据，提高速度估计的精度。在实际应用中，选择何种观测矩阵取决于具体的测量数据和系统要求。如果能实时计算和获取速度测量值，扩展观测矩阵并使用包含速度信息的测量向量确实是一种有效的方案。



在使用卡尔曼滤波进行数据融合时，是否拓展观测矩阵（即是否包含速度信息）会带来不同的优势和区别。具体来说，主要差异体现在测量精度、计算复杂度和适用场景等方面。

### 拓展观测矩阵的优势和区别

1. **精度提高**：
   - **优势**：包含速度信息的测量向量可以显著提高速度估计的精度。通过直接观测速度，滤波器能够更快速和准确地调整对速度的估计，从而提高整体状态估计的精度。
   - **区别**：未拓展观测矩阵仅包含位置信息，需要通过位置的差分来间接计算速度，这种方法可能会受到位置测量误差和采样间隔不一致的影响，从而导致速度估计不够准确。

2. **滤波器响应速度**：
   - **优势**：拓展观测矩阵使得滤波器可以更迅速地响应速度变化，因为速度信息是直接测量而不是通过间接计算得出。这在快速运动或加速度变化较大的情况下尤为重要。
   - **区别**：不拓展观测矩阵时，速度估计需要依赖于位置变化，可能会滞后于实际速度的变化。

3. **传感器数据融合**：
   - **优势**：如果传感器能够提供速度信息（例如一些高精度的GPS模块或其他测速传感器），直接将速度信息纳入观测向量可以更充分地利用这些传感器的数据，提高滤波器的性能。
   - **区别**：如果只有位置传感器（如普通GPS），则需要通过位置差分计算速度，传感器数据的利用率较低。

4. **计算复杂度**：
   - **区别**：拓展观测矩阵会增加观测向量和观测噪声矩阵的维度，增加卡尔曼增益计算的复杂度。但是对于现代计算设备来说，这种增加的计算量通常是可以接受的。

5. **系统复杂性**：
   - **区别**：拓展观测矩阵需要额外处理速度信息，增加了系统的复杂性，特别是在传感器数据预处理和滤波器设计上。

### 不拓展观测矩阵的优势和区别

1. **系统简单性**：
   - **优势**：系统设计和实现相对简单，因为只需要处理位置数据。这对于资源有限的系统（如小型嵌入式系统）尤其重要。
   - **区别**：不拓展观测矩阵时，系统只需处理位置数据，传感器数据处理和滤波器设计相对简单。

2. **适用场景**：
   - **优势**：在速度变化不剧烈或对速度估计精度要求不高的场景下，不拓展观测矩阵的方案可能足够满足需求，且能简化系统设计和实现。
   - **区别**：对于速度变化剧烈的场景，不拓展观测矩阵可能无法提供足够的精度和响应速度。

### 总结

- **拓展观测矩阵**：通过包含速度信息，能够提高估计精度和响应速度，更好地利用传感器数据，适用于对速度估计精度要求高的应用场景，但会增加系统复杂性和计算量。
- **不拓展观测矩阵**：系统实现简单，计算量较小，适用于对速度估计精度要求不高的应用场景，但在快速运动或加速度变化较大的情况下可能表现不佳。

具体选择哪种方案取决于实际应用的需求、传感器的能力以及计算资源的限制。在实际系统中，这种选择通常是一个权衡过程，需根据具体情况进行设计和调整。

卡尔曼滤波教程

# Hello World

这是本网站的第一篇博客，用于测试



## 公式测试
$F = ma, a = \frac{F}{a}$

## 图像测试

![wallhaven-1pmoy3_2560x1440.png](/static/img/45b1bedb87a7e13a161a54f67d9f8a2e.wallhaven-1pmoy3_2560x1440.webp)

Hello World

Welcome to my tech blog! Here, I document my coding journey and explore various technologies, focusing on practical solutions and streamlined techniques. From programming insights to tool recommendations, I share hands-on experiences that help sharpen your skills. Let’s learn and grow together!