自动驾驶消息传输机制-LCM

需要用到LCM消息通讯,遂研究下。

这里写目录标题

  • 1 LCM简介
  • 2. LCM源码分析
  • 3 LCM C++教程与实例
    • 3.1 安装配置及介绍
    • 3.2 创建类型定义
    • 3.3 初始化LCM
    • 3.4 发布publish一个消息
    • 3.5 订阅和接收一个消息
    • 3.6 LCM进程间通讯
    • 3.7 注意事项?
      • 3.7.1 当数据结构定义的是数组时,生成的头文件中会用vector来定义这个数据。进行赋值时需要先 resize vector 的长度。不然会填充数据时会报错。
  • 4 LCM 发 收 录 读
    • 4.1 发、收
    • 4.2 录、读
  • 5 ROS与LCM

1 LCM简介

LCM(Lightweight Communications and Marshalling)是一组用于消息传递和数据编组的库和工具,其基于UDP传输的属性,传输速度较快,其目标是高带宽和低延迟的实时系统。它提供了一种发布/订阅消息传递模型以及带有各种编程语言C++、Java、python等应用程序绑定的自动编组/解组代码生成,LCM通过将消息封装在不同的Channel中进行通信,这点类似于ROS中的Topic。
适用于高速自动驾驶场景的LCM通信协议,其特点是轻量化、传输速度快,易封装。
LCM是去ROS化的优秀选择

LCM官方:Github:lcm-proj/lcm
LCM论文:LCM: Lightweight Communications and Marshalling
LCM技术报告:LCM技术报告

2. LCM源码分析

LCM的底层代码都是使用C语言进行编写的,但是充斥着面向对象的风格,甚至实现了一个虚函数表来抽象不同通信通信方式的底层实现。因此,以面向对象的方式来分析代码,忽略C语言实现细节,直接将对某个结构体进行操作的独立函数视为该结构体的成员函数进行分析,且忽略指针,编写类图来分析C代码。

LCM提供了多种底层通信方式,包括tcp、udp、memq、file等,通过解析url来决定使用何种通信方式。主结构体为lcm_t。其类图如下图所示
在这里插入图片描述
我们可以看到一共有五种通信方式分别是lcm_udpm_t,lcm_memq_t,lcm_mpudpm_t,lcm_tcpq_t,lcm_logprov_t。

内存队列通信 lcm_memq_t
memq的通信方式用内存队列进行通信(Memory Queue),只能进行不同线程间的通信,所有的消息都在同一个内存队列中,所有的异步通信方式是linux的管道(pipe)。每个channel的所有handler顺序执行,当所有的handler执行完毕后,lcm负责销毁msg的内存。此外,不同channel也是顺序执行的,因为lcm要求同时只能有一个线程在执行lcm_handle。这就意味着所有handler都是顺序执行的。如果某个handler运行的时间超长,那么第接下来的handler拿到消息的时候,消息可能已经失去时效性。如果要实现不同的handler并行执行,用户需要书写不少额外的代码。

#include <chrono>
#include <iostream>
#include <lcm/lcm-cpp.hpp>
#include <thread>#include "exlcm/example_t.hpp"void publisher(lcm::LCM &lcm_in)
{for (int i = 0; i < 10; ++i) {exlcm::example_t my_data;my_data.timestamp = std::chrono::duration_cast<std::chrono::milliseconds>(std::chrono::steady_clock::now().time_since_epoch()).count();my_data.num_ranges = 15;my_data.ranges.resize(my_data.num_ranges);for (int i = 0; i < my_data.num_ranges; i++)my_data.ranges[i] = i;my_data.name = "example string";my_data.enabled = true;lcm_in.publish("EXAMPLE", &my_data);lcm_in.publish("LONG", &my_data);std::this_thread::sleep_for(std::chrono::milliseconds(100));}
}void example_subscriber(lcm::LCM &lcm_in, int id)
{lcm::LCM::HandlerFunction<exlcm::example_t> func;func = [id](const lcm::ReceiveBuffer *rbuf, const std::string &channel,const exlcm::example_t *msg) {const auto now = std::chrono::duration_cast<std::chrono::milliseconds>(std::chrono::steady_clock::now().time_since_epoch()).count();std::cout <<"EXAMPLE " << id << " received message at  " << msg->timestamp << ". Time passed "<< now - msg->timestamp << "ms" << std::endl;std::this_thread::sleep_for(std::chrono::milliseconds(50));};lcm_in.subscribe("EXAMPLE", func);while (0 == lcm_in.handle()) {std::cout << "EXAMPLE thread " << id << " handled the message." << std::endl;}
}void long_subscriber(lcm::LCM &lcm_in)
{lcm::LCM::HandlerFunction<exlcm::example_t> func;func = [](const lcm::ReceiveBuffer *rbuf, const std::string &channel,const exlcm::example_t *msg) {const auto now = std::chrono::duration_cast<std::chrono::milliseconds>(std::chrono::steady_clock::now().time_since_epoch()).count();std::cout << "LONG received message at  " << msg->timestamp << ". Time passed "<< now - msg->timestamp << "ms" << std::endl;std::this_thread::sleep_for(std::chrono::milliseconds(1000));};lcm_in.subscribe("LONG", func);while (0 == lcm_in.handle()) {std::cout << "LONG thread " << " handled the message." << std::endl;}
}int main(int argc, char **argv)
{lcm::LCM lcm_in("memq://");if (!lcm_in.good())return 1;std::thread pub_thread(publisher, std::ref(lcm_in));std::thread sub_thread_1(example_subscriber, std::ref(lcm_in), 1);std::thread sub_thread_2(example_subscriber, std::ref(lcm_in), 2);std::thread sub_thread_3(long_subscriber, std::ref(lcm_in));pub_thread.join();sub_thread_1.join();sub_thread_2.join();return 0;
}

