Modified lane_navigator and made it catkin compatible.

[aranyadan]

Made lane_navigator better and catkin_compatible

[raivivek]

@aranyadan You might wish to describe a bit in your commit as to why this makes the code better.

[abinashmeher999]

@aranyadan Also mention the logic you explained in the comments just before the corresponding codeblock.