arch/ppc-chrp/rtas/rtas_init.c

   1 /*
   2  * rtas_init.c
   3  *
   4  *  Created on: Mar 22, 2009
   5  *      Author: misc
   6  */
   7
   8 #define DEBUG 1
   9
  10 #include <asm/mpc5200b.h>
  11 #include <aros/debug.h>
  12 #include <aros/symbolsets.h>
  13 #include <aros/libcall.h>
  14 #include <proto/openfirmware.h>
  15 #include <proto/kernel.h>
  16 #include <proto/exec.h>
  17 #include <proto/rtas.h>
  18
  19 #include "rtas_private.h"
  20
  21 static int rtas_init(struct RTASBase *RTASBase)
  22 {
  23         int retval = TRUE;
  24         void *OpenFirmwareBase;
  25         void *key, *prop;
  26
  27         D(bug("[RTAS] RTAS Init.\n"));
  28
  29         OpenFirmwareBase = RTASBase->OpenFirmwareBase = OpenResource("openfirmware.resource");
  30         RTASBase->KernelBase = OpenResource("kernel.resource");
  31
  32         /* Get some addresses from OF tree */
  33         if (OpenFirmwareBase)
  34         {
  35                 key = OF_OpenKey("/rtas");
  36                 if (key)
  37                 {
  38                         prop = OF_FindProperty(key, "load_base");
  39                         if (prop)
  40                         {
  41                                 void **reg = OF_GetPropValue(prop);
  42                                 D(bug("[RTAS] RTAS loaded at %08x\n", *reg));
  43                                 RTASBase->rtas_base = *reg;
  44                         }
  45
  46                         prop = OF_FindProperty(key, "entry");
  47                         if (prop)
  48                         {
  49                                 void **reg = OF_GetPropValue(prop);
  50                                 D(bug("[RTAS] Entry at %08x\n", *reg));
  51                                 RTASBase->rtas_entry = *reg;
  52                         }
  53                 }
  54         }
  55         else
  56                 retval = FALSE;
  57
  58
  59         return retval;
  60 }
  61
  62 extern void return_entry();
  63 extern void return_2();
  64
  65 AROS_LH5(int32_t, RTASCall,
  66                 AROS_LHA(const char *,  name,   A0),
  67                 AROS_LHA(uint32_t,              nargs,  D0),
  68                 AROS_LHA(uint32_t,              nrets,  D1),
  69                 AROS_LHA(uint32_t *,    output, A1),
  70                 AROS_LHA(va_list,               args,   A2),
  71                 struct RTASBase *, RTASBase, 0, Rtas)
  72 {
  73         AROS_LIBFUNC_INIT
  74
  75         void *OpenFirmwareBase = RTASBase->OpenFirmwareBase;
  76         void *KernelBase = RTASBase->KernelBase;
  77
  78         int32_t token = 0;
  79         int32_t retval = -1;
  80
  81         D(bug("[RTAS] Calling method '%s'\n", name));
  82
  83         void *key = OF_OpenKey("/rtas");
  84         if (key)
  85         {
  86                 void *prop = OF_FindProperty(key, name);
  87
  88                 if (prop)
  89                 {
  90                         token = *(int32_t *)OF_GetPropValue(prop);
  91                 }
  92         }
  93
  94         if (token)
  95         {
  96                 D(bug("[RTAS] Method '%s', token %d\n", name, token));
  97                 int i;
  98
  99                 RTASBase->rtas_args.token = token;
 100                 RTASBase->rtas_args.nargs = nargs;
 101                 RTASBase->rtas_args.nret = nrets;
 102                 RTASBase->rtas_args.rets = KrnVirtualToPhysical(&RTASBase->rtas_args.args[nargs]);
 103
 104                 for (i=0; i < nargs; i++)
 105                 {
 106                         RTASBase->rtas_args.args[i] = va_arg(args, uint32_t);
 107                 }
 108
 109                 Disable();
 110
 111                 {
 112                         register intptr_t args asm ("r4") = KrnVirtualToPhysical(&RTASBase->rtas_args);
 113                         register intptr_t base asm ("r5") = RTASBase->rtas_base;
 114                         register intptr_t entry asm ("r6") = RTASBase->rtas_entry;
 115
 116                         asm volatile("li %%r3,%0; sc"::"i"(9 /*SC_RTAS*/),"r"(args),"r"(base),"r"(entry):"memory","r3");
 117                 }
 118
 119                 if (nrets > 1 && output)
 120                 {
 121                         for (i=0; i < nrets-1; i++)
 122                                 output[i] = RTASBase->rtas_args.rets[i+1];
 123                 }
 124
 125                 retval = nrets > 0 ? RTASBase->rtas_args.rets[0] : 0;
 126
 127                 D(bug("[RTAS] The call returned %d\n", retval));
 128
 129                 Enable();
 130         }
 131         else
 132                 retval = -1;
 133
 134         return retval;
 135
 136         AROS_LIBFUNC_EXIT
 137 }
 138
 139 ADD2INITLIB(rtas_init, 0)