文件通信 lcm_logprov_t
该种通信方式利用文件进行通信,可以读也可以写,其实就是log replay的底层实现。一共有读写两种模式。写模式比较简单,就是往文件中写消息。读模式比较复杂,除了主线程,还有一个读文件线程,两个线程通过管道进行通信。主线程读完一个event之后,会根据log播放速度计算下一个event的应该触发的时间,让读线程sleep一段时间,sleep结束后就触发下一个event。此外,它还支持从某一个时刻开始播放log。

tcp通信 lcm_tcpq_t
采用TCP套接字进行通信。其C/C++代码只提供了TCP的客户端,publish/subscribe方法都会尝试和服务器端建立连接,然后进行magic number校验,以确认是LCM的服务器。publish方法会直接发送消息。而subscribe方法则是将自己监听那些消息告诉给服务器,但是客户端并不检查是否成功发送注册小写给服务器端,这一点非常奇怪。由于每次handle或者publish消息都需要重新建立TCP连接,这会大大限制低延时和高速通信,不推荐使用。lcm-jave提供了服务器实现,可以参考。

udp通信 lcm_udpm_t
采用UDP套接字继续通信。采用UDP组播的方式进行通信,组播的方式在有多个接受者的情况下只复制一份数据,提高传送效率。它是内部是双线程方案,一个主线程,一个reader线程,两个线程通过pipe通信,一个管道被用来通知主线程消息到达,另一个被主线程用来quit读线程。主线程负责发消息和处理正常的lcm逻辑,还可以向reader线程发送quit的信号。reader线程负责不断地接收并组装消息,一旦消息组装完毕且主线程没有消息可用,那么通知主线程处理消息。

发送消息 Publish
一次只允许一个线程发送消息。如果消息的大小很小,直接可以用一个packet发送完,相对简单。如果消息比较大,需要将消息切割为很多个fragment,fragment会打上序列号,接收端通过序列号组装消息。第一个fragment比较特别,有channel信息。

订阅消息 Subscribe
订阅消息就是加入组播群中去。它首先会检查reader线程是否被建立,如果没有建立,有建立reader线程。创建套接字然后加入组播群。

读取消息 Read
每读完一个UDP packet,如果是短消息,直接将其读取放入message queue;如果是长消息,那么读取的是消息的一个fragment,会将其送入一个缓存结构中,该结构提前分配好消息的内存,只需往其中memcpy即可,如果收到一个不是同一个消息的fragment,直接将老的弃掉。每一个发送消息的端口都有自己的消息缓存结构,这样就不会冲突。一但消息接受完毕,就会将其送入message queue中。为了避免调用过多的malloc,它还设计了一个ringbuffer来快速分配内存。

ring buffer的设计
它设计了一个很巧妙的ring buffer,提前分配好所需内存空间,然后在该内存中分配所需数据块,还提供了简单的数据校检,下图是它的类图。
在这里插入图片描述
RingBuffer的内存状态如下图所示:
在这里插入图片描述
多端口UDP通信 lcm_mpudpm_t
在上一个lcm_udpm_t中,所有channel都通过同一个端口进行收发,但是一个进程所需的消息经常来自于多个端口。lcm_mpudpm_t允许我们使用多个端口进行UDP通信。我们需要为每个channel指定一个端口,一个端口可以对应多个channel。我们不需要提前指定每个channel对应的端口,该通信方式会通过channel名的hash来选定,如果哈希冲突,那么同一个端口就会发送多个channel消息,而且会将该消息传播给其他客户端进行同步。其实就是实现了端口自发现功能。

发送消息 Publish
实际消息发送和lcm_udpm_t一样,但是添加了一个端口分配和同步。根据哈希值来分配端口。然后将新的channel和端口的映射消息组播给其他节点,进行同步。

