MCPcopy Create free account
hub / github.com/ANYbotics/grid_map / incrementIndex

Function incrementIndex

grid_map_core/src/GridMapMath.cpp:437–457  ·  view source on GitHub ↗

Source from the content-addressed store, hash-verified

435}
436
437bool incrementIndex(Index& index, const Size& bufferSize, const Index& bufferStartIndex)
438{
439 Index unwrappedIndex = getIndexFromBufferIndex(index, bufferSize, bufferStartIndex);
440
441 // Increment index.
442 if (unwrappedIndex(1) + 1 < bufferSize(1)) {
443 // Same row.
444 unwrappedIndex[1]++;
445 } else {
446 // Next row.
447 unwrappedIndex[0]++;
448 unwrappedIndex[1] = 0;
449 }
450
451 // End of iterations reached.
452 if (!checkIfIndexInRange(unwrappedIndex, bufferSize)) return false;
453
454 // Return true iterated index.
455 index = getBufferIndexFromIndex(unwrappedIndex, bufferSize, bufferStartIndex);
456 return true;
457}
458
459bool incrementIndexForSubmap(Index& submapIndex, Index& index, const Index& submapTopLeftIndex,
460 const Size& submapBufferSize, const Size& bufferSize,

Callers 1

TESTFunction · 0.85

Calls 3

getIndexFromBufferIndexFunction · 0.85
checkIfIndexInRangeFunction · 0.85
getBufferIndexFromIndexFunction · 0.85

Tested by 1

TESTFunction · 0.68