Arduino与ROS通信过程中"Lost sync with device, restarting..."错误

对于这个问题的一种可能的解决方案,在回调函数中使用了while(1)循环,当注释掉循环后,这个问题得到了解决。

程序如下:测试的目的是:当得到话题的数据时,则Arduino控制蜂鸣器一直以该频率发出铃声;但后来发现当存在while(1)循环时,一直会报错,注释掉之后,解决这个问题;大概时回调函数没有执行完毕,新的回调又来了的缘故。

#include <ros.h>
#include <std_msgs/Int8.h>

int buzzer = 11;
int delay_time = 1;

ros::NodeHandle nh;

void messageCb(std_msgs::Int8 message)
{
  delay_time = message.data;
  unsigned char i;

//while(1)

//{

    for(i=0;i<80;i++)
    {
      digitalWrite(buzzer,HIGH);
      delay(delay_time);
      digitalWrite(buzzer,LOW);
      delay(delay_time);
     }

//}

}

ros::Subscriber<std_msgs::Int8> sub("buzzer",&messageCb);

void setup()
{
  nh.initNode();
  nh.subscribe(sub);
  pinMode(buzzer,OUTPUT);
}

void loop()
{
  nh.spinOnce();
}

猜你喜欢

转载自blog.csdn.net/qq_27806947/article/details/83218603