订阅消息 Subscribe
和lcm_udpm_t不同的地方是如果该channel没有分配端口,它会发送组播消息CHANNEL_TO_PORT_MAP_REQUEST_CHANNEL要求获得最新的端口映射表,将订阅的操作缓存起来,其实就是询问有没有publisher在发送消息。直到获得最新的端口映射表之后,才会真正执行订阅操作。

读取消息 Read
它会逐一读取每个端口,然后组装消息,根据不同的消息类型进行不同操作,主要分为内部消息和普通消息。内部消息就是CHANNEL_TO_PORT_MAP_REQUEST_CHANNEL、CHANNEL_TO_PORT_MAP_UPDATE_CHANNEL和SELF_TEST_CHANNEL。

总结
至此,我们看完了lcm的通信架构,C/C++源码阅读完毕,lcm-spy等工具没有介绍。总的来说,这个框架简洁直观,代码的可读性高,功能齐全,实现了低延时的去中心化的点对点通信,支持序列化和反序列化代码自动生成,支持多种通信方式,甚至提供了节点自发现的功能,是一个极佳的轻量级通信架构。

3 LCM C++教程与实例

3.1 安装配置及介绍

在/usr/local/bin目录下安装lcm-gen, lcm-logger, lcm-logplayer, lcm-logplayer-gui, lcm-spy可执行程序
在/usr/local/lib目录下安装liblcm.la, liblcm.so, liblcm.so.1, liblcm.so.1.3.3库文件
在/usr/local/include目录下安装eventlog.h, lcm_coretypes.h, lcm-cpp.hpp, lcm-cpp-impl.hpp, lcm.h头文件配置头文件, 在home/igs/.profile中添加以下内容后, 重启:

#glib c++
export CPLUS_INCLUDE_PATH=$CPLUS_INCLUDE_PATH:/usr/include/glib-2.0:/usr/lib/x86_64-linux-gnu/glib-2.0/include
#lcm
#export CLASSPATH=.:$CLASSPATH:/program/3rd/lcm/lcm-1.2.1/lcm-java/build/lcm
export LD_LIBRARY_PATH=$LD_LIBRARY_PATH:/usr/local/lib
#glib c
export C_INCLUDE_PATH=$C_INCLUDE_PATH:/usr/include/glib-2.0:/usr/lib/x86_64-linux-gnu/glib-2.0/include

为lcm创建一个ld.so.conf文件
export LCM_INSTALL_DIR=/usr/local/lib
sudo sh -c “echo $LCM_INSTALL_DIR > /etc/ld.so.conf.d/lcm.conf”
更新sudo ldconfig
配置pkgconfig来查找lcm.pc
export PKG_CONFIG_PATH=$PKG_CONFIG_PATH:$LCM_INSTALL_DIR/pkgconfig

C++ API 提供了三个类两个结构体封装LCM:

class lcm::LCM
struct lcm::ReceiveBuffer
class lcm::Subscription
struct lcm::LogEvent
class lcm::LogFile

3.2 创建类型定义

(type definition)
由于类型定义与编程语言类型无关,故第一步对所有编程语言都一样; 类型规则的定义与C语言非常像, 下面是一个名为example_t的示例类型, 创建一个名为 example_t.lcm 的文件

文件名: example_t.lcm
package exlcm;
struct example_t
{
int64_t timestamp;
double position[3];
double orientation[4];
int32_t num_ranges;
int16_t ranges[num_ranges];
string name;
boolean enabled;
}

更多类型规范,下表是基本类型规范:

typeDescription
int8_t8-bit signed integer
int16_t16-bit signed integer
int32_t32-bit signed integer
int64_t64-bit signed integer
float32-bit IEEE floating point value
double64-bit IEEE floating point value
stringUTF-8 string
booleantrue/false logical value
byte8-bit value
除此之外还可以定义数组;

生成特定编程语言的绑定(bindings):

lcm-gen -x example_t.lcm
运行lcm-gen -h 获取命令行帮助

运行之后,会在当前文件夹生成一个exlcm/example_t.hpp 的文件, 它包含了之前定义类型的同名类:

class example_t
{public:int64_t    timestamp;double     position[3];double     orientation[4];int32_t    num_ranges;std::vector< int16_t > ranges;std::string name;int8_t     enabled;
}

3.3 初始化LCM

任何使用LCM的应用程序第一步就是初始化LCM库, 下面是一个例子:

#include <lcm/lcm-cpp.hpp>int main(int argc, char ** argv)
{lcm::LCM lcm;if(!lcm.good())return 1;// Your application goes herereturn 0;
}

3.4 发布publish一个消息

// send_message.cpp
#include <lcm/lcm-cpp.hpp>
#include "exlcm/example_t.hpp"int main(int argc, char **argv)
{lcm::LCM lcm;if (!lcm.good())return 1;exlcm::example_t my_data;my_data.timestamp = 0;my_data.position[0] = 1;my_data.position[1] = 2;my_data.position[2] = 3;my_data.orientation[0] = 1;my_data.orientation[1] = 0;my_data.orientation[2] = 0;my_data.orientation[3] = 0;my_data.num_ranges = 15;my_data.ranges.resize(my_data.num_ranges);for (int i = 0; i < my_data.num_ranges; i++)my_data.ranges[i] = i;my_data.name = "example string";my_data.enabled = true;lcm.publish("EXAMPLE", &my_data);return 0;
}

