Kalman world state merged with local world state

Signed-off-by: eldrad <nikofinas@gmail.com>