From 1aee41298515d39f3a80be71d627ff29f586ad79 Mon Sep 17 00:00:00 2001
From: vivek-shankar <robovivek@gmail.com>
Date: Fri, 13 Jan 2017 15:51:31 -0500
Subject: [PATCH] debug neigh

---
 src/roscontroller.cpp | 6 +++---
 1 file changed, 3 insertions(+), 3 deletions(-)

diff --git a/src/roscontroller.cpp b/src/roscontroller.cpp
index eedf912..484d121 100644
--- a/src/roscontroller.cpp
+++ b/src/roscontroller.cpp
@@ -293,8 +293,8 @@ namespace rosbzz_node{
 		/* Extract neighbours position from payload*/
 		double neighbours_pos_payload[3];
 		memcpy(neighbours_pos_payload, message_obt, 3*sizeof(uint64_t));
-		//buzz_utility::Pos_struct raw_neigh_pos(neighbours_pos_payload[0],neighbours_pos_payload[1],neighbours_pos_payload[2]);
-		cout<<"obt lat ,long alt"<<neighbours_pos_payload[0]<<neighbours_pos_payload[1]<<neighbours_pos_payload[2];
+		buzz_utility::Pos_struct raw_neigh_pos(neighbours_pos_payload[0],neighbours_pos_payload[1],neighbours_pos_payload[2]);
+		//cout<<"obt lat ,long alt"<<neighbours_pos_payload[0]<<neighbours_pos_payload[1]<<neighbours_pos_payload[2];
 		/*Convert obtained position to relative position*/
 		for(i=0;i<3;i++){
 			neighbours_pos_payload[i]=neighbours_pos_payload[i]-cur_pos[i];
@@ -305,7 +305,7 @@ namespace rosbzz_node{
 		/*pass neighbour position to local maintaner*/
 		buzz_utility::Pos_struct n_pos(cvt_neighbours_pos_payload[0],cvt_neighbours_pos_payload[1],cvt_neighbours_pos_payload[2]);
 		/*Put RID and pos*/
-		//raw_neighbours_pos_put((int)out[1],raw_neigh_pos);		
+		raw_neighbours_pos_put((int)out[1],raw_neigh_pos);		
 		neighbours_pos_put((int)out[1],n_pos);
 		delete[] out;
 		buzz_utility::in_msg_process((message_obt+3));