lcm::LCM::publish() 会将数据序列化为字节流,并使用LCM将数据包传输到任何感兴趣的接收者, 字符串 EXAMPLE 是频道名称, 是随每个数据包一起发送的字符串.

3.5 订阅和接收一个消息

subscribe and receive
下面是一个接收 EXAMPLE 的例子:

// listener.cpp
#include <stdio.h>#include <lcm/lcm-cpp.hpp>
#include "exlcm/example_t.hpp"class Handler 
{public:~Handler() {}void handleMessage(const lcm::ReceiveBuffer *rbuf, const std::string &chan,const exlcm::example_t *msg){int i;printf("Received message on channel \"%s\":\n", chan.c_str());printf("  timestamp   = %lld\n", (long long) msg->timestamp);printf("  position    = (%f, %f, %f)\n", msg->position[0], msg->position[1],msg->position[2]);printf("  orientation = (%f, %f, %f, %f)\n", msg->orientation[0], msg->orientation[1],msg->orientation[2], msg->orientation[3]);printf("  ranges:");for (i = 0; i < msg->num_ranges; i++)printf(" %d", msg->ranges[i]);printf("\n");printf("  name        = '%s'\n", msg->name.c_str());printf("  enabled     = %d\n", msg->enabled);}
};int main(int argc, char **argv)
{lcm::LCM lcm;if (!lcm.good())return 1;Handler handlerObject;lcm.subscribe("EXAMPLE", &Handler::handleMessage, &handlerObject);while (0 == lcm.handle())//阻塞的{// Do nothing}return 0;
}

lcm用handle()函数来处理消息回调(接受到消息后就执行回调函数)
lcm.handle() 是阻塞的。只能放到单独的线程里执行。
lcm.handleTimeout(10) 可以超时后返回,然后执行后面的代码。设置的时间的单位是毫秒。

文件结构:

example_t.lcm
listener.cpp
Makefile
read_log.cpp
send_message.cpp

CMakeList.txt

ROS1?
find_package(lcm REQUIRED)
include(${LCM_USE_FILE})
target_link_libraries(${PROJECT_NAME} lcm)

ROS2?
set(dependencies
“geometry_msgs”
“nav_msgs”
“rclcpp”
“sensor_msgs”
“tf2”
“tf2_msgs”
“OpenCV”
“PCL”
# “lcm” #不要在ament_target_dependencies中加入lcm,不起作用的
“cv_bridge”
“image_transport”
)
ament_target_dependencies(${EXEC_NAME} ${dependencies} )
# 不加的话会报undefined reference to `lcm_destroy’
target_link_libraries(${EXEC_NAME} lcm) # 使用target_link_libraries添加lcm依赖

lcm-gen -x *.lcm;
在当前文件夹运行 make, 会出现三个可执行文件:listener, read_log, send_message;
运行 ./listener 再开一个窗口运行 ./send_message 可以看到 listener 窗口接收到信息:

3.6 LCM进程间通讯

当需要通信的进程分别在两台机器里时,需要设置如下环境变量(两台电脑命令行窗口都运行这条)。

export LCM_DEFAULT_URL=udpm://239.255.76.67:7667?ttl=1
如果需要通信的两个进程在同一台主机上则不需要运行上面的命令

如果需要在两个docker间实现通信,需要在同一网络下启动这两个容器。

#以相同的网络启动容器
docker run -it --name test_docker0 --network nat shoufei/kinetic:latest /bin/bash
docker run -it --name test_docker1 --network nat shoufei/kinetic:latest /bin/bash

注意上面的两个docker启动命令均添加了–network nat参数。其中nat是用下面的命令建立的网络接口。

docker network create nat

docker中也需要执行上面设置环境变量的命令

3.7 注意事项?

3.7.1 当数据结构定义的是数组时,生成的头文件中会用vector来定义这个数据。进行赋值时需要先 resize vector 的长度。不然会填充数据时会报错。

