Logo Search packages:      
Sourcecode: linux version File versions  Download package

p1275.c

/* $Id: p1275.c,v 1.22 2001/10/18 09:40:00 davem Exp $
 * p1275.c: Sun IEEE 1275 PROM low level interface routines
 *
 * Copyright (C) 1996,1997 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/sched.h>
#include <linux/smp.h>
#include <linux/string.h>
#include <linux/spinlock.h>

#include <asm/openprom.h>
#include <asm/oplib.h>
#include <asm/system.h>
#include <asm/spitfire.h>
#include <asm/pstate.h>
#include <asm/ldc.h>

struct {
      long prom_callback;                 /* 0x00 */
      void (*prom_cif_handler)(long *);   /* 0x08 */
      unsigned long prom_cif_stack;       /* 0x10 */
      unsigned long prom_args [23];       /* 0x18 */
      char prom_buffer [3000];
} p1275buf;

extern void prom_world(int);

extern void prom_cif_interface(void);
extern void prom_cif_callback(void);

/*
 * This provides SMP safety on the p1275buf. prom_callback() drops this lock
 * to allow recursuve acquisition.
 */
DEFINE_SPINLOCK(prom_entry_lock);

long p1275_cmd(const char *service, long fmt, ...)
{
      char *p, *q;
      unsigned long flags;
      int nargs, nrets, i;
      va_list list;
      long attrs, x;
      
      p = p1275buf.prom_buffer;

      spin_lock_irqsave(&prom_entry_lock, flags);

      p1275buf.prom_args[0] = (unsigned long)p;       /* service */
      strcpy (p, service);
      p = (char *)(((long)(strchr (p, 0) + 8)) & ~7);
      p1275buf.prom_args[1] = nargs = (fmt & 0x0f);         /* nargs */
      p1275buf.prom_args[2] = nrets = ((fmt & 0xf0) >> 4);  /* nrets */
      attrs = fmt >> 8;
      va_start(list, fmt);
      for (i = 0; i < nargs; i++, attrs >>= 3) {
            switch (attrs & 0x7) {
            case P1275_ARG_NUMBER:
                  p1275buf.prom_args[i + 3] =
                                    (unsigned)va_arg(list, long);
                  break;
            case P1275_ARG_IN_64B:
                  p1275buf.prom_args[i + 3] =
                        va_arg(list, unsigned long);
                  break;
            case P1275_ARG_IN_STRING:
                  strcpy (p, va_arg(list, char *));
                  p1275buf.prom_args[i + 3] = (unsigned long)p;
                  p = (char *)(((long)(strchr (p, 0) + 8)) & ~7);
                  break;
            case P1275_ARG_OUT_BUF:
                  (void) va_arg(list, char *);
                  p1275buf.prom_args[i + 3] = (unsigned long)p;
                  x = va_arg(list, long);
                  i++; attrs >>= 3;
                  p = (char *)(((long)(p + (int)x + 7)) & ~7);
                  p1275buf.prom_args[i + 3] = x;
                  break;
            case P1275_ARG_IN_BUF:
                  q = va_arg(list, char *);
                  p1275buf.prom_args[i + 3] = (unsigned long)p;
                  x = va_arg(list, long);
                  i++; attrs >>= 3;
                  memcpy (p, q, (int)x);
                  p = (char *)(((long)(p + (int)x + 7)) & ~7);
                  p1275buf.prom_args[i + 3] = x;
                  break;
            case P1275_ARG_OUT_32B:
                  (void) va_arg(list, char *);
                  p1275buf.prom_args[i + 3] = (unsigned long)p;
                  p += 32;
                  break;
            case P1275_ARG_IN_FUNCTION:
                  p1275buf.prom_args[i + 3] =
                              (unsigned long)prom_cif_callback;
                  p1275buf.prom_callback = va_arg(list, long);
                  break;
            }
      }
      va_end(list);

      prom_world(1);
      prom_cif_interface();
      prom_world(0);

      attrs = fmt >> 8;
      va_start(list, fmt);
      for (i = 0; i < nargs; i++, attrs >>= 3) {
            switch (attrs & 0x7) {
            case P1275_ARG_NUMBER:
                  (void) va_arg(list, long);
                  break;
            case P1275_ARG_IN_STRING:
                  (void) va_arg(list, char *);
                  break;
            case P1275_ARG_IN_FUNCTION:
                  (void) va_arg(list, long);
                  break;
            case P1275_ARG_IN_BUF:
                  (void) va_arg(list, char *);
                  (void) va_arg(list, long);
                  i++; attrs >>= 3;
                  break;
            case P1275_ARG_OUT_BUF:
                  p = va_arg(list, char *);
                  x = va_arg(list, long);
                  memcpy (p, (char *)(p1275buf.prom_args[i + 3]), (int)x);
                  i++; attrs >>= 3;
                  break;
            case P1275_ARG_OUT_32B:
                  p = va_arg(list, char *);
                  memcpy (p, (char *)(p1275buf.prom_args[i + 3]), 32);
                  break;
            }
      }
      va_end(list);
      x = p1275buf.prom_args [nargs + 3];

      spin_unlock_irqrestore(&prom_entry_lock, flags);

      return x;
}

void prom_cif_init(void *cif_handler, void *cif_stack)
{
      p1275buf.prom_cif_handler = (void (*)(long *))cif_handler;
      p1275buf.prom_cif_stack = (unsigned long)cif_stack;
}

Generated by  Doxygen 1.6.0   Back to index