C++将键盘数据作为ROS话题发布出去供订阅

#include "ros/ros.h"
#include "std_msgs/Int32.h"
#include <termio.h>

using namespace std;


int main(int argc, char *argv[])
{
    ros::init(argc, argv, "switch_flag");
    ros::NodeHandle nh;
    ros::Publisher pub;
    pub = nh.advertise<std_msgs::Int32>("/switch", 10);
    std_msgs::Int32 key;

    while (true)
    {
        int in;

        struct termios new_settings;
        struct termios stored_settings;
        //设置终端参数
        tcgetattr(0, &stored_settings);
        new_settings = stored_settings;
        new_settings.c_lflag &= (~ICANON);
        new_settings.c_cc[VTIME] = 0;
        tcgetattr(0, &stored_settings);
        new_settings.c_cc[VMIN] = 1;
        tcsetattr(0, TCSANOW, &new_settings);
        in = getchar();
        if (!ros::ok())
            break;
        tcsetattr(0, TCSANOW, &stored_settings);

        key.data = in;
        cout << "key: " << in << endl;
        cout << "key.data: " << key.data << endl;
        pub.publish(key);
        ros::spinOnce();
        // cout << "123" << endl;
    }

    return 0;
}
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

ICECREAM-7

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值