libogc/cache.c

   1 /*-------------------------------------------------------------
   2
   3 cache.c -- Cache interface
   4
   5 Copyright (C) 2004
   6 Michael Wiedenbauer (shagkur)
   7 Dave Murphy (WinterMute)
   8
   9 This software is provided 'as-is', without any express or implied
  10 warranty.  In no event will the authors be held liable for any
  11 damages arising from the use of this software.
  12
  13 Permission is granted to anyone to use this software for any
  14 purpose, including commercial applications, and to alter it and
  15 redistribute it freely, subject to the following restrictions:
  16
  17 1.      The origin of this software must not be misrepresented; you
  18 must not claim that you wrote the original software. If you use
  19 this software in a product, an acknowledgment in the product
  20 documentation would be appreciated but is not required.
  21
  22 2.      Altered source versions must be plainly marked as such, and
  23 must not be misrepresented as being the original software.
  24
  25 3.      This notice may not be removed or altered from any source
  26 distribution.
  27
  28 -------------------------------------------------------------*/
  29
  30
  31 #include <asm.h>
  32 #include <processor.h>
  33 #include "cache.h"
  34
  35 #define _SHIFTL(v, s, w)        \
  36     ((u32) (((u32)(v) & ((0x01 << (w)) - 1)) << (s)))
  37 #define _SHIFTR(v, s, w)        \
  38     ((u32)(((u32)(v) >> (s)) & ((0x01 << (w)) - 1)))
  39
  40 extern void __LCEnable();
  41
  42 void LCEnable()
  43 {
  44         u32 level;
  45
  46         _CPU_ISR_Disable(level);
  47         __LCEnable();
  48         _CPU_ISR_Restore(level);
  49 }
  50
  51 u32 LCLoadData(void *dstAddr,void *srcAddr,u32 nCount)
  52 {
  53         u32 cnt,blocks;
  54
  55         if((s32)nCount<=0) return 0;
  56
  57         cnt = (nCount+31)>>5;
  58         blocks = (cnt+127)>>7;
  59         while(cnt) {
  60                 if(cnt<0x80) {
  61                         LCLoadBlocks(dstAddr,srcAddr,cnt);
  62                         cnt = 0;
  63                         break;
  64                 }
  65                 LCLoadBlocks(dstAddr,srcAddr,0);
  66                 cnt -= 128;
  67                 dstAddr += 4096;
  68                 srcAddr += 4096;
  69         }
  70         return blocks;
  71 }
  72
  73 u32 LCStoreData(void *dstAddr,void *srcAddr,u32 nCount)
  74 {
  75         u32 cnt,blocks;
  76
  77         if((s32)nCount<=0) return 0;
  78
  79         cnt = (nCount+31)>>5;
  80         blocks = (cnt+127)>>7;
  81         while(cnt) {
  82                 if(cnt<0x80) {
  83                         LCStoreBlocks(dstAddr,srcAddr,cnt);
  84                         cnt = 0;
  85                         break;
  86                 }
  87                 LCStoreBlocks(dstAddr,srcAddr,0);
  88                 cnt -= 128;
  89                 dstAddr += 4096;
  90                 srcAddr += 4096;
  91         }
  92         return blocks;
  93 }
  94
  95 u32 LCQueueLength()
  96 {
  97         u32 hid2 = mfspr(920);
  98         return _SHIFTR(hid2,4,4);
  99 }
 100
 101 u32 LCQueueWait(u32 len)
 102 {
 103         len++;
 104         while(_SHIFTR(mfspr(920),4,4)>=len);
 105         return len;
 106 }
 107
 108 void LCFlushQueue()
 109 {
 110         mtspr(922,0);
 111         mtspr(923,1);
 112         ppcsync();
 113 }
 114
 115 void LCAlloc(void *addr,u32 bytes)
 116 {
 117         u32 level,cnt,hid2;
 118
 119         cnt = bytes>>5;
 120         hid2 = mfspr(920);
 121         if(!(hid2&0x10000000)) {
 122                 _CPU_ISR_Disable(level);
 123                 __LCEnable();
 124                 _CPU_ISR_Restore(level);
 125         }
 126         LCAllocTags(TRUE,addr,cnt);
 127 }
 128
 129 void LCAllocNoInvalidate(void *addr,u32 bytes)
 130 {
 131         u32 level,cnt,hid2;
 132
 133         cnt = bytes>>5;
 134         hid2 = mfspr(920);
 135         if(!(hid2&0x10000000)) {
 136                 _CPU_ISR_Disable(level);
 137                 __LCEnable();
 138                 _CPU_ISR_Restore(level);
 139         }
 140         LCAllocTags(FALSE,addr,cnt);
 141 }