void TestNode::test_tof_callback(const sensor_msgs::msg::PointCloud2::SharedPtr msg)
{testlcm::tof_points_t data;size_t size = msg->height * msg->width;pcl::PCLPointCloud2 pcl_pc2;pcl_conversions::toPCL(*msg,pcl_pc2);pcl::PointCloud<pcl::PointXYZ>::Ptr temp_cloud(new pcl::PointCloud<pcl::PointXYZ>);pcl::fromPCLPointCloud2(pcl_pc2,*temp_cloud);data.timestamp = msg->header.stamp.nanosec * 0.001;data.num_points = size;data.xs.resize(data.num_points);//当数据结构定义的是数组时,生成的头文件中会用vector来定义这个数据。进行赋值时需要先resize vector的长度。不然会填充数据时会报错。data.ys.resize(data.num_points);data.zs.resize(data.num_points);for(uint32_t i = 0; i < size; ++i){data.xs[i] = temp_cloud->points[i].x;data.ys[i] = temp_cloud->points[i].y;data.zs[i] = temp_cloud->points[i].z;}RCLCPP_INFO(this->get_logger(), "got test tof points");lcm.publish(REAR_TOF_POINTS_MSG, &data);
}

4 LCM 发 收 录 读

4.1 发、收

step1:定义结构体
将要发送的数据,定义在一个结构体中,写在以 .lcm 结尾的文件中。比如:

struct example_t
{int64_t  timestamp;double   position[3];double   orientation[4]; int32_t  num_ranges;int16_t  ranges[num_ranges];string   name;boolean  enabled;
}

其中,数据类型需要使用lcm支持的类型,如下:
在这里插入图片描述
定义好数据结构后,生成对应语言使用的头文件。使用如下指令:
在这里插入图片描述
没有问题的话就会生成example_t.hpp,这个文件是不允许修改的。

step2:LCM初始化
数据结构的头文件生成后,在主程序代码里#include进来

#include <lcm/lcm-cpp.hpp>
#include “example_t.hpp"

定义lcm的对象并初始化

lcm::LCM lcm;
if(!lcm.good())
return 1;

初始化干了什么呢?我们进去看一下:

inline bool
LCM::good() const
{ return this->lcm != NULL; }

step3:赋值并发送
在程序中定义一个数据结构的对象,并在相应的位置进行赋值

example_t my_data;
my_data.timestamp = 0;
my_data.position[0] = 1;
my_data.position[1] = 2;
my_data.position[2] = 3;

发送:

lcm.publish(“EXAMPLE”, &my_data);

其中"EXAMPLE"为通道名,可以自由定义,接收的时候也要指定,二者保持一致才能收到。
发送的数据较多时,可以定义多个数据结构,相应会有多个lcm生成的头文件。用不同的通道名来区分他们。发送时也可灵活选择对哪些通道的数据进行发送。
至此,lcm发送的方式就结束了,还是很简洁的。整个发送代码如下:

 	  #include <lcm/lcm-cpp.hpp>#include "exlcm/example_t.hpp"int main(int argc, char ** argv){lcm::LCM lcm;if(!lcm.good())return 1;exlcm::example_t my_data;my_data.timestamp = 0;my_data.position[0] = 1;my_data.position[1] = 2;my_data.position[2] = 3;lcm.publish("EXAMPLE", &my_data);return 0;}

接收消息
消息接收主要利用lcm.subscribe()函数,函数定义如下:

LCM::subscribe(const std::string& channel,void (MessageHandlerClass::*handlerMethod)(const ReceiveBuffer* rbuf, const std::string& channel, const MessageType* msg),MessageHandlerClass* handler)

上面需要3个参数,分别是(通道名、回调函数、句柄对象)。
接收时第一个参数为topic name, 第二个参数为自定义类::处理函数, 第三个参数为自定义类的实例化.
subscribe()还有另一种重载形式,其中回调函数只要2个参数,不用绑定具体的类对象。

LCM::subscribe(const std::string& channel,void (MessageHandlerClass::*handlerMethod)(const ReceiveBuffer* rbuf, const std::string& channel))

step1:LCM初始化

 #include <stdio.h>#include <lcm/lcm-cpp.hpp>
#include "exlcm/example_t.hpp"int main(int argc, char** argv){lcm::LCM lcm;if(!lcm.good())return 1;}

step2:定义句柄及回调函数
句柄类可以如下定义,其中handleMessage即为subscribe时使用的回调函数:

class Handler {public:~Handler() {}void handleMessage(const lcm::ReceiveBuffer* rbuf,const std::string& chan, const exlcm::example_t* msg){int i;printf("Received message on channel \"%s\":\n", chan.c_str());printf("  timestamp   = %lld\n", (long long)msg->timestamp);printf("  position    = (%f, %f, %f)\n",msg->position[0], msg->position[1], msg->position[2]);printf("\n");}};

上面代码将接收到的内容打印出来,可以看到,使用了之前定义的消息类型example_t

step3:接收消息
定义句柄对象,调用subscribe()函数接收。其中lcm.handle()

Handler handlerObject;
lcm.subscribe("EXAMPLE", &Handler::handleMessage, &handlerObject);while(0 == lcm.handle());

LCM自动解码消息,再传给回调函数,回调函数可以识别消息类型。因为回调函数在lcm.handle()方法中调度,所以不需要并发执行,这些都在一个单线程中完成。
调用lcm.handle()非常重要,函数会保持阻塞直到有任务需要做。lcm.handle()为阻塞函数,类似于ros::spinOnce(), 当需要处理时跳至处理函数, 无详细接收时阻塞等待. 若不想阻塞等待可以用其他函数???

