Fix STL iterator errors, misc. cppcheck (#182)

There were some errors in STL iterators.
Initialized values of member variables in constructor.
Removed an unused variable (model_name).
Merge pull request #183 from ros-simulation/issue_182

Fix STL iterator errors, misc. cppcheck (#182)