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