完整的接收代码如下,代码只会接收通道名为”EXAMPLE"的消息。

	1 #include <stdio.h>2 #include <lcm/lcm-cpp.hpp>3 #include "exlcm/example_t.hpp"4 5 class Handler 6 {7     public:8         ~Handler() {}9 10         void handleMessage(const lcm::ReceiveBuffer* rbuf,11                 const std::string& chan, 12                 const exlcm::example_t* msg)13         {14             int i;15             printf("Received message on channel \"%s\":\n", chan.c_str());16             printf("  timestamp   = %lld\n", (long long)msg->timestamp);17             printf("  position    = (%f, %f, %f)\n",18                     msg->position[0], msg->position[1], msg->position[2]);28         }29 };30 31 int main(int argc, char** argv)32 {33     lcm::LCM lcm;34     if(!lcm.good())35         return 1;36 37     Handler handlerObject;38     lcm.subscribe("EXAMPLE", &Handler::handleMessage, &handlerObject);39 40     while(0 == lcm.handle());41 42     return 0;43 }

一个lcm对象可以有无限个接收器,如果有多个通道的消息需要接收,可以

lcm.subscribe("AAAA", &Handler::handleMessage, &handlerObject);
lcm.subscribe("BBBB", &Handler::handleMessage, &handlerObject);

或者用下面方式接收所有通道

lcm.subscribe(".*", &Handler::handleMessage, &handlerObject);

参考CMake

cmake_minimum_required(VERSION 3.10)  project(LCM)  set(CMAKE_CXX_STANDARD 11)  find_package(lcm)#引入lcm pkg  include_directories("../type")#引入用户自定义数据类型  add_executable(LCM_Client send_msg.cpp)#分别链接发送与接收程序, 不可链接为同一工程.  target_link_libraries(LCM_Client lcm)  add_executable(LCM_Server listener.cpp)  target_link_libraries(LCM_Server lcm)

在引入用户自定义数据时可利用include_directories(“…/type”)将自定义数据hpp所在的文件夹包含, 在cpp程序中已该包含路径为起点引入hpp文件.

4.2 录、读

