arch/m68k-amiga/card/task.c

   1 /*
   2     Copyright © 1995-2011, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc:
   6     Lang: English
   7 */
   8
   9 #include <exec/types.h>
  10 #include <proto/exec.h>
  11 #include <devices/timer.h>
  12
  13 #include "card_intern.h"
  14
  15 void pcmcia_newowner(struct CardResource *CardResource, BOOL doNotify)
  16 {
  17     struct CardHandle *handle = NULL, *nexthandle;
  18     CARDDEBUG(bug("pcmcia_newowner: n=%d owned=%x rem=%d listempty=%d\n",
  19         doNotify, CardResource->ownedcard, CardResource->removed, IsListEmpty(&CardResource->handles)));
  20     Forbid();
  21     ForeachNode(&CardResource->handles, nexthandle) {
  22         CARDDEBUG(bug("Possible node %p flags %02x\n", nexthandle, nexthandle->cah_CardFlags));
  23         if (!(nexthandle->cah_CardFlags & CARDF_USED)) {
  24             handle = nexthandle;
  25             break;
  26         }
  27     }
  28     if (handle != NULL && CardResource->ownedcard == NULL && CardResource->removed == FALSE) {
  29         CardResource->ownedcard = handle;
  30         CardResource->resetberr = (CardResource->ownedcard->cah_CardFlags & CARDF_RESETREMOVE) ? GAYLE_IRQ_RESET : 0;
  31         CARDDEBUG(bug("pcmcia_newowner: %p\n", CardResource->ownedcard));
  32         CardResource->ownedcard->cah_CardFlags |= CARDF_USED;
  33         if (doNotify && CardResource->ownedcard->cah_CardInserted) {
  34             CARDDEBUG(bug("Executing cah_CardInserted(%p, %p)\n",
  35                 CardResource->ownedcard->cah_CardInserted->is_Data,
  36                 CardResource->ownedcard->cah_CardInserted->is_Code));
  37                 AROS_CARDC(CardResource->ownedcard->cah_CardInserted->is_Code,
  38                            CardResource->ownedcard->cah_CardInserted->is_Data, 0);
  39         }
  40     }
  41     Permit();
  42 }
  43
  44 void pcmcia_removeowner(struct CardResource *CardResource)
  45 {
  46     CARDDEBUG(bug("pcmcia_removeowner: owned=%p\n", CardResource->ownedcard));
  47     Forbid();
  48     if (CardResource->ownedcard != NULL) {
  49         if (CardResource->ownedcard->cah_CardRemoved) {
  50             CARDDEBUG(bug("Executing cah_CardRemoved(%p, %p)\n",
  51                 CardResource->ownedcard->cah_CardRemoved->is_Data,
  52                 CardResource->ownedcard->cah_CardRemoved->is_Code));
  53                 AROS_CARDC(CardResource->ownedcard->cah_CardRemoved->is_Code,
  54                            CardResource->ownedcard->cah_CardRemoved->is_Data, 0);
  55         }
  56     }
  57     Permit();
  58 }
  59
  60 void CardTask(struct Task *parent, struct CardResource *CardResource)
  61 {
  62     UBYTE signal;
  63
  64     signal = AllocSignal(-1);
  65     CardResource->signalmask = 1 << signal;
  66
  67     CardResource->timermp = CreateMsgPort();
  68     CardResource->timerio = (struct timerequest*) CreateIORequest(CardResource->timermp, sizeof(struct timerequest));
  69     if (!CardResource->timermp || !CardResource->timerio)
  70         Alert(AT_DeadEnd | AG_NoMemory);
  71     if (OpenDevice("timer.device", UNIT_MICROHZ, (struct IORequest*)CardResource->timerio, 0))
  72         Alert(AT_DeadEnd | AG_OpenDev);
  73
  74     Signal(parent, SIGBREAKF_CTRL_F);
  75
  76     for (;;) {
  77         UBYTE status;
  78         BOOL gotstatus;
  79
  80         Wait(CardResource->signalmask);
  81
  82         CARDDEBUG(bug("CardTask woken up\n"));
  83
  84         CardResource->changecount++;
  85
  86         Forbid();
  87         /* Removal */
  88         if (CardResource->removed == FALSE) {
  89             CardResource->removed = TRUE;
  90             pcmcia_removeowner(CardResource);
  91         }
  92         Permit();
  93
  94         gotstatus = FALSE;
  95         status = 0;
  96         /* Debounce wait, not sure if needed */
  97         for (;;) {
  98             CardResource->timerio->tr_node.io_Command = TR_ADDREQUEST;
  99             CardResource->timerio->tr_time.tv_secs = 0;
 100             CardResource->timerio->tr_time.tv_micro = 100000;
 101             DoIO((struct IORequest*)CardResource->timerio);
 102             if (gotstatus && status == pcmcia_havecard())
 103                 break;
 104             status = pcmcia_havecard();
 105             gotstatus = TRUE;
 106         }
 107
 108         CARDDEBUG(bug("PCMCIA changecnt=%d removed=%d\n", CardResource->changecount, status == FALSE));
 109
 110         CardResource->timerio->tr_time.tv_secs = 0;
 111         CardResource->timerio->tr_time.tv_micro = 10000;
 112         DoIO((struct IORequest*)CardResource->timerio);
 113
 114         SetSignal(0, CardResource->signalmask);
 115
 116         CardResource->removed = status == FALSE;
 117
 118         pcmcia_reset(CardResource);
 119
 120         CardResource->disabled = FALSE;
 121         pcmcia_clear_requests(CardResource);
 122         pcmcia_enable_interrupts();
 123
 124         /* Insert */
 125         Forbid();
 126         if (CardResource->removed == FALSE) {
 127             pcmcia_cardreset(CardResource);
 128             pcmcia_newowner(CardResource, TRUE);
 129         }
 130         Permit();
 131
 132     }
 133 }