Добрый день прошу помощи в следующем вопросе.
Робот едет по земле и получает информацию с видеокамеры. В поле зрения видеокамеры попадают яркие неподвижыне маяки. Мы с помощью этой видеокамеры должны отслеживать траекторию смещения этих маяков на ходу.
Так как земля не ровная, то имеют место тряска и раскачивание робота. Из-за этого изображение с видеокамеры также дергается и раскачивается.
Я сначала думал фильтровать это фильтром калмана, но пока что не разобрался в нем. Да и кажется, что фильтр калмана слишком избыточный для моей задачи.
Думаю использовать простой рекурскивный фильтр второго, четвертого, или большего порядка.
Но не могу понять какие данные мне нужно фильтровать. Координату или скорость. Помогите внести ясность.
Робот может развивать относительно большую скорость, но не может развивать большое ускорение. Следовательно, если маяк на изображении резко меняет траекторию, то значит это неровности. То есть нам нужно отфильтровать большие ускорения. Но с камеры мы получаем координаты. Если фильтровать частотным фильтром координаты, то это сгладит раскачку, но когда робот разгонится, данные с выхода фильтра станут сильно отставать от реальных. Это так???
Я склоняюсь к тому, чтобы по каждому кадру с камеры сначала высчитывать смещение маяка, и получать таким образом скорость. А потом уже загонять показание скорости в рекурсивный фильтр, чтобы отсеить большые ускорения.
Скажите, в правильном ли напрявлении я мыслю...???