Парковка

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

Создайте ParkingLot объект со свободным пятном в местоположении 7.

freeSpotIdx = 7;
map = ParkingLot(freeSpotIdx);

Задайте начальное положение $\left({\mathit{X}}_0,{\mathit{Y}}_0,{\theta }_0\right)$ для автомобиля , оборудованного датчиком. Целевое положение определяется на основе первого доступного свободного места, когда транспортное средство перемещается по парковке.

egoInitialPose = [20, 15, 0];

Вычислите целевое положение для транспортного средства с помощью createTargetPose функция. Целевое положение соответствует местоположению в freeSpotIdx.

egoTargetPose = createTargetPose(map,freeSpotIdx)

egoTargetPose = 1×3

   47.7500    4.9000   -1.5708

Сенсорные модули

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

Камера

Поле зрения камеры, установленной на автомобиль , оборудованный датчиком, представлено площадью, затененной зеленым цветом на следующем рисунке. Камера имеет поле зрения $\phi$ ограничены $\pm 60\mathrm{degrees}$ и максимальная глубина измерения ${\mathit{d}}_{\max }$ 10 м.

Когда автомобиль , оборудованный датчиком двигается вперед, модуль камеры обнаруживает парковочные места, которые попадают в поле зрения, и определяет, является ли место свободным или занятым. Для простоты это действие реализуется с использованием геометрических отношений между местоположениями точек и текущим положением транспортного средства. Парковочное место находится в области значений камер, если ${\mathit{d}}_{\mathit{i}}\le {\mathit{d}}_{\max }$ и ${\phi }_{\min }\le {\phi }_{\mathit{i}}\le {\phi }_{\max }$, где ${\mathit{d}}_{\mathit{i}}$ расстояние до парковочного места и ${\phi }_{\mathit{i}}$ - угол к парковочному месту.

Лидар

Агент обучения с подкреплением использует показания датчика лидара, чтобы определить близость автомобиля , оборудованного датчиком к другим транспортным средствам в окружение. Датчик лидара в этом примере также моделируется с помощью геометрических отношений. Лидарные расстояния измеряются вдоль 12 сегментов линии, которые радиально выходят из центра автомобиля , оборудованного датчиком. Когда линия лидара пересекает препятствие, это возвращает расстояние препятствия от транспортного средства. Максимальное измеряемое лидарное расстояние вдоль любого сегмента линии составляет 6 м.

Модель автоматической парковки (Auto Parking Valet)

Модель парковочного клапана, включая контроллеры, автомобиль , оборудованный датчиком, датчики и парковку, реализована в Simulink ®.

Загрузите параметры автоматической парковки.

autoParkingValetParams

Откройте модель Simulink.

mdl = 'rlAutoParkingValet';
open_system(mdl)

Динамика автомобиля , оборудованного датчиком в этой модели представлена однопутной моделью велосипеда с двумя входами: Транспортное средство скорость $\mathit{v}$ (м/с) и угол поворота руля $\delta$ (радианы). Контроллеры MPC и RL помещаются в блоки Enabled Subsystem, которые активируются сигналами, представляющими, должно ли транспортное средство искать пустое место или выполнять маневр парковки. Сигналы включения определяются алгоритмом Camera в подсистеме Vehicle Mode. Первоначально транспортное средство находится в режиме поиска, и контроллер MPC отслеживает путь ссылки. Когда свободное место найдено, активируется режим парковки, и агент RL выполняет маневр парковки.

Адаптивный прогнозирующий контроллер модели

Создайте адаптивный объект контроллера MPC для отслеживания эталонной траектории с помощью createMPCForParking скрипт. Для получения дополнительной информации об адаптивном MPC смотрите Adaptive MPC (Model Predictive Control Toolbox).

createMPCForParking

Окружение обучения с подкреплением

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

Для этого окружения:

Вот, ${\mathit{X}}_{\mathit{e}}$, ${\mathit{Y}}_{\mathit{e}}$, и ${\theta }_{\mathit{e}}$ являются положением и углом рыскания ошибок автомобиля , оборудованного датчиком из целевого положения, и $\delta$ - угол поворота руля. ${\mathit{f}}_{\mathit{t}}$ (0 или 1) указывает, припарковано ли транспортное средство и ${\mathit{g}}_{\mathit{t}}$ (0 или 1) указывает, столкнулось ли транспортное средство с препятствием в момент $\mathit{t}$.

Координатные преобразования на положении транспортного средства $\left(\mathit{X},\mathit{Y},\theta \right)$ наблюдения для различных мест стоянки:

Создайте наблюдения и спецификации действия для окружения.

numObservations = 16;
observationInfo = rlNumericSpec([numObservations 1]);
observationInfo.Name = 'observations';

steerMax = pi/4;
discreteSteerAngles = -steerMax : deg2rad(15) : steerMax;
actionInfo = rlFiniteSetSpec(num2cell(discreteSteerAngles));
actionInfo.Name = 'actions';
numActions = numel(actionInfo.Elements);

