workbench/devs/networks/atheros5000/mos_device.c

   1 /*
   2
   3 File: mos_device.c
   4 Author: Neil Cafferkey
   5 Copyright (C) 2000-2008 Neil Cafferkey
   6
   7 This program is free software; you can redistribute it and/or modify
   8 it under the terms of the GNU General Public License as published by
   9 the Free Software Foundation; either version 2 of the License, or
  10 (at your option) any later version.
  11
  12 This program is distributed in the hope that it will be useful, but
  13 WITHOUT ANY WARRANTY; without even the implied warranty of
  14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  15 General Public License for more details.
  16
  17 You should have received a copy of the GNU General Public License
  18 along with this program; if not, write to the Free Software
  19 Foundation, Inc., 59 Temple Place - Suite 330, Boston,
  20 MA 02111-1307, USA.
  21
  22 */
  23
  24
  25 #include <exec/types.h>
  26 #include <exec/resident.h>
  27 #include <utility/utility.h>
  28
  29 #include <proto/exec.h>
  30
  31 #include "device.h"
  32
  33 #include "device_protos.h"
  34
  35
  36 /* Private prototypes */
  37
  38 static struct DevBase *MOSDevInit(struct DevBase *dev_base, APTR seg_list,
  39    struct DevBase *base);
  40 static BYTE MOSDevOpen();
  41 static APTR MOSDevClose();
  42 static APTR MOSDevExpunge();
  43 static VOID MOSDevBeginIO();
  44 static VOID MOSDevAbortIO();
  45 static BOOL RXFunction(struct IOSana2Req *request, APTR buffer, ULONG size);
  46 static BOOL TXFunction(APTR buffer, struct IOSana2Req *request, ULONG size);
  47 static UBYTE *DMATXFunction(struct IOSana2Req *request);
  48 static BOOL MOSInt();
  49
  50 extern const APTR init_data;
  51 extern const struct Resident rom_tag;
  52 extern const TEXT device_name[];
  53 extern const TEXT version_string[];
  54
  55
  56 static const TEXT openpci_name[] = "openpci.library";
  57
  58
  59 static const APTR mos_vectors[] =
  60 {
  61    (APTR)FUNCARRAY_32BIT_NATIVE,
  62    (APTR)MOSDevOpen,
  63    (APTR)MOSDevClose,
  64    (APTR)MOSDevExpunge,
  65    (APTR)DevReserved,
  66    (APTR)MOSDevBeginIO,
  67    (APTR)MOSDevAbortIO,
  68    (APTR)-1
  69 };
  70
  71
  72 static const APTR mos_init_table[] =
  73 {
  74    (APTR)sizeof(struct DevBase),
  75    (APTR)mos_vectors,
  76    (APTR)&init_data,
  77    (APTR)MOSDevInit
  78 };
  79
  80
  81 const struct Resident mos_rom_tag =
  82 {
  83    RTC_MATCHWORD,
  84    (struct Resident *)&mos_rom_tag,
  85    (APTR)(&rom_tag + 1),
  86    RTF_AUTOINIT | RTF_PPC,
  87    VERSION,
  88    NT_DEVICE,
  89    0,
  90    (STRPTR)device_name,
  91    (STRPTR)version_string,
  92    (APTR)mos_init_table
  93 };
  94
  95
  96 static const struct EmulLibEntry int_trap =
  97 {
  98    TRAP_LIB,
  99    0,
 100    (APTR)MOSInt
 101 };
 102
 103
 104
 105 /****i* atheros5000.device/MOSDevInit **************************************
 106 *
 107 *   NAME
 108 *       MOSDevInit
 109 *
 110 ****************************************************************************
 111 *
 112 */
 113
 114 static struct DevBase *MOSDevInit(struct DevBase *dev_base, APTR seg_list,
 115    struct DevBase *base)
 116 {
 117    base = DevInit(dev_base, seg_list, base);
 118
 119    if(base != NULL)
 120    {
 121       base->openpci_base = OpenLibrary(openpci_name, OPENPCI_VERSION);
 122       base->wrapper_int_code = (APTR)&int_trap;
 123    }
 124    return base;
 125 }
 126
 127
 128
 129 /****i* atheros5000.device/MOSDevOpen **************************************
 130 *
 131 *   NAME
 132 *       MOSDevOpen
 133 *
 134 ****************************************************************************
 135 *
 136 */
 137
 138 static BYTE MOSDevOpen()
 139 {
 140    struct IOSana2Req *request;
 141    struct Opener *opener;
 142    BYTE error;
 143
 144    request = (APTR)REG_A1;
 145    error = DevOpen(request, REG_D0, REG_D1, (APTR)REG_A6);
 146
 147    /* Set up wrapper hooks to hide 68k emulation */
 148
 149    if(error == 0)
 150    {
 151       opener = request->ios2_BufferManagement;
 152       opener->real_rx_function = opener->rx_function;
 153       opener->real_tx_function = opener->tx_function;
 154       opener->rx_function = (APTR)RXFunction;
 155       opener->tx_function = (APTR)TXFunction;
 156       if(opener->dma_tx_function != NULL)
 157       {
 158          opener->real_dma_tx_function = opener->dma_tx_function;
 159          opener->dma_tx_function = (APTR)DMATXFunction;
 160       }
 161    }
 162
 163    return error;
 164 }
 165
 166
 167
 168 /****i* atheros5000.device/MOSDevClose *************************************
 169 *
 170 *   NAME
 171 *       MOSDevClose
 172 *
 173 ****************************************************************************
 174 *
 175 */
 176
 177 static APTR MOSDevClose()
 178 {
 179    return DevClose((APTR)REG_A1, (APTR)REG_A6);
 180 }
 181
 182
 183
 184 /****i* atheros5000.device/MOSDevExpunge ***********************************
 185 *
 186 *   NAME
 187 *       MOSDevExpunge
 188 *
 189 ****************************************************************************
 190 *
 191 */
 192
 193 static APTR MOSDevExpunge()
 194 {
 195    return DevExpunge((APTR)REG_A6);
 196 }
 197
 198
 199
 200 /****i* atheros5000.device/MOSDevBeginIO ***********************************
 201 *
 202 *   NAME
 203 *       MOSDevBeginIO
 204 *
 205 ****************************************************************************
 206 *
 207 */
 208
 209 static VOID MOSDevBeginIO()
 210 {
 211    struct IOSana2Req *request = (APTR)REG_A1;
 212
 213    /* Replace caller's cookie with our own */
 214
 215    switch(request->ios2_Req.io_Command)
 216    {
 217    case CMD_READ:
 218    case CMD_WRITE:
 219    case S2_MULTICAST:
 220    case S2_BROADCAST:
 221    case S2_READORPHAN:
 222       request->ios2_StatData = request->ios2_Data;
 223       request->ios2_Data = request;
 224    }
 225
 226    DevBeginIO(request, (APTR)REG_A6);
 227
 228    return;
 229 }
 230
 231
 232
 233 /****i* atheros5000.device/MOSDevAbortIO ***********************************
 234 *
 235 *   NAME
 236 *       MOSDevAbortIO -- Try to stop a request.
 237 *
 238 ****************************************************************************
 239 *
 240 */
 241
 242 static VOID MOSDevAbortIO()
 243 {
 244    DevAbortIO((APTR)REG_A1, (APTR)REG_A6);
 245 }
 246
 247
 248
 249 /****i* atheros5000.device/RXFunction **************************************
 250 *
 251 *   NAME
 252 *       RXFunction
 253 *
 254 ****************************************************************************
 255 *
 256 */
 257
 258 static BOOL RXFunction(struct IOSana2Req *request, APTR buffer, ULONG size)
 259 {
 260    struct DevBase *base;
 261    struct EmulCaos context;
 262    struct Opener *opener;
 263    APTR cookie;
 264
 265    base = (struct DevBase *)request->ios2_Req.io_Device;
 266    opener = request->ios2_BufferManagement;
 267    cookie = request->ios2_StatData;
 268    request->ios2_Data = cookie;
 269
 270    context.caos_Un.Function = (APTR)opener->real_rx_function;
 271    context.reg_a0 = (ULONG)cookie;
 272    context.reg_a1 = (ULONG)buffer;
 273    context.reg_d0 = size;
 274    return MyEmulHandle->EmulCall68k(&context);
 275 }
 276
 277
 278
 279 /****i* atheros5000.device/TXFunction **************************************
 280 *
 281 *   NAME
 282 *       TXFunction
 283 *
 284 ****************************************************************************
 285 *
 286 */
 287
 288 static BOOL TXFunction(APTR buffer, struct IOSana2Req *request, ULONG size)
 289 {
 290    struct DevBase *base;
 291    struct EmulCaos context;
 292    struct Opener *opener;
 293    APTR cookie;
 294
 295    base = (struct DevBase *)request->ios2_Req.io_Device;
 296    opener = request->ios2_BufferManagement;
 297    cookie = request->ios2_StatData;
 298    request->ios2_Data = cookie;
 299
 300    context.caos_Un.Function = (APTR)opener->real_tx_function;
 301    context.reg_a0 = (ULONG)buffer;
 302    context.reg_a1 = (ULONG)cookie;
 303    context.reg_d0 = size;
 304    return MyEmulHandle->EmulCall68k(&context);
 305 }
 306
 307
 308
 309 /****i* atheros5000.device/DMATXFunction ***********************************
 310 *
 311 *   NAME
 312 *       DMATXFunction
 313 *
 314 ****************************************************************************
 315 *
 316 */
 317
 318 static UBYTE *DMATXFunction(struct IOSana2Req *request)
 319 {
 320    struct DevBase *base;
 321    struct EmulCaos context;
 322    struct Opener *opener;
 323    APTR cookie;
 324
 325    base = (struct DevBase *)request->ios2_Req.io_Device;
 326    opener = request->ios2_BufferManagement;
 327    cookie = request->ios2_StatData;
 328    request->ios2_Data = cookie;
 329
 330    context.caos_Un.Function = (APTR)opener->real_dma_tx_function;
 331    context.reg_a0 = (ULONG)cookie;
 332    return (UBYTE *)MyEmulHandle->EmulCall68k(&context);
 333 }
 334
 335
 336
 337 /****i* atheros5000.device/MOSInt ******************************************
 338 *
 339 *   NAME
 340 *       MOSInt
 341 *
 342 ****************************************************************************
 343 *
 344 */
 345
 346 static BOOL MOSInt()
 347 {
 348    APTR *int_data;
 349    BOOL (*int_code)(APTR, APTR);
 350
 351    int_data = (APTR)REG_A1;
 352    int_code = int_data[0];
 353    return int_code(int_data[1], int_code);
 354 }
 355
 356
 357