Устройство определения скорости

Устройство определения скорости

Иллюстрации

Показать все

Реферат

Область техники, к которой относится изобретение

Изобретение относится к устройству определения скорости, способу определения скорости и компьютерной программе для определения скорости объекта. Кроме того, изобретение относится к объекту, содержащему упомянутое устройство определения скорости.

Уровень техники

В патенте США № 6233045 B1 раскрыт интерференционный датчик на основе самосмешения для определения скорости объекта. Датчик на основе самосмешения содержит лазер, излучающий лазерный луч, направляемый, например, на землю. Лазерный луч отражается землей, и отраженный лазерный луч поступает в лазерный резонатор. Отраженный лазерный луч, поступающий в лазерный резонатор, интерферирует с находящимся там электромагнитным полем. Возникает интерференция, так называемая «интерференция самосмешения» в виде интенсивных изменений электромагнитного поля в резонаторе. Основная частота интерференционного сигнала самосмешения является доплеровской частотой, которую используют для определения скорости объекта.

Такое определение скорости может искажаться, например, агрессивными условиями окружающей среды и тяжелыми дорожными условиями, если объектом является, например, транспортное средство. Лазерный луч также может временно блокироваться рассеивающими элементами между лазером и поверхностью дороги, то есть землей, либо сигнал обратной связи самосмешения, то есть отраженный лазерный луч может стать слишком слабым из-за непомерно большой расфокусировки или присутствия таких блокирующих объектов, как листья или другой мусор, который может подняться над землей из-за воздушной турбулентности. Вследствие этого может снизиться качество определения скорости.

Раскрытие изобретения

Целью изобретения является обеспечение устройства определения скорости, способа определения скорости и компьютерной программы для определения скорости объекта, которые позволяют повысить качество определения скорости. Еще одной целью настоящего изобретения является обеспечение соответствующего объекта, содержащего устройство определения скорости.

Согласно первому аспекту настоящего изобретения предложено устройство определения скорости для определения скорости объекта, где устройство определения скорости содержит:

блок измерения доплеровской частоты для измерения доплеровской частоты по меньшей мере для трех разных направлений измерения частоты,

блок вычисления доплеровской частоты для вычисления доплеровской частоты для одного направления вычисляемой частоты по меньшей мере из трех разных направлений вычисляемой частоты в зависимости от доплеровских частот, измеренных по меньшей мере для двух дополнительных направлений частоты из по меньшей мере трех разных направлений частоты,

блок определения скорости для определения скорости объекта в зависимости от вычисленной доплеровской частоты, которая была вычислена для упомянутого направления вычисляемой частоты и доплеровских частот по меньшей мере для двух дополнительных направлений частоты.

Поскольку блок вычисления доплеровской частоты приспособлен для вычисления доплеровской частоты для одного направления частоты из по меньшей мере трех разных направлений частоты в зависимости от доплеровских частот, измеренных по меньшей мере для двух дополнительных направлений частоты из по меньшей мере трех разных направлений частоты, надежную доплеровскую частоту можно определить также в упомянутом направлении вычисляемой частоты даже в том случае, если измерение доплеровской частоты в этом направлении вычисляемой частоты искажено. В частности, блок определения скорости может определить скорость объекта даже в том случае, если измерение доплеровской частоты в направлении вычисляемой частоты искажено путем использования вычисленной доплеровской частоты и доплеровских частот по меньшей мере для двух дополнительных направлений частоты, которые отличаются от упомянутого направления вычисляемой частоты. Это позволяет повысить качество определения скорости объекта.

Объектом предпочтительно является здесь транспортное средство.

Термин «направление частоты» - это направление, в котором измеряется доплеровская частота.

Блок определения скорости предпочтительно приспособлен для определения скорости в трех направлениях в целях определения трехмерной скорости. Объект движется предпочтительно по направлению вперед в горизонтальной плоскости, причем три направления скорости предпочтительно включают в себя направление вперед, поперечное направление, которое также предпочтительно находится в горизонтальной плоскости и которое предпочтительно перпендикулярно направлению вперед, и вертикальное направление.

