The Mobile Robot Programming Toolkit (MRPT)