[Kalman] Added matrix vizualisation
[Kalman] Better rand init matrix + better display