Доплеровские частоты, измеряемые в разных направлениях частоты, предпочтительно измерять независимо друг от друга, то есть предпочтительно, чтобы на измерение доплеровской частоты в первом направлении частоты не влияло измерение доплеровской частоты во втором направлении частоты, отличающемся от первого направления частоты. Блок измерения доплеровской частоты приспособлен для измерения отдельной доплеровской частоты в каждом направлении частоты.

Предпочтительно, чтобы блок вычисления доплеровской частоты был приспособлен не только для вычисления абсолютного значения доплеровской частоты, но также и знака доплеровской частоты, где блок определения скорости может быть адаптирован не только для определения абсолютного значения скорости, но также и направления скорости.

Предпочтительно, чтобы блок определения скорости был адаптирован для определения скорости в трех направлениях скорости для определения трехмерной скорости, где эти три направления скорости отличаются по меньшей мере от трех направлений частоты, так что скорость в одном из направлений скорости можно было бы определить комбинацией доплеровских частот, измеренных по меньшей мере для трех направлений частоты. Кроме того, предпочтительно, чтобы блок вычисления доплеровской частоты был приспособлен для вычисления доплеровской частоты для направления вычисляемой частоты в зависимости от линейной комбинации доплеровских частот, измеренных по меньшей мере для двух дополнительных направлений частоты. Кроме того предпочтительно, чтобы блок вычисления доплеровской частоты был приспособлен для вычисления доплеровской частоты для упомянутого направления вычисляемой частоты в зависимости от отрицательной суммы доплеровских частот, измеренных по меньшей мере для двух других направлений частоты. Это позволяет вычислить доплеровскую частоту для данного направления вычисляемой частоты при низких вычислительных затратах.

К тому же предпочтительно, чтобы устройство определения скорости, кроме того, содержало блок определения соблюдения условия точности для определения того, удовлетворяется ли условие точности, показывающее точность вычисления, выполненного блоком вычисления доплеровской частоты, где блок вычисления доплеровской частоты приспособлен для вычисления доплеровской частоты для направления вычисляемой частоты, если блок определения соблюдения точности определил, что условие точности соблюдено. Кроме того предпочтительно, чтобы блок определения скорости был приспособлен для определения скорости в трех направлениях скорости в целях определения трехмерной скорости, где устройство определения скорости содержит блок хранения для сохранения скоростей, которые были определены в течение времени в том или ином направлении скорости, где блок определения соблюдения условия точности приспособлен для определения того, соблюдено ли условие точности, указывающее точность вычисления, выполненного блоком вычисления доплеровской частоты, в зависимости от сохраненных скоростей. Кроме того предпочтительно, чтобы блок определения соблюдения условия точности был приспособлен для определения того, соблюдается ли условие точности, указывающее точность вычисления, выполненного блоком вычисления доплеровской частоты, путем вычисления среднего значения сохраненных скоростей и сравнения этого среднего значения с заранее определенным пороговым значением. Перед вычислением среднего значения предпочтительно выполнить низкочастотную фильтрацию сохраненных скоростей. Это обеспечивает определение только доплеровской частоты для направления вычисляемой частоты, если вычисление является достаточно точным, что дополнительно повышает качество определения скорости.

Указанное, заранее определенное пороговое значение можно определить, например, посредством калибровочных измерений, в ходе которых вычисляют упомянутое среднее значение, когда известно, достаточна или нет точность определения скорости.

Линейная комбинация доплеровских частот, измеренных по меньшей мере для двух дополнительных направлений частоты, для вычисления доплеровской частоты для направления вычисляемой частоты предпочтительно основана на одном допущении, касающемся одной или нескольких скоростей. В частности, указанная линейная комбинация может быть основана на предположении, что объект в основном перемещается в горизонтальной плоскости x-y, то есть что скорость в вертикальном направлении равна нулю. Блок хранения предпочтительно приспособлен для сохранения скоростей, которые были определены в течение некоторого времени в направлении скорости, которое относится к упомянутому допущению. В частности, блок хранения может быть приспособлен к сохранению скоростей, которые соответствуют направлению вертикальной скорости. Если объектом является транспортное средство, которое, как принято считать, перемещается в основном только по земле, то есть в горизонтальной плоскости, то можно допустить, что скорость в вертикальном направлении фактически равна нулю. Следовательно, доплеровскую частоту в направлении вычисляемой частоты можно вычислить, используя уравнение, которое описывает линейную комбинацию доплеровских частот, измеренных в других направлениях частоты, и которое основано на допущении равенства нулю скорости в вертикальном направлении. Точность вычисления доплеровской частоты в направлении вычисляемой частоты зависит тогда от степени подобия между уже сохраненными скоростями, которые были измерены в направлении вертикальной скорости и равны нулю. В этом примере можно определить, соблюдено ли условие точности, путем сравнения средней из сохраненных скоростей, которые были измерены для направления вертикальной скорости, с пороговым значением, близким к нулю.

