看《STL源码剖析》时发现了POD类型这个名词，一开始初步的理解就是普通数据类型，后来查了查比较完整的定义。

POD是Plain Old Data的缩写，是 C++ 定义的一类数据结构概念，比如 int、float 等都是 POD 类型的。两个系统进行交换数据，如果没有办法对数据进行语义检查和解释，那就只能以非常底层的数据形式进行交互，而拥有 POD 特征的类或者结构体通过二进制拷贝后依然能保持数据结构不变。也就是说，能用C语言的memcpy(),memset()等函数进行操作的类、结构体就是POD类型的数据。一般我们要研究的问题是某class, struct, union是不是POD，在STL中就是元素的类型了。

POD的特点

POD类型要满足两个特征：trivial和布局有序。我们可以用std::is_trivial<T>::value判断一个类型是否是POD

对于class,struct，要成为POD类型说白了就是要 “像” C语言下的struct，因此要满足下面条件：

1. 不能自定义构造/析构函数、拷贝/移动构造函数、拷贝/移动运算符，而是用编译器自动为我们生成的默认版本，那这个数据就是trivial。非要写的话，用 C++ 11 的 default 关键字。

2. 不能有虚函数和虚基类，否则肯定会具备面向对象特性了

3. 非静态成员变量的访问级别相同

4. 派生类不增加新的成员变量，因为 C 没有继承的概念，所以不要把普通成员在两个类中都写

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15

class A
{
};
class B
{
    B(){}
};
class C
{
    C()=default;
};

qDebug()<<std::is_trivial<A>::value;	//true
qDebug()<<std::is_trivial<B>::value;	//false，自定义构造函数
qDebug()<<std::is_trivial<C>::value;	//true，使用默认构造函数

来试验一下memcpy操作POD类型：

1
2
3
4
5
6
7
8

    C obj;
    obj.a = 13;
    obj.b = 99;
//    memset(&obj, 0 ,sizeof(obj));
    int *foo = new int(sizeof(C));
    memcpy(foo,&obj,sizeof(C));
    C* t = reinterpret_cast<C*>(foo);
    qDebug()<<t->a<<"  "<<t->b;

用Vim编辑新文件的时候, 由于服务器断开链接，会导致编辑很久的文件丢失，但是我们可以使用swp临时文件进行恢复, swp文件是隐藏文件. 比如文件路径下有以下文件.test.py.swp，可以使用vim -r test.py恢复文件test.py

设置主题

设置Vim为dracula主题，参考Dracula，在/etc/vim/vimrc的最后添加

1
2
3

packadd! dracula
syntax enable
colorscheme dracula

在普通状态下的命令

• u: 返回旧状态
• ctrl+r: 进入新状态
• 点号： 重复上一次操作
• dd: 删除光标所在行
• ndd: 删除光标下面n行
• yy: 复制光标所在行
• nyy: 复制光标下面n行

• 小写p: 将复制的内容在光标下一行粘贴

• dw: 删除光标后的单词剩余部分

• d$: 删除光标后的该行剩余部分
• /string: 查找string,有结果后n查找下一个，N查找上一个
• :set nu : 显示行号
• 清空文件： 先执行gg跳至文件首行,再执行dG就清空了文件。

查找与替换

:s（substitute）命令用来查找和替换字符串。语法如下：
:{作用范围}s/{目标}/{替换}/{替换标志}

例如: 输入:进入命令模式，然后%s/foo/bar/g会在全局范围(%)查找foo并替换为bar，所有出现都会被替换(g)

查看和设置编码

:set fileencoding即可显示文件编码格式。

以在Vim中直接进行转换文件编码，比如将一个文件转换成utf-8格式
:set fileencoding=utf-8

用vim来设置UTF-8编码的BOM标记:

1
2
3

:set nobomb // 去掉BOM
:set bomb // 加上BOM
:set bomb? //查询当前UTF-8编码的文件是否有BOM标记

Vim 跳到某行

在编辑模式下输入ngg

vim +25 my_file.txt会直接打开文件，并将光标定位在第25 行

