arch/arm-native/soc/broadcom/283x/hidd/videocoregfx/videocoregfx_init.c

   1 /*
   2     Copyright © 2013-2015, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: VideoCore Hidd initialisation code
   6     Lang: english
   7 */
   8
   9 #define DEBUG 0
  10 #include <aros/debug.h>
  11
  12 #define __OOP_NOATTRBASES__
  13
  14 #include <proto/exec.h>
  15 #include <proto/graphics.h>
  16 #include <proto/oop.h>
  17 #include <proto/vcmbox.h>
  18 #include <proto/kernel.h>
  19 #include <proto/utility.h>
  20
  21 #include <exec/types.h>
  22 #include <exec/lists.h>
  23 #include <graphics/driver.h>
  24 #include <graphics/gfxbase.h>
  25 #include <hidd/graphics.h>
  26 #include <oop/oop.h>
  27 #include <utility/utility.h>
  28 #include <aros/symbolsets.h>
  29
  30 #include "videocoregfx_class.h"
  31 #include "videocoregfx_hardware.h"
  32
  33 #include LC_LIBDEFS_FILE
  34
  35 #ifdef VCMBoxBase
  36 #undef VCMBoxBase
  37 #endif
  38
  39 #define VCMBoxBase      xsd->vcsd_VCMBoxBase
  40
  41 IPTR            __arm_periiobase __attribute__((used)) = 0 ;
  42 APTR KernelBase __attribute__((used)) = NULL;
  43
  44 static void FNAME_SUPPORT(FreeAttrBases)(const STRPTR *iftable, OOP_AttrBase *bases, ULONG num)
  45 {
  46     ULONG i;
  47
  48     for (i = 0; i < num; i++)
  49     {
  50         if (bases[i])
  51         {
  52             OOP_ReleaseAttrBase(iftable[i]);
  53             bases[i] = NULL;
  54         }
  55     }
  56 }
  57
  58 static BOOL FNAME_SUPPORT(GetAttrBases)(const STRPTR *iftable, OOP_AttrBase *bases, ULONG num)
  59 {
  60     ULONG i;
  61
  62     for (i = 0; i < num; i++)
  63     {
  64         bases[i] = OOP_ObtainAttrBase(iftable[i]);
  65         if (!bases[i])
  66         {
  67             FNAME_SUPPORT(FreeAttrBases)(iftable, bases, i);
  68             return FALSE;
  69         }
  70     }
  71
  72     return TRUE;
  73 }
  74
  75 static const STRPTR interfaces[] =
  76 {
  77     IID_Hidd_VideoCoreGfx,
  78     IID_Hidd_VideoCoreGfxBitMap,
  79     IID_Hidd_ChunkyBM,
  80     IID_Hidd_BitMap,
  81     IID_Hidd_PixFmt,
  82     IID_Hidd_Sync,
  83     IID_Hidd_Gfx,
  84     IID_Hidd
  85 };
  86
  87 static int FNAME_SUPPORT(Init)(LIBBASETYPEPTR LIBBASE)
  88 {
  89     struct VideoCoreGfx_staticdata *xsd = &LIBBASE->vsd;
  90     int retval = FALSE;
  91
  92     KernelBase = OpenResource("kernel.resource");
  93     __arm_periiobase = KrnGetSystemAttr(KATTR_PeripheralBase);
  94
  95     if (!FNAME_SUPPORT(GetAttrBases)(interfaces, xsd->vcsd_attrBases, ATTRBASES_NUM))
  96         goto failure;
  97
  98     if (!(VCMBoxBase = OpenResource("vcmbox.resource")))
  99         goto failure;
 100
 101     if (!(xsd->vcsd_VCMBoxBuff = AllocVec(16 + (sizeof(IPTR) * 2 * MAX_TAGS), MEMF_CLEAR)))
 102         goto failure;
 103
 104     xsd->vcsd_VCMBoxMessage =
 105         (unsigned int *)((xsd->vcsd_VCMBoxBuff + 0xF) & ~0x0000000F);
 106
 107     D(bug("[VideoCoreGfx] %s: VideoCore Mailbox resource @ 0x%p\n", __PRETTY_FUNCTION__, VCMBoxBase));
 108     D(bug("[VideoCoreGfx] %s: VideoCore message buffer @ 0x%p\n", __PRETTY_FUNCTION__, xsd->vcsd_VCMBoxMessage));
 109
 110
 111     xsd->vcsd_VCMBoxMessage[0] = 8 * 4;
 112     xsd->vcsd_VCMBoxMessage[1] = VCTAG_REQ;
 113     xsd->vcsd_VCMBoxMessage[2] = VCTAG_GETVCRAM;
 114     xsd->vcsd_VCMBoxMessage[3] = 8;
 115     xsd->vcsd_VCMBoxMessage[4] = 0;
 116
 117     xsd->vcsd_VCMBoxMessage[5] = 0;
 118     xsd->vcsd_VCMBoxMessage[6] = 0;
 119
 120     xsd->vcsd_VCMBoxMessage[7] = 0; // terminate tag
 121
 122     VCMBoxWrite(VCMB_BASE, VCMB_PROPCHAN, xsd->vcsd_VCMBoxMessage);
 123     if (VCMBoxRead(VCMB_BASE, VCMB_PROPCHAN) == xsd->vcsd_VCMBoxMessage)
 124     {
 125         if (FNAME_SUPPORT(InitMem)(xsd->vcsd_VCMBoxMessage[5], xsd->vcsd_VCMBoxMessage[6], LIBBASE))
 126         {
 127             bug("[VideoCoreGfx] VideoCore GPU Found\n");
 128
 129             FNAME_HW(InitGfxHW)((APTR)xsd);
 130
 131             if ((GfxBase = (struct GfxBase *)OpenLibrary("graphics.library", 41)) != NULL)
 132             {
 133                 if (AddDisplayDriver(LIBBASE->vsd.vcsd_VideoCoreGfxClass, NULL, DDRV_BootMode, TRUE, TAG_DONE) == DD_OK)
 134                 {
 135                     bug("[VideoCoreGfx] BootMode Display Driver Registered\n");
 136
 137                     LIBBASE->library.lib_OpenCnt++;
 138                     retval = TRUE;
 139                 }
 140                 CloseLibrary(&GfxBase->LibNode);
 141             }
 142         }
 143     }
 144
 145 failure:
 146     if (!(retval))
 147     {
 148         bug("[VideoCoreGfx] No VideoCore GPU Found\n");
 149
 150         FreeVec((APTR)xsd->vcsd_VCMBoxBuff);
 151
 152         FNAME_SUPPORT(FreeAttrBases)(interfaces, xsd->vcsd_attrBases, ATTRBASES_NUM);
 153     }
 154
 155     return retval;
 156 }
 157
 158 ADD2INITLIB(FNAME_SUPPORT(Init), 0)