Возможно, вы пытаетесь использовать обнаруженные координаты автомобиля, чтобы определить, где находится дорога, когда нет информации о дорожной карте. Пытаетесь создать дорогу, когда дороги нет, верно?
Фильтр Калмана предназначен для сглаживания значений, полученных от датчика. Когда датчик обнаруживает автомобиль, датчик может не дать фактическое положение автомобиля. Он будет содержать некоторые ошибки в координатах x и y.
Вы должны передать эти значения x, y в фильтр Калмана , пока данные поступают от датчика . Или, по крайней мере, в правильном порядке, который был получен от датчика.
Фильтр Калмана выдаст вам оценочные значения (сглаженные значения) положений x и y, которые подскажут вам приблизительно правильное положение автомобиля.
Предполагая, что автомобиль едет в середине дороги, эти оценочные (отфильтрованные) значения x, y являются тем, что вы можете принять за середину дороги.
Я видел твой вопрос только сейчас. Я знаю, что уже поздно, но надеюсь, что это помогло?