Revision 3a73516c scout/libscout/src/test_behaviors/danger_marking.cpp

View differences:

scout/libscout/src/test_behaviors/danger_marking.cpp
26 26
#include "danger_marking.h"
27 27

  
28 28
#define THRESH 200
29
#define min(x,y) ((x < y) ? x : y)
29 30

  
30 31
using namespace std;
31 32

  
......
45 46
    while (true)
46 47
    {
47 48
        int *readings = sonar->get_sonar_readings();
48
        dist = readings[36];
49
        dist = min(readings[35], min(readings[36], readings[37]));
49 50

  
50 51
        ROS_INFO("Dist: %d.", dist);
51 52

  

Also available in: Unified diff