arch/ppc-chrp/efika/bestcomm/bestcomm_init.c

   1 /*
   2     Copyright © 2009-2014, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #define DEBUG 1
   7
   8 #include <aros/debug.h>
   9 #include <aros/symbolsets.h>
  10 #include <proto/openfirmware.h>
  11 #include <proto/kernel.h>
  12
  13 #include "bestcomm_private.h"
  14
  15 static int bestcomm_init(struct BestCommBase *BestCommBase)
  16 {
  17         int retval = TRUE;
  18         void *OpenFirmwareBase;
  19         void *key, *prop;
  20
  21         D(bug("[SDMA] BestComm Init.\n"));
  22
  23         OpenFirmwareBase = OpenResource("openfirmware.resource");
  24
  25         /* Get some addresses from OF tree */
  26         if (OpenFirmwareBase)
  27         {
  28                 key = OF_OpenKey("/builtin");
  29                 if (key)
  30                 {
  31                         prop = OF_FindProperty(key, "reg");
  32                         if (prop)
  33                         {
  34                                 reg_t *reg = OF_GetPropValue(prop);
  35                                 BestCommBase->bc_MBAR = (uint8_t *)reg->addr;
  36                         }
  37                 }
  38
  39                 key = OF_OpenKey("/builtin/sram");
  40                 if (key)
  41                 {
  42                         prop = OF_FindProperty(key, "reg");
  43                         if (prop)
  44                         {
  45                                 reg_t *reg = OF_GetPropValue(prop);
  46                                 BestCommBase->bc_SRAM = reg->addr;
  47                                 BestCommBase->bc_SRAMSize = reg->size;
  48                         }
  49                         D(bug("[SDMA] %d bytes SRAM at %08x\n", BestCommBase->bc_SRAMSize, BestCommBase->bc_SRAM));
  50                         if (BestCommBase->bc_SRAMSize)
  51                         {
  52                                 /* Get memory for Free bitmap. Here, 1=free and 0=in use */
  53                                 BestCommBase->bc_SRAMFree = AllocMem((BestCommBase->bc_SRAMSize >> 4) / (8*sizeof(uint32_t)), MEMF_CLEAR|MEMF_PUBLIC);
  54
  55                                 prop = OF_FindProperty(key, "available");
  56                                 if (prop)
  57                                 {
  58                                         int i;
  59                                         const int regs = OF_GetPropLen(prop) / sizeof(reg_t);
  60                                         reg_t *reg = OF_GetPropValue(prop);
  61
  62                                         for (i=0; i < regs; i++)
  63                                         {
  64                                                 D(bug("[SDMA] addr=%08x len=%d\n", reg[i].addr, reg[i].size));
  65
  66
  67                                         }
  68                                 }
  69                         }
  70                 }
  71
  72                 key = OF_OpenKey("/builtin/bestcomm");
  73                 if (key)
  74                 {
  75                         void *prop = OF_FindProperty(key, "reg");
  76                         if (prop)
  77                         {
  78                                 BestCommBase->bc_BestComm = *(void **)OF_GetPropValue(prop);
  79                         }
  80                         D(bug("[SDMA] bestcomm at %08x\n", BestCommBase->bc_BestComm));
  81                 }
  82         }
  83         else
  84                 retval = FALSE;
  85
  86
  87
  88         return retval;
  89 }
  90
  91
  92 ADD2INITLIB(bestcomm_init, 0)