I am using Kalman Filter for my project. I have two state-space vectors for the ego-vehicle xE and road geometry xR with a control input vector u. I have also the measuremen