aboutsummaryrefslogtreecommitdiffstats
path: root/firmware/src/os/req_ctx.c
diff options
context:
space:
mode:
authorHarald Welte <laforge@gnumonks.org>2014-11-11 22:31:27 +0100
committerHarald Welte <laforge@gnumonks.org>2014-11-11 22:31:27 +0100
commit5a40e2fed18ed75c7b8d62f52cf4a7c660a8e026 (patch)
treebce986dd5ab366dd141456f842c887868b73db7a /firmware/src/os/req_ctx.c
parent3c85f8de8d394eaea5ed7f6e2675201d079e227b (diff)
parentb6caca4b64a73d8d3ab4ce6b51cea71b8f1a54b0 (diff)
Merge branch 'minxu-fixes'
Diffstat (limited to 'firmware/src/os/req_ctx.c')
-rw-r--r--firmware/src/os/req_ctx.c164
1 files changed, 137 insertions, 27 deletions
diff --git a/firmware/src/os/req_ctx.c b/firmware/src/os/req_ctx.c
index cc8d57b..722c099 100644
--- a/firmware/src/os/req_ctx.c
+++ b/firmware/src/os/req_ctx.c
@@ -29,11 +29,11 @@
/* FIXME: locking, FIFO order processing */
#if defined(__AT91SAM7S64__) || defined(RUN_FROM_RAM)
-#define NUM_RCTX_SMALL 16
-#define NUM_RCTX_LARGE 1
+#define NUM_RCTX_SMALL 0
+#define NUM_RCTX_LARGE 8
#else
-#define NUM_RCTX_SMALL 8
-#define NUM_RCTX_LARGE 4
+#define NUM_RCTX_SMALL 0
+#define NUM_RCTX_LARGE 20
#endif
#define NUM_REQ_CTX (NUM_RCTX_SMALL+NUM_RCTX_LARGE)
@@ -43,63 +43,173 @@ static u_int8_t rctx_data_large[NUM_RCTX_LARGE][RCTX_SIZE_LARGE];
static struct req_ctx req_ctx[NUM_REQ_CTX];
+/* queue of RCTX indexed by their current state */
+static struct req_ctx *req_ctx_queues[RCTX_STATE_COUNT], *req_ctx_tails[RCTX_STATE_COUNT];
+static unsigned req_counts[RCTX_STATE_COUNT];
+
struct req_ctx __ramfunc *req_ctx_find_get(int large,
unsigned long old_state,
unsigned long new_state)
{
+ struct req_ctx *toReturn;
unsigned long flags;
- u_int8_t i;
-
- if (large)
- i = NUM_RCTX_SMALL;
- else
- i = 0;
- for (; i < NUM_REQ_CTX; i++) {
- local_irq_save(flags);
- if (req_ctx[i].state == old_state) {
- req_ctx[i].state = new_state;
- local_irq_restore(flags);
- return &req_ctx[i];
- }
- local_irq_restore(flags);
+ if (old_state >= RCTX_STATE_COUNT || new_state >= RCTX_STATE_COUNT) {
+ DEBUGPCR("Invalid parameters for req_ctx_find_get");
+ return NULL;
}
-
- return NULL;
+ local_irq_save(flags);
+ toReturn = req_ctx_queues[old_state];
+ if (toReturn) {
+ if ((req_ctx_queues[old_state] = toReturn->next))
+ toReturn->next->prev = NULL;
+ else
+ req_ctx_tails[old_state] = NULL;
+ req_counts[old_state]--;
+ if ((toReturn->prev = req_ctx_tails[new_state]))
+ toReturn->prev->next = toReturn;
+ else
+ req_ctx_queues[new_state] = toReturn;
+ req_ctx_tails[new_state] = toReturn;
+ toReturn->state = new_state;
+ toReturn->next = NULL;
+ req_counts[new_state]++;
+ }
+ local_irq_restore(flags);
+ return toReturn;
}
u_int8_t req_ctx_num(struct req_ctx *ctx)
{
- return ((char *)ctx - (char *)&req_ctx[0])/sizeof(*ctx);
+ return ctx - req_ctx;
}
void req_ctx_set_state(struct req_ctx *ctx, unsigned long new_state)
{
unsigned long flags;
+ unsigned old_state;
- /* FIXME: do we need this kind of locking, we're UP! */
+ if (new_state >= RCTX_STATE_COUNT) {
+ DEBUGPCR("Invalid new_state for req_ctx_set_state");
+ return;
+ }
local_irq_save(flags);
+ old_state = ctx->state;
+ if (ctx->prev)
+ ctx->prev->next = ctx->next;
+ else
+ req_ctx_queues[old_state] = ctx->next;
+ if (ctx->next)
+ ctx->next->prev = ctx->prev;
+ else
+ req_ctx_tails[old_state] = ctx->prev;
+ req_counts[old_state]--;
+ if ((ctx->prev = req_ctx_tails[new_state]))
+ ctx->prev->next = ctx;
+ else
+ req_ctx_queues[new_state] = ctx;
+ req_ctx_tails[new_state] = ctx;
ctx->state = new_state;
+ ctx->next = NULL;
+ req_counts[new_state]++;
local_irq_restore(flags);
}
+#ifdef DEBUG_REQCTX
+void req_print(int state) {
+ int count = 0;
+ struct req_ctx *ctx, *last = NULL;
+ DEBUGP("State [%02i] start <==> ", state);
+ ctx = req_ctx_queues[state];
+ while (ctx) {
+ if (last != ctx->prev)
+ DEBUGP("*INV_PREV* ");
+ DEBUGP("%08X => ", ctx);
+ last = ctx;
+ ctx = ctx->next;
+ count++;
+ if (count > NUM_REQ_CTX) {
+ DEBUGP("*WILD POINTER* => ");
+ break;
+ }
+ }
+ DEBUGPCR("NULL");
+ if (!req_ctx_queues[state] && req_ctx_tails[state]) {
+ DEBUGPCR("NULL head, NON-NULL tail");
+ }
+ if (last != req_ctx_tails[state]) {
+ DEBUGPCR("Tail does not match last element");
+ }
+}
+#endif
+
void req_ctx_put(struct req_ctx *ctx)
{
- req_ctx_set_state(ctx, RCTX_STATE_FREE);
+ unsigned long intcFlags;
+ unsigned old_state;
+
+ local_irq_save(intcFlags);
+ old_state = ctx->state;
+ if (ctx->prev)
+ ctx->prev->next = ctx->next;
+ else
+ req_ctx_queues[old_state] = ctx->next;
+ if (ctx->next)
+ ctx->next->prev = ctx->prev;
+ else
+ req_ctx_tails[old_state] = ctx->prev;
+ req_counts[old_state]--;
+ if ((ctx->prev = req_ctx_tails[RCTX_STATE_FREE]))
+ ctx->prev->next = ctx;
+ else
+ req_ctx_queues[RCTX_STATE_FREE] = ctx;
+ req_ctx_tails[RCTX_STATE_FREE] = ctx;
+ ctx->state = RCTX_STATE_FREE;
+ ctx->next = NULL;
+ req_counts[RCTX_STATE_FREE]++;
+ local_irq_restore(intcFlags);
+}
+
+unsigned int req_ctx_count(unsigned long state)
+{
+ if (state >= RCTX_STATE_COUNT)
+ return 0;
+ return req_counts[state];
}
void req_ctx_init(void)
{
int i;
-
for (i = 0; i < NUM_RCTX_SMALL; i++) {
+ req_ctx[i].prev = req_ctx + i - 1;
+ req_ctx[i].next = req_ctx + i + 1;
req_ctx[i].size = RCTX_SIZE_SMALL;
+ req_ctx[i].tot_len = 0;
req_ctx[i].data = rctx_data[i];
req_ctx[i].state = RCTX_STATE_FREE;
+ DEBUGPCR("SMALL req_ctx[%02i] initialized at %08X, Data: %08X => %08X",
+ i, req_ctx + i, req_ctx[i].data, req_ctx[i].data + RCTX_SIZE_SMALL);
+ }
+
+ for (; i < NUM_REQ_CTX; i++) {
+ req_ctx[i].prev = req_ctx + i - 1;
+ req_ctx[i].next = req_ctx + i + 1;
+ req_ctx[i].size = RCTX_SIZE_LARGE;
+ req_ctx[i].tot_len = 0;
+ req_ctx[i].data = rctx_data_large[i];
+ req_ctx[i].state = RCTX_STATE_FREE;
+ DEBUGPCR("LARGE req_ctx[%02i] initialized at %08X, Data: %08X => %08X",
+ i, req_ctx + i, req_ctx[i].data, req_ctx[i].data + RCTX_SIZE_LARGE);
}
+ req_ctx[0].prev = NULL;
+ req_ctx[NUM_REQ_CTX - 1].next = NULL;
+
+ req_ctx_queues[RCTX_STATE_FREE] = req_ctx;
+ req_ctx_tails[RCTX_STATE_FREE] = req_ctx + NUM_REQ_CTX - 1;
+ req_counts[RCTX_STATE_FREE] = NUM_REQ_CTX;
- for (i = 0; i < NUM_RCTX_LARGE; i++) {
- req_ctx[NUM_RCTX_SMALL+i].size = RCTX_SIZE_LARGE;
- req_ctx[NUM_RCTX_SMALL+i].data = rctx_data_large[i];
+ for (i = RCTX_STATE_FREE + 1; i < RCTX_STATE_COUNT; i++) {
+ req_ctx_queues[i] = req_ctx_tails[i] = NULL;
+ req_counts[i] = 0;
}
}