aaa

Dependencies:   mbed BNO055_fusion Adafruit_GFX ros_lib_kinetic

myRos.h

Committer:
nakedt555
Date:
2018-12-06
Revision:
0:10f626cf3ec4
Child:
1:bdd17feaa4ce

File content as of revision 0:10f626cf3ec4:

#ifndef _MY_ROS_H_
#define _MY_ROS_H_

#include "mbed.h"
#include "ros.h"
#include "ros/time.h"
#include "std_msgs/Bool.h"

#define COURT_RED   false
#define COURT_BLUE  true

class myRos
{
    private:
    ros::NodeHandle nh_;
    bool court_color_;
//    std_msgs::Bool court_color_msg_;
//    ros::Publisher court_color_pub_;
        
    public:
    //Constructor
    myRos(bool court_color = COURT_RED) : court_color_(court_color){
        //ROS node initialize
        nh_.getHardware()->setBaud(115200);
        nh_.initNode();
        
//        initialize();

//        court_color_pub_ = new ros::Publisher("court_color", &court_color_msg_);
//        nh_.advertise(court_color_pub_);
    }
    
    void loop(){
        publisher();
        nh_.spinOnce();
//        court_color_msg_.data = court_color_;
//        court_color_pub_.publish(&court_color_msg_);
    }
    
    private:
    //Initialise
    void initialize();
    void publisher();
    
    
};

#endif