自己写的终究是不如官方发布的,https://github.com/lcm-proj/lcm/tree/master/lcm-logger
再官方github上找到了用lcm录数据并播放的源码,提供的功能也比较丰富,重要是可以按照信号发送的频率录下来,同时按频率播放,复现当时的场景。简单介绍一下。
源码编译生产2个可执行文件,lcm-logger和lcm-logplayer。
lcm-logger程序提供了命令行参数选择,生成的log是以.00 , .01为后缀的log文件,把后缀替换为.log也是可以使用的。
一般用到的参数有:
–channel:选择录制的lcm信息通道,看源码只能跟一个通道,不能同时选择录2个及以上的通道。如果不选择,会录制所有收到的通道信息。
–split-mb:设置一个大小,达到后自动新建一个新的log,可以避免log太大带来的不方便。
–invert-channels:选择不录某个通道。
如果只需要录制特定的某几个通道,可以修改源码这部分:

    if(logger.invert_channels) {// if inverting the channels, subscribe to everything and invert on the// callbacklcm_subscribe(logger.lcm, ".*", message_handler, &logger);char *regexbuf = g_strdup_printf("^%s$", chan_regex);GError *rerr = NULL;logger.regex = g_regex_new(regexbuf, (GRegexCompileFlags) 0, (GRegexMatchFlags) 0, &rerr);if(rerr) {fprintf(stderr, "%s\n", rerr->message);g_free(regexbuf);return 1;}g_free(regexbuf);} else {// otherwise, let LCM handle the regex//lcm_subscribe(logger.lcm, chan_regex, message_handler, &logger);修改这部分lcm_subscribe(logger.lcm, "LOGITECH_IMAGE", message_handler, &logger);lcm_subscribe(logger.lcm, "RMVCU", message_handler, &logger);}

原来是如果不设置–invert-channels,将会录下选择的某个通道或者所有通道。修改后,如果不设置–invert-channels,录制特定的两个通道。
使用时可以:

./lcm-logger 录制能收到的所有lcm通道,以默认方式命名log文件
./lcm-logger xxx.log 录制能收到的所有lcm通道,以设置的名称命名log文件
./lcm-logger --channel=xxx 录制通道名为xxx的信息,以默认方式命名log文件

lcm-logplayer提供了对录制log的播放,通过lcm把log中的信息再发送出来,同样提供了命令行参数:

Options:\n
-v, --verbose Print information about each packet.\n
-s, --speed=NUM Playback speed multiplier. Default is 1.0.\n
-e, --regexp=EXPR GLib regular expression of channels to play.\n
-l, --lcm-url=URL Play logged messages on the specified LCM URL.\n
-h, --help Shows some help text and exits.\n
\n", cmd);

-v是选择是否把通道信息打印出来
-s是选择发送速度,一般是使用默认速度,还原录制时的场景。
使用时:
./lcm-logplayer -v xxx.log 以默认速度播放xxx.log,同时打印出每次播放内容

5 ROS与LCM

深入地研究ROS的数据传递,因为这关系到能不能真正把ROS用于实际的工程项目中。如果工程只用ROS搭建,那么是不需要用到命题所说的LCM的。但如果ROS只是整体系统的一部分,则需要利用内存共享或者网络传输等方式与其他程序进行数据交互,这时候LCM就是一种比较简单的选择
我们已经知道ROS归根结底是一个多进程的管理工具,因此我们可以把上面的工作分成两步:1.在Ubuntu下把LCM搭建起来,可以直接发送和接收数据;2.把上面做完的用LCM发送和接收的代码移植到ROS中

//后续补充

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://xiahunao.cn/news/2814265.html

如若内容造成侵权/违法违规/事实不符,请联系瞎胡闹网进行投诉反馈,一经查实,立即删除!

相关文章

【ArcGIS】重采样栅格像元匹配问题:不同空间分辨率栅格数据统一

重采样栅格像元匹配问题&#xff1a;不同空间分辨率栅格数据统一 原始数据数据1&#xff1a;GDP分布数据2.1&#xff1a;人口密度数据2.2&#xff1a;人口总数数据3&#xff1a;土地利用类型 数据处理操作1&#xff1a;将人口密度数据投影至GDP数据&#xff08;栅格数据的投影变…

阿里云定价_ECS产品价格_云服务器收费标准 - 阿里云官方活动

2024年最新阿里云服务器租用费用优惠价格表&#xff0c;轻量2核2G3M带宽轻量服务器一年61元&#xff0c;折合5元1个月&#xff0c;新老用户同享99元一年服务器&#xff0c;2核4G5M服务器ECS优惠价199元一年&#xff0c;2核4G4M轻量服务器165元一年&#xff0c;2核4G服务器30元3…

Docker 常用操作命令备忘

Docker 一旦设置好了环境&#xff0c;日常就只要使用简单命令就可以运行和停止。 于是&#xff0c;我每次用的时候&#xff0c;都想不起来一些关键性的命令到底怎么用&#xff0c;特此记录。 一、镜像管理 从公有仓库拉取镜像 &#xff08;对于使用苹果电脑 M1/M2/M3 芯片的 …

Java玩转《啊哈算法》之模拟链表

人应该支配习惯&#xff0c;而绝不是让习惯支配人。一个人要是不能改掉坏习惯&#xff0c;那么他就一文不值。 目录 缘代码地址模拟链表创建遍历打印插入插入优化 完整代码 缘 各位小伙伴们好呀&#xff01;本人最近看了下《啊哈算法》&#xff0c;写的确实不错。 但稍显遗憾…

在Golang中简化日志记录:提升性能和调试效率

最大化效率和有效故障排除&#xff1a;在Golang中简化日志记录 日志记录是软件开发的一个基本方面&#xff0c;有助于调试、监控和理解应用程序的流程。在Golang中&#xff0c;有效的日志记录实践可以显著提高性能并简化调试过程。本文探讨了优化Golang日志记录的技术&#xf…

Android WebView实现网页滚动截图

WebView 网页滚动截屏&#xff0c;可对整个网页进行截屏而不是仅当前屏幕哦&#xff01; 注意若Web页面存在position:fixed; 的话得在调用前设置为 position:absolute; 哦&#xff0c;否则会出现很多次的&#xff0c;请看下面的具体解说吧&#xff01;&#xff01; private s…

一周学会Django5 Python Web开发-Django5列表视图ListView

锋哥原创的Python Web开发 Django5视频教程&#xff1a; 2024版 Django5 Python web开发 视频教程(无废话版) 玩命更新中~_哔哩哔哩_bilibili2024版 Django5 Python web开发 视频教程(无废话版) 玩命更新中~共计27条视频&#xff0c;包括&#xff1a;2024版 Django5 Python we…

[数据集][目标检测]狗狗表情识别VOC+YOLO格式3971张4类别

数据集格式&#xff1a;Pascal VOC格式YOLO格式(不包含分割路径的txt文件&#xff0c;仅仅包含jpg图片以及对应的VOC格式xml文件和yolo格式txt文件) 图片数量(jpg文件个数)&#xff1a;3971 标注数量(xml文件个数)&#xff1a;3971 标注数量(txt文件个数)&#xff1a;3971 标注…

Spring注解之前后端传值

目录 PathVariable 和 RequestParam RequestBody PathVariable 和 RequestParam PathVariable用于获取路径参数&#xff0c;RequestParam用于获取查询参数。 举个简单的例子&#xff1a; GetMapping("/lazzes/{clazzId}/teachers") public List<Teacher> …

HP笔记本电脑如何恢复出厂设置?这里提供几种方法

要恢复出厂设置Windows 11或10的HP笔记本电脑,你可以使用操作系统的标准方法。如果你运行的是早期版本,你可以使用HP提供的单独程序清除计算机并重新安装操作系统。 恢复出厂设置运行Windows 11的HP笔记本电脑​ 所有Windows 11计算机都有一个名为“重置此电脑”的功能,可…

【Nginx笔记02】通过Nginx服务器转发客户端的WebSocket接口到后端服务

这篇文章&#xff0c;主要介绍如何通过Nginx服务器转发客户端的WebSocket接口到后端服务【知识星球】。 目录 一、Nginx配置WebSocket 1.1、Nginx配置内容 1.2、客户端请求地址 1.3、创建WebSocket测试工程 1.4、启动测试 1.5、WebSocket超时问题 1.5.1、设置超时时间 …

数据结构与算法(数组,栈,队列,链表,哈希表,搜索算法,排序算法,查找算法,策略算法,递归算法,二叉搜索树BST,动态规划算法)

文章目录 1 课程介绍1.1 前置知识1.2 为什么要学习算法1.3 大厂面试常见数据结构题目(基础)1.4 数据结构和算法的关系 2 数据结构2.1 数据结构概述2.1.1 数据结构是什么2.1.2 数据结构分类2.1.2.1 线性结构2.1.2.2 非线性结构2.1.2.3 小总结 2.1.3 数据结构范围 2.2 数组Array2…

关于电脑一天24小时多少度电电脑的一天用电量计算

随着这几年物价的上涨&#xff0c;一些地区的电价越来越高&#xff0c;而我们经常需要使用电脑&#xff0c;那么一台电脑一天24小时用多少度电呢&#xff1f; 如何计算电脑一天的用电量&#xff1f; 让我们跟随小编来了解更多吧。 1、功耗、主机箱功耗 现在的计算机中&#xf…

IDEA如何开启Dashboard

普通的面板 Run Dashboard面板 修改配置文件 找到项目的.idea文件夹 点击编辑workspace.xml文件 添加下方代码 <component name"RunDashboard"><option name"ruleStates"><list><RuleState><option name"name" valu…

sublime双击后无法正常打开的解决方案

大家好,我是爱编程的喵喵。双985硕士毕业,现担任全栈工程师一职,热衷于将数据思维应用到工作与生活中。从事机器学习以及相关的前后端开发工作。曾在阿里云、科大讯飞、CCF等比赛获得多次Top名次。现为CSDN博客专家、人工智能领域优质创作者。喜欢通过博客创作的方式对所学的…

4核8g服务器能支持多少人访问?

腾讯云4核8G服务器支持多少人在线访问&#xff1f;支持25人同时访问。实际上程序效率不同支持人数在线人数不同&#xff0c;公网带宽也是影响4核8G服务器并发数的一大因素&#xff0c;假设公网带宽太小&#xff0c;流量直接卡在入口&#xff0c;4核8G配置的CPU内存也会造成计算…

云计算时代的运维: 职业发展方向与岗位选择

✨✨ 欢迎大家来访Srlua的博文&#xff08;づ&#xffe3;3&#xffe3;&#xff09;づ╭❤&#xff5e;✨✨ &#x1f31f;&#x1f31f; 欢迎各位亲爱的读者&#xff0c;感谢你们抽出宝贵的时间来阅读我的文章。 我是Srlua&#xff0c;在这里我会分享我的知识和经验。&#x…

素皮材质的手机壳,如何才能做到经久耐用?

近几年&#xff0c;素皮材质开始在手机背壳上开始应用&#xff0c;各家手机厂商&#xff0c;基本都给自己的旗舰系列设备推出了带素皮材质版本的手机款式&#xff0c;比如华为的Mate 60系列&#xff0c;不仅Pro版本有素皮材质&#xff0c;Pro版本更是黑白两款全是素皮材质。 那…

Qt6.8 GRPC功能使用(2)标准 Qt实现客户端

简介 基于之前的文章所说&#xff0c; Qt6.7之后才开始支持客户端、服务端、及双向流&#xff0c;恰好电脑需要重装&#xff0c;看到Qt6.8版本就直接安装了&#xff0c;内容也是使用Qt6.8的版本进行编译的 客户端实现步骤 1. 安装Qt6.8, 包含GRPC功能模块 Qt 6.8安装目录下包…

php基础学习之错误处理(其一)

一&#xff0c;错误处理的概念 错误处理指的是系统(或者用户)在执行某些代码的时候&#xff0c;发现有错误&#xff0c;就会通过错误处理的形式告知程序员&#xff0c;俗称报错 二&#xff0c;错误分类 语法错误&#xff1a;书写的代码不符合 PHP 的语法规范&#xff0c;语法错…