Кроме того, предпочтительно, чтобы блок вычисления доплеровской частоты был приспособлен к определению ошибочного направления частоты, в котором измерение доплеровской частоты связано с ошибками, и вычисления доплеровской частоты для направления вычисляемой частоты, являющегося ошибочным направлением частоты, в зависимости от доплеровских частот, измеренных по меньшей мере для двух дополнительных направлений частоты из по меньшей мере трех разных направлений частоты. Например, блок вычисления доплеровской частоты может быть приспособлен для сравнения отношения сигнал-шум, например, интерференционного сигнала самосмешения с заранее определенным пороговым значением, чтобы определить, является ли измерение доплеровской частоты ошибочным. Для определения ошибочности измерения доплеровской частоты можно также использовать другие способы. Например, можно сравнить форму частотного пика, например, интерференционного сигнала самосмешения с расчетным частотным пиком, причем, если это сравнение дает отклонение, превышающее заранее определенное пороговое значение, то можно считать, что соответствующее направление частоты является ошибочным. Либо можно определить, приводит ли доплеровская частота, измеренная в конкретном направлении частоты, к значению скорости в этом направлении частоты, которое находится в заранее определенном расчетном диапазоне скорости, причем, если эта скорость не находится в указанном заранее определенном расчетном диапазоне скорости, то можно считать, что измерение в этом конкретном направлении частоты является ошибочным. Кроме того, можно вычислить ускорение в этом конкретном направлении частоты на основе соответствующей измеренной доплеровской частоты, и можно определить, находится ли это ускорение в заранее определенном расчетном диапазоне ускорения, чтобы определить, является ли измерение доплеровской частоты ошибочным. Диапазон скорости и/или диапазон ускорения можно определить на основе известных возможных скоростей и/или ускорений объекта. Для определения того, является ли измерение доплеровской частоты в том или ином направлении частоты ошибочным, можно использовать калмановскую фильтрацию. Предпочтительно, чтобы блок вычисления доплеровской частоты был приспособлен для вычисления доплеровской частоты для данного направления вычисляемой частоты только в том случае, если блок вычисления доплеровской частоты определил ошибочное направление частоты, в котором измерение доплеровской частоты выявляется ошибочным, где данное направление вычисляемой частоты в этом случае является ошибочным направлением частоты. Это может гарантировать выполнение вычисления доплеровской частоты в направлении вычисляемой частоты только в том случае, если измерение доплеровской частоты в направлении вычисляемой частоты действительно является ошибочным, что позволяет избежать ненужных вычислений.

Кроме того, предпочтительно, чтобы блок измерения доплеровской частоты содержал по меньшей мере три лазера, направленных по меньшей мере по трем разным направлениям частоты для измерения доплеровской частоты по меньшей мере в трех разных направлениях частоты.

Кроме того, предпочтительно, чтобы блок измерения доплеровской частоты был приспособлен для использования способа измерения доплеровской частоты на основе интерференции самосмешения по меньшей мере в трех разных направлениях частоты. При использовании лазеров и интерференции самосмешения доплеровскую частоту можно определить с повышенной точностью.

Поскольку блок измерения доплеровской частоты предпочтительно содержит по меньшей мере три лазера, направленных по меньшей мере в трех разных направлениях частоты, эти направления частоты также можно рассматривать как направления лазерного луча.