Создайте интерфейс окружения Simulink, задав путь к блоку RL Agent.

blk = [mdl '/RL Controller/RL Agent'];
env = rlSimulinkEnv(mdl,blk,observationInfo,actionInfo);

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

env.ResetFcn = @autoParkingValetResetFcn;

Для получения дополнительной информации о создании окружений Simulink смотрите rlSimulinkEnv.

Создайте агента

Агент RL в этом примере является агентом проксимальной оптимизации политики (PPO) с дискретным пространством действий. Агенты PPO полагаются на представления актёра и критика, чтобы узнать оптимальную политику. Агент поддерживает функциональные аппроксимации на основе глубоких нейронных сетей для актёра и критика. Дополнительные сведения об агентах PPO см. в разделе Агенты оптимизации проксимальной политики.

Установите генератор случайного seed для повторяемости.

rng(0)

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

criticNetwork = [
    featureInputLayer(numObservations,'Normalization','none','Name','observations')
    fullyConnectedLayer(128,'Name','fc1')
    reluLayer('Name','relu1')
    fullyConnectedLayer(128,'Name','fc2')
    reluLayer('Name','relu2')
    fullyConnectedLayer(128,'Name','fc3')
    reluLayer('Name','relu3')
    fullyConnectedLayer(1,'Name','fc4')];

Создайте критика для агента PPO. Для получения дополнительной информации смотрите rlValueRepresentation и rlRepresentationOptions.

criticOptions = rlRepresentationOptions('LearnRate',1e-3,'GradientThreshold',1);
critic = rlValueRepresentation(criticNetwork,observationInfo,...
    'Observation',{'observations'},criticOptions);

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

actorNetwork = [
    featureInputLayer(numObservations,'Normalization','none','Name','observations')
    fullyConnectedLayer(128,'Name','fc1')
    reluLayer('Name','relu1')
    fullyConnectedLayer(128,'Name','fc2')
    reluLayer('Name','relu2')
    fullyConnectedLayer(numActions, 'Name', 'out')
    softmaxLayer('Name','actionProb')];

Создайте стохастическое представление актера для агента PPO. Для получения дополнительной информации смотрите rlStochasticActorRepresentation.

actorOptions = rlRepresentationOptions('LearnRate',2e-4,'GradientThreshold',1);
actor = rlStochasticActorRepresentation(actorNetwork,observationInfo,actionInfo,...
    'Observation',{'observations'},actorOptions);

Укажите опции агента и создайте агента PPO. Для получения дополнительной информации об опциях агента PPO смотрите rlPPOAgentOptions.

agentOpts = rlPPOAgentOptions(...
    'SampleTime',Ts,...
    'ExperienceHorizon',200,...
    'ClipFactor',0.2,... 
    'EntropyLossWeight',0.01,...
    'MiniBatchSize',64,...
    'NumEpoch',3,...
    'AdvantageEstimateMethod',"gae",...
    'GAEFactor',0.95,...
    'DiscountFactor',0.998);
agent = rlPPOAgent(actor,critic,agentOpts);

Во время обучения агент собирает опыт до тех пор, пока он не достигнет горизонта опыта 200 шагов или эпизод не завершится, а затем обучается из мини-пакетов 64 переживаний в течение трех эпох. Коэффициент зажима целевой функции 0,2 улучшает стабильность обучения, а значение коэффициента дисконтирования 0,998 поощряет долгосрочные вознаграждения. Отклонение у критика выход уменьшается методом обобщенной оценки преимущества с коэффициентом GAE 0,95.

Обучите агента

В данном примере вы обучаете агента максимум для 10000 эпизодов с каждым эпизодом, длящимся максимум 200 временных шагов. Обучение прекращается, когда достигается максимальное количество эпизодов или среднее вознаграждение за 100 эпизодов превышает 100.

Задайте опции для обучения с использованием rlTrainingOptions объект.

trainOpts = rlTrainingOptions(...
    'MaxEpisodes',10000,...
    'MaxStepsPerEpisode',200,...
    'ScoreAveragingWindowLength',200,...
    'Plots','training-progress',...
    'StopTrainingCriteria','AverageReward',...
    'StopTrainingValue',80);

Обучите агента с помощью train функция. Обучение этого агента является интенсивным в вычислительном отношении процессом, который занимает несколько минут. Чтобы сэкономить время при запуске этого примера, загрузите предварительно обученного агента путем установки doTraining на false. Чтобы обучить агента самостоятельно, установите doTraining на true.

doTraining = false;
if doTraining
    trainingStats = train(agent,env,trainOpts);
else
    load('rlAutoParkingValetAgent.mat','agent');
end

Симулируйте агента

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

freeSpotIdx = 7;  % free spot location
sim(mdl);

Транспортное средство достигает целевого положения в пределах заданных ошибок допусков +/- 0,75 м (положение) и +/-10 степени (ориентация).

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