//头文件 ros/ros.h 包含了标准 ROS 类的声明,你将会在每一个你写的 ROS 程序中包含它。
#include <ros.h>
//std_msgs中已经包含了所有的基本数据类型
#include <std_msgs/Byte.h>
//在创建时,如果一个内部节点没有被启动,节点句柄将启动该节点.
//一旦所有的节点句柄实例被销毁,那么节点将被自动关闭.
ros::NodeHandle nh;
//定义一个相应数据类型的对象
std_msgs::Byte button_msg;
//指明发布的数据类型,话题和缓存队列大小
//声明发布者,话题名 = button
ros::Publisher pub_button("button", &button_msg);
void setup()
{
nh.initNode();
nh.advertise(pub_button);
//定义按键SW1和SW2的模式为输入
pinMode(BDPIN_PUSH_SW_1, INPUT);
pinMode(BDPIN_PUSH_SW_2, INPUT);
}
void loop()
{
// reading的低8、7位为0
uint8_t reading = 0;
//静态局部变量如果没有被用户初始化,则会被编译器自动赋值为0,
//以后每次调用静态局部变量的时候都用上次调用后的值。
static uint32_t pre_time;
//功能:读取引脚电平状态;//形式:digitalRead(pin)//参数:pin://要读取的引脚返回值:HIGH或者LOW;
//检测到高电平,给reading赋新值
if (digitalRead(BDPIN_PUSH_SW_1) == HIGH)
{
// reading的低8位为1
reading |= 0x01;
}
if (digitalRead(BDPIN_PUSH_SW_2) == HIGH)
{
// reading的低7位为1
reading |= 0x02;
}
//millis()函数会返回一个值,该值代表当前cpu的时间
//可以用来定时,这样可以不用占用cpu时间
if (millis()-pre_time >= 50)
{
//将reading赋值给data
button_msg.data = reading;
pub_button.publish(&button_msg);
pre_time = millis();
}
//loop函数中,调用了ros::spinOnce(),在这个函数中,所有ROS通信的回调函数都被处理
nh.spinOnce();
}