Improvements for simulation

merge together with pull request for cob_environments