Model::bodiesToMove(): bug in iteration method

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
