Создайте агента или траекторию транспортного средства в ведущем сценарии
trajectory( создает траекторию для агента или транспортного средства, ac,waypoints)ac, от набора waypoints.
Примечание
Функция траектории генерирует траектории, которые имеют разрывы на ускорении между waypoints, приводящим к большому количеству толчка. Чтобы сгенерировать сглаженную, ограниченную толчками траекторию, используйте smoothTrajectory функцию вместо этого.
trajectory( задает время ожидания для агента или транспортного средства в дополнение к входным параметрам в предыдущем синтаксисе. Используйте этот синтаксис, чтобы сгенерировать ведущие сценарии останавливать-и-идти путем приостановки агента или агентов транспортного средства в определенном waypoints.ac,waypoints,speed,waittime)
Создайте ведущий сценарий и добавьте кривую дорогу 2D маршрута к нему.
scenario = drivingScenario('SampleTime',0.05); roadcenters = [5 0; 30 10; 35 25]; lspec = lanespec(2); road(scenario,roadcenters,'Lanes',lspec);
Добавьте транспортное средство в сценарий. Установите траекторию, в которой транспортное средство управляет вокруг кривой на различных скоростях.
v = vehicle(scenario,'ClassID',1);
waypoints = [6 2; 18 4; 25 7; 28 10; 31 15; 33 22];
speeds = [30 10 5 5 10 30];
trajectory(v,waypoints,speeds)
Постройте сценарий и запустите симуляцию. Наблюдайте, как транспортное средство замедляется, когда оно ведет машину по кривой.
plot(scenario,'Waypoints','on','RoadCenters','on') while advance(scenario) pause(0.1) end
Создайте ведущий сценарий, состоящий из два, дороги 2D маршрута, которые пересекаются под прямым углом.
scenario = drivingScenario('StopTime',2.75); roadCenters = [50 1 0; 2 0.9 0]; laneSpecification = lanespec(2,'Width',4); road(scenario,roadCenters,'Lanes',laneSpecification); roadCenters = [27 24 0; 27 -21 0]; road(scenario,roadCenters,'Lanes',laneSpecification);
Добавьте автомобиль, оборудованный датчиком в сценарий. Задайте waypoints и значения скорости для транспортного средства в каждом waypoint. Установите время ожидания для транспортного средства во втором waypoint. Сгенерируйте траекторию, в которой автомобиль, оборудованный датчиком перемещается через заданный waypoints на заданной скорости.
egoVehicle = vehicle(scenario,'ClassID',1,'Position',[5 -1 0]); waypoints = [5 -1 0; 16 -1 0; 40 -1 0]; speed = [30; 0; 30]; waittime = [0; 0.3; 0]; trajectory(egoVehicle,waypoints,speed,waittime);
Добавьте автомобиль в сценарий. Задайте waypoints и значения скорости для автомобиля в каждом waypoint. Установите время ожидания для автомобиля во втором waypoint. Сгенерируйте траекторию, в которой автомобиль перемещается через заданный waypoints на заданной скорости.
car = vehicle(scenario,'ClassID',1,'Position',[48 4 0],'PlotColor',[0.494 0.184 0.556], 'Name','Car'); waypoints = [47 3 0; 38 3 0; 10 3 0]; speed = [30; 0; 30]; waittime = [0; 0.3; 0]; trajectory(car,waypoints,speed,waittime);
Добавьте машину скорой помощи в сценарий. Сгенерируйте траекторию, в которой машина скорой помощи перемещается через заданный waypoints на постоянной скорости.
ambulance = vehicle(scenario,'ClassID',6,'Position',[25 22 0],'PlotColor',[0.466 0.674 0.188],'Name','Ambulance'); waypoints = [25 22 0; 25 13 0; 25 6 0; 26 2 0; 33 -1 0; 45 -1 0]; speed = 25; trajectory(ambulance,waypoints,speed);
Создайте пользовательское окно рисунка, чтобы построить сценарий.
fig = figure; set(fig,'Position',[0,0,800,600]); movegui(fig,'center'); hViewPnl = uipanel(fig,'Position',[0 0 1 1],'Title','Stop-and-Go Scenario'); hPlt = axes(hViewPnl);
Постройте сценарий и запустите симуляцию. Автомобиль, оборудованный датчиком и автомобиль делают паузу в течение их заданного времени ожидания, чтобы избежать столкновения с машиной скорой помощи.
plot(scenario,'Waypoints','on','RoadCenters','on','Parent',hPlt) while advance(scenario) pause(0.1) end
Симулируйте ведущий сценарий, в котором автомобиль управляет наоборот, чтобы отступить в парковочное место.
Создайте ведущий сценарий, содержащий парковку.
scenario = drivingScenario; vertices = [0 9; 18 9; 18 -9; 0 -9]; parkingLot(scenario,vertices,ParkingSpace=parkingSpace);
Создайте автомобиль и задайте его траекторию. Автомобильные диски вперед, остановки, и затем управляют наоборот, чтобы отступить в парковочное место. Когда автомобиль вводит парковочное место, он имеет угол ориентации рыскания, который является 90 градусами против часовой стрелки от того, где он запустился.
car = vehicle(scenario,ClassID=1); waypoints = [9 -5; 9 5; 6 -1.3; 2 -1.3]; speed = [3; 0; -2; 0]; yaw = [90 90 180 180]; smoothTrajectory(car,waypoints,speed,Yaw=yaw)
Постройте ведущий сценарий и отобразите waypoints траектории.
plot(scenario,Waypoints="on") while advance(scenario) pause(0.001) end
Задайте траекторию пешехода, который поворачивает направо на пересечении.
Создайте ведущий сценарий. Добавьте дорожные сегменты, которые задают пересечение.
scenario = drivingScenario; roadCenters = [0 10; 0 -10]; road(scenario,roadCenters); road(scenario,flip(roadCenters,2));
Добавьте пешеходного агента в сценарий.
pedestrian = actor(scenario, ... 'ClassID',4, ... 'Length',0.24, ... 'Width',0.45, ... 'Height',1.7, ... 'Position',[-9 0 0], ... 'RCSPattern',[-8 -8; -8 -8], ... 'Mesh', driving.scenario.pedestrianMesh, ... 'Name','Pedestrian');
Задайте траекторию пешехода. Пешеход приближается к пересечению, делает паузу кратко, и затем поворачивает направо на пересечении. Чтобы задать резкий правый поворот, задайте два waypoints на пересечении, которые являются близко друг к другу. Для этих waypoints задайте угол ориентации рыскания второго waypoint в углу в 90 градусов сначала waypoint.
waypoints = [-9 0; -0.25 0; 0 -0.25; 0 -9];
speed = [1.5; 0; 0.5; 1.5];
yaw = [0; 0; -90; -90];
waittime = [0; 0.2; 0; 0];
trajectory(pedestrian,waypoints,speed,waittime,'Yaw', yaw);
Постройте ведущий сценарий и отобразите waypoints пешехода.
plot(scenario,'Waypoints','on') while advance(scenario) pause(0.001) end
trajectory функция создает траекторию для агента, чтобы следовать в сценарии. Траектория состоит из пути, сопровождаемого объектом и его скоростью вдоль пути. Вы задаете путь с помощью N двумерный или 3D waypoints. Каждый из сегментов N - 1 между waypoints задает кривую, искривление которой варьируется линейно с расстоянием вдоль сегмента. Функция соответствует кусочной кривой clothoid к (x, y) координаты waypoints путем соответствия с искривлением с обеих сторон waypoint. Для незакрытой кривой искривление в первом и последнем waypoint является нулем. Если первые и последние waypoints совпадают, то искривления до и после конечных точек являются соответствующими. z - координаты траектории интерполированы с помощью сохраняющей форму кусочной кубической кривой.
Сгенерированная траектория приводит к кусочному профилю постоянного ускорения для каждого сегмента между waypoints. Эти сегменты имеют ускоряющие разрывы между ними. Чтобы избежать разрывов на ускорении, используйте smoothTrajectory функция, чтобы сгенерировать траектории вместо этого.