Кроме того, предпочтительно, чтобы блок определения доплеровской частоты содержал более трех лазеров, где по меньшей мере два лазера направлены в одном и том же направлении частоты. Поскольку по меньшей мере два лазера направлены в одном и том же направлении частоты, доплеровская частота измеряется с избыточностью в указанном одном и том же направлении частоты. Таким образом, даже в том случае, если измерение доплеровской частоты одним их этих двух лазеров подвергается искажению, доплеровскую частоту все же можно будет измерить с высоким уровнем качества благодаря использованию другого лазера из по меньшей двух лазеров, направленных в одном и том же направлении частоты. Это может дополнительно повысить качество определения скорости объекта.

Кроме того, предпочтительно, чтобы блок определения доплеровской частоты содержал более трех лазеров, направленных в разных направлениях частоты. Поскольку блок определения доплеровской частоты содержит более трех лазеров, направленных в разных направлениях частоты, доплеровские частоты можно определить для более чем трех направлений частоты. Кроме того, поскольку более чем три лазера направлены в разных направлениях частоты, эти разные направления частоты линейно зависят друг от друга, и доплеровскую частоту, измеренную для первого направления частоты, также можно вычислить посредством линейного комбинирования доплеровских частот, измеренных для других направлений частоты. Таким образом, в этом варианте также имеет место избыточность, которую можно использовать для замены измеренной доплеровской частоты вычисленной доплеровской частотой при ошибочном измерении доплеровской частоты. Например, если вышеупомянутая доплеровская частота, которая была измерена для первого направления частоты, получена с ошибкой, то эту измеренную доплеровскую частоту можно заменить вычисленной доплеровской частотой при определении скорости.

Кроме того, предпочтительно, чтобы блок определения доплеровской частоты содержал более трех лазеров, направленных в разных направлениях частоты, где блок определения скорости приспособлен для использования первого поднабора лазеров для определения первой линейной скорости и использования второго поднабора лазеров для определения второй линейной скорости. Предпочтительно, чтобы блок определения скорости был приспособлен для определения параметра вращения, в частности, углового положения и/или угловой скорости объекта на основе определенных первой и второй линейных скоростей. В частности, блок определения скорости приспособлен для определения по меньшей мере одного из: скорости рысканья, скорости крена и скорости тангажа в качестве угловой скорости. Лазеры для формирования первого поднабора и второго поднабора можно выбирать в динамическом режиме. Первый поднабор лазеров и второй поднабор лазеров можно рассматривать в качестве двух виртуальных датчиков. Предпочтительно, чтобы блок определения скорости был приспособлен для переключения с первого поднабора лазеров на второй поднабор лазеров и обратно, так чтобы первая линейная скорость и вторая линейная скорость определялись последовательно и многократно, где угловую скорость объекта определяют на основе последовательно и многократно определенных первой и второй линейных скоростей. Поскольку первый поднабор лазеров отличается от второго поднабора лазеров, по меньшей мере одним направлением лазерного луча (то есть направлением частоты) первого поднабора лазеров отличается от любого из направлений лазерного луча второго поднабора лазеров. Таким образом, угловое перемещение объекта типа рысканья, крена или тангажа, обычно приводит к разным линейным скоростям по меньшей мере в одном из направлений скорости. Блок определения скорости может быть приспособлен для определения угловой скорости на основе этого различия.

Согласно дополнительному аспекту настоящего изобретения представлен объект, содержащий устройство определения скорости для определения скорости объекта. Объектом предпочтительно является транспортное средство, такое как автомобиль, велосипед, мотоцикл, грузовой автомобиль, поезд, корабль, лодка, самолет и т.д., либо иной подвижный объект.

Согласно дополнительному аспекту настоящего изобретения представлен способ определения скорости для определения скорости объекта, причем способ определения скорости содержит:

измерение доплеровской частоты по меньшей мере для трех разных направлений частоты,

вычисление доплеровской частоты для одного направления вычисления частоты по меньшей мере из трех разных направлений частоты в зависимости от доплеровских частот, измеренных по меньшей мере трех разных направлений частоты, так что можно надежно определить доплеровскую частоту в направлении вычисляемой частоты даже в том случае, если измерение доплеровской частоты подвергается искажению,

