Kalman Filter for (x1,y1),(x2,y2) pair implemented