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

   1 /*
   2     Copyright © 2013-2017, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #define DEBUG 1
   7 #include <aros/debug.h>
   8
   9 #define __OOP_NOATTRBASES__
  10
  11 #include <proto/exec.h>
  12 #include <proto/oop.h>
  13 #include <proto/mbox.h>
  14 #include <proto/kernel.h>
  15 #include <proto/utility.h>
  16
  17 #include <exec/types.h>
  18 #include <exec/lists.h>
  19 #include <exec/memory.h>
  20 #include <hidd/gfx.h>
  21 #include <hidd/pci.h>
  22 #include <oop/oop.h>
  23 #include <utility/utility.h>
  24 #include <aros/symbolsets.h>
  25
  26 #include "vc4gfx_hidd.h"
  27 #include "vc4gfx_hardware.h"
  28
  29 #include LC_LIBDEFS_FILE
  30
  31 #ifdef MBoxBase
  32 #undef MBoxBase
  33 #endif
  34
  35 #define MBoxBase      xsd->vcsd_MBoxBase
  36
  37 void *mh_Alloc(struct MemHeaderExt *mhe, IPTR size, ULONG *flags)
  38 {
  39     D(bug("[VideoCoreGfx] %s(%d bytes, 0x%08x)\n", __PRETTY_FUNCTION__, size, flags));
  40
  41     return NULL;
  42 }
  43
  44 /*
  45     returns a handle on a block of gpu memory. you cannot directly access this
  46     memory unless it is locked, since it may be moved around by the gpu.
  47 */
  48 void *FNAME_SUPPORT(Alloc)(struct MemHeaderExt *mhe, IPTR size, ULONG *flags)
  49 {
  50     struct VideoCoreGfx_staticdata *xsd = (APTR)mhe->mhe_UserData;
  51     ULONG gpumemflags = VCMEM_NORMAL, gpumemalign = 0;
  52
  53     D(bug("[VideoCoreGfx] %s(%d bytes, 0x%08x)\n", __PRETTY_FUNCTION__, size, flags));
  54
  55     if (!(*flags & MEMF_PUBLIC))
  56         gpumemflags = VCMEM_L1NONALLOCATING | VCMEM_NOINIT | VCMEM_LAZYLOCK;
  57     if (*flags & MEMF_CLEAR)
  58         gpumemflags |= VCMEM_ZERO;
  59     if (*flags & MEMF_HWALIGNED)
  60         gpumemalign = 4096;
  61
  62     xsd->vcsd_MBoxMessage[0] = AROS_LE2LONG(9 * 4);
  63     xsd->vcsd_MBoxMessage[1] = AROS_LE2LONG(VCTAG_REQ);
  64     xsd->vcsd_MBoxMessage[2] = AROS_LE2LONG(VCTAG_ALLOCMEM);
  65     xsd->vcsd_MBoxMessage[3] = AROS_LE2LONG(4 * 3);
  66     xsd->vcsd_MBoxMessage[4] = AROS_LE2LONG(size);
  67     xsd->vcsd_MBoxMessage[5] = AROS_LE2LONG(gpumemalign);
  68     xsd->vcsd_MBoxMessage[6] = AROS_LE2LONG(gpumemflags);
  69
  70     xsd->vcsd_MBoxMessage[7] = 0;
  71
  72     xsd->vcsd_MBoxMessage[8] = 0; // terminate tag
  73
  74     MBoxWrite((void*)VCMB_BASE, VCMB_PROPCHAN, xsd->vcsd_MBoxMessage);
  75     if (MBoxRead((void*)VCMB_BASE, VCMB_PROPCHAN) == xsd->vcsd_MBoxMessage)
  76     {
  77         D(bug("[VideoCoreGfx] %s: Allocated %d bytes, memhandle @ 0x%p\n", __PRETTY_FUNCTION__,
  78             AROS_LE2LONG(xsd->vcsd_MBoxMessage[4]), AROS_LE2LONG(xsd->vcsd_MBoxMessage[7])));
  79
  80         mhe->mhe_MemHeader.mh_Free -= size;
  81
  82         return (void*)(AROS_LE2LONG(xsd->vcsd_MBoxMessage[7]) & 0x3fffffff);
  83     }
  84     return NULL;
  85 }
  86
  87 /*
  88     Lock the gpu memory represented by the memhandle,
  89     and return a physical pointer to it..
  90 */
  91 void *FNAME_SUPPORT(LockMem)(struct MemHeaderExt *mhe, void *memhandle)
  92 {
  93     struct VideoCoreGfx_staticdata *xsd = (APTR)mhe->mhe_UserData;
  94
  95     D(bug("[VideoCoreGfx] %s(memhandle @ 0x%p)\n", __PRETTY_FUNCTION__, memhandle));
  96
  97     xsd->vcsd_MBoxMessage[0] = AROS_LE2LONG(7 * 4);
  98     xsd->vcsd_MBoxMessage[1] = AROS_LE2LONG(VCTAG_REQ);
  99     xsd->vcsd_MBoxMessage[2] = AROS_LE2LONG(VCTAG_LOCKMEM);
 100     xsd->vcsd_MBoxMessage[3] = AROS_LE2LONG(4);
 101     xsd->vcsd_MBoxMessage[4] = AROS_LE2LONG((ULONG)memhandle);
 102
 103     xsd->vcsd_MBoxMessage[5] = 0;
 104
 105     xsd->vcsd_MBoxMessage[6] = 0; // terminate tag
 106
 107     MBoxWrite((void*)VCMB_BASE, VCMB_PROPCHAN, xsd->vcsd_MBoxMessage);
 108     if (MBoxRead((void*)VCMB_BASE, VCMB_PROPCHAN) == xsd->vcsd_MBoxMessage)
 109     {
 110         D(bug("[VideoCoreGfx] %s: Memory locked @ 0x%p\n", __PRETTY_FUNCTION__, AROS_LE2LONG(xsd->vcsd_MBoxMessage[5])));
 111         return (void*)(AROS_LE2LONG(xsd->vcsd_MBoxMessage[5]) & 0x3fffffff);
 112     }
 113     return NULL;
 114 }
 115
 116 /*
 117     Unlock the gpu memory represented by the memhandle.
 118 */
 119 void *FNAME_SUPPORT(UnLockMem)(struct MemHeaderExt *mhe, void *memhandle)
 120 {
 121     struct VideoCoreGfx_staticdata *xsd = (APTR)mhe->mhe_UserData;
 122
 123     D(bug("[VideoCoreGfx] %s(memhandle @ 0x%p)\n", __PRETTY_FUNCTION__, memhandle));
 124
 125     xsd->vcsd_MBoxMessage[0] = AROS_LE2LONG(7 * 4);
 126     xsd->vcsd_MBoxMessage[1] = AROS_LE2LONG(VCTAG_REQ);
 127     xsd->vcsd_MBoxMessage[2] = AROS_LE2LONG(VCTAG_UNLOCKMEM);
 128     xsd->vcsd_MBoxMessage[3] = AROS_LE2LONG(4);
 129     xsd->vcsd_MBoxMessage[4] = AROS_LE2LONG((ULONG)memhandle);
 130
 131     xsd->vcsd_MBoxMessage[5] = 0;
 132
 133     xsd->vcsd_MBoxMessage[6] = 0; // terminate tag
 134
 135     MBoxWrite((void*)VCMB_BASE, VCMB_PROPCHAN, xsd->vcsd_MBoxMessage);
 136     if (MBoxRead((void*)VCMB_BASE, VCMB_PROPCHAN) == xsd->vcsd_MBoxMessage)
 137     {
 138         D(bug("[VideoCoreGfx] %s: Memory unlocked [status %08x]\n", __PRETTY_FUNCTION__, AROS_LE2LONG(xsd->vcsd_MBoxMessage[5])));
 139         return (void*)AROS_LE2LONG(xsd->vcsd_MBoxMessage[5]);
 140     }
 141     return NULL;
 142 }
 143
 144 void mh_Free(struct MemHeaderExt *mhe, APTR  mem,  IPTR size)
 145 {
 146     D(bug("[VideoCoreGfx] %s(0x%p)\n", __PRETTY_FUNCTION__, mem));
 147 }
 148
 149 /*
 150     Frees the gpu memory associated with the handle.
 151 */
 152 void FNAME_SUPPORT(Free)(struct MemHeaderExt *mhe, APTR  memhandle, IPTR size)
 153 {
 154     struct VideoCoreGfx_staticdata *xsd = (APTR)mhe->mhe_UserData;
 155
 156     D(bug("[VideoCoreGfx] %s(memhandle @ 0x%p)\n", __PRETTY_FUNCTION__, memhandle));
 157
 158     xsd->vcsd_MBoxMessage[0] = AROS_LE2LONG(7 * 4);
 159     xsd->vcsd_MBoxMessage[1] = AROS_LE2LONG(VCTAG_REQ);
 160     xsd->vcsd_MBoxMessage[2] = AROS_LE2LONG(VCTAG_FREEMEM);
 161     xsd->vcsd_MBoxMessage[3] = AROS_LE2LONG(4);
 162     xsd->vcsd_MBoxMessage[4] = AROS_LE2LONG((ULONG)memhandle);
 163
 164     xsd->vcsd_MBoxMessage[5] = 0;
 165
 166     xsd->vcsd_MBoxMessage[6] = 0; // terminate tag
 167
 168     MBoxWrite((void*)VCMB_BASE, VCMB_PROPCHAN, xsd->vcsd_MBoxMessage);
 169     if (MBoxRead((void*)VCMB_BASE, VCMB_PROPCHAN) == xsd->vcsd_MBoxMessage)
 170     {
 171         mhe->mhe_MemHeader.mh_Free += size;
 172
 173         D(bug("[VideoCoreGfx] %s: Memory freed [status %08x]\n", __PRETTY_FUNCTION__, AROS_LE2LONG(xsd->vcsd_MBoxMessage[5])));
 174     }
 175 }
 176
 177 void *mh_AllocAbs(struct MemHeaderExt *mhe, IPTR size, APTR  mem)
 178 {
 179     D(bug("[VideoCoreGfx] %s(0x%p, %d bytes)\n", __PRETTY_FUNCTION__, mem, size));
 180
 181     return NULL;
 182 }
 183
 184 void *mh_ReAlloc(struct MemHeaderExt *mhe, APTR  old,  IPTR size)
 185 {
 186     D(bug("[VideoCoreGfx] %s(0x%p, %d bytes)\n", __PRETTY_FUNCTION__, old, size));
 187
 188     return NULL;
 189 }
 190
 191 IPTR mh_Avail(struct MemHeaderExt *mhe, ULONG flags)
 192 {
 193     //struct VideoCoreGfx_staticdata *xsd = (APTR)mhe->mhe_UserData;
 194
 195     D(bug("[VideoCoreGfx] %s(0x%08x)\n", __PRETTY_FUNCTION__, flags));
 196
 197     return mhe->mhe_MemHeader.mh_Free;
 198 }
 199
 200 int FNAME_SUPPORT(InitMem)(void *memstart, int memlength, struct VideoCoreGfxBase *VideoCoreGfxBase)
 201 {
 202     struct VideoCoreGfx_staticdata *xsd = &LIBBASE->vsd;
 203 //    struct MemChunk *mc = memstart;
 204
 205     InitSemaphore(&xsd->vcsd_GPUMemLock);
 206
 207     bug("[VideoCoreGfx] VideoCore GPU Memory @ 0x%p [%dKB]\n", memstart, memlength >> 10);
 208
 209     xsd->vcsd_GPUMemManage.mhe_MemHeader.mh_Node.ln_Type = NT_MEMORY;
 210     xsd->vcsd_GPUMemManage.mhe_MemHeader.mh_Node.ln_Name = "VideoCore GPU Memory";
 211     xsd->vcsd_GPUMemManage.mhe_MemHeader.mh_Node.ln_Pri = -128;
 212     xsd->vcsd_GPUMemManage.mhe_MemHeader.mh_Attributes = MEMF_CHIP | MEMF_MANAGED | MEMF_PUBLIC;
 213 //    xsd->vcsd_GPUMemManage.mhe_MemHeader.mh_First = mc;
 214     xsd->vcsd_GPUMemManage.mhe_MemHeader.mh_First = NULL;
 215     xsd->vcsd_GPUMemManage.mhe_MemHeader.mh_Lower = (APTR)memstart;
 216     xsd->vcsd_GPUMemManage.mhe_MemHeader.mh_Free = memlength;
 217     xsd->vcsd_GPUMemManage.mhe_MemHeader.mh_Upper = (APTR)(xsd->vcsd_GPUMemManage.mhe_MemHeader.mh_Free + (IPTR)memstart);
 218
 219     xsd->vcsd_GPUMemManage.mhe_UserData = xsd;
 220
 221     xsd->vcsd_GPUMemManage.mhe_Alloc = mh_Alloc;
 222     xsd->vcsd_GPUMemManage.mhe_Free = mh_Free;
 223     xsd->vcsd_GPUMemManage.mhe_AllocAbs = mh_AllocAbs;
 224     xsd->vcsd_GPUMemManage.mhe_ReAlloc = mh_ReAlloc;
 225     xsd->vcsd_GPUMemManage.mhe_Avail = mh_Avail;
 226
 227 //    mc->mc_Next = NULL;
 228 //    mc->mc_Bytes = xsd->vcsd_GPUMemManage.mhe_MemHeader.mh_Free;
 229
 230     Disable();
 231     AddTail(&SysBase->MemList, (struct Node *)&xsd->vcsd_GPUMemManage);
 232     Enable();
 233
 234     bug("[VideoCoreGfx] Memory Manager Initialised\n");
 235
 236     return TRUE;
 237 }