3 * Author Karsten Keil <kkeil@novell.com>
5 * Copyright 2008 by Karsten Keil <kkeil@novell.com>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
19 #include <linux/slab.h>
20 #include <linux/module.h>
21 #include <linux/mISDNhw.h>
31 struct FsmTimer timer;
34 dchannel_l1callback *dcb;
37 #define TIMER3_VALUE 7000
40 struct Fsm l1fsm_s = {NULL, 0, 0, NULL, NULL};
52 #define L1S_STATE_COUNT (ST_L1_F8 + 1)
54 static char *strL1SState[] =
80 #define L1_EVENT_COUNT (EV_TIMER3 + 1)
82 static char *strL1Event[] =
99 l1m_debug(struct FsmInst *fi, char *fmt, ...)
101 struct layer1 *l1 = fi->userdata;
102 struct va_format vaf;
110 printk(KERN_DEBUG "%s: %pV\n", dev_name(&l1->dch->dev.dev), &vaf);
116 l1_reset(struct FsmInst *fi, int event, void *arg)
118 mISDN_FsmChangeState(fi, ST_L1_F3);
122 l1_deact_cnf(struct FsmInst *fi, int event, void *arg)
124 struct layer1 *l1 = fi->userdata;
126 mISDN_FsmChangeState(fi, ST_L1_F3);
127 if (test_bit(FLG_L1_ACTIVATING, &l1->Flags))
128 l1->dcb(l1->dch, HW_POWERUP_REQ);
132 l1_deact_req_s(struct FsmInst *fi, int event, void *arg)
134 struct layer1 *l1 = fi->userdata;
136 mISDN_FsmChangeState(fi, ST_L1_F3);
137 mISDN_FsmRestartTimer(&l1->timer, 550, EV_TIMER_DEACT, NULL, 2);
138 test_and_set_bit(FLG_L1_DEACTTIMER, &l1->Flags);
142 l1_power_up_s(struct FsmInst *fi, int event, void *arg)
144 struct layer1 *l1 = fi->userdata;
146 if (test_bit(FLG_L1_ACTIVATING, &l1->Flags)) {
147 mISDN_FsmChangeState(fi, ST_L1_F4);
148 l1->dcb(l1->dch, INFO3_P8);
150 mISDN_FsmChangeState(fi, ST_L1_F3);
154 l1_go_F5(struct FsmInst *fi, int event, void *arg)
156 mISDN_FsmChangeState(fi, ST_L1_F5);
160 l1_go_F8(struct FsmInst *fi, int event, void *arg)
162 mISDN_FsmChangeState(fi, ST_L1_F8);
166 l1_info2_ind(struct FsmInst *fi, int event, void *arg)
168 struct layer1 *l1 = fi->userdata;
170 mISDN_FsmChangeState(fi, ST_L1_F6);
171 l1->dcb(l1->dch, INFO3_P8);
175 l1_info4_ind(struct FsmInst *fi, int event, void *arg)
177 struct layer1 *l1 = fi->userdata;
179 mISDN_FsmChangeState(fi, ST_L1_F7);
180 l1->dcb(l1->dch, INFO3_P8);
181 if (test_and_clear_bit(FLG_L1_DEACTTIMER, &l1->Flags))
182 mISDN_FsmDelTimer(&l1->timer, 4);
183 if (!test_bit(FLG_L1_ACTIVATED, &l1->Flags)) {
184 if (test_and_clear_bit(FLG_L1_T3RUN, &l1->Flags))
185 mISDN_FsmDelTimer(&l1->timer, 3);
186 mISDN_FsmRestartTimer(&l1->timer, 110, EV_TIMER_ACT, NULL, 2);
187 test_and_set_bit(FLG_L1_ACTTIMER, &l1->Flags);
192 l1_timer3(struct FsmInst *fi, int event, void *arg)
194 struct layer1 *l1 = fi->userdata;
196 test_and_clear_bit(FLG_L1_T3RUN, &l1->Flags);
197 if (test_and_clear_bit(FLG_L1_ACTIVATING, &l1->Flags)) {
198 if (test_and_clear_bit(FLG_L1_DBLOCKED, &l1->Flags))
199 l1->dcb(l1->dch, HW_D_NOBLOCKED);
200 l1->dcb(l1->dch, PH_DEACTIVATE_IND);
202 if (l1->l1m.state != ST_L1_F6) {
203 mISDN_FsmChangeState(fi, ST_L1_F3);
204 l1->dcb(l1->dch, HW_POWERUP_REQ);
209 l1_timer_act(struct FsmInst *fi, int event, void *arg)
211 struct layer1 *l1 = fi->userdata;
213 test_and_clear_bit(FLG_L1_ACTTIMER, &l1->Flags);
214 test_and_set_bit(FLG_L1_ACTIVATED, &l1->Flags);
215 l1->dcb(l1->dch, PH_ACTIVATE_IND);
219 l1_timer_deact(struct FsmInst *fi, int event, void *arg)
221 struct layer1 *l1 = fi->userdata;
223 test_and_clear_bit(FLG_L1_DEACTTIMER, &l1->Flags);
224 test_and_clear_bit(FLG_L1_ACTIVATED, &l1->Flags);
225 if (test_and_clear_bit(FLG_L1_DBLOCKED, &l1->Flags))
226 l1->dcb(l1->dch, HW_D_NOBLOCKED);
227 l1->dcb(l1->dch, PH_DEACTIVATE_IND);
228 l1->dcb(l1->dch, HW_DEACT_REQ);
232 l1_activate_s(struct FsmInst *fi, int event, void *arg)
234 struct layer1 *l1 = fi->userdata;
236 mISDN_FsmRestartTimer(&l1->timer, TIMER3_VALUE, EV_TIMER3, NULL, 2);
237 test_and_set_bit(FLG_L1_T3RUN, &l1->Flags);
238 l1->dcb(l1->dch, HW_RESET_REQ);
242 l1_activate_no(struct FsmInst *fi, int event, void *arg)
244 struct layer1 *l1 = fi->userdata;
246 if ((!test_bit(FLG_L1_DEACTTIMER, &l1->Flags)) &&
247 (!test_bit(FLG_L1_T3RUN, &l1->Flags))) {
248 test_and_clear_bit(FLG_L1_ACTIVATING, &l1->Flags);
249 if (test_and_clear_bit(FLG_L1_DBLOCKED, &l1->Flags))
250 l1->dcb(l1->dch, HW_D_NOBLOCKED);
251 l1->dcb(l1->dch, PH_DEACTIVATE_IND);
255 static struct FsmNode L1SFnList[] =
257 {ST_L1_F3, EV_PH_ACTIVATE, l1_activate_s},
258 {ST_L1_F6, EV_PH_ACTIVATE, l1_activate_no},
259 {ST_L1_F8, EV_PH_ACTIVATE, l1_activate_no},
260 {ST_L1_F3, EV_RESET_IND, l1_reset},
261 {ST_L1_F4, EV_RESET_IND, l1_reset},
262 {ST_L1_F5, EV_RESET_IND, l1_reset},
263 {ST_L1_F6, EV_RESET_IND, l1_reset},
264 {ST_L1_F7, EV_RESET_IND, l1_reset},
265 {ST_L1_F8, EV_RESET_IND, l1_reset},
266 {ST_L1_F3, EV_DEACT_CNF, l1_deact_cnf},
267 {ST_L1_F4, EV_DEACT_CNF, l1_deact_cnf},
268 {ST_L1_F5, EV_DEACT_CNF, l1_deact_cnf},
269 {ST_L1_F6, EV_DEACT_CNF, l1_deact_cnf},
270 {ST_L1_F7, EV_DEACT_CNF, l1_deact_cnf},
271 {ST_L1_F8, EV_DEACT_CNF, l1_deact_cnf},
272 {ST_L1_F6, EV_DEACT_IND, l1_deact_req_s},
273 {ST_L1_F7, EV_DEACT_IND, l1_deact_req_s},
274 {ST_L1_F8, EV_DEACT_IND, l1_deact_req_s},
275 {ST_L1_F3, EV_POWER_UP, l1_power_up_s},
276 {ST_L1_F4, EV_ANYSIG_IND, l1_go_F5},
277 {ST_L1_F6, EV_ANYSIG_IND, l1_go_F8},
278 {ST_L1_F7, EV_ANYSIG_IND, l1_go_F8},
279 {ST_L1_F3, EV_INFO2_IND, l1_info2_ind},
280 {ST_L1_F4, EV_INFO2_IND, l1_info2_ind},
281 {ST_L1_F5, EV_INFO2_IND, l1_info2_ind},
282 {ST_L1_F7, EV_INFO2_IND, l1_info2_ind},
283 {ST_L1_F8, EV_INFO2_IND, l1_info2_ind},
284 {ST_L1_F3, EV_INFO4_IND, l1_info4_ind},
285 {ST_L1_F4, EV_INFO4_IND, l1_info4_ind},
286 {ST_L1_F5, EV_INFO4_IND, l1_info4_ind},
287 {ST_L1_F6, EV_INFO4_IND, l1_info4_ind},
288 {ST_L1_F8, EV_INFO4_IND, l1_info4_ind},
289 {ST_L1_F3, EV_TIMER3, l1_timer3},
290 {ST_L1_F4, EV_TIMER3, l1_timer3},
291 {ST_L1_F5, EV_TIMER3, l1_timer3},
292 {ST_L1_F6, EV_TIMER3, l1_timer3},
293 {ST_L1_F8, EV_TIMER3, l1_timer3},
294 {ST_L1_F7, EV_TIMER_ACT, l1_timer_act},
295 {ST_L1_F3, EV_TIMER_DEACT, l1_timer_deact},
296 {ST_L1_F4, EV_TIMER_DEACT, l1_timer_deact},
297 {ST_L1_F5, EV_TIMER_DEACT, l1_timer_deact},
298 {ST_L1_F6, EV_TIMER_DEACT, l1_timer_deact},
299 {ST_L1_F7, EV_TIMER_DEACT, l1_timer_deact},
300 {ST_L1_F8, EV_TIMER_DEACT, l1_timer_deact},
304 release_l1(struct layer1 *l1) {
305 mISDN_FsmDelTimer(&l1->timer, 0);
308 module_put(THIS_MODULE);
313 l1_event(struct layer1 *l1, u_int event)
321 mISDN_FsmEvent(&l1->l1m, EV_RESET_IND, NULL);
324 mISDN_FsmEvent(&l1->l1m, EV_DEACT_IND, NULL);
327 mISDN_FsmEvent(&l1->l1m, EV_POWER_UP, NULL);
330 mISDN_FsmEvent(&l1->l1m, EV_DEACT_CNF, NULL);
333 mISDN_FsmEvent(&l1->l1m, EV_ANYSIG_IND, NULL);
336 mISDN_FsmEvent(&l1->l1m, EV_ANYSIG_IND, NULL);
339 mISDN_FsmEvent(&l1->l1m, EV_INFO2_IND, NULL);
342 mISDN_FsmEvent(&l1->l1m, EV_INFO4_IND, NULL);
345 mISDN_FsmEvent(&l1->l1m, EV_INFO4_IND, NULL);
347 case PH_ACTIVATE_REQ:
348 if (test_bit(FLG_L1_ACTIVATED, &l1->Flags))
349 l1->dcb(l1->dch, PH_ACTIVATE_IND);
351 test_and_set_bit(FLG_L1_ACTIVATING, &l1->Flags);
352 mISDN_FsmEvent(&l1->l1m, EV_PH_ACTIVATE, NULL);
359 if (*debug & DEBUG_L1)
360 printk(KERN_DEBUG "%s %x unhandled\n",
366 EXPORT_SYMBOL(l1_event);
369 create_l1(struct dchannel *dch, dchannel_l1callback *dcb) {
372 nl1 = kzalloc(sizeof(struct layer1), GFP_ATOMIC);
374 printk(KERN_ERR "kmalloc struct layer1 failed\n");
377 nl1->l1m.fsm = &l1fsm_s;
378 nl1->l1m.state = ST_L1_F3;
380 nl1->l1m.debug = *debug & DEBUG_L1_FSM;
381 nl1->l1m.userdata = nl1;
382 nl1->l1m.userint = 0;
383 nl1->l1m.printdebug = l1m_debug;
386 mISDN_FsmInitTimer(&nl1->l1m, &nl1->timer);
387 __module_get(THIS_MODULE);
391 EXPORT_SYMBOL(create_l1);
397 l1fsm_s.state_count = L1S_STATE_COUNT;
398 l1fsm_s.event_count = L1_EVENT_COUNT;
399 l1fsm_s.strEvent = strL1Event;
400 l1fsm_s.strState = strL1SState;
401 mISDN_FsmNew(&l1fsm_s, L1SFnList, ARRAY_SIZE(L1SFnList));
408 mISDN_FsmFree(&l1fsm_s);