Statistics
| Branch: | Tag: | Revision:

amiro-os / devices / DiWheelDrive / amiro_map.cpp @ e1f1c4b5

History | View | Annotate | Download (538 Bytes)

1
#include "amiro_map.hpp"
2

    
3

    
4
void AmiroMap::initialize(int8_t (&config)[MAX_NODES][NODE_ATTRIBUTES]){
5

    
6
  uint8_t nodeCount = 0;
7
  bool end = false;
8

    
9
  for (int i=0; i<MAX_NODES; i++){
10
    if(config[i][NODE_ATTRIBUTES - 1] == 255){
11
      end = true;
12
      break;
13
    }
14
    nodeCount++;
15
  }
16
  if (!end || nodeCount == 0 ){
17

    
18
    // Failed to determine the amount of nodes
19
    return;
20
  }
21

    
22
  this->nodeList = (struct node*) malloc(nodeCount * sizeof(struct node)); 
23

    
24
  
25

    
26
}
27

    
28

    
29
void AmiroMap::update(){
30
  
31
}
32

    
33

    
34
void AmiroMap::uninitialize(){
35
  
36
}
37