root / trunk / code / projects / slam / slam_analyzer.c @ 90
History | View | Annotate | Download (711 Bytes)
1 |
#include "slam_analyzer.h" |
---|---|
2 |
#include "slam_defs.h" |
3 |
#include <stdio.h> |
4 |
#include <stdlib.h> |
5 |
|
6 |
|
7 |
|
8 |
void slam_analyze(RobotData* head){
|
9 |
//The good stuff.
|
10 |
|
11 |
} |
12 |
|
13 |
|
14 |
|
15 |
void slam_print_data(RobotData* head){
|
16 |
if(head==NULL) printf("No data to display.\n"); |
17 |
RobotData* iter = head; |
18 |
BomNode* bomIter; |
19 |
char i;
|
20 |
while(iter!= NULL){ |
21 |
bomIter = iter->bom_head; |
22 |
printf("Robot %x:\n",iter->id);
|
23 |
for(i=0;i<5;i++) |
24 |
printf("\tSharp IR %i : %i\n\n",i,iter->IR[i]);
|
25 |
if(BomIter == NULL){ |
26 |
printf("No Bom Data to Display\n\n\n");
|
27 |
} |
28 |
else{
|
29 |
while(bomIter!=NULL){ |
30 |
printf("\tBom reading for robot %x : %i",BomIter->id, BomIter->value);
|
31 |
bomIter = bomIter->next; |
32 |
} |
33 |
} |
34 |
} |
35 |
} |