fixed iterator access in GetIteratorClosest, where it was possible that an iterator pointed to --begin() and its time was accessed.
Merge branch 'master' into fix/sorted_container_accessors
Merge pull request #68 from ethz-asl/fix/sorted_container_accessors

fixed iterator access in GetIteratorClosest, where it was possible that ...