rom/usb/classes/arosx/arosx.library.c

   1 /*
   2     Copyright © 2019, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include <aros/libcall.h>
   7 #include <aros/symbolsets.h>
   8
   9 #include <exec/types.h>
  10 #include <exec/libraries.h>
  11
  12 #include <proto/exec.h>
  13
  14 #include "debug.h"
  15
  16 #include "arosx.class.h"
  17 #include "include/arosx.h"
  18
  19 BOOL AROSXClass_SendEvent(LIBBASETYPEPTR arosxb, ULONG ehmt, APTR param1, APTR param2);
  20
  21 static const UBYTE libarosx[] = "arosx.library";
  22
  23 AROS_UFH3(struct AROSXBase *, libInit, AROS_UFHA(struct AROSXBase *, base, D0), AROS_UFHA(BPTR, seglist, A0), AROS_UFHA(struct ExecBase *, SysBase, A6)) {
  24     AROS_USERFUNC_INIT
  25
  26     mybug(-1, ("[AROSXLib] libInit base: 0x%08lx seglist: 0x%08lx SysBase: 0x%08lx\n", base, seglist, SysBase));
  27
  28     base->arosx_LibNode.lib_Node.ln_Type = NT_LIBRARY;
  29     base->arosx_LibNode.lib_Node.ln_Name = (UBYTE*)libarosx;
  30     base->arosx_LibNode.lib_Flags        = LIBF_SUMUSED|LIBF_CHANGED;
  31     base->arosx_LibNode.lib_Version      = 0;
  32     base->arosx_LibNode.lib_Revision     = 1;
  33     base->arosx_LibNode.lib_IdString     = (UBYTE*)libarosx;
  34
  35     /* Store segment, don't have one... */
  36     //base->arosx_LibNode.np_SegList = seglist;
  37
  38     return(base);
  39
  40     AROS_USERFUNC_EXIT
  41 }
  42
  43 AROS_LH1(struct AROSXBase *, libOpen, AROS_LHA(ULONG, version, D0), struct AROSXBase *, base, 1, lib) {
  44     AROS_LIBFUNC_INIT
  45
  46     ++base->arosx_LibNode.lib_OpenCnt;
  47     base->arosx_LibNode.lib_Flags &= ~LIBF_DELEXP;
  48
  49     return base;
  50
  51     AROS_LIBFUNC_EXIT
  52 }
  53
  54 AROS_LH0(BPTR, libClose, struct AROSXBase *, base, 2, lib) {
  55     AROS_LIBFUNC_INIT
  56
  57     BPTR ret;
  58     ret = BNULL;
  59
  60     if(--base->arosx_LibNode.lib_OpenCnt == 0) {
  61         if(base->arosx_LibNode.lib_Flags & LIBF_DELEXP)
  62         {
  63             mybug(-1, ("[AROSXLib] libClose: calling expunge...\n"));
  64             ret = AROS_LC1(BPTR, libExpunge, AROS_LCA(struct AROSXBase *, base, D0), struct AROSXBase *, base, 3, lib);
  65         }
  66     }
  67
  68     return(ret);
  69
  70     AROS_LIBFUNC_EXIT
  71 }
  72
  73 AROS_LH0(BPTR, libExpunge, struct AROSXBase *, base, 3, lib) {
  74     AROS_LIBFUNC_INIT
  75
  76     BPTR ret;
  77
  78     /*
  79         CHECME: Our memory belongs to arosx.class, make sure we free only allocated memory
  80     */
  81
  82     mybug(-1, ("[AROSXLib] libExpunge base: 0x%08lx\n", base));
  83
  84     ret = BNULL;
  85
  86     if(base->arosx_LibNode.lib_OpenCnt == 0)
  87     {
  88         mybug(-1, ("[AROSXLib] libExpunge: Unloading...\n"));
  89
  90         //ret = base->np_SegList;
  91
  92         mybug(-1, ("[AROSXLib] libExpunge: removing library node 0x%08lx\n", &base->arosx_LibNode.lib_Node));
  93         Remove(&base->arosx_LibNode.lib_Node);
  94
  95         mybug(-1, ("[AROSXLib] libExpunge: FreeMem()...\n"));
  96         FreeMem((char *) base - base->arosx_LibNode.lib_NegSize, (ULONG) (base->arosx_LibNode.lib_NegSize + base->arosx_LibNode.lib_PosSize));
  97
  98         mybug(-1, ("[AROSXLib] libExpunge: Unloading done! arosx.library expunged!\n"));
  99
 100         return(ret);
 101     }
 102     else
 103     {
 104         mybug(-1, ("[AROSXLib] libExpunge: Could not expunge, LIBF_DELEXP set!\n"));
 105         base->arosx_LibNode.lib_Flags |= LIBF_DELEXP;
 106     }
 107
 108     return(BNULL);
 109
 110     AROS_LIBFUNC_EXIT
 111 }
 112
 113 AROS_LH0(IPTR, libReserved, struct AROSXBase *, base, 4, lib) {
 114     AROS_LIBFUNC_INIT
 115     return (IPTR)NULL;
 116     AROS_LIBFUNC_EXIT
 117 }
 118
 119 AROS_LH2(struct AROSX_EventHook *, AROSX_AddEventHandler,
 120          AROS_LHA(struct MsgPort *, mp, A1),
 121          AROS_LHA(ULONG, msgmask, D0),
 122          struct AROSXBase *, base, 5, lib)
 123 {
 124     AROS_LIBFUNC_INIT
 125
 126     struct AROSXClassBase *arosxb;
 127     arosxb = base->arosxb;
 128
 129     struct AROSXClassController *arosxc;
 130
 131     struct AROSX_EventHook *eh = NULL;
 132
 133     mybug(-1, ("AROSX_AddEventHandler(%p, %p)\n", mp, msgmask));
 134
 135     if(mp) {
 136         if((eh = AllocVec(sizeof(struct AROSX_EventHook), (MEMF_CLEAR|MEMF_ANY)))) {
 137             eh->eh_MsgPort = mp;
 138             eh->eh_MsgMask = msgmask;
 139             ObtainSemaphore(&arosxb->event_lock);
 140             AddTail(&base->arosxb->event_port_list, &eh->eh_Node);
 141             ReleaseSemaphore(&arosxb->event_lock);
 142
 143             /*
 144                 Send connect events from those controllers that are already connected and inluded in the mask
 145             */
 146
 147             ObtainSemaphore(&arosxb->arosxc_lock);
 148
 149             arosxc = arosxb->arosxc_0;
 150             if( (((msgmask>>28) & 1) && (arosxc->status.connected)) ) {
 151                 AROSXClass_SendEvent(arosxb, ((1<<28) | ((arosxc->controller_type)<<20) | AROSX_EHMF_CONNECT), (APTR)1, (APTR)2);
 152                 mybug(-1, ("Sent connect event for 0\n"));
 153             }
 154
 155             arosxc = arosxb->arosxc_1;
 156             if( (((msgmask>>28) & 2) && (arosxc->status.connected)) ) {
 157                 AROSXClass_SendEvent(arosxb, ((2<<28) | ((arosxc->controller_type)<<20) | AROSX_EHMF_CONNECT), (APTR)1, (APTR)2);
 158                 mybug(-1, ("Sent connect event for 1\n"));
 159             }
 160
 161             arosxc = arosxb->arosxc_2;
 162             if( (((msgmask>>28) & 4) && (arosxc->status.connected)) ) {
 163                 AROSXClass_SendEvent(arosxb, ((4<<28) | ((arosxc->controller_type)<<20) | AROSX_EHMF_CONNECT), (APTR)1, (APTR)2);
 164                 mybug(-1, ("Sent connect event for 2\n"));
 165             }
 166
 167             arosxc = arosxb->arosxc_3;
 168             if( (((msgmask>>28) & 8) && (arosxc->status.connected)) ) {
 169                 AROSXClass_SendEvent(arosxb, ((8<<28) | ((arosxc->controller_type)<<20) | AROSX_EHMF_CONNECT), (APTR)1, (APTR)2);
 170                 mybug(-1, ("Sent connect event for 3\n"));
 171             }
 172
 173             ReleaseSemaphore(&arosxb->arosxc_lock);
 174
 175         }
 176
 177     }
 178
 179     return(eh);
 180     AROS_LIBFUNC_EXIT
 181 }
 182
 183 AROS_LH1(void, AROSX_RemEventHandler,
 184          AROS_LHA(struct AROSX_EventHook *, eh, A0),
 185          struct AROSXBase *, base, 6, lib)
 186 {
 187     AROS_LIBFUNC_INIT
 188
 189     struct AROSXClassBase *arosxb;
 190     arosxb = base->arosxb;
 191
 192     struct Message *msg;
 193
 194     mybug(-1, ("AROSX_RemEventHandler(%p)\n", eh));
 195     if(!eh) {
 196         return;
 197     }
 198
 199     ObtainSemaphore(&arosxb->event_lock);
 200     Remove(&eh->eh_Node);
 201     while((msg = GetMsg(eh->eh_MsgPort))) {
 202         ReplyMsg(msg);
 203     }
 204     ReleaseSemaphore(&arosxb->event_lock);
 205
 206     mybug(-1, ("AROSX_RemEventHandler garbage collector\n"));
 207
 208     struct AROSX_EventNote *en;
 209     while((en = (struct AROSX_EventNote *) GetMsg(&arosxb->event_reply_port))) {
 210         mybug(-1, ("    Free AROSX_EventNote(%p)\n", en));
 211         FreeVec(en);
 212     }
 213
 214     FreeVec(eh);
 215
 216     AROS_LIBFUNC_EXIT
 217 }
 218
 219
 220
 221
 222 static const APTR libFuncTable[] = {
 223     &AROS_SLIB_ENTRY(libOpen, lib, 1),
 224     &AROS_SLIB_ENTRY(libClose, lib, 2),
 225     &AROS_SLIB_ENTRY(libExpunge, lib, 3),
 226     &AROS_SLIB_ENTRY(libReserved, lib, 4),
 227     &AROS_SLIB_ENTRY(AROSX_AddEventHandler, lib, 5),
 228     &AROS_SLIB_ENTRY(AROSX_RemEventHandler, lib, 6),
 229     (APTR) -1,
 230 };
 231
 232 struct AROSXBase * AROSXInit(void) {
 233
 234     struct AROSXBase *lib;
 235
 236     mybug(-1,("AROSXInit\n"));
 237
 238     if((lib = (struct AROSXBase *)MakeLibrary((APTR) libFuncTable, NULL, (APTR) libInit, sizeof(struct AROSXBase), NULL))) {
 239         Forbid();
 240         AddLibrary((struct Library *)lib);
 241         lib->arosx_LibNode.lib_OpenCnt++;
 242         Permit();
 243     } else {
 244         mybug(-1, ("failed to create arosx.library\n"));
 245     }
 246
 247     mybug(-1,("AROSXInit base 0x%08lx\n", lib));
 248     mybug(-1,("AROSXInit done\n"));
 249
 250     return lib;
 251 }