Costmap layer: preferred heading

[jlblancoc]

• Each layer will define an (x,y)-(x,y) range, and a preferred heading plus a margin.
• Demo with ramps and preferred directions cost layer