определение скорости объекта в зависимости от вычисленной доплеровской частоты, которая была вычислена для упомянутого направления вычисляемой частоты и доплеровских частот по меньшей мере для двух дополнительных направления частоты.

Согласно дополнительному аспекту настоящего изобретения представлена компьютерная программа определения скорости для определения скорости рассматриваемого объекта, где компьютерная программа содержит средство программного кода для инициирования выполнения устройством определения скорости, определенным в пункте 1 формулы изобретения, этапов способа определения скорости, определенного в пункте 14 формулы изобретения, при выполнении компьютерной программы определения скорости на компьютере, управляющем устройством определения скорости.

Должно быть понятно, что устройство определения скорости по п.1, объект по п.13, способ определения скорости по п.14 и компьютерная программа определения скорости по п.15 подобны и/или идентичны предпочтительным вариантам осуществления изобретения, детально определенным в зависимых пунктах формулы изобретения.

Следует понимать, что предпочтительным вариантом изобретения также может быть любая комбинация зависимых пунктов с соответствующим независимым пунктом формулы изобретения.

Краткое описание чертежей

Фиг.1 - примерное схематическое представление варианта транспортного средства, содержащего вариант устройства определения скорости для определения скорости указанного транспортного средства.

Фиг.2 - более подробное примерное схематическое представление варианта устройства определения скорости.

Фиг.3 - примерное схематическое представление варианта блока измерения доплеровской частоты, входящего в состав блока определения скорости.

Фиг.4 - примерное схематическое представление ориентации направлений частоты, в которых измеряют доплеровскую частоту, по отношению к направлениям скорости, в которых определяют скорость транспортного средства.

Фиг.5 - примерная зависимость доплеровских частот от времени.

Фиг.6 - примерная блок-схема, иллюстрирующая вариант способа определения скорости для определения скорости транспортного средства.

Фиг.7 - примерное схематическое представление дополнительного варианта блока измерения доплеровской частоты.

Фиг.8 и 9 - возможные конфигурации лазеров и направлений частоты в дополнительных вариантах блока измерения доплеровской частоты.

Осуществление изобретения

На фиг.1 в качестве примера схематически представлен объект 2, в данном варианте транспортное средство, которое содержит устройство 1 определения скорости для определения скорости транспортного средства 2. Устройство 1 измерения скорости более подробно схематически показано на фиг.2.

Устройство 1 определения скорости содержит блок 3 измерения доплеровской частоты для измерения доплеровской частоты для трех разных направлений частоты. В качестве примера блок 3 измерения доплеровской частоты более подробно показан на фиг.3.

Блок 3 измерения доплеровской частоты содержит три лазера 13, 14, 15 для создания излучения 9 в направлении земли 8 в трех разных направлениях 10, 11, 12 частоты для измерения доплеровской частоты в этих разных направлениях 10, 11, 12. Лазеры 13, 14, 15 управляются блоком 16 управления. Блок 3 измерения доплеровской частоты приспособлен для использования интерференционного способа смешения для измерения доплеровских частот в указанных трех различных направлениях 10, 11, 12 частоты. Лазерный луч, излучаемый соответствующим лазером, отражается землей 8, и отраженный луч вновь поступает в резонатор соответствующего лазера. Вновь поступающий свет лазера вызывает интерференцию самосмешения в резонаторе, создавая изменения интенсивности в резонаторе. Для измерения этих изменений интенсивности и создания соответствующего сигнала интенсивности предусмотрен встроенный фотодиод или внешний фотодиод. В другом варианте эти изменения также можно измерить путем измерения флуктуаций питающего тока или питающего напряжения соответствующего лазера. При использовании внешнего фотодиода часть лазерного света выводится, и эта выведенная часть лазерного света направляется на внешний фотодиод. Созданный сигнал интенсивности можно рассматривать как интерференционный сигнал самосмешения, а основную частоту сигнала интенсивности можно рассматривать как доплеровскую частоту. Таким образом, блок 16 управления предпочтительно приспособлен для приема трех сигналов интенсивности от фотодиодов, которые выделены для трех лазеров 13, 14, 15, и для определения из каждого из трех сигналов интенсивности, то есть из каждого из трех интерференционных сигналов самосмешения доплеровской частоты для соответствующего направления 10, 11, 12 частоты. Более подробное описание способа на основе интерференционного самосмешения можно найти в работе Xavaier Raoul и др. «A Double Laser Diode Onboard Sensor for Velocity Measurements», IEEE Transactions on Instrumentation and Measurement, том 53, №№ стр. 95-101, Февраль 2004, содержание которой включено сюда по ссылке.

