arch/arm-native/soc/broadcom/2708/hidd/vc4gfx/vc4gfx_init.c

   1 /*
   2     Copyright © 2013-2017, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: BCM VideoCore4 Gfx Hidd initialisation code
   6     Lang: english
   7 */
   8
   9 #define DEBUG 1
  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/mbox.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/gfx.h>
  26 #include <oop/oop.h>
  27 #include <utility/utility.h>
  28 #include <aros/symbolsets.h>
  29
  30 #include "vc4gfx_hidd.h"
  31 #include "vc4gfx_hardware.h"
  32
  33 #include LC_LIBDEFS_FILE
  34
  35 #ifdef MBoxBase
  36 #undef MBoxBase
  37 #endif
  38
  39 #define MBoxBase      xsd->vcsd_MBoxBase
  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_Gfx_VideoCore4,
  78     IID_Hidd_BitMap_VideoCore4,
  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 (!(MBoxBase = OpenResource("mbox.resource")))
  99         goto failure;
 100
 101     if (!(xsd->vcsd_MBoxBuff = AllocVec(16 + (sizeof(IPTR) * 2 * MAX_TAGS), MEMF_CLEAR)))
 102         goto failure;
 103
 104     xsd->vcsd_MBoxMessage =
 105         (unsigned int *)((xsd->vcsd_MBoxBuff + 0xF) & ~0x0000000F);
 106
 107     D(bug("[VideoCoreGfx] %s: VideoCore Mailbox resource @ 0x%p\n", __PRETTY_FUNCTION__, MBoxBase));
 108     D(bug("[VideoCoreGfx] %s: VideoCore message buffer @ 0x%p\n", __PRETTY_FUNCTION__, xsd->vcsd_MBoxMessage));
 109
 110
 111     xsd->vcsd_MBoxMessage[0] = 8 * 4;
 112     xsd->vcsd_MBoxMessage[1] = VCTAG_REQ;
 113     xsd->vcsd_MBoxMessage[2] = VCTAG_GETVCRAM;
 114     xsd->vcsd_MBoxMessage[3] = 8;
 115     xsd->vcsd_MBoxMessage[4] = 0;
 116
 117     xsd->vcsd_MBoxMessage[5] = 0;
 118     xsd->vcsd_MBoxMessage[6] = 0;
 119
 120     xsd->vcsd_MBoxMessage[7] = 0; // terminate tag
 121
 122     MBoxWrite(VCMB_BASE, VCMB_PROPCHAN, xsd->vcsd_MBoxMessage);
 123     if (MBoxRead(VCMB_BASE, VCMB_PROPCHAN) == xsd->vcsd_MBoxMessage)
 124     {
 125         if (FNAME_SUPPORT(InitMem)(xsd->vcsd_MBoxMessage[5], xsd->vcsd_MBoxMessage[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                 LIBBASE->vsd.vcsd_basebm = OOP_FindClass(CLID_Hidd_BitMap);
 134                 if (AddDisplayDriver(LIBBASE->vsd.vcsd_VideoCoreGfxClass, NULL, DDRV_BootMode, TRUE, TAG_DONE) == DD_OK)
 135                 {
 136                     bug("[VideoCoreGfx] BootMode Display Driver Registered\n");
 137
 138                     LIBBASE->library.lib_OpenCnt++;
 139                     retval = TRUE;
 140                 }
 141                 CloseLibrary(&GfxBase->LibNode);
 142             }
 143         }
 144     }
 145
 146 failure:
 147     if (!(retval))
 148     {
 149         bug("[VideoCoreGfx] No VideoCore GPU Found\n");
 150
 151         FreeVec((APTR)xsd->vcsd_MBoxBuff);
 152
 153         FNAME_SUPPORT(FreeAttrBases)(interfaces, xsd->vcsd_attrBases, ATTRBASES_NUM);
 154     }
 155
 156     return retval;
 157 }
 158
 159 ADD2INITLIB(FNAME_SUPPORT(Init), 0)