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
add_arcofi_timer(struct IsdnCardState * cs)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
send_arcofi(struct IsdnCardState * cs)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
arcofi_fsm(struct IsdnCardState * cs,int event,void * data)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
arcofi_timer(struct timer_list * t)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
clear_arcofi(struct IsdnCardState * cs)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
init_arcofi(struct IsdnCardState * cs)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 }
132