Устройство 1 определения скорости содержит блок 4 вычисления доплеровской частоты для вычисления доплеровской частоты для направления вычисляемой частоты из числа трех разных направлений 10, 11, 12 частоты в зависимости от доплеровских частот, измеренных по меньшей мере для дополнительных направлений частоты из по меньшей мере трех разных направлений 10, 11, 12 частоты. Устройство 1 определения скорости, кроме того, содержит блок 5 определения скорости для определения скорости объекта 2 в зависимости от вычисленной доплеровской частоты, которая была вычислена для направления вычисляемой частоты и доплеровских частот по меньшей мере двух дополнительных направлений частоты.

Поскольку блок 4 вычисления доплеровской частоты приспособлен для вычисления доплеровской частоты для направления вычисляемой частоты из трех разных направлений 10, 11, 12 частоты в зависимости от доплеровских частот, измеренных по меньшей мере для двух дополнительных направлений частоты в трех разных направлениях 10, 11, 12 частоты, надежную доплеровскую частоту можно также определить в направлении вычисляемой частоты даже в том случае, если измерение доплеровской частоты в направлении вычисляемой частоты подвергается искажению. Таким образом, блок 5 определения скорости может определить скорость объекта 2 даже в том случае, если измерение доплеровской частоты в направлении вычисляемой частоты подвергается искажению, путем использования вычисленной доплеровской частоты и доплеровских частот, измеренных для по меньшей мере двух дополнительных направлений частоты, которые отличаются от направления вычисляемой частоты. Это повышает надежность определения скорости объекта 2.

В одном варианте блок 4 вычисления доплеровской частоты адаптирован для определения того, является ли измерение доплеровской частоты ошибочным. Если три измеренные доплеровские частоты не являются ошибочными, то эти три измеренные доплеровские частоты подают в блок 5 определения скорости для определения скорости в зависимости от этих трех измеренных доплеровских частот. Если одна из измеренных доплеровских частот является ошибочной, то блок 4 вычисления доплеровской частоты вычисляет доплеровскую частоту в зависимости от измеренных доплеровских частот, не являющихся ошибочными, причем блок 5 определения скорости определяет скорость в зависимости от откалиброванной доплеровской частоты и измеренных доплеровских частот, которые не являются ошибочными.

Например, блок вычисления доплеровской частоты может быть адаптирован для сравнения отношения сигнал-шум, например, интерференционного сигнала самосмешения с предварительно определенным пороговым значением, чтобы определить, является ли измерение доплеровской частоты ошибочным. Для определения ошибочного измерения доплеровской частоты можно также использовать другие способы. Например, можно сравнить форму частотного пика, например, интерференционного сигнала самосмешения с расчетным частотным пиком, причем, если сравнение дает отклонение, большее заранее определенного порогового значения, можно определить, что соответствующее направление частоты является ошибочным направлением частоты. Либо можно определить, даст ли доплеровская частота, измеренная в конкретном направлении частоты, скорость в этом же направлении частоты, которая окажется в заранее определенном расчетном диапазоне скорости, причем, если эта скорость не окажется в заранее определенном расчетном диапазоне скорости, то можно считать, что измерение в этом конкретном направлении частоты является ошибочным. Кроме того, в этом конкретном направлении частоты можно вычислить ускорение на основе соответствующей измеренной доплеровской частоты, и можно определить, находится ли это ускорение в заранее определенном расчетном диапазоне ускорения, чтобы определить, является ли данное измерение доплеровской частоты ошибочным. Диапазон скорости и/или диапазон ускорения можно определить на основе известных возможных скоростей и/или ускорений объекта. Для определения того, является ли измерение доплеровской частоты в том или ином направлении частоты ошибочным, можно также использовать фильтрацию Калмана.

