Введение

Логика решения для согласования светофора является основным компонентом автоматизированных ведущих приложений. Логика решения взаимодействует с контроллером, чтобы регулировать автомобиль, оборудованный датчиком на основе состояния светофора и других транспортных средств в маршруте эго. Симуляция реальных сценариев трафика с реалистическими условиями может обеспечить больше понимания взаимодействий между логикой решения и контроллером. Automated Driving Toolbox™ обеспечивает 3D среду симуляции, приводимую в действие Нереальным Engine® от Epic Games®. Можно использовать этот механизм, чтобы визуализировать движение транспортного средства в предварительно созданной 3D сцене. Этот механизм обеспечивает интуитивный способ анализировать эффективность логики решения и алгоритмов управления при согласовании светофора на пересечении.

Для получения информации о том, как спроектировать логику решения и средства управления для согласования светофора в среде кубоида. Смотрите Согласование Светофора (Automated Driving Toolbox) пример. В этом примере показано, как управлять светофором в Нереальной сцене и затем как симулировать и визуализировать поведение транспортного средства для различных сценариев тестирования. В этом примере вы будете:

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

В этом примере вы включаете симуляцию уровня системы посредством интеграции с Нереальным Engine. Эта среда требует Windows® 64-битная платформа.

if ~ispc
    error(['3D Simulation is only supported on Microsoft', char(174), ' Windows', char(174), '.']);
end

Исследуйте архитектуру тестовой модели

Чтобы исследовать поведение системы согласования светофора, откройте тестовую модель симуляции для системы.

open_system("TrafficLightNegotiationWithUnrealTestBench");

Открытие этой модели запускает helperSLTrafficLightNegotiationWithUnrealSetup скрипт, чтобы инициализировать сценарий тестирования, сохраненный как drivingScenario Объект (Automated Driving Toolbox) в базовом рабочем пространстве. Сценарий тестирования по умолчанию, scenario_TLN_straight_greenToRed_with_lead_vehicle, содержит один автомобиль, оборудованный датчиком и два неавтомобиля, оборудованных датчиком. Этот скрипт настройки также конфигурирует параметры проектирования контроллера, параметры модели транспортного средства и сигналы шины Simulink® задать вводы и выводы для TrafficLightNegotiationWithUnrealTestBench модель.

Тестовая модель содержит следующие подсистемы:

Логика Решения Светофора, Маршрут После образцов модели Контроллера и подсистема Динамики аппарата снова используются от Согласования Светофора (Automated Driving Toolbox) пример. Этот пример изменяет Датчики и подсистему Среды, чтобы сделать его совместимым для симуляции с Нереальной сценой.

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

open_system("TrafficLightNegotiationWithUnrealTestBench/Sensors and Environment");

Выберите Scenario

Сцена и дорожная сеть, требуемая для тестовой модели, заданы следующими частями этой подсистемы:

Можно отобразить выбранный раздел сцены городского квартала США при помощи helperDisplayTrafficLightScene функция.

Задайте x и пределы y, чтобы выбрать желаемую область сцены и построить извлеченную сцену.

xlimit = [-110 70];
ylimit = [-105 105];
hFigure = helperDisplayTrafficLightScene(xlimit, ylimit);
snapnow;
close(hFigure);

helperGetTrafficLightScenario функция задает ссылочный путь для автомобиля, оборудованного датчиком, чтобы следовать, когда информация о маршруте не доступна. Блок Reference Path Info читает ссылочный путь, сохраненный в переменной referencePathInfo базового рабочего пространства. Автомобиль, оборудованный датчиком может или пойти прямо или повернуть налево на пересечении на основе ссылочной траектории. Можно выбрать одну из этих ссылочных траекторий путем установки входных значений helperGetTrafficLightScenario функция. Установите значение к

Блок Set Velocity читает скоростное значение из переменной setVelocity базового рабочего пространства и дает как вход контроллеру.

Установите положения транспортного средства

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

Обнаружения транспортного средства предохранителей подсистемы Fusion Отслеживания и Датчика от Управления Радарным Генератором Данных (Automated Driving Toolbox) и Генератор Обнаружения Видения (Automated Driving Toolbox) блокируют и отслеживают сплавленные обнаружения с помощью блока Multi-Object Tracker (Automated Driving Toolbox), чтобы обеспечить объектные дорожки, окружающие автомобиль, оборудованный датчиком. Блок Vision Detection Generator также обеспечивает обнаружения маршрута относительно автомобиля, оборудованного датчиком, который помогает в идентификации транспортных средств, существующих в маршруте эго.

Управляйте светофором в нереальной сцене

Эта модель использует Симуляцию 3D Контроллер Светофора блок помощника, чтобы сконфигурировать и управлять состоянием светофора в Нереальной сцене. Симуляция 3D Контроллер Светофора блок помощника управляет состоянием светофора при помощи Timer-Based или State-Based режим. Можно выбрать желаемый режим при помощи Control mode параметр маски. По умолчанию эта модель использует State-Based режим. Для получения информации о Timer-Based режим, см. описание маски блока.

В State-Based режим, блок перезаписывает состояние светофора, заданного Traffic Light ID входной порт. Значение для Traffic Light ID входной порт установлен intersectionInfo.trafficLightToNegotiate переменная в helperGetTrafficLightScenario функция. В этой модели, значении для Traffic Light ID входной порт установлен в 16. Это подразумевает, что блок управляет светофором со Значением идентификатора 16 в сцене городского квартала США. Состояния всего светофора, существующего в сцене городского квартала США, возвращены Ground Truth выходной порт Simulation 3D Traffic Light Controller блок помощника. Модель тестирует логику решения и средства управления при помощи информации об основной истине и не требует основанного на восприятии обнаружения светофора.

