workbench/devs/networks/rhine/aros_device.c

   1 /*
   2
   3 Copyright (C) 2011,2012 Neil Cafferkey
   4
   5 This program is free software; you can redistribute it and/or modify
   6 it under the terms of the GNU General Public License as published by
   7 the Free Software Foundation; either version 2 of the License, or
   8 (at your option) any later version.
   9
  10 This program is distributed in the hope that it will be useful, but
  11 WITHOUT ANY WARRANTY; without even the implied warranty of
  12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  13 General Public License for more details.
  14
  15 You should have received a copy of the GNU General Public License
  16 along with this program; if not, write to the Free Software
  17 Foundation, Inc., 59 Temple Place - Suite 330, Boston,
  18 MA 02111-1307, USA.
  19
  20 */
  21
  22
  23 #include <exec/types.h>
  24 #include <exec/resident.h>
  25 #include <aros/asmcall.h>
  26 #include <aros/libcall.h>
  27 #include "initializers.h"
  28
  29 #include "device.h"
  30
  31 #include "device_protos.h"
  32
  33
  34 /* Private prototypes */
  35
  36 AROS_UFP3(struct DevBase *, AROSDevInit,
  37    AROS_UFPA(struct DevBase *, dev_base, D0),
  38    AROS_UFPA(APTR, seg_list, A0),
  39    AROS_UFPA(struct DevBase *, base, A6));
  40 AROS_LD3(BYTE, AROSDevOpen,
  41    AROS_LDA(struct IOSana2Req *, request, A1),
  42    AROS_LDA(LONG, unit_num, D0),
  43    AROS_LDA(ULONG, flags, D1),
  44    struct DevBase *, base, 1, S2);
  45 AROS_LD1(APTR, AROSDevClose,
  46    AROS_LDA(struct IOSana2Req *, request, A1),
  47    struct DevBase *, base, 2, S2);
  48 AROS_LD0(APTR, AROSDevExpunge,
  49    struct DevBase *, base, 3, S2);
  50 AROS_LD0(APTR, AROSDevReserved,
  51    struct DevBase *, base, 4, S2);
  52 AROS_LD1(VOID, AROSDevBeginIO,
  53    AROS_LDA(struct IOSana2Req *, request, A1),
  54    struct DevBase *, base, 5, S2);
  55 AROS_LD1(VOID, AROSDevAbortIO,
  56    AROS_LDA(struct IOSana2Req *, request, A1),
  57    struct DevBase *, base, 6, S2);
  58 static BOOL RXFunction(struct IOSana2Req *request, APTR buffer, ULONG size);
  59 static BOOL TXFunction(APTR buffer, struct IOSana2Req *request, ULONG size);
  60 static UBYTE *DMATXFunction(struct IOSana2Req *request);
  61 AROS_INTP(AROSInt);
  62
  63 extern const APTR init_data;
  64 extern const struct Resident rom_tag;
  65 extern const TEXT device_name[];
  66 extern const TEXT version_string[];
  67
  68
  69 static const APTR vectors[] =
  70 {
  71    (APTR)AROS_SLIB_ENTRY(AROSDevOpen, S2, 1),
  72    (APTR)AROS_SLIB_ENTRY(AROSDevClose, S2, 2),
  73    (APTR)AROS_SLIB_ENTRY(AROSDevExpunge, S2, 3),
  74    (APTR)AROS_SLIB_ENTRY(AROSDevReserved, S2, 4),
  75    (APTR)AROS_SLIB_ENTRY(AROSDevBeginIO, S2, 5),
  76    (APTR)AROS_SLIB_ENTRY(AROSDevAbortIO, S2, 6),
  77    (APTR)-1
  78 };
  79
  80
  81 static const APTR init_table[] =
  82 {
  83    (APTR)sizeof(struct DevBase),
  84    (APTR)vectors,
  85    (APTR)&init_data,
  86    (APTR)AROSDevInit,
  87 };
  88
  89
  90 const struct Resident aros_rom_tag =
  91 {
  92    RTC_MATCHWORD,
  93    (struct Resident *)&aros_rom_tag,
  94    (APTR)(&rom_tag + 1),
  95    RTF_AUTOINIT,
  96    VERSION,
  97    NT_DEVICE,
  98    0,
  99    (TEXT *)device_name,
 100    (TEXT *)version_string,
 101    (APTR)init_table
 102 };
 103
 104
 105
 106 /****i* rhine.device/AROSDevInit *******************************************
 107 *
 108 *   NAME
 109 *       AROSDevInit
 110 *
 111 ****************************************************************************
 112 *
 113 */
 114
 115 AROS_UFH3(struct DevBase *, AROSDevInit,
 116    AROS_UFHA(struct DevBase *, dev_base, D0),
 117    AROS_UFHA(APTR, seg_list, A0),
 118    AROS_UFHA(struct DevBase *, base, A6))
 119 {
 120    AROS_LIBFUNC_INIT
 121
 122    base = DevInit(dev_base, seg_list, base);
 123
 124    if(base != NULL)
 125       base->wrapper_int_code = (APTR)AROSInt;
 126    return base;
 127
 128    AROS_LIBFUNC_EXIT
 129 }
 130
 131
 132
 133 /****i* rhine.device/AROSDevOpen *******************************************
 134 *
 135 *   NAME
 136 *       AROSDevOpen
 137 *
 138 ****************************************************************************
 139 *
 140 */
 141
 142 AROS_LH3(BYTE, AROSDevOpen,
 143    AROS_LHA(struct IOSana2Req *, request, A1),
 144    AROS_LHA(LONG, unit_num, D0),
 145    AROS_LHA(ULONG, flags, D1),
 146    struct DevBase *, base, 1, S2)
 147 {
 148    AROS_LIBFUNC_INIT
 149
 150    struct Opener *opener;
 151    BYTE error;
 152
 153    error = DevOpen(request, unit_num, flags, base);
 154
 155    /* Set up wrapper hooks to hide register-call functions */
 156
 157    if(error == 0)
 158    {
 159       opener = request->ios2_BufferManagement;
 160       opener->real_rx_function = opener->rx_function;
 161       opener->real_tx_function = opener->tx_function;
 162       opener->rx_function = (APTR)RXFunction;
 163       opener->tx_function = (APTR)TXFunction;
 164       if(opener->dma_tx_function != NULL)
 165       {
 166          opener->real_dma_tx_function = opener->dma_tx_function;
 167          opener->dma_tx_function = (APTR)DMATXFunction;
 168       }
 169    }
 170
 171    return error;
 172
 173    AROS_LIBFUNC_EXIT
 174 }
 175
 176
 177
 178 /****i* rhine.device/AROSDevClose ******************************************
 179 *
 180 *   NAME
 181 *       AROSDevClose
 182 *
 183 ****************************************************************************
 184 *
 185 */
 186
 187 AROS_LH1(APTR, AROSDevClose,
 188    AROS_LHA(struct IOSana2Req *, request, A1),
 189    struct DevBase *, base, 2, S2)
 190 {
 191    AROS_LIBFUNC_INIT
 192
 193    return DevClose(request, base);
 194
 195    AROS_LIBFUNC_EXIT
 196 }
 197
 198
 199
 200 /****i* rhine.device/AROSDevExpunge ****************************************
 201 *
 202 *   NAME
 203 *       AROSDevExpunge
 204 *
 205 ****************************************************************************
 206 *
 207 */
 208
 209 AROS_LH0(APTR, AROSDevExpunge,
 210    struct DevBase *, base, 3, S2)
 211 {
 212    AROS_LIBFUNC_INIT
 213
 214    return DevExpunge(base);
 215
 216    AROS_LIBFUNC_EXIT
 217 }
 218
 219
 220
 221 /****i* rhine.device/AROSDevReserved ***************************************
 222 *
 223 *   NAME
 224 *       AROSDevReserved
 225 *
 226 ****************************************************************************
 227 *
 228 */
 229
 230 AROS_LH0(APTR, AROSDevReserved,
 231    struct DevBase *, base, 4, S2)
 232 {
 233    AROS_LIBFUNC_INIT
 234
 235    return DevReserved(base);
 236
 237    AROS_LIBFUNC_EXIT
 238 }
 239
 240
 241
 242 /****i* rhine.device/AROSDevBeginIO ****************************************
 243 *
 244 *   NAME
 245 *       AROSDevBeginIO
 246 *
 247 ****************************************************************************
 248 *
 249 */
 250
 251 AROS_LH1(VOID, AROSDevBeginIO,
 252    AROS_LHA(struct IOSana2Req *, request, A1),
 253    struct DevBase *, base, 5, S2)
 254 {
 255    AROS_LIBFUNC_INIT
 256
 257    /* Replace caller's cookie with our own */
 258
 259    switch(request->ios2_Req.io_Command)
 260    {
 261    case CMD_READ:
 262    case CMD_WRITE:
 263    case S2_MULTICAST:
 264    case S2_BROADCAST:
 265    case S2_READORPHAN:
 266       request->ios2_StatData = request->ios2_Data;
 267       request->ios2_Data = request;
 268    }
 269
 270    DevBeginIO(request, base);
 271
 272    AROS_LIBFUNC_EXIT
 273 }
 274
 275
 276
 277 /****i* rhine.device/AROSDevAbortIO ****************************************
 278 *
 279 *   NAME
 280 *       AROSDevAbortIO -- Try to stop a request.
 281 *
 282 ****************************************************************************
 283 *
 284 */
 285
 286 AROS_LH1(VOID, AROSDevAbortIO,
 287    AROS_LHA(struct IOSana2Req *, request, A1),
 288    struct DevBase *, base, 6, S2)
 289 {
 290    AROS_LIBFUNC_INIT
 291
 292    DevAbortIO(request, base);
 293
 294    AROS_LIBFUNC_EXIT
 295 }
 296
 297
 298
 299 /****i* rhine.device/RXFunction ********************************************
 300 *
 301 *   NAME
 302 *       RXFunction
 303 *
 304 ****************************************************************************
 305 *
 306 */
 307
 308 static BOOL RXFunction(struct IOSana2Req *request, APTR buffer, ULONG size)
 309 {
 310    struct Opener *opener;
 311    APTR cookie;
 312
 313    opener = request->ios2_BufferManagement;
 314    cookie = request->ios2_StatData;
 315    request->ios2_Data = cookie;
 316
 317    return AROS_UFC3(BOOL, (APTR)opener->real_rx_function,
 318       AROS_UFCA(APTR, cookie, A0),
 319       AROS_UFCA(APTR, buffer, A1),
 320       AROS_UFCA(ULONG, size, D0));
 321 }
 322
 323
 324
 325 /****i* rhine.device/TXFunction ********************************************
 326 *
 327 *   NAME
 328 *       TXFunction
 329 *
 330 ****************************************************************************
 331 *
 332 */
 333
 334 static BOOL TXFunction(APTR buffer, struct IOSana2Req *request, ULONG size)
 335 {
 336    struct Opener *opener;
 337    APTR cookie;
 338
 339    opener = request->ios2_BufferManagement;
 340    cookie = request->ios2_StatData;
 341    request->ios2_Data = cookie;
 342
 343    return AROS_UFC3(BOOL, (APTR)opener->real_tx_function,
 344       AROS_UFCA(APTR, buffer, A0),
 345       AROS_UFCA(APTR, cookie, A1),
 346       AROS_UFCA(ULONG, size, D0));
 347 }
 348
 349
 350
 351 /****i* rhine.device/DMATXFunction *****************************************
 352 *
 353 *   NAME
 354 *       DMATXFunction
 355 *
 356 ****************************************************************************
 357 *
 358 */
 359
 360 static UBYTE *DMATXFunction(struct IOSana2Req *request)
 361 {
 362    struct Opener *opener;
 363    APTR cookie;
 364
 365    opener = request->ios2_BufferManagement;
 366    cookie = request->ios2_StatData;
 367    request->ios2_Data = cookie;
 368
 369    return AROS_UFC1(UBYTE *, (APTR)opener->real_dma_tx_function,
 370       AROS_UFCA(APTR, cookie, A0));
 371 }
 372
 373
 374
 375 /****i* rhine.device/AROSInt ***********************************************
 376 *
 377 *   NAME
 378 *       AROSInt
 379 *
 380 ****************************************************************************
 381 *
 382 */
 383 #undef SysBase
 384
 385 AROS_INTH2(AROSInt, APTR *, int_data, mask)
 386 {
 387    AROS_INTFUNC_INIT
 388
 389    BOOL (*int_code)(APTR, APTR, UBYTE);
 390
 391    int_code = int_data[0];
 392    return int_code(int_data[1], int_code, mask);
 393
 394    AROS_INTFUNC_EXIT
 395 }
 396
 397
 398