drivers/isdn/hisax/arcofi.c

   1 /* $Id: arcofi.c,v 1.14.2.3 2004/01/13 14:31:24 keil Exp $
   2  *
   3  * Ansteuerung ARCOFI 2165
   4  *
   5  * Author       Karsten Keil
   6  * Copyright    by Karsten Keil      <keil@isdn4linux.de>
   7  *
   8  * This software may be used and distributed according to the terms
   9  * of the GNU General Public License, incorporated herein by reference.
  10  *
  11  */
  12
  13 #include <linux/sched.h>
  14 #include "hisax.h"
  15 #include "isdnl1.h"
  16 #include "isac.h"
  17 #include "arcofi.h"
  18
  19 #define ARCOFI_TIMER_VALUE      20
  20
  21 static void
  22 add_arcofi_timer(struct IsdnCardState *cs) {
  23         if (test_and_set_bit(FLG_ARCOFI_TIMER, &cs->HW_Flags)) {
  24                 del_timer(&cs->dc.isac.arcofitimer);
  25         }
  26         cs->dc.isac.arcofitimer.expires = jiffies + ((ARCOFI_TIMER_VALUE * HZ) / 1000);
  27         add_timer(&cs->dc.isac.arcofitimer);
  28 }
  29
  30 static void
  31 send_arcofi(struct IsdnCardState *cs) {
  32         add_arcofi_timer(cs);
  33         cs->dc.isac.mon_txp = 0;
  34         cs->dc.isac.mon_txc = cs->dc.isac.arcofi_list->len;
  35         memcpy(cs->dc.isac.mon_tx, cs->dc.isac.arcofi_list->msg, cs->dc.isac.mon_txc);
  36         switch (cs->dc.isac.arcofi_bc) {
  37         case 0: break;
  38         case 1: cs->dc.isac.mon_tx[1] |= 0x40;
  39                 break;
  40         default: break;
  41         }
  42         cs->dc.isac.mocr &= 0x0f;
  43         cs->dc.isac.mocr |= 0xa0;
  44         cs->writeisac(cs, ISAC_MOCR, cs->dc.isac.mocr);
  45         (void) cs->readisac(cs, ISAC_MOSR);
  46         cs->writeisac(cs, ISAC_MOX1, cs->dc.isac.mon_tx[cs->dc.isac.mon_txp++]);
  47         cs->dc.isac.mocr |= 0x10;
  48         cs->writeisac(cs, ISAC_MOCR, cs->dc.isac.mocr);
  49 }
  50
  51 int
  52 arcofi_fsm(struct IsdnCardState *cs, int event, void *data) {
  53         if (cs->debug & L1_DEB_MONITOR) {
  54                 debugl1(cs, "arcofi state %d event %d", cs->dc.isac.arcofi_state, event);
  55         }
  56         if (event == ARCOFI_TIMEOUT) {
  57                 cs->dc.isac.arcofi_state = ARCOFI_NOP;
  58                 test_and_set_bit(FLG_ARCOFI_ERROR, &cs->HW_Flags);
  59                 wake_up(&cs->dc.isac.arcofi_wait);
  60                 return (1);
  61         }
  62         switch (cs->dc.isac.arcofi_state) {
  63         case ARCOFI_NOP:
  64                 if (event == ARCOFI_START) {
  65                         cs->dc.isac.arcofi_list = data;
  66                         cs->dc.isac.arcofi_state = ARCOFI_TRANSMIT;
  67                         send_arcofi(cs);
  68                 }
  69                 break;
  70         case ARCOFI_TRANSMIT:
  71                 if (event == ARCOFI_TX_END) {
  72                         if (cs->dc.isac.arcofi_list->receive) {
  73                                 add_arcofi_timer(cs);
  74                                 cs->dc.isac.arcofi_state = ARCOFI_RECEIVE;
  75                         } else {
  76                                 if (cs->dc.isac.arcofi_list->next) {
  77                                         cs->dc.isac.arcofi_list =
  78                                                 cs->dc.isac.arcofi_list->next;
  79                                         send_arcofi(cs);
  80                                 } else {
  81                                         if (test_and_clear_bit(FLG_ARCOFI_TIMER, &cs->HW_Flags)) {
  82                                                 del_timer(&cs->dc.isac.arcofitimer);
  83                                         }
  84                                         cs->dc.isac.arcofi_state = ARCOFI_NOP;
  85                                         wake_up(&cs->dc.isac.arcofi_wait);
  86                                 }
  87                         }
  88                 }
  89                 break;
  90         case ARCOFI_RECEIVE:
  91                 if (event == ARCOFI_RX_END) {
  92                         if (cs->dc.isac.arcofi_list->next) {
  93                                 cs->dc.isac.arcofi_list =
  94                                         cs->dc.isac.arcofi_list->next;
  95                                 cs->dc.isac.arcofi_state = ARCOFI_TRANSMIT;
  96                                 send_arcofi(cs);
  97                         } else {
  98                                 if (test_and_clear_bit(FLG_ARCOFI_TIMER, &cs->HW_Flags)) {
  99                                         del_timer(&cs->dc.isac.arcofitimer);
 100                                 }
 101                                 cs->dc.isac.arcofi_state = ARCOFI_NOP;
 102                                 wake_up(&cs->dc.isac.arcofi_wait);
 103                         }
 104                 }
 105                 break;
 106         default:
 107                 debugl1(cs, "Arcofi unknown state %x", cs->dc.isac.arcofi_state);
 108                 return (2);
 109         }
 110         return (0);
 111 }
 112
 113 static void
 114 arcofi_timer(struct timer_list *t) {
 115         struct IsdnCardState *cs = from_timer(cs, t, dc.isac.arcofitimer);
 116         arcofi_fsm(cs, ARCOFI_TIMEOUT, NULL);
 117 }
 118
 119 void
 120 clear_arcofi(struct IsdnCardState *cs) {
 121         if (test_and_clear_bit(FLG_ARCOFI_TIMER, &cs->HW_Flags)) {
 122                 del_timer(&cs->dc.isac.arcofitimer);
 123         }
 124 }
 125
 126 void
 127 init_arcofi(struct IsdnCardState *cs) {
 128         timer_setup(&cs->dc.isac.arcofitimer, arcofi_timer, 0);
 129         init_waitqueue_head(&cs->dc.isac.arcofi_wait);
 130         test_and_set_bit(HW_ARCOFI, &cs->HW_Flags);
 131 }