newlib/libgloss/sparc_leon/kernel_debug.c

163 lines
5.0 KiB
C

/*
* Copyright (c) 2011 Aeroflex Gaisler
*
* BSD license:
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#include <asm-leon/queue.h>
/*#include <sys/fsu_pthread_queue.h>*/
#include <asm-leon/contextswitch.h>
#include <asm-leon/leonbare_kernel.h>
#include <asm-leon/leonbare_debug.h>
#include <asm-leon/stack.h>
#include <asm-leon/leonstack.h>
#include <stdarg.h>
/*indent:
indent -kr -i4 -ts4 -sob -l80 -ss -ncs -nut newlib-1.13.0/libgloss/sparc_leon/kernel*.c
indent -kr -i4 -ts4 -sob -l80 -ss -ncs -nut *.h
indent -kr -i4 -ts4 -sob -l80 -ss -ncs -nut *.c
*/
void leonbare_sched_printqueue ();
int
leonbare_sched_verify ()
{
#ifdef LBDEBUG_DO_ASSERT
int i, j;
leonbare_thread_t c, d;
for (i = 0; i < LEONBARE_RUNQ_NR; i++)
{
LBTAILQ_FOREACH (c, LEONBARE_KR_RUNQ (i), th_runq)
{
if (i < LEONBARE_RUNQ_READY_NR)
{
LBPASSERT (c->th_runq_idx == i,
"thread %s has wrong runq[%d] index (%d) ",
LEONBARE_TH_NAME_DBG (c), i, c->th_runq_idx);
LBPASSERT (c->th_runq_which == LEONBARE_KR_RUNQ_WHICH,
"thread %s in runqueue[%d] has wrong th_runq_which(%d) (!=LEONBARE_KR_RUNQ_WHICH(%d))",
LEONBARE_TH_NAME_DBG (c), i, c->th_runq_which,
LEONBARE_KR_RUNQ_WHICH);
}
else if (i == LEONBARE_RUNQ_SUSPENDED_IDX)
{
LBPASSERT (c->th_flags & LEONBARE_TH_SUSPENDED,
"thread %s in suspension queue has LEONBARE_TH_SUSPENDED not set ",
LEONBARE_TH_NAME_DBG (c));
}
else if (i == LEONBARE_RUNQ_KILLED_IDX)
{
LBPASSERT (c->
th_flags & (LEONBARE_TH_TERMINATED |
LEONBARE_TH_FINISHED),
"thread %s in killed queue has (LEONBARE_TH_TERMINATED | LEONBARE_TH_FINISHED) not set ",
LEONBARE_TH_NAME_DBG (c));
}
else if (i >= LEONBARE_RUNQ_PREPARE_IDX &&
i < (LEONBARE_RUNQ_PREPARE_IDX + LEONBARE_RUNQ_READY_NR))
{
LBPASSERT (c->th_runq_idx == (i - LEONBARE_RUNQ_PREPARE_IDX),
"thread %s has wrong prepare-runq[%d] index (%d) ",
LEONBARE_TH_NAME_DBG (c),
i - LEONBARE_RUNQ_PREPARE_IDX, c->th_runq_idx);
LBPASSERT (c->th_runq_which != LEONBARE_KR_RUNQ_WHICH,
"thread %s in prepare-runqueue[%d] has wrong th_runq_which(%d) (==LEONBARE_KR_RUNQ_WHICH(%d))",
LEONBARE_TH_NAME_DBG (c), i, c->th_runq_which,
LEONBARE_KR_RUNQ_WHICH);
}
if (i != LEONBARE_RUNQ_KILLED_IDX)
{
LBPASSERT (!
(c->
th_flags & (LEONBARE_TH_TERMINATED |
LEONBARE_TH_FINISHED)),
"thread %s not in killed queue has (LEONBARE_TH_TERMINATED | LEONBARE_TH_FINISHED) set ",
LEONBARE_TH_NAME_DBG (c));
}
if (i != LEONBARE_RUNQ_SUSPENDED_IDX)
{
LBPASSERT (!(c->th_flags & (LEONBARE_TH_SUSPENDED)),
"thread %s not in suspend queue has LEONBARE_TH_SUSPENDED set ",
LEONBARE_TH_NAME_DBG (c));
}
if (LBTAILQ_NEXT (c, th_runq))
{
LBPASSERT (c->th_account <=
LBTAILQ_NEXT (c, th_runq)->th_account,
"thread %s account is not sorted (%d<=%d)",
LEONBARE_TH_NAME_DBG (c), c->th_account,
LBTAILQ_NEXT (c, th_runq)->th_account);
}
}
}
LBTAILQ_FOREACH (c, LEONBARE_KR_ALLQ, th_allq)
{
if ((j = c->th_runq_idx) != -1)
{
LBPASSERT (j >= 0
&& j < LEONBARE_RUNQ_NR,
"thread %s has wrong runq index (%d) ",
LEONBARE_TH_NAME_DBG (c), c->th_runq_idx);
LBTAILQ_FOREACH (d, LEONBARE_KR_RUNQ (j), th_runq)
{
if (d == c)
{
break;
}
}
/*LBPASSERT(d,"thread %s is not in runq[%d] ",LEONBARE_TH_NAME_DBG(c),j); */
}
}
#endif
}
int
leonbare_debug_printf (const char *fmt, ...)
{
va_list ap;
va_start (ap, fmt);
vprintf (fmt, ap);
va_end (ap);
return 0;
}
void
leonbare_sched_printqueue ()
{
int i, j;
leonbare_thread_t c;
for (i = 0; i < LEONBARE_RUNQ_NR; i++)
{
LBDEBUG_HEADER_PRINTF (LBDEBUG_QUEUE_NR, "runq[%d]:[", i);
LBTAILQ_FOREACH (c, LEONBARE_KR_RUNQ (i), th_runq)
{
LBDEBUG (LBDEBUG_QUEUE_NR, "%s[0x%x](%d),", LEONBARE_TH_NAME_DBG (c),
c, c->th_account);
}
LBDEBUG (LBDEBUG_QUEUE_NR, "]\n", 0);
}
}