Adding the weight_histogram function (not yet finisched)
Changed arguments of computeCoherence function and completed weight_histogram function in particle_filter.hpp
Debugging
Debugging
Fixed template compiler errors: missing typedef's added
Debugging
Correct typo in comment