Quelle  prom.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/* Prom access routines for the sun3x */

#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/tty.h>
#include <linux/console.h>
#include <linux/init.h>
#include <linux/mm.h>
#include <linux/string.h>

#include <asm/page.h>
#include <asm/setup.h>
#include <asm/traps.h>
#include <asm/sun3xprom.h>
#include <asm/idprom.h>
#include <asm/sun3ints.h>
#include <asm/openprom.h>
#include <asm/machines.h>

void (*sun3x_putchar)(int);
int (*sun3x_getchar)(void);
int (*sun3x_mayget)(void);
int (*sun3x_mayput)(int);
void (*sun3x_prom_reboot)(void);
e_vector sun3x_prom_abort;
struct linux_romvec *romvec;

/* prom vector table */
e_vector *sun3x_prom_vbr;

/* Handle returning to the prom */
static void sun3x_halt(void)
{
 unsigned long flags;

 /* Disable interrupts while we mess with things */
 local_irq_save(flags);

 /* Restore prom vbr */
 asm volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr));

 /* Restore prom NMI clock */
// sun3x_disable_intreg(5);
 sun3_enable_irq(7);

 /* Let 'er rip */
 asm volatile ("trap #14");

 /* Restore everything */
 sun3_disable_irq(7);
 sun3_enable_irq(5);

 asm volatile ("movec %0,%%vbr" : : "r" ((void*)vectors));
 local_irq_restore(flags);
}

void sun3x_reboot(void)
{
 /* This never returns, don't bother saving things */
 local_irq_disable();

 /* Restore prom vbr */
 asm volatile ("movec %0,%%vbr" : : "r" ((void*)sun3x_prom_vbr));

 /* Restore prom NMI clock */
 sun3_disable_irq(5);
 sun3_enable_irq(7);

 /* Let 'er rip */
 (*romvec->pv_reboot)("vmlinux");
}

static void sun3x_prom_write(struct console *co, const char *s,
                             unsigned int count)
{
 while (count--) {
  if (*s == '\n')
   sun3x_putchar('\r');
  sun3x_putchar(*s++);
 }
}

/* debug console - write-only */

static struct console sun3x_debug = {
 .name = "debug",
 .write = sun3x_prom_write,
 .flags = CON_PRINTBUFFER,
 .index = -1,
};

void __init sun3x_prom_init(void)
{
 /* Read the vector table */

 sun3x_putchar = *(void (**)(int)) (SUN3X_P_PUTCHAR);
 sun3x_getchar = *(int (**)(void)) (SUN3X_P_GETCHAR);
 sun3x_mayget = *(int (**)(void))  (SUN3X_P_MAYGET);
 sun3x_mayput = *(int (**)(int))   (SUN3X_P_MAYPUT);
 sun3x_prom_reboot = *(void (**)(void)) (SUN3X_P_REBOOT);
 sun3x_prom_abort = *(e_vector *)  (SUN3X_P_ABORT);
 romvec = (struct linux_romvec *)SUN3X_PROM_BASE;

 idprom_init();

 if (!((idprom->id_machtype & SM_ARCH_MASK) == SM_SUN3X)) {
  pr_warn("Machine reports strange type %02x\n",
   idprom->id_machtype);
  pr_warn("Pretending it's a 3/80, but very afraid...\n");
  idprom->id_machtype = SM_SUN3X | SM_3_80;
 }

 /* point trap #14 at abort.
 * XXX this is futile since we restore the vbr first - oops
 */
 vectors[VEC_TRAP14] = sun3x_prom_abort;
}

static int __init sun3x_debug_setup(char *arg)
{
 /* If debug=prom was specified, start the debug console */
 if (MACH_IS_SUN3X && !strcmp(arg, "prom"))
  register_console(&sun3x_debug);
 return 0;
}

early_param("debug", sun3x_debug_setup);

/* some prom functions to export */
int prom_getintdefault(int node, char *property, int deflt)
{
 return deflt;
}

int prom_getbool (int node, char *prop)
{
 return 1;
}

void prom_printf(char *fmt, ...)
{
}

void prom_halt (void)
{
 sun3x_halt();
}

/* Get the idprom and stuff it into buffer 'idbuf'.  Returns the
 * format type.  'num_bytes' is the number of bytes that your idbuf
 * has space for.  Returns 0xff on error.
 */
unsigned char
prom_get_idprom(char *idbuf, int num_bytes)
{
        int i;

 /* make a copy of the idprom structure */
 for (i = 0; i < num_bytes; i++)
  idbuf[i] = ((char *)SUN3X_IDPROM)[i];

        return idbuf[0];
}