Bug fixes

Davide Sangallirequested to merge
bug-fixes into develop

Few fixes.

Some of the bugs where introduced with MR !235 (merged) which was not properly tested before entering the develop.

Robots are running

Edited by Davide Sangalli

Merge request reports