Muhammad Saifuddin Jazuli / Mbed 2 deprecated NucleoFM

Dependencies:   mbed ros_lib_melodic

Committer:
jazulienux
Date:
Mon Oct 26 22:25:16 2020 +0000
Revision:
0:a4a02499a5f3
Robsonema - NucleoFM

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jazulienux 0:a4a02499a5f3 1 #ifndef PROXIMITY_CPP
jazulienux 0:a4a02499a5f3 2 #define PROXIMITY_CPP
jazulienux 0:a4a02499a5f3 3 #include "Proximity.h"
jazulienux 0:a4a02499a5f3 4 #include <mbed.h>
jazulienux 0:a4a02499a5f3 5 #include "config.h"
jazulienux 0:a4a02499a5f3 6
jazulienux 0:a4a02499a5f3 7 DigitalIn * prox_left;
jazulienux 0:a4a02499a5f3 8 DigitalIn * prox_right;
jazulienux 0:a4a02499a5f3 9
jazulienux 0:a4a02499a5f3 10 Proximity::Proximity()
jazulienux 0:a4a02499a5f3 11 {
jazulienux 0:a4a02499a5f3 12 prox_left = new DigitalIn(PORT_PROX_LEFT);
jazulienux 0:a4a02499a5f3 13 prox_right = new DigitalIn(PORT_PROX_RIGHT);
jazulienux 0:a4a02499a5f3 14 }
jazulienux 0:a4a02499a5f3 15
jazulienux 0:a4a02499a5f3 16 int Proximity::read(){
jazulienux 0:a4a02499a5f3 17 int status = 0;
jazulienux 0:a4a02499a5f3 18 if(prox_left->read() == 0){
jazulienux 0:a4a02499a5f3 19 status += 1;
jazulienux 0:a4a02499a5f3 20 }
jazulienux 0:a4a02499a5f3 21 if(prox_right->read() == 0){
jazulienux 0:a4a02499a5f3 22 status += 2;
jazulienux 0:a4a02499a5f3 23 }
jazulienux 0:a4a02499a5f3 24 return status;
jazulienux 0:a4a02499a5f3 25 }
jazulienux 0:a4a02499a5f3 26
jazulienux 0:a4a02499a5f3 27 #endif