安装 Vim 主题

1. 下载主题文件，比如solarized.vim
2. 找到vim的runtime路径,在Vim的命令行模式输入 echo $VIMRUNTIME会显示。Ubuntu 17.10的是/usr/share/vim/vim80。它里面有colors文件夹，放入下载的主题文件。
3. 修改.vimrc文件，它应该在/etc/vim目录，添加以下内容：

1
2
3

syntax enable
set background=dark
colorscheme solarized

然后重启Vim即可

配置Vim

/etc/vim/vimrc添加下面内容:

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22

set nu
colorscheme falcon

"禁止生成临时文件
set nobackup
set noswapfile

"搜索逐字符高亮
set hlsearch
set incsearch
set confirm
set background=dark
set autoread
set cursorline

hi CursorLine   cterm=NONE ctermbg=darkred ctermfg=white 
hi CursorColumn cterm=NONE ctermbg=darkred ctermfg=white

filetype plugin on

set showcmd     " Show (partial) command in status line.
set showmatch       " Show matching brackets.

配置Vim的光标颜色样式

1
2
3
4
5
6
7
8
9
10
11
12
13
14

if &term =~ "xterm"
    " INSERT mode
    let &t_SI = "\<Esc>[5 q" . "\<Esc>]12;orange\x7"
    " REPLACE mode
    let &t_SR = "\<Esc>[3 q" . "\<Esc>]12;black\x7"
    " NORMAL mode
    let &t_EI = "\<Esc>[5 q" . "\<Esc>]12;red\x7"
endif
" 1 -> blinking block  闪烁的方块
" 2 -> solid block  不闪烁的方块
" 3 -> blinking underscore  闪烁的下划线
" 4 -> solid underscore  不闪烁的下划线
" 5 -> blinking vertical bar  闪烁的竖线
" 6 -> solid vertical bar  不闪烁的竖线

定义模板类时，函数声明和实现都必须放在头文件里，否则编译失败，准确地讲，是在链接阶段报错．原因在于编译器虽然也编译了包含模板定义的源码文件，但是该文件仅仅是模板的定义，而并没有真正的实例化出具体的函数来。因此在链接阶段，编译器进行符号查找时，发现源码文件中的符号，在所有二进制文件中都找不到相关的定义，因此就报错了。
不过，函数的实现可以放在头文件的类外，不一定必须在类体内．

参考：
C++模板编译模型

new运算是先分配内存再执行构造函数，delete是先执行析构函数再释放内存。

STL allocator将这些操作做了精密分工：内存配置有alloc::allocate()负责，内存释放由alloc::deallocate()负责； 对象构造由::construct()负责，对象析构由::destroy()负责。

STL采用了两级配置器，当分配的空间大小超过128字节时，会使用第一级空间配置器，直接使用malloc()、realloc()、free()函数进行内存空间的分配和释放；当分配的空间小于128字节时，为减少申请小内存造成的内存碎片和额外负担问题，将使用第二级空间配置器，它采用了内存池技术，通过16个free-list来配置和回收内存，free-list对内存的需求量按8的倍数处理，也就是16个free-list分别管理8,16,24……128字节的内存区块。

C++所有的标准容器类都接受一个allocator类作为其模板参数；这个参数有一个默认值，比如std::vector是 vector >的简写。

1
2
3
4

template <class T, class Alloc = alloc>  // 预设使用 alloc 为配置器
class vector {

}

1
2

std::string s="123";
printf("%s",s);

结果报错： cannot pass non-trivial object of type ‘std::string’ (aka ‘basic_string, allocator >’) to variadic function; expected type from format string was char*

也有可能不报错但是显示不正常，这跟编译器有关。

在main函数中访问回调函数中处理的变量

做法是让类的成员函数做回调函数，在回调函数中处理相应变量，在main函数中实例化类，然后通过返回对象的成员进行访问

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35

class Listener 
{
public:
    double theta1f;
    double theta2f;
    double theta3f;

    void callback(const std_msgs::Float32MultiArray::ConstPtr& msg);
};

