arch/arm-native/soc/broadcom/283x/sdcard/sdcard_bcm2835bus.c

   1 /*
   2     Copyright © 2013, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include "sdcard_intern.h"
   7 #include "timer.h"
   8
   9 void FNAME_BCMSDCBUS(BCMLEDCtrl)(int lvl)
  10 {
  11     if (lvl > 0)
  12         *(volatile ULONG *)GPCLR0 = (1 << 16); // Turn Activity LED ON
  13     else
  14         *(volatile ULONG *)GPSET0 = (1 << 16); // Turn Activity LED OFF
  15 }
  16
  17 ULONG FNAME_SDCBUS(GetClockDiv)(ULONG speed, struct sdcard_Bus *bus)
  18 {
  19     ULONG __BCMClkDiv;
  20
  21     for (__BCMClkDiv = 0; __BCMClkDiv < V300_MAXCLKDIV; __BCMClkDiv++) {
  22         if ((bus->sdcb_ClockMax / (__BCMClkDiv + 1)) <= speed)
  23                 break;
  24     }
  25
  26     return __BCMClkDiv;
  27 }
  28
  29 UBYTE FNAME_BCMSDCBUS(BCMMMIOReadByte)(ULONG reg, struct sdcard_Bus *bus)
  30 {
  31     ULONG val = *(volatile ULONG *)(((ULONG)bus->sdcb_IOBase + reg) & ~3);
  32
  33     return (val >> ((reg & 3) << 3)) & 0xFF;
  34 }
  35
  36 UWORD FNAME_BCMSDCBUS(BCMMMIOReadWord)(ULONG reg, struct sdcard_Bus *bus)
  37 {
  38     ULONG val = *(volatile ULONG *)(((ULONG)bus->sdcb_IOBase + reg) & ~3);
  39
  40     return (val >> (((reg >> 1) & 1) << 4)) & 0xFFFF;
  41 }
  42
  43 ULONG FNAME_BCMSDCBUS(BCMMMIOReadLong)(ULONG reg, struct sdcard_Bus *bus)
  44 {
  45     return *(volatile ULONG *)(bus->sdcb_IOBase + reg);
  46 }
  47
  48 static void FNAME_BCMSDCBUS(BCM2835WriteLong)(ULONG reg, ULONG val, struct sdcard_Bus *bus)
  49 {
  50     /* Bug: two SDC clock cycle delay required between successive chipset writes */
  51     while (sdcard_CurrentTime() < (bus->sdcb_Private + 6))
  52         sdcard_Udelay(1);
  53
  54     *(volatile ULONG *)(bus->sdcb_IOBase + reg) = val;
  55     bus->sdcb_Private = (IPTR)sdcard_CurrentTime();
  56 }
  57
  58 void FNAME_BCMSDCBUS(BCMMMIOWriteByte)(ULONG reg, UBYTE val, struct sdcard_Bus *bus)
  59 {
  60     ULONG currval = *(volatile ULONG *)(((ULONG)bus->sdcb_IOBase + reg) & ~3);
  61     ULONG shift = (reg & 3) << 3;
  62     ULONG mask = 0xFF << shift;
  63     ULONG newval = (currval & ~mask) | (val << shift);
  64
  65     FNAME_BCMSDCBUS(BCM2835WriteLong)(reg & ~3, newval, bus);
  66 }
  67
  68 void FNAME_BCMSDCBUS(BCMMMIOWriteWord)(ULONG reg, UWORD val, struct sdcard_Bus *bus)
  69 {
  70     ULONG currval = *(volatile ULONG *)(((ULONG)bus->sdcb_IOBase + reg) & ~3);
  71     ULONG shift = ((reg >> 1) & 1) << 4;
  72     ULONG mask = 0xFFFF << shift;
  73     ULONG newval = (currval & ~mask) | (val << shift);
  74
  75     FNAME_BCMSDCBUS(BCM2835WriteLong)(reg & ~3, newval, bus);
  76 }
  77
  78 void FNAME_BCMSDCBUS(BCMMMIOWriteLong)(ULONG reg, ULONG val, struct sdcard_Bus *bus)
  79 {
  80     FNAME_BCMSDCBUS(BCM2835WriteLong)(reg, val, bus);
  81 }