Curb Detection Dynamic ROI

* Automatically slide the curb detection ROI around the previously
detect curb.
* Added some more debug plots
* Fixed a bug in plotFusion plot