void Listener::callback(const std_msgs::Float32MultiArray::ConstPtr& msg) 
{
    theta1f = msg->data[0];
    theta2f = msg->data[1];
    theta3f = msg->data[2];
}

int main(int argc, char **argv) 
{
    ros::init(argc, argv, "node");
    ros::NodeHandle nh;
    ros::Rate loop_rate(30);
    Listener listener;
    ros::Subscriber sub = nh.subscribe<std_msgs::float32multiarray>("topic_subscribed", 1, &Listener::callback, &listener);
    while (ros::ok())
    {
        ros::spinOnce();
        ROS_INFO("This is theta1f: %.2f", listener.theta1f);
        ROS_INFO("This is theta2f: %.2f", listener.theta2f);
        ROS_INFO("This is theta2f: %.2f", listener.theta2f);
        loop_rate.sleep();
    }

    return 0;
}

回调函数中访问main函数中的变量赋值

以前我都是用全局变量来实现，但这种方法总感觉不保险，后来发现ROS中有专门的解决方法，NodeHandle::subscribe有一个重载可以处理这种情况，用到了boost::bind，其实用std::bind也能实现。代码如下：

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37

#include <ros/ros.h>
#include <std_msgs/Int8.h>
//回调函数里访问main中的一个结构体
typedef struct _Struct
{
  int        m;
  double     n;
} myStruct;

void callback(const std_msgs::Int8ConstPtr& msg, myStruct p)
{
  ROS_INFO("msg: %d", msg->data);
  ROS_INFO("m: %d",p.m);
  ROS_INFO("n: %f",p.n);
  sleep(1);
}


int main(int argc, char** argv)
{
  ros::init(argc,argv, "Sub");
  ros::NodeHandle nh;

  myStruct p;
  p.m = 7;
  p.n = 1.85;

  // "_1" 是占位符，对应 void callback(const std_msgs::Int8ConstPtr& msg, myStruct p)第一个参数
  /*  subscribe (
   * const std::string &base_topic,
   * uint32_t queue_size,
   * const boost::function< void(const std_msgs::Int8ConstPtr &)>   &callback  )
   */
  ros::Subscriber sub = nh.subscribe<std_msgs::Int8>("topic", 20, boost::bind(&callback, _1, p) );
  ros::spin();
  return 0;
}

myStruct是我自定义的结构体，在main函数里对其声明的变量赋值，回调的形参里多了它的变量。
其中subscribe函数的原型是这个：

1
2
3
4
5
6
7

template<class M >
Subscriber ros::NodeHandle::subscribe(const std::string& topic,
	uint32_t  	queue_size,
	const boost::function< void(const boost::shared_ptr< M const > &)> &  	callback,
	const VoidConstPtr &  	tracked_object = VoidConstPtr(),
	const TransportHints &  	transport_hints = TransportHints() 
) 	

与平时的重载形式不同，这次要用到话题的模板类型，第三个形参不是回调函数的指针，而是boost::bind，其中_1是一个占位符，要传给回调函数参数，在发生函数调用时才接受实参；最后是结构体的变量。

注意：回调函数第一个形参必须是const std_msgs::Int8ConstPtr&形式，其他形式比如const std_msgs::Int8Ptr&会报错，另外看到一篇博客说这里不能用引用，但是我用引用也没报错。对于回调函数callback，一般在bind里不用&，但是用了也可以，因为bind可接受函数或函数指针

参考：
How to make callback function called by several subscriber?
How to pass arguments to/from subscriber callback functions

程序演示

下面是我写的一个服务程序，服务文件ctrl.srv的构成为：

1
2
3

int8 cmd
---
bool ret

注意：最好是将所有自定义的服务和消息文件放到一个单独的package里面，否则会出现一个package的修改会影响到另一个用到它的消息/服务的package的编译．

新建srv文件后，容易忘记在CMakeLists里添加这个文件，导致编译失败

服务端

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30

#include <ros/ros.h>
#include <riki_msgs/ctrl.h>

