workbench/devs/networks/realtek8180/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 APTR mos_vectors[] =
  57 {
  58    (APTR)FUNCARRAY_32BIT_NATIVE,
  59    (APTR)MOSDevOpen,
  60    (APTR)MOSDevClose,
  61    (APTR)MOSDevExpunge,
  62    (APTR)DevReserved,
  63    (APTR)MOSDevBeginIO,
  64    (APTR)MOSDevAbortIO,
  65    (APTR)-1
  66 };
  67
  68
  69 static const APTR mos_init_table[] =
  70 {
  71    (APTR)sizeof(struct DevBase),
  72    (APTR)mos_vectors,
  73    (APTR)&init_data,
  74    (APTR)MOSDevInit
  75 };
  76
  77
  78 const struct Resident mos_rom_tag =
  79 {
  80    RTC_MATCHWORD,
  81    (struct Resident *)&mos_rom_tag,
  82    (APTR)(&rom_tag + 1),
  83    RTF_AUTOINIT | RTF_PPC,
  84    VERSION,
  85    NT_DEVICE,
  86    0,
  87    (STRPTR)device_name,
  88    (STRPTR)version_string,
  89    (APTR)mos_init_table
  90 };
  91
  92
  93 static const struct EmulLibEntry int_trap =
  94 {
  95    TRAP_LIB,
  96    0,
  97    (APTR)MOSInt
  98 };
  99
 100
 101
 102 /****i* atheros.device/MOSDevInit ******************************************
 103 *
 104 *   NAME
 105 *       MOSDevInit
 106 *
 107 ****************************************************************************
 108 *
 109 */
 110
 111 static struct DevBase *MOSDevInit(struct DevBase *dev_base, APTR seg_list,
 112    struct DevBase *base)
 113 {
 114    base = DevInit(dev_base, seg_list, base);
 115
 116    if(base != NULL)
 117    {
 118       base->wrapper_int_code = (APTR)&int_trap;
 119    }
 120    return base;
 121 }
 122
 123
 124
 125 /****i* atheros.device/MOSDevOpen ******************************************
 126 *
 127 *   NAME
 128 *       MOSDevOpen
 129 *
 130 ****************************************************************************
 131 *
 132 */
 133
 134 static BYTE MOSDevOpen()
 135 {
 136    struct IOSana2Req *request;
 137    struct Opener *opener;
 138    BYTE error;
 139
 140    request = (APTR)REG_A1;
 141    error = DevOpen(request, REG_D0, REG_D1, (APTR)REG_A6);
 142
 143    /* Set up wrapper hooks to hide 68k emulation */
 144
 145    if(error == 0)
 146    {
 147       opener = request->ios2_BufferManagement;
 148       opener->real_rx_function = opener->rx_function;
 149       opener->real_tx_function = opener->tx_function;
 150       opener->rx_function = (APTR)RXFunction;
 151       opener->tx_function = (APTR)TXFunction;
 152       if(opener->dma_tx_function != NULL)
 153       {
 154          opener->real_dma_tx_function = opener->dma_tx_function;
 155          opener->dma_tx_function = (APTR)DMATXFunction;
 156       }
 157    }
 158
 159    return error;
 160 }
 161
 162
 163
 164 /****i* atheros.device/MOSDevClose *****************************************
 165 *
 166 *   NAME
 167 *       MOSDevClose
 168 *
 169 ****************************************************************************
 170 *
 171 */
 172
 173 static APTR MOSDevClose()
 174 {
 175    return DevClose((APTR)REG_A1, (APTR)REG_A6);
 176 }
 177
 178
 179
 180 /****i* atheros.device/MOSDevExpunge ***************************************
 181 *
 182 *   NAME
 183 *       MOSDevExpunge
 184 *
 185 ****************************************************************************
 186 *
 187 */
 188
 189 static APTR MOSDevExpunge()
 190 {
 191    return DevExpunge((APTR)REG_A6);
 192 }
 193
 194
 195
 196 /****i* atheros.device/MOSDevBeginIO ***************************************
 197 *
 198 *   NAME
 199 *       MOSDevBeginIO
 200 *
 201 ****************************************************************************
 202 *
 203 */
 204
 205 static VOID MOSDevBeginIO()
 206 {
 207    struct IOSana2Req *request = (APTR)REG_A1;
 208
 209    /* Replace caller's cookie with our own */
 210
 211    switch(request->ios2_Req.io_Command)
 212    {
 213    case CMD_READ:
 214    case CMD_WRITE:
 215    case S2_MULTICAST:
 216    case S2_BROADCAST:
 217    case S2_READORPHAN:
 218       request->ios2_StatData = request->ios2_Data;
 219       request->ios2_Data = request;
 220    }
 221
 222    DevBeginIO(request, (APTR)REG_A6);
 223
 224    return;
 225 }
 226
 227
 228
 229 /****i* atheros.device/MOSDevAbortIO ***************************************
 230 *
 231 *   NAME
 232 *       MOSDevAbortIO -- Try to stop a request.
 233 *
 234 ****************************************************************************
 235 *
 236 */
 237
 238 static VOID MOSDevAbortIO()
 239 {
 240    DevAbortIO((APTR)REG_A1, (APTR)REG_A6);
 241 }
 242
 243
 244
 245 /****i* atheros.device/RXFunction ******************************************
 246 *
 247 *   NAME
 248 *       RXFunction
 249 *
 250 ****************************************************************************
 251 *
 252 */
 253
 254 static BOOL RXFunction(struct IOSana2Req *request, APTR buffer, ULONG size)
 255 {
 256    struct DevBase *base;
 257    struct EmulCaos context;
 258    struct Opener *opener;
 259    APTR cookie;
 260
 261    base = (struct DevBase *)request->ios2_Req.io_Device;
 262    opener = request->ios2_BufferManagement;
 263    cookie = request->ios2_StatData;
 264    request->ios2_Data = cookie;
 265
 266    context.caos_Un.Function = (APTR)opener->real_rx_function;
 267    context.reg_a0 = (ULONG)cookie;
 268    context.reg_a1 = (ULONG)buffer;
 269    context.reg_d0 = size;
 270    return MyEmulHandle->EmulCall68k(&context);
 271 }
 272
 273
 274
 275 /****i* atheros.device/TXFunction ******************************************
 276 *
 277 *   NAME
 278 *       TXFunction
 279 *
 280 ****************************************************************************
 281 *
 282 */
 283
 284 static BOOL TXFunction(APTR buffer, struct IOSana2Req *request, ULONG size)
 285 {
 286    struct DevBase *base;
 287    struct EmulCaos context;
 288    struct Opener *opener;
 289    APTR cookie;
 290
 291    base = (struct DevBase *)request->ios2_Req.io_Device;
 292    opener = request->ios2_BufferManagement;
 293    cookie = request->ios2_StatData;
 294    request->ios2_Data = cookie;
 295
 296    context.caos_Un.Function = (APTR)opener->real_tx_function;
 297    context.reg_a0 = (ULONG)buffer;
 298    context.reg_a1 = (ULONG)cookie;
 299    context.reg_d0 = size;
 300    return MyEmulHandle->EmulCall68k(&context);
 301 }
 302
 303
 304
 305 /****i* atheros.device/DMATXFunction ***************************************
 306 *
 307 *   NAME
 308 *       DMATXFunction
 309 *
 310 ****************************************************************************
 311 *
 312 */
 313
 314 static UBYTE *DMATXFunction(struct IOSana2Req *request)
 315 {
 316    struct DevBase *base;
 317    struct EmulCaos context;
 318    struct Opener *opener;
 319    APTR cookie;
 320
 321    base = (struct DevBase *)request->ios2_Req.io_Device;
 322    opener = request->ios2_BufferManagement;
 323    cookie = request->ios2_StatData;
 324    request->ios2_Data = cookie;
 325
 326    context.caos_Un.Function = (APTR)opener->real_dma_tx_function;
 327    context.reg_a0 = (ULONG)cookie;
 328    return (UBYTE *)MyEmulHandle->EmulCall68k(&context);
 329 }
 330
 331
 332
 333 /****i* atheros.device/MOSInt **********************************************
 334 *
 335 *   NAME
 336 *       MOSInt
 337 *
 338 ****************************************************************************
 339 *
 340 */
 341
 342 static BOOL MOSInt()
 343 {
 344    APTR *int_data;
 345    BOOL (*int_code)(APTR, APTR);
 346
 347    int_data = (APTR)REG_A1;
 348    int_code = int_data[0];
 349    return int_code(int_data[1], int_code);
 350 }
 351
 352
 353