Fix bugs in cartographer server