GrovePIRMotionSensor.cpp

Go to the documentation of this file.

/*
 * rosserial PIR Motion Sensor Example
 *
 * This tutorial demonstrates the usage of the
 * Seeedstudio PIR Motion Sensor Grove module
 * http://www.seeedstudio.com/depot/Grove-PIR-Motion-Sensor-p-802.html
 *
 * Source Code Based on:
 * https://developer.mbed.org/teams/Seeed/code/Seeed_Grove_PIR_Motion_Sensor_Example/
 */
 
#include "mbed.h"
#include <ros.h>
#include <std_msgs/Bool.h>
 
ros::NodeHandle  nh;
 
std_msgs::Bool motion_msg;
ros::Publisher pub_motion("motion", &motion_msg);
 
Timer t;
#ifdef TARGET_LPC1768
DigitalIn sig1(p9);
#elif defined(TARGET_KL25Z) || defined(TARGET_NUCLEO_F401RE)
DigitalIn sig1(D6);
#else
#error "You need to specify a pin for the sensor"
#endif
 
int main()
{
  t.start();
 
  nh.initNode();
  nh.advertise(pub_motion);
 
  long publisher_timer = 0;
 
  while (1)
  {
 
    if (t.read_ms() > publisher_timer)
    {
      motion_msg.data = sig1;
      pub_motion.publish(&motion_msg);
      publisher_timer = t.read_ms() + 1000;
    }
    nh.spinOnce();
  }
}