rusefi
/
atbetaflight
mirror of https://github.com/rusefi/atbetaflight.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Minor optimisations to queueAdd and queueRemove

This commit is contained in:
Martin Budden 2016-01-21 10:38:25 +00:00 committed by borisbstyle
parent 2b8e75a761
commit e52c597d0e
1 changed files with 4 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
src/main/scheduler.c
View File

@ -82,17 +82,14 @@ STATIC_UNIT_TESTED bool queueContains(cfTask_t *task)
STATIC_UNIT_TESTED void queueAdd(cfTask_t *task)
{
if (taskQueueSize >= TASK_COUNT -1) {
if ((taskQueueSize >= TASK_COUNT -1) || queueContains(task)) {
return;
}
if (queueContains(task)) {
return;
}
++taskQueueSize;
for (int ii = 0; ii < taskQueueSize; ++ii) {
for (int ii = 0; ii <= taskQueueSize; ++ii) {
if (taskQueueArray[ii] == NULL || taskQueueArray[ii]->staticPriority < task->staticPriority) {
memmove(&taskQueueArray[ii+1], &taskQueueArray[ii], sizeof(task) * (taskQueueSize - ii - 1));
memmove(&taskQueueArray[ii+1], &taskQueueArray[ii], sizeof(task) * (taskQueueSize - ii));
taskQueueArray[ii] = task;
++taskQueueSize;
return;
}
}
@ -104,9 +101,6 @@ STATIC_UNIT_TESTED void queueRemove(cfTask_t *task)
if (taskQueueArray[ii] == task) {
memmove(&taskQueueArray[ii], &taskQueueArray[ii+1], sizeof(task) * (taskQueueSize - ii));
--taskQueueSize;
if (taskQueueSize == 0) {
taskQueueArray[0] = NULL; // ensure item zero is null when queue is empty
}
return;
}
}