Added footprint scaling option in obstaclelayer
Only last point check
Added tunable paramters