TX2 gpio c++ ros读取通过文件方式读取

最新推荐文章于 2023-06-17 20:30:41 发布

原创最新推荐文章于 2023-06-17 20:30:41 发布 · 2.2k 阅读

2 ·

CC 4.0 BY-SA版权

文章标签：

#自动驾驶 #人工智能 #机器学习

TX2 专栏收录该内容

5 篇文章

订阅专栏

本文详细介绍了如何使用C++和ROS进行GPIO（通用输入输出）操作，包括设置sysfs GPIO值、通过文件系统读取和写入GPIO状态，并展示了在ROS中实时监控和发布GPIO信号的示例代码。

1.TX2 gpio图

2.sysfs gpio值如GPIO26，值为gpio388

cd /sys/class/gpio/
echo 388 > export #使能端口
cd gpio388
cat direction #方向
cat value #输出值

3.通过c++实现

#include <iostream>
#include <fstream>

using namespace std;
int main(int argc,char** argv)
{
       ifstream dirStream("/sys/devices/c2f0000.gpio/gpiochip1/gpio/gpio338/value");
       if(!dirStream)
       {
         cout<<"unable open"<<endl;
       }
       else
       {
        cout<<"open"<<endl;
       }
       int value_;
       dirStream>>value_;
       cout<<value_<<endl;
       return 0;
}

4.ros执行

#include "ros/ros.h"
#include "std_msgs/Int8.h"
#include "sstream"
#include <iostream>
#include <fstream>

using namespace std;
int main(int argc,char** argv)
{
       ros::init(argc,argv,"gpio_ss");
       ros::NodeHandle n;
       ros::Publisher pub=n.advertise<std_msgs::Int8>("gpio_ss",100);
       ros::Rate loop_rate(1);
       std_msgs::Int8 msg;
       int ss=0;
       while(ros::ok())
       {
          ifstream dirStream("/sys/devices/c2f0000.gpio/gpiochip1/gpio/gpio338/value");
          if(!dirStream)
          {
            cout<<"unable open"<<endl;
          }
          else
          {
            cout<<"open"<<endl;
          }
          dirStream>>ss;
	  msg.data=ss;
          cout<<ss<<endl;
	  pub.publish(msg);
	  ros::spinOnce();
	  loop_rate.sleep();
       }
       return 0;
}