#116: Fixed the code in command base and robotmap