Subversion Repositories or1k

/* auxio.c: Probing for the Sparc AUXIO register at boot time.

 *

 * Copyright (C) 1996 David S. Miller (davem@caip.rutgers.edu)

 */

#include <asm/oplib.h>

#include <asm/io.h>

/* Probe and map in the Auxiliary I/O register */

unsigned char *auxio_register;

void

auxio_probe(void)

{

        int node, auxio_nd;

        struct linux_prom_registers auxregs[1];

        node = prom_getchild(prom_root_node);

        auxio_nd = prom_searchsiblings(node, "auxiliary-io");

        if(!auxio_nd) {

                node = prom_searchsiblings(node, "obio");

                node = prom_getchild(node);

                auxio_nd = prom_searchsiblings(node, "auxio");

                if(!auxio_nd) {

                        prom_printf("Cannot find auxio node, cannot continue...\n");

                        prom_halt();

                }

        }

        prom_getproperty(auxio_nd, "reg", (char *) auxregs, sizeof(auxregs));

        prom_apply_obio_ranges(auxregs, 0x1);

        /* Map the register both read and write */

        auxio_register = (unsigned char *) sparc_alloc_io(auxregs[0].phys_addr, 0,

                                                          auxregs[0].reg_size,

                                                          "auxiliaryIO",

                                                          auxregs[0].which_io, 0x0);

        /* Fix the address on sun4m and sun4c. */

        if((((unsigned long) auxregs[0].phys_addr) & 3) == 3 ||

           sparc_cpu_model == sun4c)

                auxio_register = (unsigned char *) ((int)auxio_register | 3);

}