Subversion Repositories c0or1k

/*

 * Generic to arch-specific interface for

 * exchange_registers()

 *

 * Copyright (C) 2008 Bahadir Balban

 */

#include <l4/macros.h>

#include <l4lib/exregs.h>

#include L4LIB_INC_ARCH(syslib.h)

#include INC_GLUE(message.h)

void exregs_set_read(struct exregs_data *exregs)

{

        exregs->flags |= EXREGS_READ;

}

void exregs_print_registers(void)

{

        struct exregs_data exregs;

        /* Read registers */

        memset(&exregs, 0, sizeof(exregs));

        exregs.valid_vect = ~0;  /* Set all flags */

        exregs.flags |= EXREGS_READ;

        exregs.flags |= EXREGS_SET_UTCB;

        exregs.flags |= EXREGS_SET_PAGER;

        BUG_ON(l4_exchange_registers(&exregs, self_tid()) < 0);

        /* Print out registers */

        printf("Task (%x) register state upon fault:\n", self_tid());

        printf("R0: 0x%x\n", exregs.context.r0);

        printf("R1: 0x%x\n", exregs.context.r1);

        printf("R2: 0x%x\n", exregs.context.r2);

        printf("R3: 0x%x\n", exregs.context.r3);

        printf("R4: 0x%x\n", exregs.context.r4);

        printf("R5: 0x%x\n", exregs.context.r5);

        printf("R6: 0x%x\n", exregs.context.r6);

        printf("R7: 0x%x\n", exregs.context.r7);

        printf("R8: 0x%x\n", exregs.context.r8);

        printf("R9: 0x%x\n", exregs.context.r9);

        printf("R10: 0x%x\n", exregs.context.r10);

        printf("R11: 0x%x\n", exregs.context.r11);

        printf("R12: 0x%x\n", exregs.context.r12);

        printf("R13: 0x%x\n", exregs.context.sp);

        printf("R14: 0x%x\n", exregs.context.lr);

        printf("R15: 0x%x\n", exregs.context.pc);

        printf("Pager: 0x%x\n", exregs.pagerid);

        printf("Utcb @ 0x%lx\n", exregs.utcb_address);

}

void exregs_set_mr(struct exregs_data *s, int offset, unsigned long val)

{

        /* Get MR0 */

        u32 *mr = &s->context.MR0_REGISTER;

        /* Sanity check */

        BUG_ON(offset > MR_TOTAL || offset < 0);

        /* Set MR */

        mr[offset] = val;

        /* Set valid bit for mr register */

        s->valid_vect |= FIELD_TO_BIT(exregs_context_t, MR0_REGISTER) << offset;

}

void exregs_set_pager(struct exregs_data *s, l4id_t pagerid)

{

        s->pagerid = pagerid;

        s->flags |= EXREGS_SET_PAGER;

}

unsigned long exregs_get_utcb(struct exregs_data *s)

{

        return s->utcb_address;

}

unsigned long exregs_get_stack(struct exregs_data *s)

{

        return s->context.sp;

}

void exregs_set_utcb(struct exregs_data *s, unsigned long virt)

{

        s->utcb_address = virt;

        s->flags |= EXREGS_SET_UTCB;

}

void exregs_set_stack(struct exregs_data *s, unsigned long sp)

{

        s->context.sp = sp;

        s->valid_vect |= FIELD_TO_BIT(exregs_context_t, sp);

}

void exregs_set_pc(struct exregs_data *s, unsigned long pc)

{

        s->context.pc = pc;

        s->valid_vect |= FIELD_TO_BIT(exregs_context_t, pc);

}