Add Histogram Equalization

#define HISTOGRAM_EQUALIZATION 1