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
  65     while(count)
  66     {
  67         outw(*addr++, data->ioBase);
  68         count -= 2;
  69     }
  70 }
  71
  72 void ata_insw(struct pio_data *data, APTR address, ULONG count)
  73 {
  74     UWORD *addr = address;
  75
  76     while(count)
  77     {
  78         *addr++ = inw(data->ioBase);
  79         count -= 2;
  80     }
  81 }
  82
  83 void ata_outsl(struct pio_data *data, APTR address, ULONG count)
  84 {
  85     if (count & 2)
  86     {
  87         ata_outsw(data, address, count);
  88     }
  89     else
  90     {
  91         ULONG *addr = address;
  92
  93         while(count)
  94         {
  95             outl(*addr++, data->ioBase);
  96             count -= 4;
  97         }
  98     }
  99 }
 100
 101 void ata_insl(struct pio_data *data, APTR address, ULONG count)
 102 {
 103     if (count & 2)
 104     {
 105         ata_insw(data, address, count);
 106     }
 107     else
 108     {
 109         ULONG *addr = address;
 110
 111         while(count)
 112         {
 113             *addr++ = inl(data->ioBase);
 114             count -= 4;
 115         }
 116     }
 117 }
 118
 119 #endif
 120
 121 const APTR bus_FuncTable[] =
 122 {
 123     ata_out,
 124     ata_in,
 125     ata_out_alt,
 126     ata_in_alt,
 127     (APTR *)-1
 128 };
 129
 130 const APTR pio_FuncTable[] =
 131 {
 132     ata_outsw,
 133     ata_insw,
 134     ata_outsl,
 135     ata_insl,
 136     (APTR *)-1
 137 };