Simple histogram filter to get used to armadillo and c++