自动驾驶消息传输机制-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://www.rhkb.cn/news/265207.html

如若内容造成侵权/违法违规/事实不符,请联系长河编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

SpringMVC 学习(十)之异常处理

目录 1 异常处理介绍 2 通过 SimpleMappingExceptionResolver 实现 3 通过接口 HandlerExceptionResolver 实现 4 通过 ExceptionHandler 注解实现&#xff08;推荐&#xff09; 1 异常处理介绍 在 SpringMVC中&#xff0c;异常处理器&#xff08;Exceptio…

go test用法(获取单元测试覆盖率)

go test用法&#xff08;获取ut覆盖率&#xff09; 为了提升系统的稳定性&#xff0c;一般公司都会对代码的单元测试覆盖率有一定要求。下面针对golang自带的测试命令go test做讲解。 1 命令 1.1 go test ./… &#xff08;运行当前目录及所有子目录下的测试用例&#xff09; …

13.云原生之常用研发中间件部署

云原生专栏大纲 文章目录 mysql主从集群部署mysql高可用集群高可用互为主从架构互为主从架构如何实现主主复制中若是两台master上同时出现写操作可能会出现的问题该架构是否存在问题&#xff1f; heml部署mysql高可用集群 nacos集群部署官网文档部署nacoshelm部署nacos redis集…

yolov9 瑞芯微芯片rknn部署、地平线芯片Horizon部署、TensorRT部署

特别说明&#xff1a;参考官方开源的yolov9代码、瑞芯微官方文档、地平线的官方文档&#xff0c;如有侵权告知删&#xff0c;谢谢。 模型和完整仿真测试代码&#xff0c;放在github上参考链接 模型和代码。 之前写过yolov8检测、分割、关键点模型的部署的多篇博文&#xff0c;y…

Mysql 高可用解决方案

1.环境说明 操作系统&#xff1a;centos7.7 主服务器&#xff1a;node2(192.168.1.102) 从服务器&#xff1a;node3(192.168.1.103) keepalived中虚拟ip(VIP):192.168.1.100 2.准备事项 主库和从库数据库的版本一致把主库的数据同步给从库一份 3.主库配置 3.1 编辑MySQL配…

读《Shape-Guided: Shape-Guided Dual-Memory Learning for 3D Anomaly Detection》

Chu Y M, Chieh L, Hsieh T I, et al. Shape-Guided Dual-Memory Learning for 3D Anomaly Detection[J]. 2023.&#xff08;为毛paperwithcode上面曾经的榜一引用却只有1&#xff09; 摘要 专家学习 无监督 第一个专家&#xff1a;局部几何&#xff0c;距离建模 第二个专家&…

postman访问k8s api

第一种方式&#xff1a; kubectl -n kubesphere-system get sa kubesphere -oyaml apiVersion: v1 kind: ServiceAccount metadata:annotations:meta.helm.sh/release-name: ks-coremeta.helm.sh/release-namespace: kubesphere-systemcreationTimestamp: "2023-07-24T07…

[Flutter]设置应用包名、名称、版本号、最低支持版本、Icon、启动页以及环境判断、平台判断和打包

一、设置应用包名 在Flutter开发中&#xff0c;修改应用程序的包名&#xff08;也称作Application ID&#xff09;涉及几个步骤&#xff0c;因为包名是在项目的Android和iOS平台代码中分别配置的。请按照以下步骤操作&#xff1a; 1.Android Flutter工程中全局搜索替换包名 …

在CentOS上使用Docker搭建Halo博客并实现远程访问的详细指南

&#x1f308;个人主页&#xff1a;聆风吟 &#x1f525;系列专栏&#xff1a;网络奇遇记、数据结构 &#x1f516;少年有梦不应止于心动&#xff0c;更要付诸行动。 文章目录 &#x1f4cb;前言一. Docker部署Halo1.1 检查Docker版本1.2 在Docker中部署Halo 二. Linux安装Cpol…

水库安全监测方案(福建地区水库安全监测案例分享)

