mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-21 15:00:42 +07:00
54a6a043fb
If mISDN_FsmNew() fails to allocate memory for jumpmatrix then null pointer dereference will occur on any write to jumpmatrix. The patch adds check on successful allocation and corresponding error handling. Found by Linux Driver Verification project (linuxtesting.org). Signed-off-by: Anton Vasilyev <vasilyev@ispras.ru> Signed-off-by: David S. Miller <davem@davemloft.net>
425 lines
9.7 KiB
C
425 lines
9.7 KiB
C
/*
|
|
*
|
|
* Author Karsten Keil <kkeil@novell.com>
|
|
*
|
|
* Copyright 2008 by Karsten Keil <kkeil@novell.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
*/
|
|
|
|
|
|
#include <linux/slab.h>
|
|
#include <linux/module.h>
|
|
#include <linux/mISDNhw.h>
|
|
#include "core.h"
|
|
#include "layer1.h"
|
|
#include "fsm.h"
|
|
|
|
static u_int *debug;
|
|
|
|
struct layer1 {
|
|
u_long Flags;
|
|
struct FsmInst l1m;
|
|
struct FsmTimer timer3;
|
|
struct FsmTimer timerX;
|
|
int delay;
|
|
int t3_value;
|
|
struct dchannel *dch;
|
|
dchannel_l1callback *dcb;
|
|
};
|
|
|
|
#define TIMER3_DEFAULT_VALUE 7000
|
|
|
|
static
|
|
struct Fsm l1fsm_s = {NULL, 0, 0, NULL, NULL};
|
|
|
|
enum {
|
|
ST_L1_F2,
|
|
ST_L1_F3,
|
|
ST_L1_F4,
|
|
ST_L1_F5,
|
|
ST_L1_F6,
|
|
ST_L1_F7,
|
|
ST_L1_F8,
|
|
};
|
|
|
|
#define L1S_STATE_COUNT (ST_L1_F8 + 1)
|
|
|
|
static char *strL1SState[] =
|
|
{
|
|
"ST_L1_F2",
|
|
"ST_L1_F3",
|
|
"ST_L1_F4",
|
|
"ST_L1_F5",
|
|
"ST_L1_F6",
|
|
"ST_L1_F7",
|
|
"ST_L1_F8",
|
|
};
|
|
|
|
enum {
|
|
EV_PH_ACTIVATE,
|
|
EV_PH_DEACTIVATE,
|
|
EV_RESET_IND,
|
|
EV_DEACT_CNF,
|
|
EV_DEACT_IND,
|
|
EV_POWER_UP,
|
|
EV_ANYSIG_IND,
|
|
EV_INFO2_IND,
|
|
EV_INFO4_IND,
|
|
EV_TIMER_DEACT,
|
|
EV_TIMER_ACT,
|
|
EV_TIMER3,
|
|
};
|
|
|
|
#define L1_EVENT_COUNT (EV_TIMER3 + 1)
|
|
|
|
static char *strL1Event[] =
|
|
{
|
|
"EV_PH_ACTIVATE",
|
|
"EV_PH_DEACTIVATE",
|
|
"EV_RESET_IND",
|
|
"EV_DEACT_CNF",
|
|
"EV_DEACT_IND",
|
|
"EV_POWER_UP",
|
|
"EV_ANYSIG_IND",
|
|
"EV_INFO2_IND",
|
|
"EV_INFO4_IND",
|
|
"EV_TIMER_DEACT",
|
|
"EV_TIMER_ACT",
|
|
"EV_TIMER3",
|
|
};
|
|
|
|
static void
|
|
l1m_debug(struct FsmInst *fi, char *fmt, ...)
|
|
{
|
|
struct layer1 *l1 = fi->userdata;
|
|
struct va_format vaf;
|
|
va_list va;
|
|
|
|
va_start(va, fmt);
|
|
|
|
vaf.fmt = fmt;
|
|
vaf.va = &va;
|
|
|
|
printk(KERN_DEBUG "%s: %pV\n", dev_name(&l1->dch->dev.dev), &vaf);
|
|
|
|
va_end(va);
|
|
}
|
|
|
|
static void
|
|
l1_reset(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
mISDN_FsmChangeState(fi, ST_L1_F3);
|
|
}
|
|
|
|
static void
|
|
l1_deact_cnf(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
struct layer1 *l1 = fi->userdata;
|
|
|
|
mISDN_FsmChangeState(fi, ST_L1_F3);
|
|
if (test_bit(FLG_L1_ACTIVATING, &l1->Flags))
|
|
l1->dcb(l1->dch, HW_POWERUP_REQ);
|
|
}
|
|
|
|
static void
|
|
l1_deact_req_s(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
struct layer1 *l1 = fi->userdata;
|
|
|
|
mISDN_FsmChangeState(fi, ST_L1_F3);
|
|
mISDN_FsmRestartTimer(&l1->timerX, 550, EV_TIMER_DEACT, NULL, 2);
|
|
test_and_set_bit(FLG_L1_DEACTTIMER, &l1->Flags);
|
|
}
|
|
|
|
static void
|
|
l1_power_up_s(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
struct layer1 *l1 = fi->userdata;
|
|
|
|
if (test_bit(FLG_L1_ACTIVATING, &l1->Flags)) {
|
|
mISDN_FsmChangeState(fi, ST_L1_F4);
|
|
l1->dcb(l1->dch, INFO3_P8);
|
|
} else
|
|
mISDN_FsmChangeState(fi, ST_L1_F3);
|
|
}
|
|
|
|
static void
|
|
l1_go_F5(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
mISDN_FsmChangeState(fi, ST_L1_F5);
|
|
}
|
|
|
|
static void
|
|
l1_go_F8(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
mISDN_FsmChangeState(fi, ST_L1_F8);
|
|
}
|
|
|
|
static void
|
|
l1_info2_ind(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
struct layer1 *l1 = fi->userdata;
|
|
|
|
mISDN_FsmChangeState(fi, ST_L1_F6);
|
|
l1->dcb(l1->dch, INFO3_P8);
|
|
}
|
|
|
|
static void
|
|
l1_info4_ind(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
struct layer1 *l1 = fi->userdata;
|
|
|
|
mISDN_FsmChangeState(fi, ST_L1_F7);
|
|
l1->dcb(l1->dch, INFO3_P8);
|
|
if (test_and_clear_bit(FLG_L1_DEACTTIMER, &l1->Flags))
|
|
mISDN_FsmDelTimer(&l1->timerX, 4);
|
|
if (!test_bit(FLG_L1_ACTIVATED, &l1->Flags)) {
|
|
if (test_and_clear_bit(FLG_L1_T3RUN, &l1->Flags))
|
|
mISDN_FsmDelTimer(&l1->timer3, 3);
|
|
mISDN_FsmRestartTimer(&l1->timerX, 110, EV_TIMER_ACT, NULL, 2);
|
|
test_and_set_bit(FLG_L1_ACTTIMER, &l1->Flags);
|
|
}
|
|
}
|
|
|
|
static void
|
|
l1_timer3(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
struct layer1 *l1 = fi->userdata;
|
|
|
|
test_and_clear_bit(FLG_L1_T3RUN, &l1->Flags);
|
|
if (test_and_clear_bit(FLG_L1_ACTIVATING, &l1->Flags)) {
|
|
if (test_and_clear_bit(FLG_L1_DBLOCKED, &l1->Flags))
|
|
l1->dcb(l1->dch, HW_D_NOBLOCKED);
|
|
l1->dcb(l1->dch, PH_DEACTIVATE_IND);
|
|
}
|
|
if (l1->l1m.state != ST_L1_F6) {
|
|
mISDN_FsmChangeState(fi, ST_L1_F3);
|
|
/* do not force anything here, we need send INFO 0 */
|
|
}
|
|
}
|
|
|
|
static void
|
|
l1_timer_act(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
struct layer1 *l1 = fi->userdata;
|
|
|
|
test_and_clear_bit(FLG_L1_ACTTIMER, &l1->Flags);
|
|
test_and_set_bit(FLG_L1_ACTIVATED, &l1->Flags);
|
|
l1->dcb(l1->dch, PH_ACTIVATE_IND);
|
|
}
|
|
|
|
static void
|
|
l1_timer_deact(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
struct layer1 *l1 = fi->userdata;
|
|
|
|
test_and_clear_bit(FLG_L1_DEACTTIMER, &l1->Flags);
|
|
test_and_clear_bit(FLG_L1_ACTIVATED, &l1->Flags);
|
|
if (test_and_clear_bit(FLG_L1_DBLOCKED, &l1->Flags))
|
|
l1->dcb(l1->dch, HW_D_NOBLOCKED);
|
|
l1->dcb(l1->dch, PH_DEACTIVATE_IND);
|
|
l1->dcb(l1->dch, HW_DEACT_REQ);
|
|
}
|
|
|
|
static void
|
|
l1_activate_s(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
struct layer1 *l1 = fi->userdata;
|
|
|
|
mISDN_FsmRestartTimer(&l1->timer3, l1->t3_value, EV_TIMER3, NULL, 2);
|
|
test_and_set_bit(FLG_L1_T3RUN, &l1->Flags);
|
|
/* Tell HW to send INFO 1 */
|
|
l1->dcb(l1->dch, HW_RESET_REQ);
|
|
}
|
|
|
|
static void
|
|
l1_activate_no(struct FsmInst *fi, int event, void *arg)
|
|
{
|
|
struct layer1 *l1 = fi->userdata;
|
|
|
|
if ((!test_bit(FLG_L1_DEACTTIMER, &l1->Flags)) &&
|
|
(!test_bit(FLG_L1_T3RUN, &l1->Flags))) {
|
|
test_and_clear_bit(FLG_L1_ACTIVATING, &l1->Flags);
|
|
if (test_and_clear_bit(FLG_L1_DBLOCKED, &l1->Flags))
|
|
l1->dcb(l1->dch, HW_D_NOBLOCKED);
|
|
l1->dcb(l1->dch, PH_DEACTIVATE_IND);
|
|
}
|
|
}
|
|
|
|
static struct FsmNode L1SFnList[] =
|
|
{
|
|
{ST_L1_F3, EV_PH_ACTIVATE, l1_activate_s},
|
|
{ST_L1_F6, EV_PH_ACTIVATE, l1_activate_no},
|
|
{ST_L1_F8, EV_PH_ACTIVATE, l1_activate_no},
|
|
{ST_L1_F3, EV_RESET_IND, l1_reset},
|
|
{ST_L1_F4, EV_RESET_IND, l1_reset},
|
|
{ST_L1_F5, EV_RESET_IND, l1_reset},
|
|
{ST_L1_F6, EV_RESET_IND, l1_reset},
|
|
{ST_L1_F7, EV_RESET_IND, l1_reset},
|
|
{ST_L1_F8, EV_RESET_IND, l1_reset},
|
|
{ST_L1_F3, EV_DEACT_CNF, l1_deact_cnf},
|
|
{ST_L1_F4, EV_DEACT_CNF, l1_deact_cnf},
|
|
{ST_L1_F5, EV_DEACT_CNF, l1_deact_cnf},
|
|
{ST_L1_F6, EV_DEACT_CNF, l1_deact_cnf},
|
|
{ST_L1_F7, EV_DEACT_CNF, l1_deact_cnf},
|
|
{ST_L1_F8, EV_DEACT_CNF, l1_deact_cnf},
|
|
{ST_L1_F6, EV_DEACT_IND, l1_deact_req_s},
|
|
{ST_L1_F7, EV_DEACT_IND, l1_deact_req_s},
|
|
{ST_L1_F8, EV_DEACT_IND, l1_deact_req_s},
|
|
{ST_L1_F3, EV_POWER_UP, l1_power_up_s},
|
|
{ST_L1_F4, EV_ANYSIG_IND, l1_go_F5},
|
|
{ST_L1_F6, EV_ANYSIG_IND, l1_go_F8},
|
|
{ST_L1_F7, EV_ANYSIG_IND, l1_go_F8},
|
|
{ST_L1_F3, EV_INFO2_IND, l1_info2_ind},
|
|
{ST_L1_F4, EV_INFO2_IND, l1_info2_ind},
|
|
{ST_L1_F5, EV_INFO2_IND, l1_info2_ind},
|
|
{ST_L1_F7, EV_INFO2_IND, l1_info2_ind},
|
|
{ST_L1_F8, EV_INFO2_IND, l1_info2_ind},
|
|
{ST_L1_F3, EV_INFO4_IND, l1_info4_ind},
|
|
{ST_L1_F4, EV_INFO4_IND, l1_info4_ind},
|
|
{ST_L1_F5, EV_INFO4_IND, l1_info4_ind},
|
|
{ST_L1_F6, EV_INFO4_IND, l1_info4_ind},
|
|
{ST_L1_F8, EV_INFO4_IND, l1_info4_ind},
|
|
{ST_L1_F3, EV_TIMER3, l1_timer3},
|
|
{ST_L1_F4, EV_TIMER3, l1_timer3},
|
|
{ST_L1_F5, EV_TIMER3, l1_timer3},
|
|
{ST_L1_F6, EV_TIMER3, l1_timer3},
|
|
{ST_L1_F8, EV_TIMER3, l1_timer3},
|
|
{ST_L1_F7, EV_TIMER_ACT, l1_timer_act},
|
|
{ST_L1_F3, EV_TIMER_DEACT, l1_timer_deact},
|
|
{ST_L1_F4, EV_TIMER_DEACT, l1_timer_deact},
|
|
{ST_L1_F5, EV_TIMER_DEACT, l1_timer_deact},
|
|
{ST_L1_F6, EV_TIMER_DEACT, l1_timer_deact},
|
|
{ST_L1_F7, EV_TIMER_DEACT, l1_timer_deact},
|
|
{ST_L1_F8, EV_TIMER_DEACT, l1_timer_deact},
|
|
};
|
|
|
|
static void
|
|
release_l1(struct layer1 *l1) {
|
|
mISDN_FsmDelTimer(&l1->timerX, 0);
|
|
mISDN_FsmDelTimer(&l1->timer3, 0);
|
|
if (l1->dch)
|
|
l1->dch->l1 = NULL;
|
|
module_put(THIS_MODULE);
|
|
kfree(l1);
|
|
}
|
|
|
|
int
|
|
l1_event(struct layer1 *l1, u_int event)
|
|
{
|
|
int err = 0;
|
|
|
|
if (!l1)
|
|
return -EINVAL;
|
|
switch (event) {
|
|
case HW_RESET_IND:
|
|
mISDN_FsmEvent(&l1->l1m, EV_RESET_IND, NULL);
|
|
break;
|
|
case HW_DEACT_IND:
|
|
mISDN_FsmEvent(&l1->l1m, EV_DEACT_IND, NULL);
|
|
break;
|
|
case HW_POWERUP_IND:
|
|
mISDN_FsmEvent(&l1->l1m, EV_POWER_UP, NULL);
|
|
break;
|
|
case HW_DEACT_CNF:
|
|
mISDN_FsmEvent(&l1->l1m, EV_DEACT_CNF, NULL);
|
|
break;
|
|
case ANYSIGNAL:
|
|
mISDN_FsmEvent(&l1->l1m, EV_ANYSIG_IND, NULL);
|
|
break;
|
|
case LOSTFRAMING:
|
|
mISDN_FsmEvent(&l1->l1m, EV_ANYSIG_IND, NULL);
|
|
break;
|
|
case INFO2:
|
|
mISDN_FsmEvent(&l1->l1m, EV_INFO2_IND, NULL);
|
|
break;
|
|
case INFO4_P8:
|
|
mISDN_FsmEvent(&l1->l1m, EV_INFO4_IND, NULL);
|
|
break;
|
|
case INFO4_P10:
|
|
mISDN_FsmEvent(&l1->l1m, EV_INFO4_IND, NULL);
|
|
break;
|
|
case PH_ACTIVATE_REQ:
|
|
if (test_bit(FLG_L1_ACTIVATED, &l1->Flags))
|
|
l1->dcb(l1->dch, PH_ACTIVATE_IND);
|
|
else {
|
|
test_and_set_bit(FLG_L1_ACTIVATING, &l1->Flags);
|
|
mISDN_FsmEvent(&l1->l1m, EV_PH_ACTIVATE, NULL);
|
|
}
|
|
break;
|
|
case CLOSE_CHANNEL:
|
|
release_l1(l1);
|
|
break;
|
|
default:
|
|
if ((event & ~HW_TIMER3_VMASK) == HW_TIMER3_VALUE) {
|
|
int val = event & HW_TIMER3_VMASK;
|
|
|
|
if (val < 5)
|
|
val = 5;
|
|
if (val > 30)
|
|
val = 30;
|
|
l1->t3_value = val;
|
|
break;
|
|
}
|
|
if (*debug & DEBUG_L1)
|
|
printk(KERN_DEBUG "%s %x unhandled\n",
|
|
__func__, event);
|
|
err = -EINVAL;
|
|
}
|
|
return err;
|
|
}
|
|
EXPORT_SYMBOL(l1_event);
|
|
|
|
int
|
|
create_l1(struct dchannel *dch, dchannel_l1callback *dcb) {
|
|
struct layer1 *nl1;
|
|
|
|
nl1 = kzalloc(sizeof(struct layer1), GFP_ATOMIC);
|
|
if (!nl1) {
|
|
printk(KERN_ERR "kmalloc struct layer1 failed\n");
|
|
return -ENOMEM;
|
|
}
|
|
nl1->l1m.fsm = &l1fsm_s;
|
|
nl1->l1m.state = ST_L1_F3;
|
|
nl1->Flags = 0;
|
|
nl1->t3_value = TIMER3_DEFAULT_VALUE;
|
|
nl1->l1m.debug = *debug & DEBUG_L1_FSM;
|
|
nl1->l1m.userdata = nl1;
|
|
nl1->l1m.userint = 0;
|
|
nl1->l1m.printdebug = l1m_debug;
|
|
nl1->dch = dch;
|
|
nl1->dcb = dcb;
|
|
mISDN_FsmInitTimer(&nl1->l1m, &nl1->timer3);
|
|
mISDN_FsmInitTimer(&nl1->l1m, &nl1->timerX);
|
|
__module_get(THIS_MODULE);
|
|
dch->l1 = nl1;
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL(create_l1);
|
|
|
|
int
|
|
l1_init(u_int *deb)
|
|
{
|
|
debug = deb;
|
|
l1fsm_s.state_count = L1S_STATE_COUNT;
|
|
l1fsm_s.event_count = L1_EVENT_COUNT;
|
|
l1fsm_s.strEvent = strL1Event;
|
|
l1fsm_s.strState = strL1SState;
|
|
return mISDN_FsmNew(&l1fsm_s, L1SFnList, ARRAY_SIZE(L1SFnList));
|
|
}
|
|
|
|
void
|
|
l1_cleanup(void)
|
|
{
|
|
mISDN_FsmFree(&l1fsm_s);
|
|
}
|