bool control(riki_msgs::ctrl::Request &req, riki_msgs::ctrl::Response &res)
{
    if(req.cmd==0)
    {
        ROS_INFO("shutting down camera");
        system("rosnode kill /usb_cam");
        ROS_INFO("close camera done");
        res.ret = 0;
    }
    else
    {
        ROS_INFO("starting camera");
        system("roslaunch usb_cam usb_cam.launch & ");
        ROS_INFO("camera is up");
        res.ret = 1;
    }
}

int main(int argc, char** argv)
{
    ros::init(argc,argv,"camServer");
    ros::NodeHandle nh;
    ros::ServiceServer server = nh.advertiseService("control_cam",control);
    ROS_INFO("------ waiting for client's request ------");
    ros::spin();
    return 0;
}

可以看出服务端的程序与话题中的订阅者程序高度相似，control函数就是个回调函数。

system函数调用roslaunch时，由于是在fork出的子进程里执行，launch的节点会一直阻塞不返回，在命令最后加&，让子进程返回

service回调函数里只能return true或false，若return整数会导致客户端的call结果为false，但实际成功，这样会影响判断。

service客户端发命令后，出现报错 ERROR: service [/service_name] responded with an error: b’’ ，原因在于service服务端的回调函数必须 return true

advertiseService的部分源码

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15

