case study: highway lane following + lane change · add screen shot of original model and highlight...
TRANSCRIPT
![Page 1: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/1.jpg)
1© 2019 The MathWorks, Inc.
Case Study: Highway Lane Following + Lane ChangeDesign and test decision making, path planning, and control modules in traffic scenarios
Seo-Wook Park
Application Engineering, MathWorks
Shusen Zhang
Application Engineering, MathWorks
![Page 2: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/2.jpg)
2
SAE Levels of Driving Automation vs. Automated Driving Technologies
L0 No Automation FCW, LDW
L1Driver
Assistance
ACC
AEB-Vehicle (City/Inter-Urban)
Lane Keep Assist/Lateral Support
AEB-VRU(Cyclist)
Junction Assist
AEB-VRU (Pedestrian)
L2 Partial Automation Auto Pilot: Traffic Jam Assist
L3Conditional
Automation
Auto Pilot: Highway
Auto Pilot: Parking
Auto Pilot: Road Train
L4 High Automation Self-Driving & Human-Driven Car
L5 Full Automation Self-Driving Car
2010 2014 2016 2018 2020 2025 2030
ACC
Lane Keep Assist/Lateral Support
Traffic Jam Assist (LF)
FCW
AEB-Vehicle (City/Inter-Urban)
AEB-VRU(Cyclist)
AEB-VRU (Pedestrian)
Auto Pilot (LF+LC)
Lane Change
ACC
Lane Keep Assist/Lateral Support
Traffic Jam Assist (LF)
J3016
Automated Driving Toolbox™
![Page 3: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/3.jpg)
3
Traffic Jam Assist with ACC and Lane Following Control
ACC(Longitudinal Control)
Lane Centering(Lateral Control)
Traffic Jam Assist(Longitudinal
+ Lateral Control)
Automated Driving Toolbox
![Page 4: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/4.jpg)
4
Auto Pilot: Lane Following plus Lane Change
Traffic Jam Assist(Longitudinal
+ Lateral Control)
Automated Driving Toolbox
Auto Lane Change(LC Decision Logic
+ Planning)
Auto Pilot(Lane Following
+ Lane Change)
Baseline example
![Page 5: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/5.jpg)
5
Example for Single Lane Change in dense traffic conditions
![Page 6: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/6.jpg)
6
Case Study for Lane Following plus Lane Change
Design lane following +
lane change controller
Automate
regression testing
Test robustness
with traffic agents
▪ Review baseline LF example
▪ Design sensor configuration
▪ Design additional MIO detectors
▪ Design safety zone calculation
▪ Design lane change logic
▪ Design trajectory planner
▪ Define assessment metrics
▪ Add predefined scenarios
▪ Run Simulink test
▪ Specify driver logic for traffic agents
▪ Randomize scenarios using traffic
agents
▪ Identify and assess unexpected
behavior
![Page 7: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/7.jpg)
7
Learn about developing a lane following controller
Lane Following Control with Sensor Fusion
▪ Specify scenario and sensors
▪ Design lateral (lane keeping) and longitudinal
(lane spacing) model predictive controllers
▪ Integrate sensor fusion
▪ Generate C/C++ code
▪ Test with software in the loop (SIL) simulation
Model Predictive Control ToolboxTM
Automated Driving ToolboxTM
Embedded Coder®
Baseline example
Automated Driving Toolbox
![Page 8: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/8.jpg)
8
Review lane following test bench model architecture
Lane following
controller
Vehicle and
environment
Collision
detection
Baseline example
![Page 9: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/9.jpg)
9
Review lane following test bench model architecture
Lane following
controller
Vehicle and
environment
Collision
detection
Baseline example
Ego vehicle
dynamics
Radar detection
sensor model
Vision detection
sensor modelDriving scenario reader
(Other vehicle poses)
![Page 10: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/10.jpg)
10
Review lane following test bench model architecture
Lane following
controller
Vehicle and
environment
Collision
detection
Baseline example
Estimate lane center
• Detect lane center
• Preview curvature
Tracking and sensor fusion
• Cluster and track detections
• Identify most important object (MIO) ahead
Model predictive controller
• Lateral: Follow lane center
• Longitudinal: Adaptive cruise control
![Page 11: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/11.jpg)
11
Add lane change functionality to lane following controller
1. Add more
sensors
+ Lane Change
![Page 12: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/12.jpg)
12
Add lane change functionality to lane following controller
1. Add more
sensors
2. Identify most important
objects in adjacent lanes
+ Lane Change
![Page 13: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/13.jpg)
13
Add lane change functionality to lane following controller
1. Add more
sensors
2. Identify most important
objects in adjacent lanes
4. Decide when to
change lane
3. Calculate safety
zones
5. Plan trajectory
+ Lane Change
![Page 14: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/14.jpg)
14
Add lane change functionality to lane following controller
1. Add more
sensors
2. Identify most important
objects in adjacent lanes
4. Decide when to
change lane
3. Calculate safety
zones
5. Plan trajectory
+ Lane Change
![Page 15: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/15.jpg)
15
System requirements for lane changeIntelligent transport systems - Lane change decision aid systems (LCDAS)
Typically implemented with
Short Range Radar
Typically implemented with
Mid Range Radar
Adjacent zones
for Blind Spot Detection
Rear zones
for closing vehicle warning
17387
![Page 16: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/16.jpg)
16
Explore sensor placement with Driving Scenario Designer
![Page 17: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/17.jpg)
17
Review sensor configuration for lane following example
Camera
FoV = 43.6 x 150m
FrontMRR
FoV = 90 x 60m
FrontLRR
FoV = 20 x 175m
• SRR: Short-Range Radar
• MRR: Mid-Range Radar
• LRR: Long-Range Radar
![Page 18: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/18.jpg)
18
Add rear looking sensors to support left lane change
Camera
FoV = 43.6 x 150m
FrontMRR
FoV = 90 x 60m
FrontLRR
FoV = 20 x 175m
LeftRearSRR
FoV = 140 x 40m
LeftRearMRR
FoV = 30 x 80m
• SRR: Short-Range Radar
• MRR: Mid-Range Radar
• LRR: Long-Range Radar
![Page 19: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/19.jpg)
19
Overall sensor configuration for lane following plus lane change
Camera
FoV = 43.6 x 150m
FrontMRR
FoV = 90 x 60m
FrontLRR
FoV = 20 x 175m
LeftRearSRR
FoV = 140 x 40m
LeftRearMRR
FoV = 30 x 80m
LeftFrontSRR
FoV = 140 x 40m
RightRearSRR
FoV = 140 x 40m
RightRearMRR
FoV = 30 x 80m
RightFrontSRR
FoV = 140 x 40m
1 front camera
8 radars
• SRR: Short-Range Radar
• MRR: Mid-Range Radar
• LRR: Long-Range Radar
![Page 20: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/20.jpg)
20
Review sensor models for lane following controller
1 radar
1 front camera
Visualize with
Birds Eye Scope
Baseline example
![Page 21: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/21.jpg)
21
Add sensor models for lane change
8 radar
1 front camera
Visualize with
Birds Eye Scope
+ Lane Change
![Page 22: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/22.jpg)
22
1. Add more
sensors
2. Identify most important
objects in adjacent lanes
4. Decide when to
change lane
3. Calculate safety
zones
5. Plan trajectory
4. Decide when to
change lane
1. Add more
sensors
3. Calculate safety
zones
5. Plan trajectory
2. Identify most important
objects in adjacent lanes
Add lane change functionality to lane following controller
✓
![Page 23: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/23.jpg)
23
Identify Most Important Objects (MIO) to detect
Ego Car
▪ Lane following
➢ one EgoFront MIO is enough
▪ Lane change
➢ needs more MIOs
surrounding ego car
RightFront
MIO
LeftRear
MIO
LeftFront
MIO
EgoRear
MIO
RightRear
MIO
EgoFront
MIO
Ego CarLeftRear
MIO
RightRear
MIO
EgoFront
MIO
RightFront
MIO
• Radar
detections
Vision
detections track
Track
history
Ground
truth
| Lane
detections
Bird’s-Eye Scope
![Page 24: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/24.jpg)
24
Review baseline MIO detector architecture for lane following controller
Add screen shot of
original model and
highlight MIO block
Ego lane
One MIO
(EgoFront)
Baseline example
![Page 25: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/25.jpg)
25
Add MIO detectors for lane change
Add screen shot of
original model and
highlight new MIO
blocks/calculations
Adjacent
lane
6 MIOs
Ego lane
+ Lane Change
![Page 26: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/26.jpg)
26
1. Add more
sensors
2. Identify most important
objects in adjacent lanes
4. Decide when to
change lane
3. Calculate safety
zones
5. Plan trajectory
1. Add more
sensors
2. Identify most important
objects in adjacent lanes
4. Decide when to
change lane
3. Calculate safety
zones
5. Plan trajectory
Add lane change functionality to lane following controller
✓
✓
![Page 27: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/27.jpg)
27
Calculate safety zones
Ego Car
EgoFront
MIO
𝑣𝑓𝜌 +𝑣𝑓2
2𝑎𝑏𝑟𝑎𝑘𝑒
𝑜𝑟, 𝑣𝑓𝑇𝑇𝐶𝐹𝐶𝑊
Lane following is unsafeif ego front MIO is detected
within the safety zone
Longitudinal safe distance
= travel distance during response time(𝜌)
+ braking distance with 𝑎𝑏𝑟𝑎𝑘𝑒
𝑇𝑇𝐶𝐹𝐶𝑊 : Time-to-Contact
Safety Zone
for lane following
![Page 28: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/28.jpg)
28
Calculate safety zones
Ego Car
EgoFront
MIO
Safety Zone
for lane following
LeftRear
MIO
LeftFront
MIO
𝑣𝑙𝑓𝜌 +𝑣𝑙𝑓2
2𝑎𝑏𝑟𝑎𝑘𝑒𝑜𝑟, 𝑣𝑙𝑓𝑇𝑇𝐶𝐿𝐶
𝑣𝑙𝑟𝜌 +𝑣𝑙𝑟2
2𝑎𝑏𝑟𝑎𝑘𝑒𝑜𝑟, 𝑣𝑙𝑟𝑇𝑇𝐶𝐿𝐶
Left lane change is safeif no MIOs are detected
within the safety zone
Safety Zone
for left lane change
![Page 29: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/29.jpg)
29
Calculate safety zones
EgoFront
MIO
LeftRear
MIO
LeftFront
MIO
EgoRear
MIO
Safety Zone
for lane following
Safety Zone
for right lane change
Safety Zone
for left lane change
Right lane change is unsafeif MIOs are detected
within the safety zone
Ego Car
RightFront
MIO
RightRear
MIO
![Page 30: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/30.jpg)
30
Calculate safety zones
EgoFront
MIO
LeftRear
MIO
LeftFront
MIO
EgoRear
MIO
Safety Zone
for lane following
Safety Zone
for left lane change
Ego Car
RightFront
MIO
RightRear
MIO
Trigger lane change
to safe side
Safety Zone
for right lane change
FCW
![Page 31: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/31.jpg)
31
Visualize safety zones
EgoFront
MIO
LeftRear
MIO
LeftFront
MIO
EgoRear
MIO
Safety Zone
for lane following
Safety Zone
for left lane change
Ego Car
RightFront
MIO
RightRear
MIO
Trigger lane change
to safe side
Safety Zone
for right lane change
FCW
![Page 32: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/32.jpg)
32
Visualize safety zones and trajectory
![Page 33: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/33.jpg)
33
Create custom visualization for safety zones and trajectory
▪ The MATLAB System block brings
existing System objects (based on
matlab.System) into Simulink®
![Page 34: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/34.jpg)
34
Create birds eye plot with utilities from
Automated Driving Toolbox
![Page 35: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/35.jpg)
35
Plot safety zones and trajectory with MATLAB
![Page 36: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/36.jpg)
36
3. Calculate safety
zones
1. Add more
sensors
2. Identify most important
objects in adjacent lanes
4. Decide when to
change lane
5. Plan trajectory
3. Calculate safety
zones
1. Add more
sensors
2. Identify most important
objects in adjacent lanes
4. Decide when to
change lane
5. Plan trajectory
1. Add more
sensors
2. Identify most important
objects in adjacent lanes
4. Decide when to
change lane
5. Plan trajectory
Add lane change functionality to lane following controller
3. Calculate safety
zones
✓
✓ ✓
![Page 37: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/37.jpg)
37
Lane change decision logic and planning
Lane Change
Decision Logic
Lane Change
Planning
MIOs
Ego &
Adjacent
lanes
LC parameters
Reference
trajectory
for lane
change
LC Trigger
Safety zone
calculations
![Page 38: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/38.jpg)
38
Lane Change
Planning
Design lane change decision logic
MIOs
Ego &
Adjacent
lanes
LC parameters
Reference
trajectory
for lane
change
LC Trigger
Lane following
mode
FCW detected
Left lane change
Right lane change
Lane change
mode
Lane Change
Decision Logic
Safety zone
calculations
![Page 39: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/39.jpg)
39
Design lane change planning
Lane Change
Decision Logic
MIOs
Ego &
Adjacent
lanes
LC parameters
Reference
trajectory
for lane
change
LC Trigger
Safety zone
calculationsLane Change
Planning
Generate
Trajectory
Generate
Reference
Point
Calculate
Deviation
![Page 40: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/40.jpg)
40
Generate trajectory
▪ Quintic polynomial
▪ Start boundary conditions
▪ End boundary conditions
𝑠 𝑡 = 𝑎5𝑡5 + 𝑎4𝑡
4+ 𝑎3𝑡3+ 𝑎2𝑡
2+ 𝑎1𝑡 + 𝑎0ሶ𝑠 𝑡 = 5𝑎5𝑡
4 + 4𝑎4𝑡3+ 3𝑎3𝑡
2+ 2𝑎2𝑡+ 𝑎1ሷ𝑠 𝑡 = 20𝑎5𝑡
3 + 12𝑎4𝑡2+ 6𝑎3𝑡+ 2𝑎2
𝑤ℎ𝑒𝑟𝑒 𝑠 = 𝑙𝑜𝑛𝑔𝑖𝑡𝑢𝑑𝑖𝑛𝑎𝑙 𝑜𝑟 𝑙𝑎𝑡𝑒𝑟𝑎𝑙 𝑑𝑖𝑠𝑡𝑎𝑛𝑐𝑒
𝑎0 = 𝑠𝑠𝑡𝑎𝑟𝑡𝑎1 = ሶ𝑠𝑠𝑡𝑎𝑟𝑡2𝑎2 = ሷ𝑠𝑠𝑡𝑎𝑟𝑡
𝑎5𝑡𝑓5 + 𝑎4𝑡𝑓
4 + 𝑎3𝑡𝑓3 + 𝑎2𝑡𝑓
2+ 𝑎1𝑡𝑓 + 𝑎0 = 𝑠𝑒𝑛𝑑5𝑎5𝑡𝑓
4 + 4𝑎4𝑡𝑓3+ 3𝑎3𝑡𝑓
2+ 2𝑎2𝑡𝑓+ 𝑎1= ሶ𝑠𝑒𝑛𝑑20𝑎5𝑡𝑓
3 + 12𝑎4𝑡𝑓2+ 6𝑎3𝑡𝑓+ 2𝑎2 = ሷ𝑠𝑒𝑛𝑑
𝑥
𝑦
𝑑𝑙𝑜𝑛𝑔
𝑑𝑙𝑎𝑡
𝜃𝑣
![Page 41: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/41.jpg)
41
Example of trajectory generation for lane change
Longitudinal trajectory Lateral trajectory
![Page 42: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/42.jpg)
42
Calculate deviations from reference point
𝑥
𝑦
𝑑𝑙𝑜𝑛𝑔
𝑑𝑙𝑎𝑡
[𝑥 𝑖 , 𝑦 𝑖 , 𝜃 𝑖 , 𝜅 𝑖 , 𝑣 𝑖 ]
𝜃
𝑣
Reference
trajectory
Lateral
deviation
Heading
deviation
Reference
point
![Page 43: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/43.jpg)
43
Case Study for Lane Following plus Lane Change
Design lane following +
lane change controller
Automate
regression testing
Test robustness
with traffic agents
▪ Review baseline LF example
▪ Design sensor configuration
▪ Design additional MIO detectors
▪ Design safety zone calculation
▪ Design lane change logic
▪ Design trajectory planner
▪ Define assessment metrics
▪ Add predefined scenarios
▪ Run Simulink test
▪ Specify driver logic for traffic agents
▪ Randomize scenarios using traffic
agents
▪ Identify and assess unexpected
behavior
![Page 44: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/44.jpg)
44
Manage testing against scenarios
System simulation
Algorithm
under test
Test Manager
Scenario Sensors Vehicles Metrics
![Page 45: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/45.jpg)
45
Create test scenariosNo Test Name Test Description Host car Lead car Third car
1 01_SlowMoving Passing for slow moving lead car initial velocity = 20m/s
HWT = 6.5sec
(HW = 130m)
v_set = 20m/s
constant velocity =
10m/s
None
HW : Headway
HWT : Headway time
v_set : set velocity for ego car
21
Slow moving
![Page 46: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/46.jpg)
46
No Test Name Test Description Host car Lead car Third car
4 04_CutInWithBrake Passing for cut-in car with brake initial velocity = 20m/s
v_set = 20m/s
initial velocity = 18m/s
Cut-in with brake @ 6m/s2
(18m/s→10m/s)
constant velocity =
10m/s
Create test scenariosHW : Headway
HWT : Headway time
v_set : set velocity for ego car
2
1
3
![Page 47: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/47.jpg)
48
Create test scenariosNo Test Name Test Description Host car Lead car Third car Spec
7 07_RightLaneChange Passing for slow moving lead car
to right lane
initial velocity = 20m/s
HWT = 6.5sec
(HW = 130m)
v_set = 20m/s
constant velocity = 10m/s Constant
velocity =
25m/s
(3rd & 4th cars in
left lane)
HW : Headway
HWT : Headway time
v_set : set velocity for ego car
21
4
Slow moving
3
![Page 48: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/48.jpg)
49
Add assessments
collision
longitudinal safe distance
lateral deviation
![Page 49: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/49.jpg)
50
Review report generated by Test Manager test cases
![Page 50: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/50.jpg)
51
Case Study for Lane Following plus Lane Change
Design lane following +
lane change controller
Automate
regression testing
Test robustness
with traffic agents
▪ Review baseline LF example
▪ Design sensor configuration
▪ Design additional MIO detectors
▪ Design safety zone calculation
▪ Design lane change logic
▪ Design trajectory planner
▪ Define assessment metrics
▪ Add predefined scenarios
▪ Run Simulink test
▪ Specify driver logic for traffic agents
▪ Randomize scenarios using traffic
agents
▪ Identify and assess unexpected
behavior
![Page 51: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/51.jpg)
52
Assign traffic agents to all vehicles except ego car
Ego car with
LF/LC controller
Traffic agent with driver
logic state machine
![Page 52: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/52.jpg)
53
Simulate interaction between traffic agents
▪ Driver decision logic
implemented by Stateflow™
▪ Rules are based on ground
truths
▪ Integrate into cuboid driving
scenario
▪ Visualize and debug
Proof of Concept
![Page 53: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/53.jpg)
54
Scenario Reader
Ego car is controlled by the closed-loop
controller including ego vehicle dynamics
Driving scenario is
pre-defined by DSD
Scenario Reader
Block
![Page 54: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/54.jpg)
55
Traffic agent State machine
implementing driver logic
![Page 55: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/55.jpg)
56
Implement driver logic for traffic agent using Stateflow™
Lane Keep
mode
Front MIO
detected
Lane change
mode
Maintain
set velocityFCW
detected
Collision
detected
Follow
front MIO
Le
ft L
CR
igh
t L
C
Follow Car
mode
![Page 56: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/56.jpg)
57
Simulate with traffic agents
![Page 57: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/57.jpg)
58
Analyze results for near collision situation
![Page 58: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/58.jpg)
59
Recap: Case Study for Lane Following plus Lane Change
Design lane following +
lane change controller
Automate
regression testing
Test robustness
with traffic agents
▪ Review baseline LF example
▪ Design sensor configuration
▪ Design additional MIO detectors
▪ Design safety zone calculation
▪ Design lane change logic
▪ Design trajectory planner
▪ Define assessment metrics
▪ Add predefined scenarios
▪ Run Simulink test
▪ Specify driver logic for traffic agents
▪ Randomize scenarios using traffic
agents
▪ Identify and assess unexpected
behavior
![Page 59: Case Study: Highway Lane Following + Lane Change · Add screen shot of original model and highlight MIO block Ego lane One MIO (EgoFront) Baseline example. 25 Add MIO detectors for](https://reader030.vdocuments.mx/reader030/viewer/2022040417/5d50c03d88c9935a0e8bad7a/html5/thumbnails/59.jpg)
60
Contact us to learn more
Would you like to discuss any of
these topics in more detail?
Contact your local team or
reach out to me at