編程開發(fā)
為了方便大家使用,TogetherROS針對零拷貝功能進(jìn)行了封裝,風(fēng)格類似ROS2中話題通信的接口,還是話題通信一樣的流程,我們只需要修改幾個函數(shù)就可以實(shí)現(xiàn)啦。
運(yùn)行例程
$ source /opt/tros/local_setup.bash
$ source install/local_setup.bash
$ ros2 run hbmem_pubsub talker
$ ros2 run hbmem_pubsub listener
代碼解析
發(fā)布者publisher_hbmem.cpp:
#include < chrono >
#include < functional >
#include < memory >
#include < string >
#include "rclcpp/rclcpp.hpp"
#include "hbmem_pubsub/msg/sample_message.hpp"
using namespace std::chrono_literals;
class MinimalHbmemPublisher : public rclcpp::Node {
public:
MinimalHbmemPublisher () : Node("minimal_hbmem_publisher"), count_(0) {
// 創(chuàng)建publisher_hbmem,topic為"topic",QOS為KEEPLAST(10),以及默認(rèn)的可靠傳輸
publisher_ = this- >create_publisher_hbmem< hbmem_pubsub::msg::SampleMessage >(
"topic", 10);
// 定時器,每隔40毫秒調(diào)用一次timer_callback進(jìn)行消息發(fā)送
timer_ = this- >create_wall_timer(
40ms, std::bind(&MinimalHbmemPublisher ::timer_callback, this));
}
private:
// 定時器回調(diào)函數(shù)
void timer_callback() {
// 獲取要發(fā)送的消息
auto loanedMsg = publisher_- >borrow_loaned_message();
// 判斷消息是否可用,可能出現(xiàn)獲取消息失敗導(dǎo)致消息不可用的情況
if (loanedMsg.is_valid()) {
// 引用方式獲取實(shí)際的消息
auto& msg = loanedMsg.get();
// 獲取當(dāng)前時間,單位為us
auto time_now =
std::chrono::duration_cast< std::chrono::microseconds >(
std::chrono::steady_clock::now().time_since_epoch()).count();
// 對消息的index和time_stamp進(jìn)行賦值
msg.index = count_;
msg.time_stamp = time_now;
// 打印發(fā)送消息
RCLCPP_INFO(this- >get_logger(), "message: %d", msg.index);
publisher_- >publish(std::move(loanedMsg));
// 注意,發(fā)送后,loanedMsg已不可用
// 計數(shù)器加一
count_++;
} else {
// 獲取消息失敗,丟棄該消息
RCLCPP_INFO(this- >get_logger(), "Failed to get LoanMessage!");
}
}
// 定時器
rclcpp::TimerBase::SharedPtr timer_;
// hbmem publisher
rclcpp::PublisherHbmem< hbmem_pubsub::msg::SampleMessage >::SharedPtr publisher_;
// 計數(shù)器
size_t count_;
};
int main(int argc, char * argv[])
{
rclcpp::init(argc, argv);
rclcpp::spin(std::make_shared< MinimalHbmemPublisher >());
rclcpp::shutdown();
return 0;
}
訂閱者subscriber_hbmem.cpp:
#include < memory >
#include "rclcpp/rclcpp.hpp"
#include "hbmem_pubsub/msg/sample_message.hpp"
class MinimalHbmemSubscriber : public rclcpp::Node {
public:
MinimalHbmemSubscriber () : Node("minimal_hbmem_subscriber") {
// 創(chuàng)建subscription_hbmem,topic為"sample",QOS為KEEPLAST(10),以及默認(rèn)的可靠傳輸
// 消息回調(diào)函數(shù)為topic_callback
subscription_ =
this- >create_subscription_hbmem< hbmem_pubsub::msg::SampleMessage >(
"topic", 10,
std::bind(&MinimalHbmemSubscriber ::topic_callback, this,
std::placeholders::_1));
}
private:
// 消息回調(diào)函數(shù)
void topic_callback(
const hbmem_pubsub::msg::SampleMessage::SharedPtr msg) const {
// 注意,msg只能在回調(diào)函數(shù)中使用,回調(diào)函數(shù)返回后,該消息就會被釋放
// 獲取當(dāng)前時間
auto time_now =
std::chrono::duration_cast< std::chrono::microseconds >(
std::chrono::steady_clock::now().time_since_epoch())
.count();
// 計算延時并打印出來
RCLCPP_INFO(this- >get_logger(), "msg %d, time cost %dus", msg- >index,
time_now - msg- >time_stamp);
}
// hbmem subscription
rclcpp::SubscriptionHbmem< hbmem_pubsub::msg::SampleMessage >::SharedPtr
subscription_;
};
int main(int argc, char * argv[])
{
rclcpp::init(argc, argv);
rclcpp::spin(std::make_shared< MinimalHbmemSubscriber >());
rclcpp::shutdown();
return 0;
}
聲明:本文內(nèi)容及配圖由入駐作者撰寫或者入駐合作網(wǎng)站授權(quán)轉(zhuǎn)載。文章觀點(diǎn)僅代表作者本人,不代表電子發(fā)燒友網(wǎng)立場。文章及其配圖僅供工程師學(xué)習(xí)之用,如有內(nèi)容侵權(quán)或者其他違規(guī)問題,請聯(lián)系本站處理。
舉報投訴
-
機(jī)器人
+關(guān)注
關(guān)注
210文章
27839瀏覽量
204603 -
通信
+關(guān)注
關(guān)注
18文章
5880瀏覽量
135321 -
編程
+關(guān)注
關(guān)注
88文章
3521瀏覽量
93272 -
ROS
+關(guān)注
關(guān)注
1文章
276瀏覽量
16884
發(fā)布評論請先 登錄
相關(guān)推薦
使用banana PI 作為管道機(jī)器人控制及數(shù)據(jù)傳輸
使用banana PI 作為管道機(jī)器人控制及數(shù)據(jù)傳輸轉(zhuǎn)自 lemaker 版權(quán)保護(hù)banana pi 成功應(yīng)用在管道機(jī)器人上.用于控制及視頻數(shù)據(jù)傳輸管道
發(fā)表于 08-09 21:21
自己開發(fā)的機(jī)器人圖形化編程軟件
自己開發(fā)的機(jī)器人圖形化編程軟件從2005年起就開始搞機(jī)器人教學(xué)了,至今每年夏天都舉行機(jī)器人夏令營。10年來一直嘗試做一款簡單穩(wěn)定好用的
發(fā)表于 07-02 20:15
智能救援機(jī)器人的功能和作用
智能機(jī)器人配有許多能夠識別環(huán)境參數(shù)的ADM238LJR傳感器,可以采集蒸汽成分、現(xiàn)場圖像界面、障礙物等信息。該無線數(shù)據(jù)傳輸控制模塊能夠在上位機(jī)軟件中友好地將準(zhǔn)確的自然環(huán)境信息內(nèi)容顯示在現(xiàn)場,并
發(fā)表于 11-30 15:10
工業(yè)機(jī)器人應(yīng)用編程考核設(shè)備分享
ZNH-KH01工業(yè)機(jī)器人應(yīng)用編程考核設(shè)備一、概述工業(yè)機(jī)器人應(yīng)用編程考核設(shè)備能滿足工業(yè)機(jī)器人應(yīng)用編程
發(fā)表于 07-01 11:06
數(shù)據(jù)傳輸指令
一、數(shù)據(jù)傳輸指令───────────────────────────────────────它們在存貯器和寄存器、寄存器和輸入輸出端口之間傳送數(shù)據(jù).1. 通用數(shù)據(jù)傳送指令.MOV 傳送字或字節(jié).MOVSX 先符號擴(kuò)展,再傳送.
發(fā)表于 07-27 07:18
stm32的幾種數(shù)據(jù)傳輸總結(jié)
引言在一般的項(xiàng)目開發(fā)過程中,往往需要兩塊或以上單片機(jī)進(jìn)行通信完成數(shù)據(jù)傳輸,例如四旋翼無人機(jī)在飛行過程中無線傳輸數(shù)據(jù)回到地面站,治療儀器需要實(shí)時將患者和
發(fā)表于 08-23 07:32
機(jī)器人與編程的區(qū)別
在前一篇文章中講了機(jī)器人與編程的區(qū)別,但總感覺講的比較空泛,這篇文章繼續(xù)講講那些區(qū)別。計算機(jī)編程和機(jī)器人編程最大的區(qū)別就是一個是控制虛擬的,
發(fā)表于 09-01 07:12
Motoman機(jī)器人離線編程
歡迎關(guān)注Jungle的Motoman機(jī)器人離線編程專欄系列文章:Motoman機(jī)器人離線編程——Motocom32開發(fā)簡介Motoman
發(fā)表于 09-07 07:33
Modem數(shù)據(jù)傳輸標(biāo)準(zhǔn)
Modem數(shù)據(jù)傳輸標(biāo)準(zhǔn)
數(shù)據(jù)傳輸標(biāo)準(zhǔn)是指MODEM的
發(fā)表于 12-28 13:29
?983次閱讀
數(shù)據(jù)傳輸,數(shù)據(jù)傳輸的工作方式有哪些?
數(shù)據(jù)傳輸,數(shù)據(jù)傳輸的工作方式有哪些?
將數(shù)據(jù)從一個地方傳輸到另一個地方的方法多得令人難以置信。
數(shù)
發(fā)表于 03-18 14:41
?6002次閱讀
數(shù)據(jù)傳輸速率是什么意思
數(shù)據(jù)傳輸速率是什么意思
數(shù)據(jù)傳輸速率是通過信道每秒可傳輸的數(shù)字信息量的量度。數(shù)據(jù)傳輸速率也稱為吞吐率。數(shù)據(jù)傳輸速率由很
發(fā)表于 03-18 14:45
?4974次閱讀
什么是零拷貝技術(shù)
在傳統(tǒng)操作系統(tǒng)的數(shù)據(jù)傳輸過程中,系統(tǒng)內(nèi)部會在磁盤、內(nèi)存、緩存中多次進(jìn)行數(shù)據(jù)拷貝,每次都會占用CPU的資源,數(shù)據(jù)量小的時候還好。 隨著數(shù)據(jù)量的
如何進(jìn)行零拷貝性能測試
10 -s 1 -m Array4m -r 100 -- max -runtime 30 #未開啟 開啟零拷貝數(shù)據(jù)傳輸: $ ros2 run performance_test perf_test
評論