bool ServiceManager::advertiseService(const AdvertiseServiceOptions& ops)
{
   boost::recursive_mutex::scoped_lock shutdown_lock(shutting_down_mutex_);
   if (shutting_down_)
   {
     return false;
   }
   {
     boost::mutex::scoped_lock lock(service_publications_mutex_);
     // 如果service已经发布，就报错，然后返回，其实这里改成报警比较合适
     if (isServiceAdvertised(ops.service))
     {
       ROS_ERROR("Tried to advertise a service that is already advertised in this node [%s]", ops.service.c_str());
       return false;
     }

如果涉及到耗时的工作，回调函数应该这样写

1
2
3
4
5
6

bool serviceCB(mow_msgs::task::Request &req, mow_msgs::task::Response &res)
{
  // ......
  res.ret = "to charge";
  // 耗时的工作
}

客户端

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42

#include <ros/ros.h>
#include <riki_msgs/ctrl.h>

int main(int argc, char** argv)
{
    ros::init(argc, argv, "controlCam");
    if(argc!=2)
    {
        ROS_INFO("client need command");
        return 1;
    }
    ros::NodeHandle nh;
    ros::ServiceClient client = nh.serviceClient<riki_msgs::ctrl>("control_cam");
    riki_msgs::ctrl srv;
    srv.request.cmd = atoi(argv[1]);
    if(client.exists())
    {
        ROS_INFO("service control_cam is up");
        ROS_INFO("service name:%s",client.getService().c_str());
    }
    else
    {
        ROS_ERROR("service control_cam is not available");
        return 1;
    }
    if(client.call(srv))
    {
        ROS_INFO("client calling srv !");
        if(srv.request.cmd>0)
            ROS_INFO("Sending command start!");
        else
            ROS_INFO("Sending command stop!");
    }
    else
    {
        ROS_ERROR("client calls srv failed !");
        return 1;
    }
    // 调用成功以后才能获取response
    cout<<"服务端的返回值: "<<srv.response.ret<<endl;
    return 0;
}

构建client的时候后面的路径要写绝对路径，有时候需要加个 /

客户端的程序与话题发布者的程序高度相似，exists()检查服务端的服务是否启动，若未启动则返回。call调用了服务，成功会返回true，而且调用完成后，可以在客户端程序里获得服务端的返回值

最后，先运行服务端，然后运行客户端，如果是rosrun control_cam controlCam 1则在服务端所在终端启动摄像头程序，若是0则关闭。

另一种使用方式

1
2
3
4
5
6
7
8
9

std_srvs::Empty srv;
ros::service::call("/move_base_node/clear_costmaps", srv);

while(!ros::service::call("static_map", req, resp))
{
    ROS_WARN("Request for map failed; trying again...");
    ros::Duration d(0.5);
    d.sleep();
}

常用函数

ros::ServiceClient常用函数：

1
2
3
4
5
6
7
8
9

bool call (Service &service)  //调用service，client发起通信。成功返回true

bool exists ()  //检查相应名称的服务是否可用

std::string getService ()  //返回客户端通信的服务名称
// 单例模式
static const ServiceManagerPtr &  instance ()

bool    unadvertiseService (const std::string &serv_name)

问题

切换算法时，会有个报警 Tried to advertise a service that is already advertised in this node。这个其实无任何影响，报警在ROS底层的源码，原因在于GlobalPlanner::initialize函数有一句:

1

make_plan_srv_ = private_nh.advertiseService("make_plan", &GlobalPlanner::makePlanService, this);

1
2
3
4

std::string makePlanServiceName = "/move_base/"+name+"/make_plan";

ros::ServiceManager::instance()->unadvertiseService(makePlanServiceName);
make_plan_srv_ = private_nh.advertiseService("make_plan", &GlobalPlanner::makePlanService, this);

md5不匹配

调用service时报错md5不匹配，其实是调用失败了，call的返回值是false，首先应检查客户端定义是否正确和服务是否存在:

客户端一直阻塞

我在move_base.cpp里写了一个函数 func，是rosservice的客户端，调用service clear_costmaps。在MoveBase的其他函数里，调用这个函数，结果发现会一直阻塞。后来注意到服务端程序就是MoveBase::clearCostmapsService，也就是在同一个类里

客户端call service阻塞的原因只有两个：

1. 多个客户端call 同一个service，而服务端一次只能处理一个请求
2. 服务端程序没有return值

服务端程序是MoveBase的，而且有了返回值，那么只可能是第一个原因了。

参考：blocking service callbacks

无法进入图形界面

![https://live.staticflickr.com/7870/46689319155_bc1d198671_z.jpg]
![https://live.staticflickr.com/7892/33727819068_7e69d575f5.jpg]

1.Ctrl+ALt+F1（F1~F5都可以）进入控制台

2.输入用户名和密码进入系统；

3.依次输入以下命令

1
2
3
4
5

cd /etc/X11

sudo cp xorg.conf.failsafe xorg.conf

sudo reboot

开机启动VMWare并启动指定系统

将VMWare的快捷方式放到C:\ProgramData\Microsoft\Windows\Start Menu\Programs\StartUp，然后打开快捷方式，修改目标：

改成

1

"....exe"  -x  "/path_to_system/Ubuntu 64.vmx"

如何让虚拟机网段与主机相同

先用管理员身份打开VMWare，再打开编辑-虚拟网络编辑器，将网络做如图设置：桥接模式，并选择网卡为主机真实网卡。这样进入虚拟机后，IP就同主机了，设置成DHCP即可。

无法打开虚拟机，提示要获得所有权，但还是失败

很简单，删除虚拟机文件夹下的lck文件夹即可，映像被lck锁定了。应当是上次没有正常关闭虚拟机导致的

硬盘空间太少

向虚拟机复制文件就是先在cache文件夹里面生成一个同样的文件，并使用拷贝的方式将其拷贝到拖拽放置的目录中。因此，如果不进行清理的话，cache文件夹中产生的文件，并不会自动删除或者释放。

该文件夹位于用户目录下/home/xxxx/.cache/vmware/drag_and_drop进入文件夹，可以见到每一次拖拽产生的文件，都在子文件夹中有一份。直接删除便可以腾出海量的空间。

vmware tool安装后仍然不能复制的问题

1
2
3
4

sudo apt-get upgrade
sudo  mkdir /mnt/cdrom 
sudo apt-get install open-vm-tools-desktop -y
sudo reboot

VM虚拟机增加磁盘空间

VM虚拟机增加磁盘空间

VMWare 分辨率设置

参考链接

服务和话题

rosservice call

rosservice call addTwoNum 3 4: 调用服务，addTwoNum是服务名称， 名称不加引号，3和4是服务中的req变量的值，注意必须按服务文件中的顺序赋值。

但上面是简单情况，srv文件稍微有点复杂时，就会怎么填也不对，个人认为这是ROS Service很失败的一个地方。
例如srv文件的请求部分是这样的：

1
2

string request_string
string album

1
2

rosservice call service_name "request_string: ''
album: ''"

call执行成功时，终端不会有任何结果。但是经常出现这样的错误： ERROR: service [/control_cam] responded with an error: ，但程序执行没有问题。原因是 程序中对srv文件中的应答没有处理

其他常用命令：

• rosservice list: 显示当前所有活动的服务
• rosservice info addTwoNum: 显示服务的信息
• rosservice type addTwoNum: 显示服务的变量类型

其实服务的相关命令和话题的很类似

ROS的服务类型

启动乌龟节点时，有一个服务叫clear，类型：

1
2
3

rosservice type clear

std_srvs/Empty

std_srvs包还有两个服务：std_srvs/Trigger和std_srvs/SetBool，但是很不常用

• locate的速度比find快，因为它并不是真的查找文件，而是查数据库。

• 新建的文件，我们立即用locate命令去查找，一般是找不到的，因为数据库的更新不是实时的，而是每天

• locate命令所搜索的后台数据库在/var/lib/mlocate这个目录下，可能有些Linux系统位置不同，具体我们可以用locate locate查询

• 并不是所有的目录下的文件都会用locate命令搜索到，/etc/updatedb.conf这个配置文件中，配置了一些locate命令的一些规则。

• updatedb会大致每天运行，这是靠系统的crontab命令实现的

• updatedb -U：更新指定目录相关的数据库信息。默认是整个系统，耗时比较长，因此可以使用该参数，比如sudo updatedb -U /home/user/

updatedb的配置文件 /etc/updatedb.conf

1
2
3
4
5

cat /etc/updatedb.conf 
PRUNE_BIND_MOUNTS = "yes"
PRUNEFS = "9p afs anon_inodefs auto autofs bdev binfmt_misc cgroup cifs coda configfs cpuset debugfs devpts ecryptfs exofs fuse fuse.sshfs fusectl gfs gfs2 gpfs hugetlbfs inotifyfs iso9660 jffs2 lustre mqueue ncpfs nfs nfs4 nfsd pipefs proc ramfs rootfs rpc_pipefs securityfs selinuxfs sfs sockfs sysfs tmpfs ubifs udf usbfs fuse.glusterfs ceph fuse.ceph"
PRUNENAMES = ".git .hg .svn"
PRUNEPATHS = "/afs /media /mnt /net /sfs /tmp /udev /var/cache/ccache /var/lib/yum/yumdb /var/spool/cups /var/spool/squid /var/tmp /var/lib/ceph"

• PRUNENAMES 搜索时不搜索的文件类型
• PRUNEPATHS 搜索时不搜索的路径
• PRUNE_BIND_MOUNTS = "yes" 开启搜索限制
• PRUNEFS 搜索时不搜索的文件系统

locate 常用命令

1
2
3
4
5
6
7

locate -c   # 查询指定文件的数目。(c为count的意思)
locate -e   # 只显示当前存在的文件条目。(e为existing的意思)
locate -i   # 查找时忽略大小写区别

# 使用正则表达式查找文件
locate -r makefile$		# 以makefile结尾的文件
locate -r ^/home/user/		# 以/home/user/开头的文件		

从结果中取出词尾是config2的

注意：locate的结果可能是不存在的文件，这时最好用locate -e

locate 查找文件tree.xml，也就是知道完整的文件名时，那么最好用 locate /tree.xml，如果不加/，会显示test_tree.xml的结果

find 常用命令

查找当前目录中(包括子目录)所有扩展名为cfg的文件:

1
2

# 或者 '*.cfg'
find -name *.cfg

• find . -name '*.cpp' -mmin -30 当前目录下，最近30分钟修改的cpp文件

• find . -name '*.cpp' -mtime 0 当前目录下，最近24小时修改的cpp文件

• find . -type f -mtime 0 当前目录下，最近24小时修改的常规文件