Subversion Repositories or1k_old

/* tick14.c

 * linux/arch/sparc/kernel/tick14.c

 *

 * Copyright (C) 1996 David Redman (djhr@tadpole.co.uk)

 *

 * This file handles the Sparc specific level14 ticker

 * This is really useful for profiling OBP uses it for keyboard

 * aborts and other stuff.

 *

 *

 */

#include <linux/errno.h>

#include <linux/sched.h>

#include <linux/kernel.h>

#include <linux/param.h>

#include <linux/string.h>

#include <linux/mm.h>

#include <linux/timex.h>

#include <asm/oplib.h>

#include <asm/segment.h>

#include <asm/timer.h>

#include <asm/mostek.h>

#include <asm/system.h>

#include <asm/irq.h>

#include <asm/io.h>

extern unsigned long lvl14_save[5];

static unsigned long *linux_lvl14 = NULL;

static unsigned long obp_lvl14[4];

void install_linux_ticker(void)

{

        unsigned long flags;

        if (!linux_lvl14)

                return;

        save_flags(flags); cli();

        linux_lvl14[0] =  lvl14_save[0];

        linux_lvl14[1] =  lvl14_save[1];

        linux_lvl14[2] =  lvl14_save[2];

        linux_lvl14[3] =  lvl14_save[3];

        restore_flags(flags);

}

void install_obp_ticker(void)

{

        unsigned long flags;

        if (!linux_lvl14)

                return;

        save_flags(flags); cli();

        linux_lvl14[0] =  obp_lvl14[0];

        linux_lvl14[1] =  obp_lvl14[1];

        linux_lvl14[2] =  obp_lvl14[2];

        linux_lvl14[3] =  obp_lvl14[3];

        restore_flags(flags);

}

void claim_ticker14(void (*handler)(int, void *, struct pt_regs *),

                    int irq_nr, unsigned int timeout )

{

        /* first we copy the obp handler instructions

         */

        disable_irq(irq_nr);

        if (!handler)

                return;

        linux_lvl14 = (unsigned long *)lvl14_save[4];

        obp_lvl14[0] = linux_lvl14[0];

        obp_lvl14[1] = linux_lvl14[1];

        obp_lvl14[2] = linux_lvl14[2];

        obp_lvl14[3] = linux_lvl14[3];

        if (!request_irq(irq_nr,

                         handler,

                         (SA_INTERRUPT | SA_STATIC_ALLOC),

                         "counter14",

                         NULL)) {

                install_linux_ticker();

                load_profile_irq(timeout);

                enable_irq(irq_nr);

        }

}