https://pyside.pythonprogramminghelp.com/3-outrageous-kalman-gain-derivation/