/**
@brief create a mem_link_device instance
@param type the type of a memory interface medium
@param modem the pointer to a modem_data instance (i.e. modem platform data)
*/
struct mem_link_device *mem_create_link_device(enum mem_iface_type type,
struct modem_data *modem)
{
struct mem_link_device *mld;
struct link_device *ld;
int i;
char name[MAX_NAME_LEN];
mif_err("+++\n");
if (modem->ipc_version < SIPC_VER_50) {
mif_err("%s<->%s: ERR! IPC version %d < SIPC_VER_50\n",
modem->link_name, modem->name, modem->ipc_version);
return NULL;
}
/*
** Alloc an instance of mem_link_device structure
*/
mld = kzalloc(sizeof(struct mem_link_device), GFP_KERNEL);
if (!mld) {
mif_err("%s<->%s: ERR! mld kzalloc fail\n",
modem->link_name, modem->name);
return NULL;
}
mld->type = type;
/*====================================================================*\
Initialize "memory snapshot buffer (MSB)" framework
\*====================================================================*/
if (msb_init() < 0) {
mif_err("%s<->%s: ERR! msb_init() fail\n",
modem->link_name, modem->name);
goto error;
}
/*====================================================================*\
Set attributes as a "link_device"
\*====================================================================*/
ld = &mld->link_dev;
ld->mdm_data = modem;
ld->name = modem->link_name;
ld->aligned = 1;
ld->ipc_version = modem->ipc_version;
ld->init_comm = mem_init_comm;
ld->send = mem_send;
#ifdef CONFIG_LINK_DEVICE_SHMEM
if (type == MEM_SYS_SHMEM)
ld->xmit_boot = mem_xmit_boot;
#endif
ld->dload_start = mem_start_download;
ld->firm_update = mem_update_firm_info;
ld->force_dump = mem_force_dump;
ld->dump_start = mem_start_upload;
INIT_LIST_HEAD(&ld->list);
skb_queue_head_init(&ld->sk_fmt_tx_q);
skb_queue_head_init(&ld->sk_raw_tx_q);
skb_queue_head_init(&ld->sk_fmt_rx_q);
skb_queue_head_init(&ld->sk_raw_rx_q);
init_completion(&ld->init_cmpl);
for (i = 0; i < MAX_SIPC5_DEV; i++) {
spin_lock_init(&ld->tx_lock[i]);
spin_lock_init(&ld->rx_lock[i]);
}
spin_lock_init(&ld->netif_lock);
atomic_set(&ld->netif_stopped, 0);
snprintf(name, MAX_NAME_LEN, "%s_tx_wq", ld->name);
ld->tx_wq = create_singlethread_workqueue(name);
if (!ld->tx_wq) {
mif_err("%s: ERR! fail to create tx_wq\n", ld->name);
goto error;
}
snprintf(name, MAX_NAME_LEN, "%s_rx_wq", ld->name);
ld->rx_wq = create_singlethread_workqueue(name);
if (!ld->rx_wq) {
mif_err("%s: ERR! fail to create rx_wq\n", ld->name);
goto error;
}
INIT_DELAYED_WORK(&ld->rx_delayed_work, link_to_demux_work);
/*====================================================================*\
Initialize MEM locks, completions, bottom halves, etc
\*====================================================================*/
spin_lock_init(&mld->lock);
/*
** Initialize variables for TX & RX
*/
msb_queue_head_init(&mld->msb_rxq);
msb_queue_head_init(&mld->msb_log);
tasklet_init(&mld->rx_tsk, mem_rx_task, (unsigned long)mld);
hrtimer_init(&mld->tx_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
mld->tx_timer.function = tx_timer_func;
/*
** Initialize variables for CP booting and crash dump
*/
atomic_set(&mld->cp_boot_done, 0);
spin_lock_init(&mld->pif_init_lock);
INIT_DELAYED_WORK(&mld->udl_rx_dwork, udl_rx_work);
snprintf(name, MAX_NAME_LEN, "%s_dump_wlock", ld->name);
wake_lock_init(&mld->dump_wlock, WAKE_LOCK_SUSPEND, name);
#ifdef DEBUG_MODEM_IF
INIT_WORK(&mld->dump_work, mem_dump_work);
#endif
mif_err("---\n");
return mld;
error:
kfree(mld);
mif_err("xxx\n");
return NULL;
}
struct mem_link_device *mem_create_link_device(enum mem_iface_type type,
struct modem_data *modem)
{
struct mem_link_device *mld;
struct link_device *ld;
int i;
mif_err("+++\n");
if (modem->ipc_version < SIPC_VER_50) {
mif_err("%s<->%s: ERR! IPC version %d < SIPC_VER_50\n",
modem->link_name, modem->name, modem->ipc_version);
return NULL;
}
/*
** Alloc an instance of mem_link_device structure
*/
mld = kzalloc(sizeof(struct mem_link_device), GFP_KERNEL);
if (!mld) {
mif_err("%s<->%s: ERR! mld kzalloc fail\n",
modem->link_name, modem->name);
return NULL;
}
/*
** Retrieve modem-specific attributes value
*/
mld->type = type;
mld->attrs = modem->link_attrs;
/*====================================================================*\
Initialize "memory snapshot buffer (MSB)" framework
\*====================================================================*/
if (msb_init() < 0) {
mif_err("%s<->%s: ERR! msb_init() fail\n",
modem->link_name, modem->name);
goto error;
}
/*====================================================================*\
Set attributes as a "link_device"
\*====================================================================*/
ld = &mld->link_dev;
ld->name = modem->link_name;
if (mld->attrs & LINK_ATTR(LINK_ATTR_SBD_IPC)) {
mif_err("%s<->%s: LINK_ATTR_SBD_IPC\n", ld->name, modem->name);
ld->sbd_ipc = true;
}
if (mld->attrs & LINK_ATTR(LINK_ATTR_IPC_ALIGNED)) {
mif_err("%s<->%s: LINK_ATTR_IPC_ALIGNED\n",
ld->name, modem->name);
ld->aligned = true;
}
ld->ipc_version = modem->ipc_version;
ld->mdm_data = modem;
/*
Set up link device methods
*/
ld->init_comm = mem_init_comm;
#ifdef CONFIG_LINK_DEVICE_WITH_SBD_ARCH
ld->terminate_comm = mem_terminate_comm;
#endif
ld->send = mem_send;
ld->boot_on = mem_boot_on;
if (mld->attrs & LINK_ATTR(LINK_ATTR_MEM_BOOT)) {
if (mld->attrs & LINK_ATTR(LINK_ATTR_XMIT_BTDLR))
ld->xmit_boot = mem_xmit_boot;
ld->dload_start = mem_start_download;
ld->firm_update = mem_update_firm_info;
ld->security_req = mem_security_request;
}
ld->force_dump = mem_force_dump;
if (mld->attrs & LINK_ATTR(LINK_ATTR_MEM_DUMP)) {
ld->dump_start = mem_start_upload;
}
ld->close_tx = mem_close_tx;
INIT_LIST_HEAD(&ld->list);
skb_queue_head_init(&ld->sk_fmt_tx_q);
skb_queue_head_init(&ld->sk_raw_tx_q);
skb_queue_head_init(&ld->sk_fmt_rx_q);
skb_queue_head_init(&ld->sk_raw_rx_q);
for (i = 0; i < MAX_SIPC5_DEVICES; i++) {
spin_lock_init(&ld->tx_lock[i]);
spin_lock_init(&ld->rx_lock[i]);
}
spin_lock_init(&ld->netif_lock);
atomic_set(&ld->netif_stopped, 0);
if (mem_rx_setup(ld) < 0)
goto error;
/*====================================================================*\
Set attributes as a "memory link_device"
\*====================================================================*/
if (mld->attrs & LINK_ATTR(LINK_ATTR_DPRAM_MAGIC)) {
mif_err("%s<->%s: LINK_ATTR_DPRAM_MAGIC\n",
ld->name, modem->name);
mld->dpram_magic = true;
}
#ifdef CONFIG_LINK_DEVICE_WITH_SBD_ARCH
if (mld->attrs & LINK_ATTR(LINK_ATTR_IOSM_MESSAGE)) {
mif_err("%s<->%s: MODEM_ATTR_IOSM_MESSAGE\n",
ld->name, modem->name);
mld->iosm = true;
mld->cmd_handler = iosm_event_bh;
} else {
mld->cmd_handler = mem_cmd_handler;
}
#else
mld->cmd_handler = mem_cmd_handler;
#endif
/*====================================================================*\
Initialize MEM locks, completions, bottom halves, etc
\*====================================================================*/
spin_lock_init(&mld->lock);
/*
** Initialize variables for TX & RX
*/
msb_queue_head_init(&mld->msb_rxq);
msb_queue_head_init(&mld->msb_log);
tasklet_init(&mld->rx_tsk, mem_rx_task, (unsigned long)mld);
hrtimer_init(&mld->tx_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
mld->tx_timer.function = tx_timer_func;
#ifdef CONFIG_LINK_DEVICE_WITH_SBD_ARCH
hrtimer_init(&mld->sbd_tx_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
mld->sbd_tx_timer.function = sbd_tx_timer_func;
INIT_WORK(&mld->iosm_w, iosm_event_work);
#endif
/*
** Initialize variables for CP booting and crash dump
*/
INIT_DELAYED_WORK(&mld->udl_rx_dwork, udl_rx_work);
#ifdef DEBUG_MODEM_IF
INIT_WORK(&mld->dump_work, mem_dump_work);
#endif
mif_err("---\n");
return mld;
error:
kfree(mld);
mif_err("xxx\n");
return NULL;
}