ros 代码找到包的路径

#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.路径含有空格或则特殊字符，程序可能不正正常工作。需要做特殊处理。本代码暂未考虑。