workbench/devs/networks/atheros5000/mos_device.c

   1 /*
   2
   3 File: mos_device.c
   4 Author: Neil Cafferkey
   5 Copyright (C) 2000-2011 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 #include <libraries/query.h>
  29
  30 #include <proto/exec.h>
  31
  32 #include "device.h"
  33
  34 #include "device_protos.h"
  35
  36
  37 /* Private prototypes */
  38
  39 static struct DevBase *MOSDevInit(struct DevBase *dev_base, APTR seg_list,
  40    struct DevBase *base);
  41 static BYTE MOSDevOpen();
  42 static APTR MOSDevClose();
  43 static APTR MOSDevExpunge();
  44 static VOID MOSDevBeginIO();
  45 static VOID MOSDevAbortIO();
  46 static BOOL RXFunction(struct IOSana2Req *request, APTR buffer, ULONG size);
  47 static BOOL TXFunction(APTR buffer, struct IOSana2Req *request, ULONG size);
  48 static UBYTE *DMATXFunction(struct IOSana2Req *request);
  49 static BOOL MOSInt();
  50
  51 extern const APTR init_data;
  52 extern const struct Resident rom_tag;
  53 extern const TEXT device_name[];
  54 extern const TEXT version_string[];
  55
  56
  57 static const TEXT openpci_name[] = "openpci.library";
  58
  59
  60 static const APTR mos_vectors[] =
  61 {
  62    (APTR)FUNCARRAY_32BIT_NATIVE,
  63    (APTR)MOSDevOpen,
  64    (APTR)MOSDevClose,
  65    (APTR)MOSDevExpunge,
  66    (APTR)DevReserved,
  67    (APTR)MOSDevBeginIO,
  68    (APTR)MOSDevAbortIO,
  69    (APTR)-1
  70 };
  71
  72
  73 static const APTR mos_init_table[] =
  74 {
  75    (APTR)sizeof(struct DevBase),
  76    (APTR)mos_vectors,
  77    (APTR)&init_data,
  78    (APTR)MOSDevInit
  79 };
  80
  81
  82 static const struct TagItem query_tags[] =
  83 {
  84    {QUERYINFOATTR_NAME, (UPINT)device_name},
  85    {QUERYINFOATTR_IDSTRING, (UPINT)version_string},
  86    {QUERYINFOATTR_DESCRIPTION, (UPINT)"Atheros5000 WLAN network driver"},
  87    {QUERYINFOATTR_COPYRIGHT, (UPINT)"2000-2011 Neil Cafferkey"},
  88    {QUERYINFOATTR_AUTHOR, (UPINT)"Neil Cafferkey"},
  89    {QUERYINFOATTR_DATE, (UPINT)DATE},
  90    {QUERYINFOATTR_VERSION, VERSION},
  91    {QUERYINFOATTR_REVISION, REVISION},
  92    {QUERYINFOATTR_CODETYPE, MACHINE_PPC},
  93    {QUERYINFOATTR_SUBTYPE, QUERYSUBTYPE_DEVICE},
  94    {QUERYINFOATTR_CLASS, QUERYCLASS_NET},
  95    {QUERYINFOATTR_NET_IPTYPE, 2048},
  96    {TAG_END, 0}
  97 };
  98
  99
 100 const struct Resident mos_rom_tag =
 101 {
 102    RTC_MATCHWORD,
 103    (struct Resident *)&mos_rom_tag,
 104    (APTR)(&rom_tag + 1),
 105    RTF_AUTOINIT | RTF_PPC | RTF_EXTENDED,
 106    VERSION,
 107    NT_DEVICE,
 108    0,
 109    (STRPTR)device_name,
 110    (STRPTR)version_string,
 111    (APTR)mos_init_table,
 112    REVISION,
 113    (struct TagItem *)&query_tags
 114 };
 115
 116
 117 static const struct EmulLibEntry int_trap =
 118 {
 119    TRAP_LIB,
 120    0,
 121    (APTR)MOSInt
 122 };
 123
 124
 125
 126 /****i* atheros5000.device/MOSDevInit **************************************
 127 *
 128 *   NAME
 129 *       MOSDevInit
 130 *
 131 ****************************************************************************
 132 *
 133 */
 134
 135 static struct DevBase *MOSDevInit(struct DevBase *dev_base, APTR seg_list,
 136    struct DevBase *base)
 137 {
 138    base = DevInit(dev_base, seg_list, base);
 139
 140    if(base != NULL)
 141    {
 142       base->openpci_base = OpenLibrary(openpci_name, OPENPCI_VERSION);
 143       base->wrapper_int_code = (APTR)&int_trap;
 144    }
 145    return base;
 146 }
 147
 148
 149
 150 /****i* atheros5000.device/MOSDevOpen **************************************
 151 *
 152 *   NAME
 153 *       MOSDevOpen
 154 *
 155 ****************************************************************************
 156 *
 157 */
 158
 159 static BYTE MOSDevOpen()
 160 {
 161    struct IOSana2Req *request;
 162    struct Opener *opener;
 163    BYTE error;
 164
 165    request = (APTR)REG_A1;
 166    error = DevOpen(request, REG_D0, REG_D1, (APTR)REG_A6);
 167
 168    /* Set up wrapper hooks to hide 68k emulation */
 169
 170    if(error == 0)
 171    {
 172       opener = request->ios2_BufferManagement;
 173       opener->real_rx_function = opener->rx_function;
 174       opener->real_tx_function = opener->tx_function;
 175       opener->rx_function = (APTR)RXFunction;
 176       opener->tx_function = (APTR)TXFunction;
 177       if(opener->dma_tx_function != NULL)
 178       {
 179          opener->real_dma_tx_function = opener->dma_tx_function;
 180          opener->dma_tx_function = (APTR)DMATXFunction;
 181       }
 182    }
 183
 184    return error;
 185 }
 186
 187
 188
 189 /****i* atheros5000.device/MOSDevClose *************************************
 190 *
 191 *   NAME
 192 *       MOSDevClose
 193 *
 194 ****************************************************************************
 195 *
 196 */
 197
 198 static APTR MOSDevClose()
 199 {
 200    return DevClose((APTR)REG_A1, (APTR)REG_A6);
 201 }
 202
 203
 204
 205 /****i* atheros5000.device/MOSDevExpunge ***********************************
 206 *
 207 *   NAME
 208 *       MOSDevExpunge
 209 *
 210 ****************************************************************************
 211 *
 212 */
 213
 214 static APTR MOSDevExpunge()
 215 {
 216    return DevExpunge((APTR)REG_A6);
 217 }
 218
 219
 220
 221 /****i* atheros5000.device/MOSDevBeginIO ***********************************
 222 *
 223 *   NAME
 224 *       MOSDevBeginIO
 225 *
 226 ****************************************************************************
 227 *
 228 */
 229
 230 static VOID MOSDevBeginIO()
 231 {
 232    struct IOSana2Req *request = (APTR)REG_A1;
 233
 234    /* Replace caller's cookie with our own */
 235
 236    switch(request->ios2_Req.io_Command)
 237    {
 238    case CMD_READ:
 239    case CMD_WRITE:
 240    case S2_MULTICAST:
 241    case S2_BROADCAST:
 242    case S2_READORPHAN:
 243       request->ios2_StatData = request->ios2_Data;
 244       request->ios2_Data = request;
 245    }
 246
 247    DevBeginIO(request, (APTR)REG_A6);
 248
 249    return;
 250 }
 251
 252
 253
 254 /****i* atheros5000.device/MOSDevAbortIO ***********************************
 255 *
 256 *   NAME
 257 *       MOSDevAbortIO -- Try to stop a request.
 258 *
 259 ****************************************************************************
 260 *
 261 */
 262
 263 static VOID MOSDevAbortIO()
 264 {
 265    DevAbortIO((APTR)REG_A1, (APTR)REG_A6);
 266 }
 267
 268
 269
 270 /****i* atheros5000.device/RXFunction **************************************
 271 *
 272 *   NAME
 273 *       RXFunction
 274 *
 275 ****************************************************************************
 276 *
 277 */
 278
 279 static BOOL RXFunction(struct IOSana2Req *request, APTR buffer, ULONG size)
 280 {
 281    struct DevBase *base;
 282    struct EmulCaos context;
 283    struct Opener *opener;
 284    APTR cookie;
 285
 286    base = (struct DevBase *)request->ios2_Req.io_Device;
 287    opener = request->ios2_BufferManagement;
 288    cookie = request->ios2_StatData;
 289    request->ios2_Data = cookie;
 290
 291    context.caos_Un.Function = (APTR)opener->real_rx_function;
 292    context.reg_a0 = (ULONG)cookie;
 293    context.reg_a1 = (ULONG)buffer;
 294    context.reg_d0 = size;
 295    return MyEmulHandle->EmulCall68k(&context);
 296 }
 297
 298
 299
 300 /****i* atheros5000.device/TXFunction **************************************
 301 *
 302 *   NAME
 303 *       TXFunction
 304 *
 305 ****************************************************************************
 306 *
 307 */
 308
 309 static BOOL TXFunction(APTR buffer, struct IOSana2Req *request, ULONG size)
 310 {
 311    struct DevBase *base;
 312    struct EmulCaos context;
 313    struct Opener *opener;
 314    APTR cookie;
 315
 316    base = (struct DevBase *)request->ios2_Req.io_Device;
 317    opener = request->ios2_BufferManagement;
 318    cookie = request->ios2_StatData;
 319    request->ios2_Data = cookie;
 320
 321    context.caos_Un.Function = (APTR)opener->real_tx_function;
 322    context.reg_a0 = (ULONG)buffer;
 323    context.reg_a1 = (ULONG)cookie;
 324    context.reg_d0 = size;
 325    return MyEmulHandle->EmulCall68k(&context);
 326 }
 327
 328
 329
 330 /****i* atheros5000.device/DMATXFunction ***********************************
 331 *
 332 *   NAME
 333 *       DMATXFunction
 334 *
 335 ****************************************************************************
 336 *
 337 */
 338
 339 static UBYTE *DMATXFunction(struct IOSana2Req *request)
 340 {
 341    struct DevBase *base;
 342    struct EmulCaos context;
 343    struct Opener *opener;
 344    APTR cookie;
 345
 346    base = (struct DevBase *)request->ios2_Req.io_Device;
 347    opener = request->ios2_BufferManagement;
 348    cookie = request->ios2_StatData;
 349    request->ios2_Data = cookie;
 350
 351    context.caos_Un.Function = (APTR)opener->real_dma_tx_function;
 352    context.reg_a0 = (ULONG)cookie;
 353    return (UBYTE *)MyEmulHandle->EmulCall68k(&context);
 354 }
 355
 356
 357
 358 /****i* atheros5000.device/MOSInt ******************************************
 359 *
 360 *   NAME
 361 *       MOSInt
 362 *
 363 ****************************************************************************
 364 *
 365 */
 366
 367 static BOOL MOSInt()
 368 {
 369    APTR *int_data;
 370    BOOL (*int_code)(APTR, APTR);
 371
 372    int_data = (APTR)REG_A1;
 373    int_code = int_data[0];
 374    return int_code(int_data[1], int_code);
 375 }
 376
 377
 378