Traffic Light Select блок извлекает состояние светофора со Значением идентификатора 16 от Ground Truth вывод . Образец модели Логики Решения Светофора использует значение состояния, чтобы вынести решение между ведущим автомобилем и светофором. Для получения дополнительной информации об образце модели Логики Решения Светофора, смотрите Согласование Светофора (Automated Driving Toolbox) пример.

Блок Traffic Light Stop Line Position обеспечивает положение линии остановки на пересечении, соответствующем выбранному светофору trafficLightToNegotiate. Значение положения линии остановки задано intersectionInfo.tlStopLinePosition.

Блок Intersection Center обеспечивает позицию перекрестного центра дорожной сети в сценарии. Это получено с помощью intersectionInfo, выход от helperGetTrafficLightScenario.

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

Distance To Traffic Light Stop Line блок вычисляет Евклидово расстояние между линией остановки, соответствующей выбранному светофору trafficLightToNegotiate и текущее положение автомобиля, оборудованного датчиком.

Логика Решения Светофора использует значение расстояния, чтобы решить самый важный объект (MIO), самый близкий объект перед автомобилем, оборудованным датчиком. Это может быть ведущее транспортное средство или светофор в маршруте эго.

Светофор, Переключающий Логический блок выходные параметры tlState, состояние светофора, который должен быть установлен. Это реализовано с помощью Stateflow™ и использует значение расстояния, чтобы инициировать изменение состояния когда EgoVehicle ближе к светофору, чем заданное расстояние.

Откройте Светофор, Переключающий Логический блок.

open_system("TrafficLightNegotiationWithUnrealTestBench/Sensors and Environment/Traffic Light Switching Logic", 'force');

Светофор, Переключающий Логику, использует Configuration params параметр маски, чтобы считать настройку светофора, trafficLightConfig, от базового рабочего пространства. Можно использовать trafficLightConfig структура, чтобы сконфигурировать различные сценарии тестирования. Эта структура задана в функции сценария тестирования и имеет следующие поля: stateChangeDistance, initialState, и changeState.

Переключение состояния происходит на основе настройки набора и когда EgoVehicle достигает stateChangeDistance. Когда initialState Red и changeState Green диаграмма Stateflow переключается от Red утвердите к Green состояние. С другой стороны, когда initialState Green и changeState Red диаграмма Stateflow моделируется таким образом, что изменение состояния происходит от Green утвердите к Yellow состояние и после одной секунды, светофор переключается на Red состояние.

Симулируйте поведение транспортного средства во время зеленого к Красному переходу

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

Сконфигурируйте TrafficLightNegotiationWithUnrealTestBench модель, чтобы использовать scenario_TLN_straight_greenToRed_with_lead_vehicle сценарий тестирования.

helperSLTrafficLightNegotiationWithUnrealSetup(...
    "scenario_TLN_straight_greenToRed_with_lead_vehicle");

Отобразите trafficLightConfig параметры структуры устанавливаются для сценария тестирования.

disp(trafficLightConfig');

           initialState: 2
    stateChangeDistance: 10
            changeState: 0

Симулируйте модель. Во время симуляции модель регистрирует сигналы, требуемые для анализа методом моделирования сообщения к logsout.

Чтобы сократить командное окно выход, сначала выключите сообщения обновления MPC.

mpcverbosity('off');
sim("TrafficLightNegotiationWithUnrealTestBench");

Постройте результаты симуляции с помощью helperPlotTrafficLightControlAndNegotiationResults функция.

hFigResults = helperPlotTrafficLightControlAndNegotiationResults(logsout, trafficLightConfig.stateChangeDistance);

Исследуйте результаты.

Можно послать к Согласованию Светофора (Automated Driving Toolbox) пример узнать больше об этом анализе и взаимодействиях между логикой решения и контроллером.

Закройте фигуру.

close(hFigResults);

Симулируйте поведение транспортного средства во время Красного к зеленому переходу

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

Функция сценария тестирования scenario_TLN_red_to_green_with_cross_traffic_vehicle реализации этот сценарий. Сконфигурируйте TrafficLightNegotiationWithUnrealTestBench модель, чтобы использовать этот сценарий.

helperSLTrafficLightNegotiationWithUnrealSetup(...
    "scenario_TLN_straight_redToGreen_with_cross_vehicle");

Отобразите trafficLightConfig параметры структуры, которые устанавливаются для этого сценария тестирования.

disp(trafficLightConfig');

           initialState: 0
    stateChangeDistance: 11
            changeState: 2

Симулируйте модель.

sim("TrafficLightNegotiationWithUnrealTestBench");

Постройте результаты симуляции.

hFigResults = helperPlotTrafficLightControlAndNegotiationResults(logsout, trafficLightConfig.stateChangeDistance);

Исследуйте результаты.

Закройте фигуру.

close(hFigResults);

Исследуйте другие сценарии

В предыдущих разделах вы исследовали поведение системы для scenario_TLN_straight_greenToRed_with_lead_vehicle и scenario_TLN_straight_redToGreen_with_cross_vehicle сценарии. Ниже список сценариев, которые совместимы с TrafficLightNegotiationWithUnrealTestBench.

scenario_TLN_straight_greenToRed
scenario_TLN_straight_greenToRed_with_lead_vehicle [Default]
scenario_TLN_straight_redToGreen_with_cross_vehicle
scenario_TLN_left_redToGreen_with_lead_vehicle

Используйте эти дополнительные сценарии, чтобы анализировать TrafficLightNegotiationWithUnrealTestBench при различных условиях.

Включите сообщения обновления MPC.

mpcverbosity('on');

Можно использовать шаблоны моделирования в этом примере, чтобы создать собственное приложение согласования светофора.