arch/ppc-all/prep/kernel/io.c

   1
   2 #include <aros/libcall.h>
   3 #include <aros/asmcall.h>
   4
   5 #include <proto/exec.h>
   6 #include <proto/kernel.h>
   7
   8 #include "kernel.h"
   9
  10 /*****************************************************************************
  11
  12     NAME */
  13
  14         AROS_LH1(APTR, BusToPhys,
  15
  16 /*  SYNOPSIS */
  17         AROS_LHA(APTR, busAddress, A0),
  18
  19 /*  LOCATION */
  20         APTR, KernelBase, 1, Kernel)
  21
  22 /*  FUNCTION
  23         This function translates Bus address (address that device sees) to
  24         Physical address (address seen by CPU).
  25
  26     INPUTS
  27         busAddress - Bus address as seen by device
  28
  29     RESULT
  30         Physical address seen by CPU
  31
  32 *****************************************************************************/
  33 {
  34     AROS_LIBFUNC_INIT
  35
  36     return((APTR)((ULONG)busAddress+_BUS_BASE));
  37
  38     AROS_LIBFUNC_EXIT
  39 }
  40
  41
  42
  43
  44 /*****************************************************************************
  45
  46     NAME */
  47
  48         AROS_LH1(APTR, PhysToBus,
  49
  50 /*  SYNOPSIS */
  51         AROS_LHA(APTR, physAddress, A0),
  52
  53 /*  LOCATION */
  54         APTR, KernelBase, 2, Kernel)
  55
  56 /*  FUNCTION
  57         This function translates Physical address address (address seen by CPU)
  58         to Bus address (address seen by device).
  59
  60     INPUTS
  61         physAddress - Physical address as seen by CPU
  62
  63     RESULT
  64         Bus address seen by device
  65
  66 *****************************************************************************/
  67 {
  68     AROS_LIBFUNC_INIT
  69
  70     return((APTR)((ULONG)physAddress+_BUS_BASE));
  71
  72     AROS_LIBFUNC_EXIT
  73 }
  74
  75
  76 /*****************************************************************************
  77
  78     IO access functions
  79
  80     These functions are the only allowable things used to communicate with IO
  81     address space. Please note that theirs implementation is platform specific.
  82
  83     Also note, that allthough it might be possible to talk to hardware without
  84     them, it doesn't have to be possible any time. It may happen, that
  85     self-made IO access will end with program killed.
  86
  87     There is no description available for this functions, but there is no need
  88     for any. Function names and parameters are self-explaining.
  89
  90 *****************************************************************************/
  91
  92 AROS_LH2(void, OutB,
  93     AROS_LHA(UWORD, port, D0),
  94     AROS_LHA(UBYTE, val, D1),
  95     APTR, KernelBase, 3, Kernel)
  96 {
  97     AROS_LIBFUNC_INIT
  98
  99     asm volatile (
 100         "stbx %0,0,%1   \n\t"
 101         "sync           \n\t"
 102         :
 103         : "r"(val), "r"(port + _IO_BASE));
 104
 105     AROS_LIBFUNC_EXIT
 106 }
 107
 108 AROS_LH2(void, OutW,
 109     AROS_LHA(UWORD, port, D0),
 110     AROS_LHA(UWORD, val, D1),
 111     APTR, KernelBase, 4, Kernel)
 112 {
 113     AROS_LIBFUNC_INIT
 114
 115     asm volatile (
 116         "sthbrx %0,0,%1 \n\t"
 117         "sync           \n\t"
 118         :
 119         : "r"(val), "r"(port + _IO_BASE));
 120
 121     AROS_LIBFUNC_EXIT
 122 }
 123
 124 AROS_LH2(void, OutL,
 125     AROS_LHA(UWORD, port, D0),
 126     AROS_LHA(ULONG, val, D1),
 127     APTR, KernelBase, 5, Kernel)
 128 {
 129     AROS_LIBFUNC_INIT
 130
 131     asm volatile (
 132         "stwbrx %0,0,%1 \n\t"
 133         "sync           \n\t"
 134         :
 135         : "r"(val), "r"(port + _IO_BASE));
 136
 137     AROS_LIBFUNC_EXIT
 138 }
 139
 140 AROS_LH1(UBYTE, InB,
 141     AROS_LHA(UWORD, port, D0),
 142     APTR, KernelBase, 6, Kernel)
 143 {
 144     AROS_LIBFUNC_INIT
 145
 146     UBYTE ret;
 147
 148     asm volatile ("lbzx %0,0,%1\n\tisync\n\tnop"
 149         :"=r"(ret)
 150         :"r"(port + _IO_BASE));
 151
 152     return(ret);
 153
 154     AROS_LIBFUNC_EXIT
 155 }
 156
 157 AROS_LH1(UWORD, InW,
 158     AROS_LHA(UWORD, port, D0),
 159     APTR, KernelBase, 7, Kernel)
 160 {
 161     AROS_LIBFUNC_INIT
 162
 163     UWORD ret;
 164
 165     asm volatile ("lhbrx %0,0,%1\n\tisync\n\tnop"
 166         :"=r"(ret)
 167         :"r"(port + _IO_BASE));
 168
 169     return(ret);
 170
 171     AROS_LIBFUNC_EXIT
 172 }
 173
 174 AROS_LH1(ULONG, InL,
 175     AROS_LHA(UWORD, port, D0),
 176     APTR, KernelBase, 8, Kernel)
 177 {
 178     AROS_LIBFUNC_INIT
 179
 180     ULONG ret;
 181
 182     asm volatile ("lwbrx %0,0,%1\n\tisync\n\tnop"
 183         :"=r"(ret)
 184         :"r"(port + _IO_BASE));
 185
 186     return(ret);
 187
 188     AROS_LIBFUNC_EXIT
 189 }
 190