behavior planning——12.example cost funtion -lane change penalty

 

In the image above, the blue self driving car (bottom left) is trying to get to the goal (gold star). It's currently in the correct lane but the green car is going very slowly, so it considers whether it should perform a lane change (LC) or just keep lane (KL). These options are shown as lighter blue vehicles with a dashed outline.

If we want to design a cost function that deals with lane choice, it will be helpful to establish what the relevant variables are. In this case, we can define:

Before we define an actual cost function, let's think of some of the properties we want it to have...

 

习题 1/3

First, thinking only about delta d: Would we prefer the absolute value of delta d to be big or small?

• Big

• Small

提交

 

习题 2/3

Now let's think about how s factors into our considerations of lane cost. Should costs associated with lane change be more important when we are far from the goal (in s coordinate) or close to the goal?

• Far

• Close

提交

 

So we want a cost function that penalizes large ∣ and we want that penalty to be bigger when Δ is small.

Furthermore, we want to make sure that the maximum cost of this cost function never exceeds one and that the minimum never goes below zero.

Which of the following proposals meets these criteria?

 

习题 3/3

Which of the options shown above meet the criteria we want (assume delta s is always positive)?

• Option 1

• Option 2

• Option 3

提交

 

In this example, we found that the ratio ​Δs​​∣Δd∣​​ was important. If we call that ratio x we can then use that ratio in any function with bounded range. These functions tend to be useful when designing cost functions. These types of functions are called Sigmoid Functions. You can learn more in the Wikipedia article if you're interested.