workbench/devs/networks/prism2/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 <resources/card.h>
  28
  29 #include "initializers.h"
  30
  31 #include "device.h"
  32
  33 #include "device_protos.h"
  34
  35
  36 /* Private prototypes */
  37
  38 AROS_UFP3(struct DevBase *, AROSDevInit,
  39    AROS_UFPA(struct DevBase *, dev_base, D0),
  40    AROS_UFPA(APTR, seg_list, A0),
  41    AROS_UFPA(struct DevBase *, base, A6));
  42 AROS_LD3(BYTE, AROSDevOpen,
  43    AROS_LDA(struct IOSana2Req *, request, A1),
  44    AROS_LDA(LONG, unit_num, D0),
  45    AROS_LDA(ULONG, flags, D1),
  46    struct DevBase *, base, 1, S2);
  47 AROS_LD1(APTR, AROSDevClose,
  48    AROS_LDA(struct IOSana2Req *, request, A1),
  49    struct DevBase *, base, 2, S2);
  50 AROS_LD0(APTR, AROSDevExpunge,
  51    struct DevBase *, base, 3, S2);
  52 AROS_LD0(APTR, AROSDevReserved,
  53    struct DevBase *, base, 4, S2);
  54 AROS_LD1(VOID, AROSDevBeginIO,
  55    AROS_LDA(struct IOSana2Req *, request, A1),
  56    struct DevBase *, base, 5, S2);
  57 AROS_LD1(VOID, AROSDevAbortIO,
  58    AROS_LDA(struct IOSana2Req *, request, A1),
  59    struct DevBase *, base, 6, S2);
  60 static BOOL RXFunction(struct IOSana2Req *request, APTR buffer, ULONG size);
  61 static BOOL TXFunction(APTR buffer, struct IOSana2Req *request, ULONG size);
  62 static UBYTE *DMATXFunction(struct IOSana2Req *request);
  63 AROS_INTP(AROSInt);
  64 AROS_CARDP(AROSCardInt);
  65
  66 extern const APTR init_data;
  67 extern const struct Resident rom_tag;
  68 extern const TEXT device_name[];
  69 extern const TEXT version_string[];
  70
  71
  72 static const APTR vectors[] =
  73 {
  74    (APTR)AROS_SLIB_ENTRY(AROSDevOpen, S2, 1),
  75    (APTR)AROS_SLIB_ENTRY(AROSDevClose, S2, 2),
  76    (APTR)AROS_SLIB_ENTRY(AROSDevExpunge, S2, 3),
  77    (APTR)AROS_SLIB_ENTRY(AROSDevReserved, S2, 4),
  78    (APTR)AROS_SLIB_ENTRY(AROSDevBeginIO, S2, 5),
  79    (APTR)AROS_SLIB_ENTRY(AROSDevAbortIO, S2, 6),
  80    (APTR)-1
  81 };
  82
  83
  84 static const APTR init_table[] =
  85 {
  86    (APTR)sizeof(struct DevBase),
  87    (APTR)vectors,
  88    (APTR)&init_data,
  89    (APTR)AROSDevInit,
  90 };
  91
  92
  93 const struct Resident aros_rom_tag =
  94 {
  95    RTC_MATCHWORD,
  96    (struct Resident *)&aros_rom_tag,
  97    (APTR)(&rom_tag + 1),
  98    RTF_AUTOINIT,
  99    VERSION,
 100    NT_DEVICE,
 101    0,
 102    (TEXT *)device_name,
 103    (TEXT *)version_string,
 104    (APTR)init_table
 105 };
 106
 107
 108
 109 /****i* prism2.device/AROSDevInit ******************************************
 110 *
 111 *   NAME
 112 *       AROSDevInit
 113 *
 114 ****************************************************************************
 115 *
 116 */
 117
 118 AROS_UFH3(struct DevBase *, AROSDevInit,
 119    AROS_UFHA(struct DevBase *, dev_base, D0),
 120    AROS_UFHA(APTR, seg_list, A0),
 121    AROS_UFHA(struct DevBase *, base, A6))
 122 {
 123    AROS_LIBFUNC_INIT
 124
 125    base = DevInit(dev_base, seg_list, base);
 126
 127    if(base != NULL) {
 128       base->wrapper_int_code = (APTR)AROSInt;
 129       base->wrapper_card_code = (APTR)AROSCardInt;
 130    }
 131    return base;
 132
 133    AROS_LIBFUNC_EXIT
 134 }
 135
 136
 137
 138 /****i* prism2.device/AROSDevOpen ******************************************
 139 *
 140 *   NAME
 141 *       AROSDevOpen
 142 *
 143 ****************************************************************************
 144 *
 145 */
 146
 147 AROS_LH3(BYTE, AROSDevOpen,
 148    AROS_LHA(struct IOSana2Req *, request, A1),
 149    AROS_LHA(LONG, unit_num, D0),
 150    AROS_LHA(ULONG, flags, D1),
 151    struct DevBase *, base, 1, S2)
 152 {
 153    AROS_LIBFUNC_INIT
 154
 155    struct Opener *opener;
 156    BYTE error;
 157
 158    error = DevOpen(request, unit_num, flags, base);
 159
 160    /* Set up wrapper hooks to hide register-call functions */
 161
 162    if(error == 0)
 163    {
 164       opener = request->ios2_BufferManagement;
 165       opener->real_rx_function = opener->rx_function;
 166       opener->real_tx_function = opener->tx_function;
 167       opener->rx_function = (APTR)RXFunction;
 168       opener->tx_function = (APTR)TXFunction;
 169       if(opener->dma_tx_function != NULL)
 170       {
 171          opener->real_dma_tx_function = opener->dma_tx_function;
 172          opener->dma_tx_function = (APTR)DMATXFunction;
 173       }
 174    }
 175
 176    return error;
 177
 178    AROS_LIBFUNC_EXIT
 179 }
 180
 181
 182
 183 /****i* prism2.device/AROSDevClose *****************************************
 184 *
 185 *   NAME
 186 *       AROSDevClose
 187 *
 188 ****************************************************************************
 189 *
 190 */
 191
 192 AROS_LH1(APTR, AROSDevClose,
 193    AROS_LHA(struct IOSana2Req *, request, A1),
 194    struct DevBase *, base, 2, S2)
 195 {
 196    AROS_LIBFUNC_INIT
 197
 198    return DevClose(request, base);
 199
 200    AROS_LIBFUNC_EXIT
 201 }
 202
 203
 204
 205 /****i* prism2.device/AROSDevExpunge ***************************************
 206 *
 207 *   NAME
 208 *       AROSDevExpunge
 209 *
 210 ****************************************************************************
 211 *
 212 */
 213
 214 AROS_LH0(APTR, AROSDevExpunge,
 215    struct DevBase *, base, 3, S2)
 216 {
 217    AROS_LIBFUNC_INIT
 218
 219    return DevExpunge(base);
 220
 221    AROS_LIBFUNC_EXIT
 222 }
 223
 224
 225
 226 /****i* prism2.device/AROSDevReserved **************************************
 227 *
 228 *   NAME
 229 *       AROSDevReserved
 230 *
 231 ****************************************************************************
 232 *
 233 */
 234
 235 AROS_LH0(APTR, AROSDevReserved,
 236    struct DevBase *, base, 4, S2)
 237 {
 238    AROS_LIBFUNC_INIT
 239
 240    return DevReserved(base);
 241
 242    AROS_LIBFUNC_EXIT
 243 }
 244
 245
 246
 247 /****i* prism2.device/AROSDevBeginIO ***************************************
 248 *
 249 *   NAME
 250 *       AROSDevBeginIO
 251 *
 252 ****************************************************************************
 253 *
 254 */
 255
 256 AROS_LH1(VOID, AROSDevBeginIO,
 257    AROS_LHA(struct IOSana2Req *, request, A1),
 258    struct DevBase *, base, 5, S2)
 259 {
 260    AROS_LIBFUNC_INIT
 261
 262    /* Replace caller's cookie with our own */
 263
 264    switch(request->ios2_Req.io_Command)
 265    {
 266    case CMD_READ:
 267    case CMD_WRITE:
 268    case S2_MULTICAST:
 269    case S2_BROADCAST:
 270    case S2_READORPHAN:
 271       request->ios2_StatData = request->ios2_Data;
 272       request->ios2_Data = request;
 273    }
 274
 275    DevBeginIO(request, base);
 276
 277    AROS_LIBFUNC_EXIT
 278 }
 279
 280
 281
 282 /****i* prism2.device/AROSDevAbortIO ***************************************
 283 *
 284 *   NAME
 285 *       AROSDevAbortIO -- Try to stop a request.
 286 *
 287 ****************************************************************************
 288 *
 289 */
 290
 291 AROS_LH1(VOID, AROSDevAbortIO,
 292    AROS_LHA(struct IOSana2Req *, request, A1),
 293    struct DevBase *, base, 6, S2)
 294 {
 295    AROS_LIBFUNC_INIT
 296
 297    DevAbortIO(request, base);
 298
 299    AROS_LIBFUNC_EXIT
 300 }
 301
 302
 303
 304 /****i* prism2.device/RXFunction *******************************************
 305 *
 306 *   NAME
 307 *       RXFunction
 308 *
 309 ****************************************************************************
 310 *
 311 */
 312
 313 static BOOL RXFunction(struct IOSana2Req *request, APTR buffer, ULONG size)
 314 {
 315    struct Opener *opener;
 316    APTR cookie;
 317
 318    opener = request->ios2_BufferManagement;
 319    cookie = request->ios2_StatData;
 320    request->ios2_Data = cookie;
 321
 322    return AROS_UFC3(BOOL, (APTR)opener->real_rx_function,
 323       AROS_UFCA(APTR, cookie, A0),
 324       AROS_UFCA(APTR, buffer, A1),
 325       AROS_UFCA(ULONG, size, D0));
 326 }
 327
 328
 329
 330 /****i* prism2.device/TXFunction *******************************************
 331 *
 332 *   NAME
 333 *       TXFunction
 334 *
 335 ****************************************************************************
 336 *
 337 */
 338
 339 static BOOL TXFunction(APTR buffer, struct IOSana2Req *request, ULONG size)
 340 {
 341    struct Opener *opener;
 342    APTR cookie;
 343
 344    opener = request->ios2_BufferManagement;
 345    cookie = request->ios2_StatData;
 346    request->ios2_Data = cookie;
 347
 348    return AROS_UFC3(BOOL, (APTR)opener->real_tx_function,
 349       AROS_UFCA(APTR, buffer, A0),
 350       AROS_UFCA(APTR, cookie, A1),
 351       AROS_UFCA(ULONG, size, D0));
 352 }
 353
 354
 355
 356 /****i* prism2.device/DMATXFunction ****************************************
 357 *
 358 *   NAME
 359 *       DMATXFunction
 360 *
 361 ****************************************************************************
 362 *
 363 */
 364
 365 static UBYTE *DMATXFunction(struct IOSana2Req *request)
 366 {
 367    struct Opener *opener;
 368    APTR cookie;
 369
 370    opener = request->ios2_BufferManagement;
 371    cookie = request->ios2_StatData;
 372    request->ios2_Data = cookie;
 373
 374    return AROS_UFC1(UBYTE *, (APTR)opener->real_dma_tx_function,
 375       AROS_UFCA(APTR, cookie, A0));
 376 }
 377
 378
 379
 380 /****i* prism2.device/AROSInt **********************************************
 381 *
 382 *   NAME
 383 *       AROSInt
 384 *
 385 ****************************************************************************
 386 *
 387 */
 388 #undef SysBase
 389
 390 AROS_INTH2(AROSInt, APTR *, int_data, mask)
 391 {
 392    AROS_INTFUNC_INIT
 393
 394    BOOL (*int_code)(APTR, APTR, UBYTE);
 395
 396    int_code = int_data[0];
 397    return int_code(int_data[1], int_code, mask);
 398
 399    AROS_INTFUNC_EXIT
 400 }
 401
 402 /****i* prism2.device/AROSCardInt ******************************************
 403 *
 404 *   NAME
 405 *       AROSCardInt
 406 *
 407 ****************************************************************************
 408 *
 409 */
 410 /* Mask is in D0 */
 411 AROS_CARDH(AROSCardInt, APTR *, int_data, mask)
 412 {
 413    AROS_CARDFUNC_INIT
 414
 415    BOOL (*int_code)(APTR, APTR, UBYTE);
 416
 417    int_code = int_data[0];
 418    return int_code(int_data[1], int_code, mask);
 419
 420    AROS_CARDFUNC_EXIT
 421 }
 422