Revision 581
wireless library now times out instead of infinitely looping in waiting for ok
PositionMonitor.cpp | ||
---|---|---|
43 | 43 |
|
44 | 44 |
//TODO: check for error returned |
45 | 45 |
int numPositions = vision_get_robot_positions(&positions); |
46 |
printf("numPositions is %d\n", numPositions); |
|
46 |
/* |
|
47 |
printf("numPositions is %d\n", numPositions); |
|
47 | 48 |
for (int i = 0; i < numPositions; i++) { |
48 | 49 |
printf("{%d,%d} ", positions[i].x, positions[i].y); |
49 | 50 |
} |
50 | 51 |
printf("\n"); |
52 |
*/ |
|
51 | 53 |
|
52 | 54 |
map<int, VisionPosition> newPositionMap; |
53 | 55 |
|
... | ... | |
101 | 103 |
|
102 | 104 |
positionMap = newPositionMap; |
103 | 105 |
|
104 |
printf("\npositionMap size is %d and deleteBufferMap size is %d\n", positionMap.size(), deleteBufferMap.size()); |
|
106 |
// printf("\npositionMap size is %d and deleteBufferMap size is %d\n", positionMap.size(), deleteBufferMap.size());
|
|
105 | 107 |
|
108 |
/* |
|
106 | 109 |
//TODO: remove this debug information |
107 | 110 |
map<int, VisionPosition>::iterator iter; |
108 | 111 |
for (iter = positionMap.begin(); iter != positionMap.end(); iter++) { |
109 | 112 |
printf("%d has position (%d, %d) with delete buffer %d\n", iter->first, iter->second.x, iter->second.y, deleteBufferMap[iter->first]); |
110 | 113 |
} |
114 |
*/ |
|
111 | 115 |
|
116 |
|
|
112 | 117 |
pthread_mutex_unlock(&position_map_lock); |
113 | 118 |
|
114 | 119 |
if (positions) { |
Also available in: Unified diff