Fixes problem if timestamp of logged data is earlier than logged data start date.
Changes (improves) particle filter algorithm. Splits um a motion in further submotions to integrate measurements in between.
Adds histogram to measure particle set diversity and to add random particles to garantee a certain diversity.