amiro-os / devices / DiWheelDrive / amiro_map.cpp @ 8dced1c9
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 |
|