Added a new parameter to generate the steer angle instead of the angular speed for the control.

Heading cost weighted by the number of samples.

assigned to @shernand

mentioned in commit 16fa933f

merged