arch/ppc-sam440/ata/lowlevel_sam440.c

   1 #include <exec/types.h>
   2 #include <asm/io.h>
   3 #include <asm/amcc440.h>
   4
   5 VOID ata_insw(APTR address, UWORD port, ULONG count)
   6 {
   7     UWORD *addr = address;
   8     UWORD *p = (UWORD*)(port + PCIC0_IO);
   9
  10     while(count)
  11     {
  12         *addr++ = inw(p);
  13         count -= 2;
  14     }
  15 }
  16
  17 VOID ata_insl(APTR address, UWORD port, ULONG count)
  18 {
  19     if (count & 2)
  20         ata_insw(address, port, count);
  21     else
  22     {
  23         ULONG *addr = address;
  24         ULONG *p = (ULONG*)(port + PCIC0_IO);
  25
  26         while(count)
  27         {
  28             *addr++ = inl(p);
  29             count -= 4;
  30         }
  31     }
  32 }
  33
  34 VOID ata_outsw(APTR address, UWORD port, ULONG count)
  35 {
  36     UWORD *addr = address;
  37     UWORD *p = (UWORD*)(port + PCIC0_IO);
  38
  39     while(count)
  40     {
  41         outw(*addr++, p);
  42         count -= 2;
  43     }
  44 }
  45
  46 VOID ata_outsl(APTR address, UWORD port, ULONG count)
  47 {
  48     if (count & 2)
  49         ata_outsw(address, port, count);
  50     else
  51     {
  52         ULONG *addr = address;
  53         ULONG *p = (ULONG*)(port + PCIC0_IO);
  54
  55         while(count)
  56         {
  57             outl(*addr++, p);
  58             count -= 4;
  59         }
  60     }
  61 }
  62
  63 void ata_400ns(ULONG port)
  64 {
  65     register ULONG tick_old, tick;
  66
  67     asm volatile("mftbl %0":"=r"(tick_old));
  68
  69     do {
  70         asm volatile("mftbl %0":"=r"(tick));
  71     } while(tick < (tick_old + 60));
  72 }