Q
Dependencies: SRF05 ros_lib_kinetic TinyGPSPlus
PROJ515.hpp
- Committer:
- Luka_Danilovic
- Date:
- 2019-05-06
- Revision:
- 3:cd1f2bde7ac2
- Parent:
- 2:7288dd12186e
- Child:
- 4:f74d88f5f629
File content as of revision 3:cd1f2bde7ac2:
#ifndef __PROJ515_H__ //Inclusion safeguards #define __PROJ515_H__ //Definition of the inclusion /*============================================================================*/ /* Libraries */ #include "mbed.h" // Mbed RTOS #include "hcsr04.h" // HCSR04 ultrasound sensor libary //#include "SRF05.h" // SRF05 ultrasound sensor custom libary #include "ros.h" // ROS Library #include "sensor_msgs/Range.h" // ROS Sensor Messages component /* Definitions */ #define LEDS_OFF 0x00 // LED bus all off #define LEDS_ON 0x07 // LED bus all on #define USP_CF1T PG_1 // Cliff ultrasound 1 Trigger #define USP_CF1E PB_11 // Cliff ultrasound 1 Echo #define USP_CF2T PF_9 // Cliff ultrasound 2 Trigger #define USP_CF2E PB_10 // Cliff ultrasound 2 Echo #define USP_CF3T PF_7 // Cliff ultrasound 3 Trigger #define USP_CF3E PE_15 // Cliff ultrasound 3 Echo #define USP_CF4T PF_8 // Cliff ultrasound 4 Trigger #define USP_CF4E PE_12 // Cliff ultrasound 4 Echo #define USP_CB1T PE_6 // Curb ultrasound 1 Trigger #define USP_CB1E PE_7 // Curb ultrasound 1 Echo #define USP_CB2T PE_5 // Curb ultrasound 2 Trigger #define USP_CB2E PE_8 // Curb ultrasound 2 Echo #define USP_CB3T PE_4 // Curb ultrasound 3 Trigger #define USP_CB3E PG_9 // Curb ultrasound 3 Echo #define USP_CB4T PE_2 // Curb ultrasound 4 Trigger #define USP_CB4E PG_14 // Curb ultrasound 4 Echo #define FOV 1.396 // Ultrasound sensor field of view #define MIN_RANGE 0.2 // Ultrasound sensor min range #define MAX_RANGE 2.5 // Ultrasound sensor max range #define CLIFF_TRH 0.12 // Robot cliff treshold #define CLIFF_ZRO 0 // Cliff not existent #define EXCL_ZONE 0.255 // Robot footprint exclusion zone #define ROS_Baud 921600 // ROS Baud Rate #define frameID "ultrasound_range" // ROS frame ID #define ULTRASOUND 0x00 // Ultrasound #define PRINT_DATA 0x01 // Thread communication event to print data /* Namespaces */ using namespace std; // Make all std symbols visible using namespace ros; // Make all ros symbols visible using namespace sensor_msgs; // Make all sensor_msgs symbols visible using namespace std_msgs; // Make all sdt_msgs symbols visible /* Declarations */ extern float cfDist1; // Distance returned by cliff u_sensor1 (m) extern float cfDist2; // Distance returned by cliff u_sensor2 (m) extern float cfDist3; // Distance returned by cliff u_sensor3 (m) extern float cfDist4; // Distance returned by cliff u_sensor4 (m) extern float cbDist1; // Distance returned by curb u_sensor1 (m) extern float cbDist2; // Distance returned by curb u_sensor2 (m) extern float cbDist3; // Distance returned by curb u_sensor3 (m) extern float cbDist4; // Distance returned by curb u_sensor4 (m) extern float wPeriod; // Wait period(ms) for ROS publisher /* GPIO */ DigitalIn bttn(USER_BUTTON); // Onboard blue user button BusOut leds(LED1, LED2, LED3); // Onboard LEDs bus /* Instantiations */ HCSR04 USS_CF1(USP_CF1T, USP_CF1E); // Ultrasound sensor cliff 1 HCSR04 USS_CF2(USP_CF2T, USP_CF2E); // Ultrasound sensor cliff 2 HCSR04 USS_CF3(USP_CF3T, USP_CF3E); // Ultrasound sensor cliff 3 HCSR04 USS_CF4(USP_CF4T, USP_CF4E); // Ultrasound sensor cliff 4 HCSR04 USS_CB1(USP_CB1T, USP_CB1E); // Ultrasound sensor cliff 1 HCSR04 USS_CB2(USP_CB2T, USP_CB2E); // Ultrasound sensor cliff 2 HCSR04 USS_CB3(USP_CB3T, USP_CB3E); // Ultrasound sensor cliff 3 HCSR04 USS_CB4(USP_CB4T, USP_CB4E); // Ultrasound sensor cliff 4 //Serial usbSer(USBTX, USBRX); // Serial over USB OTG (DEBUG with no ROS) NodeHandle nh; // Instance for ROS Node Handler Range ultrasound_msg_cf1; // Instance for ROS NavSatFix message 1 Range ultrasound_msg_cf2; // Instance for ROS NavSatFix message 2 Range ultrasound_msg_cf3; // Instance for ROS NavSatFix message 3 Range ultrasound_msg_cf4; // Instance for ROS NavSatFix message 4 Range ultrasound_msg_cb1; // Instance for ROS NavSatFix message 5 Range ultrasound_msg_cb2; // Instance for ROS NavSatFix message 6 Range ultrasound_msg_cb3; // Instance for ROS NavSatFix message 7 Range ultrasound_msg_cb4; // Instance for ROS NavSatFix message 8 // Instance for ROS publishers (Range message for cliff and curb sensors) Publisher ultrasound_pub_cf1("/ultrasound/cf1", &ultrasound_msg_cf1); Publisher ultrasound_pub_cf2("/ultrasound/cf2", &ultrasound_msg_cf2); Publisher ultrasound_pub_cf3("/ultrasound/cf3", &ultrasound_msg_cf3); Publisher ultrasound_pub_cf4("/ultrasound/cf4", &ultrasound_msg_cf4); Publisher ultrasound_pub_cb1("/ultrasound/cb1", &ultrasound_msg_cb1); Publisher ultrasound_pub_cb2("/ultrasound/cb2", &ultrasound_msg_cb2); Publisher ultrasound_pub_cb3("/ultrasound/cb3", &ultrasound_msg_cb3); Publisher ultrasound_pub_cb4("/ultrasound/cb4", &ultrasound_msg_cb4); /* Threads and Signals */ //Thread myThread (osPriorityNormal); //EventFlags myEventFlag; /* Function Prototypes */ //void myFunctionPrototype(); /*============================================================================*/ #endif // End of inclusion