Model::bodiesToMove(): bug in iteration method

[basil-huber]

in Model::bodiesToMove(), we loop over bodies_ which is a std::map with

for(int i = 0; i < bodies_.size(); i++){
    bodies_[i]

If the keys of bodies_ are not starting with 0 and consecutive, we access non-existing elements, which leads to a seg fault