Some bugfixes for QReal:Robots 2.5.0