← Back to the chapter · Next detail →

Technical detail · IoT Mathematics: Fusion and Sampling Decisions

State prediction with matrices

Step 1: Model the System State

From Section C.2 (Matrices), define state vector as position and velocity:

x⃗=[pxpyvxvy]\vec{x} = \begin{bmatrix} p_x \\ p_y \\ v_x \\ v_y \end{bmatrix}

Where:

Step 2: State Transition (Prediction)

From Section A.1 (Derivatives) and A.2 (Integrals), position changes via velocity integration:

pnew=pold+v⋅Δtp_{new} = p_{old} + v \cdot \Delta t

In matrix form (Section C.3):

x⃗k+1=F⋅x⃗k+w⃗k\vec{x}_{k+1} = F \cdot \vec{x}_k + \vec{w}_k

F=[10Δt0010Δt00100001]F = \begin{bmatrix} 1 & 0 & \Delta t & 0 \\ 0 & 1 & 0 & \Delta t \\ 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 1 \end{bmatrix}

Example: Current state is position (100m, 200m), velocity (15 m/s, 0 m/s), Δt=0.1s\Delta t = 0.1s

[pxpyvxvy]new=[100.100100.100100001][100200150]=[101.5200150]\begin{bmatrix} p_x \\ p_y \\ v_x \\ v_y \end{bmatrix}_{new} = \begin{bmatrix} 1 & 0 & 0.1 & 0 \\ 0 & 1 & 0 & 0.1 \\ 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 1 \end{bmatrix} \begin{bmatrix} 100 \\ 200 \\ 15 \\ 0 \end{bmatrix} = \begin{bmatrix} 101.5 \\ 200 \\ 15 \\ 0 \end{bmatrix}

Predicted position: (101.5m, 200m) after 0.1 seconds.

← Back to the chapter · Next detail →