解决ROS打印中文乱码

大概知道是编码有问题，网上查了挺多，最后解决方式是，在函数开头加入下面代码的任意一句即可：

setlocale(LC_CTYPE, "zh_CN.utf8");

setlocale(LC_ALL, ""); // 我用的是这一句，亲测ok