CFLAGS = -O2 -g -Wall
CXXFLAGS = -O2 -g -Wall
+CONFIG_UOLED_TTY="/dev/null"
IDL_COMPILER=$(USER_BIN_DIR)/orte-idl
CFLAGS += -DDISPLAY_DEBUG
#define HOKUYO_CLUSTER_TO_DEG(x) (113.0-(x*HOKUYO_BEAMS_IN_CLUSTER*(360.0/1024.0)))
#define HOKUYO_CLUSTER_TO_RAD(x) (M_PI/180 * (113.0)-(x*HOKUYO_BEAMS_IN_CLUSTER*((2*M_PI)/1024.0)))
-#define HOKUYO_DEVICE "/dev/ttyPSC2" // /dev/ttyACM0
+#define HOKUYO_DEVICE "/dev/ttyACM0" // /dev/ttyACM0
int hokuyo_get_scan();
void scan_publisher_callback(const ORTESendInfo *info, void *vinstance, void *arg);
data = s->data;
for (i = 0; i < HOKUYO_CLUSTER_CNT; i++) {
- if((i==0)||(i==6)||(i==7)||(i==26)||(i==27)||(i==28))
+ printf("data %d: %d\t",i,data[i]);
+// if((i==0)||(i==6)||(i==7)||(i==26)||(i==27)||(i==28))
+ if((i<6)||((i>27))) // ||(i==7)||(i==26)||(i==27)||(i==28))
continue;
if(data[i] > 19) {
beam.ang = HOKUYO_CLUSTER_TO_RAD(i);
}
}
+ printf("\n");
}
/**