Still working on updating the two-dimensional-cost synthesis implementation. Do not merge yet - I am still testing!
Commit @ 34000 feet above sea level: Bugfix & removed some debugging code. Ready to be tested by Jim.
Merge remote-tracking branch 'progirep/TwoDimensionalCostMinimization' into TwoDimensionalCostMinimization
update the IROS2013 example