Блок 5 определения скорости приспособлен для определения скорости v_x, v_y, v_z в трех направлениях x → , z → скорости для определения трехмерной скорости. Объект 2 предпочтительно перемещается в прямом направлении x → в горизонтальной плоскости, то есть в плоскости, параллельной земле 8, где три направления v_x, v_y, v_z скорости предпочтительно включают в себя прямое направление x → , поперечное направление , которое также находится в горизонтальной плоскости и перпендикулярно прямому направлению x → , и вертикальное направление z → скорости. Эти три направления x → , z → скорости показаны на фиг.1 в виде координатной системы 42.

Три направления x → , z → скорости отличаются по меньшей мере от трех направлений 10, 11, 12 частоты, так что скорость в одном из направлений x → , z → скорости можно определить как комбинацию доплеровских частот, измеренных для трех направлений 10, 11, 12 частоты. В этом варианте блок 5 определения скорости приспособлен для определения скорости объекта 2, то есть вектора v_x, v_y, v_z скорости транспортного средства относительно земли в соответствии со следующим уравнением:

Скорость транспортного средства предпочтительно определяют в заранее определенной системе отсчета транспортного средства, как это описано в стандарте ISO 8855. Система отсчета транспортного средства представляет собой правостороннюю прямоугольную систему координат, зафиксированную на транспортном средстве. Положительное направление оси x указывает на направление, в котором ведут транспортное средство, положительное направление оси y указывает направление влево, если смотреть в положительном направлении оси x, а положительное направление оси z указывает направление вверх.

В общем случае, если цель движется от датчика скорости, то доплеровская частота будет отрицательной, а если цель движется к датчику скорости, то доплеровская частота будет положительной. В настоящем варианте целью является дорога, где скорость дороги v → r o a d является отрицательной скоростью v → транспортного средства. Следовательно, доплеровскую частоту можно вычислить согласно следующему уравнению:

где e → - единичный вектор соответствующего направления частоты. Спроецировав направления частот в системе отсчета транспортного средства, можно получить следующее уравнение:

где λ обозначает длину волны лазерных лучей, излучаемых лазерами 13, 14, 15, а f 1 , f 2 , f 3 обозначают доплеровские частоты, измеренные или вычисленные для направлений 10, 11, 12 частоты соответственно.

Углы Θ i и φ i для направлений частот с единичными векторами e → i , где i=1, 2, 3, предпочтительно определяют следующим образом. Угол Θ i предпочтительно является углом между соответствующим направлением частоты и единичным вектором z, а угол φ i предпочтительно является проекцией e → i на плоскость x-y и единичный вектор x.

В одном варианте эти углы можно установить следующим образом:

На фиг.3 схематически показаны три направления 10, 11, 12 частоты без указания предпочтительной трехмерной ориентации направлений 10, 11, 12 частоты. Предпочтительная трехмерная ориентация направлений 10, 11, 12 частоты показана на фиг.4. Как можно видеть из фиг.4, три направления 10, 11, 12 частоты предпочтительно имеют одинаковый угол тангажа, равный 25 градусам, и азимутальные углы, равные 0, 210 и 330 градусам соответственно.

Доплеровские частоты, измеренные в разных направлениях 10, 11, 12 частоты, измеряют независимо друг от друга, то есть на измерение доплеровской частоты в первом направлении частоты не влияет измерение доплеровской частоты во втором направлении частоты, отличающемся от первого направления частоты. В частности, блок 3 измерения доплеровской частоты приспособлен для измерения отдельной доплеровской частоты в каждом направлении 10, 11, 12 частоты.

Из-за жестких условий окружающей среды и тяжелых дорожных условий один канал обнаружения, то есть измерение доплеровской частоты в одном из направлений 10, 11, 12 частоты может оказаться ошибочным. Например, лазерный луч в одном направлении частоты может быть временно заблокирован рассеивающими объектами, находящимися между соответствующим лазером и поверхностью 8 дороги, либо из-за значительной расфокусировки слишком сильно ослабнет сигнал обратной связи на основе самосмешения, то есть интенси