root / trunk / code / projects / slam / slam_analyzer.c @ 90
History | View | Annotate | Download (711 Bytes)
1 | 90 | jscheine | #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 | } |