# Is my Kalman Filter model reasonable? Using for a 3 wheels rover platform

Background: I'm building a 3 omniwheel rover platform that looks something like this: It has 1 IMU sensors on each of the wheels (3 in total). So in theory, I can get gyroscope and accelerometer data from each of the wheels and use that information to calculate the current speed of the wheels.

So let's say this is my model:

$$x_k = \begin{bmatrix} v_k\\a_k \end{bmatrix} = Ax_{k-1} + Bu_{k-1}$$

where: $$A = \begin{bmatrix} 0&\Delta t \\ 0&0 \end{bmatrix}$$ and $$B = \begin{bmatrix} 1&0\\0&0 \end{bmatrix}$$ and $$u_{k-1} = \begin{bmatrix} u_{velocity}\\0 \end{bmatrix}$$

I can "control" the speed of each wheels, but of course that's not accurate. But I cannot control the acceleration of each wheels, so I let $$u_{acceleration}$$ in matrix $$u_{k-1}$$ to be 0.

$$z_k = \begin{bmatrix} v_{measure}\\a_{measure} \end{bmatrix} = H\begin{bmatrix} \omega_{measure}\\a_{measure} \end{bmatrix}$$ with $$H = \begin{bmatrix} R&0\\0&1 \end{bmatrix}$$

$$\omega_{measure}$$ is the data from gyroscope and $$a_{measure}$$ is the data from accelerometer (of each wheels).

Predict:

$$x_k = Ax_{k-1} + Bu_{k-1}$$

$$P_k = AP_{k-1}A^T + Q$$

I haven't really make up my mind about what Q should be.

Update:

$$K_k = P_kH^t(HP_kH^T + R)^{-1}$$

$$x_k = x_k + K_k(z_k - Hx_k)$$

$$P_k = (I - K_kH)P_k$$