我司星创易联最近在福建省受到了一个水库安全监测系统项目的委托。该水库位于福建中部山区,作为该地区的重要防洪与供水工程,对下游数十万人的生活产生重大影响。但是因为水库附近地质情况复杂,水库大坝在多次洪水冲击下出现一定病害,亟须全面加强对水库大坝安全状况的监测,以确…

Ethernet/IP转Modbus TCP网关

产品功能 1 YC-EIP-TCP工业级EtherNet/IP 网关 2 Modbus TCP 转 EtherNet/IP 3支持ModBus主从站 4 即插即用 无需编程 轻松组态 ,即实现数据交互 5导轨安装 支持提供EDS文件 6 EtherNET/IP与ModBus互转数据透明传输可接入PLC组态 支持CodeSys/支持欧姆龙PLC 支持罗克韦尔(AB) 典…

国辰智企MES系统优化企业管理,让生产制造更高效

在制造业的舞台上&#xff0c;MES制造执行管理系统如同一位出色的导演&#xff0c;将生产过程中的各个场景巧妙地连接起来&#xff0c;演绎出一场场精彩的制造盛宴。让我们一同走进MES在制造业的具体应用场景&#xff0c;感受它带来的变革与创新。 在生产计划与调度的场景中&am…

一文读懂什么是 OCR 识别

在数字化时代&#xff0c;信息处理和数据管理是企业运营的重要环节。然而&#xff0c;手工输入信息存在效率低和准确性低的问题&#xff0c;严重影响了企业的工作流程和决策过程。因此&#xff0c;OCR&#xff08;Optical Character Recognition&#xff09;识别技术的应用变得…

【设计模式】5种创建型模式详解

创建型模式提供创建对象的机制,能够提升已有代码的灵活性和复用性。 常用的有&#xff1a;单例模式、工厂模式&#xff08;工厂方法和抽象工厂&#xff09;、建造者模式。不常用的有&#xff1a;原型模式。 一、单例模式 1.1 单例模式介绍 1 ) 定义 单例模式&#xff08;Si…

亚信安慧AntDB数据库与流式处理的有机融合

流式处理的概念 2001年9月11日&#xff0c;美国世贸大楼被袭击&#xff0c;美国国防部第一次将“主动预警”纳入国防的宏观战略规划。而IBM作为当时全球最大的IT公司&#xff0c;承担了大量基础支撑软件研发的任务。其中2009年正式发布的IBM InfoSphere Streams&#xff0c;就是…

【深度学习】Pytorch教程(八):PyTorch数据结构:2、张量的数学运算(6):高维张量:乘法、卷积(conv2d~四维张量;conv3d~五维张量)

文章目录 一、前言二、实验环境三、PyTorch数据结构1、Tensor&#xff08;张量&#xff09;1. 维度&#xff08;Dimensions&#xff09;2. 数据类型&#xff08;Data Types&#xff09;3. GPU加速&#xff08;GPU Acceleration&#xff09; 2、张量的数学运算1. 向量运算2. 矩阵…

11 Redis之高并发问题(读+写) + 缓存预热+分布式锁

8. 高并发问题 Redis做缓存虽减轻了DBMS的压力&#xff0c;减小了RT(Response Time)&#xff0c;但在高并发情况下也是可能会出现各种问题的。 8.1 缓存穿透 当用户访问的数据既不在数据库中也不在缓存中&#xff0c;如id为“-1”的数据或id为特别大不存在的数据, 这时的用户…

List去重有几种方式

目录 1、for循环添加去重 2、for 双循环去重 3、for 双循环重复坐标去重 4、Set去重 5、stream流去重 1、for循环添加去重 List<String> oldList new ArrayList<>();oldList.add("张三");oldList.add("张三");oldList.add("李四&q…

电子电器架构新趋势 —— 最佳着力点:域控制器

电子电器架构新趋势 —— 最佳着力点&#xff1a;域控制器 我是穿拖鞋的汉子&#xff0c;魔都中坚持长期主义的汽车电子工程师&#xff08;Wechat&#xff1a;gongkenan2013&#xff09;。 老规矩&#xff0c;分享一段喜欢的文字&#xff0c;避免自己成为高知识低文化的工程师…

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

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