ros 代码找到包的路径

版权声明:https://blog.csdn.net/CAIYUNFREEDOM https://blog.csdn.net/CAIYUNFREEDOM/article/details/90713011
#include<stdio.h>
#include<string.h>
void get_packagePath(char* pack, char *path) {

	char cmd[26] = "rospack find ";
	strcat(cmd, pack);

	FILE *fp = popen(cmd, "r");
	fgets(path, 256, fp);
	pclose(fp);

}
int main() {
//system("rospack find vi2cmdnode ");

	char path[256];
	get_packagePath("vi2cmdnode", path);

	printf("package path:\n%s", path);
	return 0;
}

特殊情况:

1.包名称太长,需要修改cmd[26]为更大的数组。

2.路径名称太长,需要修改path为更大的数组。

3.路径含有空格或则特殊字符,程序可能不正正常工作。需要做特殊处理。本代码暂未考虑。

猜你喜欢

转载自blog.csdn.net/CAIYUNFREEDOM/article/details/90713011
今日推荐