Initial checkin for local min/max filter

I think Willow Garage has nothing to do with the code :)