rom/openfirmware/of_init.c

   1 /*
   2  * of_init.c
   3  *
   4  *  Created on: Oct 12, 2008
   5  *      Author: misc
   6  */
   7
   8 #define DEBUG 1
   9
  10 #include <inttypes.h>
  11 #include <aros/kernel.h>
  12 #include <aros/symbolsets.h>
  13 #include <aros/debug.h>
  14 #include <exec/nodes.h>
  15 #include <exec/lists.h>
  16 #include <utility/tagitem.h>
  17 #include <proto/kernel.h>
  18 #include <proto/utility.h>
  19
  20 #include "of_intern.h"
  21 #include LC_LIBDEFS_FILE
  22
  23 AROS_LH1(void *, OF_OpenKey,
  24          AROS_LHA(char *, Key, A0),
  25          struct OpenFirmwareBase *, OpenFirmwareBase, 1, Openfirmware)
  26 {
  27     AROS_LIBFUNC_INIT
  28
  29     char ptrbuf[64];
  30     int i;
  31     of_node_t *node, *root = NULL;
  32
  33     D(bug("[OF] OpenKey('%s')\n", Key));
  34
  35     if (*Key != '/')
  36     {
  37         D(bug("[OF] Key must have absolute path\n"));
  38     }
  39     else
  40     {
  41         root = LIBBASE->of_Root;
  42
  43         while(*Key)
  44         {
  45                 Key++;
  46                 for (i=0; i < 63; i++)
  47                 {
  48                         if (*Key == '/' || *Key == 0)
  49                                 break;
  50                         ptrbuf[i] = *Key;
  51                         Key++;
  52                 }
  53
  54                 ptrbuf[i] = 0;
  55
  56                 D(bug("[OF] looking for child '%s'\n", ptrbuf));
  57
  58                 ForeachNode(&root->on_children, node)
  59                 {
  60                         if (!strcmp(node->on_name, ptrbuf))
  61                         {
  62                                 root = node;
  63                                 break;
  64                         }
  65                 }
  66         }
  67     }
  68
  69     return root;
  70
  71     AROS_LIBFUNC_EXIT
  72 }
  73
  74 AROS_LH1I(void, OF_CloseKey,
  75          AROS_LHA(void *, Key, A0),
  76          struct OpenFirmwareBase *, OpenFirmwareBase, 2, Openfirmware)
  77 {
  78     AROS_LIBFUNC_INIT
  79
  80     AROS_LIBFUNC_EXIT
  81 }
  82
  83 AROS_LH2I(void *, OF_GetChild,
  84          AROS_LHA(void *, Key, A0),
  85          AROS_LHA(void *, Prev, A1),
  86          struct OpenFirmwareBase *, OpenFirmwareBase, 3, Openfirmware)
  87 {
  88     AROS_LIBFUNC_INIT
  89
  90     of_node_t *node = (of_node_t *)Key;
  91     of_node_t *last = (of_node_t *)Prev;
  92
  93     if (last)
  94         return GetSucc(last);
  95     else
  96         return GetHead(&node->on_children);
  97
  98     AROS_LIBFUNC_EXIT
  99 }
 100
 101 AROS_LH2I(void *, OF_FindProperty,
 102          AROS_LHA(void *, Key, A0),
 103          AROS_LHA(char *, name, A1),
 104          struct OpenFirmwareBase *, OpenFirmwareBase, 4, Openfirmware)
 105 {
 106     AROS_LIBFUNC_INIT
 107
 108     of_node_t *node = (of_node_t *)Key;
 109     of_property_t *p, *prop = NULL;
 110
 111     ForeachNode(&node->on_properties, p)
 112     {
 113         if (!strcmp(p->op_name, name))
 114         {
 115                 prop = p;
 116                         break;
 117                 }
 118     }
 119
 120         return prop;
 121
 122     AROS_LIBFUNC_EXIT
 123 }
 124
 125 AROS_LH2I(void *, OF_GetProperty,
 126          AROS_LHA(void *, Key, A0),
 127          AROS_LHA(void *, Prev, A1),
 128          struct OpenFirmwareBase *, OpenFirmwareBase, 5, Openfirmware)
 129 {
 130     AROS_LIBFUNC_INIT
 131
 132     of_node_t *node = (of_node_t *)Key;
 133     of_property_t *last = (of_property_t *)Prev;
 134
 135     if (last)
 136         return GetSucc(last);
 137     else
 138         return GetHead(&node->on_properties);
 139
 140     AROS_LIBFUNC_EXIT
 141 }
 142
 143 AROS_LH1I(uint32_t, OF_GetPropLen,
 144          AROS_LHA(void *, Key, A0),
 145          struct OpenFirmwareBase *, OpenFirmwareBase, 6, Openfirmware)
 146 {
 147     AROS_LIBFUNC_INIT
 148
 149     of_property_t *prop = (of_property_t *)Key;
 150
 151     if (prop)
 152         return prop->op_length;
 153     else
 154         return 0;
 155
 156     AROS_LIBFUNC_EXIT
 157 }
 158
 159 AROS_LH1I(char *, OF_GetPropName,
 160          AROS_LHA(void *, Key, A0),
 161          struct OpenFirmwareBase *, OpenFirmwareBase, 8, Openfirmware)
 162 {
 163     AROS_LIBFUNC_INIT
 164
 165     of_property_t *prop = (of_property_t *)Key;
 166
 167     if (prop)
 168         return prop->op_name;
 169     else
 170         return "(null)";
 171
 172     AROS_LIBFUNC_EXIT
 173 }
 174
 175 AROS_LH1I(void *, OF_GetPropValue,
 176          AROS_LHA(void *, Key, A0),
 177          struct OpenFirmwareBase *, OpenFirmwareBase, 7, Openfirmware)
 178 {
 179     AROS_LIBFUNC_INIT
 180
 181     of_property_t *prop = (of_property_t *)Key;
 182
 183     if (prop)
 184         return prop->op_value;
 185     else
 186         return NULL;
 187
 188     AROS_LIBFUNC_EXIT
 189 }
 190
 191
 192 static int OF_Init(LIBBASETYPEPTR LIBBASE)
 193 {
 194         void *KernelBase = OpenResource("kernel.resource");
 195
 196         D(bug("[OF] OpenFirmware_Init\n"));
 197
 198         if (KernelBase)
 199         {
 200                 struct TagItem *tags = KrnGetBootInfo();
 201
 202                 if (tags)
 203                 {
 204                         intptr_t oftree;
 205                         D(bug("[OF] BootInto @ %08x\n", tags));
 206
 207                         oftree = GetTagData(KRN_OpenFirmwareTree, 0, tags);
 208
 209                         if (oftree)
 210                         {
 211                                 D(bug("[OF] OpenFirmware root at %08x\n", oftree));
 212                                 LIBBASE->of_Root = (of_node_t *)oftree;
 213
 214                                 return TRUE;
 215                         }
 216                         D(else bug("[OF] No OpenFirmware tree passed from bootloader\n"));
 217                 }
 218                 D(else bug("[OF] No BootInfo found\n"));
 219         }
 220
 221         return FALSE;
 222 }
 223
 224 ADD2INITLIB(OF_Init, 0)