rom/hidds/ata_pci/interface_pio.c

   1 /*
   2     Copyright © 2004-2013, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: PCI IDE PIO interface functions
   6     Lang: English
   7 */
   8
   9 #include "interface_pio.h"
  10
  11 void ata_out(struct pio_data *data, UBYTE val, UWORD offset)
  12 {
  13     outb(val, offset + data->ioBase);
  14 }
  15
  16 UBYTE ata_in(struct pio_data *data, UWORD offset)
  17 {
  18     return inb(offset + data->ioBase);
  19 }
  20
  21 void ata_out_alt(struct pio_data *data, UBYTE val, UWORD offset)
  22 {
  23     outb(val, offset + data->ioAlt);
  24 }
  25
  26 UBYTE ata_in_alt(struct pio_data *data, UWORD offset)
  27 {
  28     return inb(offset + data->ioAlt);
  29 }
  30
  31 #if defined(__i386__) || defined(__x86_64__)
  32
  33 void ata_outsw(struct pio_data *data, APTR address, ULONG count)
  34 {
  35     outsw(data->ioBase, address, count >> 1);
  36 }
  37
  38 void ata_insw(struct pio_data *data, APTR address, ULONG count)
  39 {
  40     insw(data->ioBase, address, count >> 1);
  41 }
  42
  43 void ata_outsl(struct pio_data *data, APTR address, ULONG count)
  44 {
  45     if (count & 2)
  46         outsw(data->ioBase, address, count >> 1);
  47     else
  48         outsl(data->ioBase, address, count >> 2);
  49 }
  50
  51 void ata_insl(struct pio_data *data, APTR address, ULONG count)
  52 {
  53     if (count & 2)
  54         insw(data->ioBase, address, count >> 1);
  55     else
  56         insl(data->ioBase, address, count >> 2);
  57 }
  58
  59 #else
  60
  61 void ata_outsw(struct pio_data *data, APTR address, ULONG count)
  62 {
  63     UWORD *addr = address;
  64     UWORD *p = (UWORD*)(port + data);
  65
  66     while(count)
  67     {
  68         outw(*addr++, p);
  69         count -= 2;
  70     }
  71 }
  72
  73 void ata_insw(struct pio_data *data, APTR address, ULONG count)
  74 {
  75     UWORD *addr = address;
  76
  77     while(count)
  78     {
  79         *addr++ = inw(data->ioBase);
  80         count -= 2;
  81     }
  82 }
  83
  84 void ata_outsl(struct pio_data *data, APTR address, ULONG count)
  85 {
  86     if (count & 2)
  87     {
  88         ata_outsw(address, port, count, data);
  89     }
  90     else
  91     {
  92         ULONG *addr = address;
  93
  94         while(count)
  95         {
  96             outl(*addr++, data->ioBase);
  97             count -= 4;
  98         }
  99     }
 100 }
 101
 102 void ata_insl(struct pio_data *data, APTR address, ULONG count)
 103 {
 104     if (count & 2)
 105     {
 106         ata_insw(address, count, data);
 107     }
 108     else
 109     {
 110         ULONG *addr = address;
 111
 112         while(count)
 113         {
 114             *addr++ = inl(data->ioBase);
 115             count -= 4;
 116         }
 117     }
 118 }
 119
 120 #endif
 121
 122 const APTR bus_FuncTable[] =
 123 {
 124     ata_out,
 125     ata_in,
 126     ata_out_alt,
 127     ata_in_alt,
 128     (APTR *)-1
 129 };
 130
 131 const APTR pio_FuncTable[] =
 132 {
 133     ata_outsw,
 134     ata_insw,
 135     ata_outsl,
 136     ata_insl,
 137     (APTR *)-1
 138 };