[PATCH net-next v4 09/10] net: wwan: tmi: Introduce WWAN interface
Yanchao Yang
yanchao.yang at mediatek.com
Fri Mar 17 01:09:41 PDT 2023
Creates the WWAN interface which implements the wwan_ops for registration with
the WWAN framework. WWAN interface also implements the net_device_ops functions
used by the network devices. Network device operations include open, stop,
start transmission and get states.
Signed-off-by: Yanchao Yang <yanchao.yang at mediatek.com>
Signed-off-by: Hua Yang <hua.yang at mediatek.com>
---
drivers/net/wwan/mediatek/Makefile | 3 +-
drivers/net/wwan/mediatek/mtk_data_plane.h | 11 +
drivers/net/wwan/mediatek/mtk_dpmaif.c | 68 ++-
drivers/net/wwan/mediatek/mtk_wwan.c | 511 +++++++++++++++++++++
4 files changed, 587 insertions(+), 6 deletions(-)
create mode 100644 drivers/net/wwan/mediatek/mtk_wwan.c
diff --git a/drivers/net/wwan/mediatek/Makefile b/drivers/net/wwan/mediatek/Makefile
index 27ad6628b83d..86ed172532ac 100644
--- a/drivers/net/wwan/mediatek/Makefile
+++ b/drivers/net/wwan/mediatek/Makefile
@@ -12,6 +12,7 @@ mtk_tmi-y = \
mtk_port.o \
mtk_port_io.o \
mtk_fsm.o \
- mtk_dpmaif.o
+ mtk_dpmaif.o \
+ mtk_wwan.o
obj-$(CONFIG_MTK_TMI) += mtk_tmi.o
diff --git a/drivers/net/wwan/mediatek/mtk_data_plane.h b/drivers/net/wwan/mediatek/mtk_data_plane.h
index 9dbef5911c49..672f582aca61 100644
--- a/drivers/net/wwan/mediatek/mtk_data_plane.h
+++ b/drivers/net/wwan/mediatek/mtk_data_plane.h
@@ -23,6 +23,7 @@ enum mtk_data_feature {
struct mtk_data_blk {
struct mtk_md_dev *mdev;
+ struct mtk_wwan_ctlb *wcb;
struct mtk_dpmaif_ctlb *dcb;
};
@@ -82,9 +83,19 @@ struct mtk_data_trans_info {
struct napi_struct **napis;
};
+struct mtk_data_port_ops {
+ int (*init)(struct mtk_data_blk *data_blk, struct mtk_data_trans_info *trans_info);
+ void (*exit)(struct mtk_data_blk *data_blk);
+ int (*recv)(struct mtk_data_blk *data_blk, struct sk_buff *skb,
+ unsigned char q_id, unsigned char if_id);
+ void (*notify)(struct mtk_data_blk *data_blk, enum mtk_data_evt evt, u64 data);
+};
+
+int mtk_wwan_cmd_execute(struct net_device *dev, enum mtk_data_cmd_type cmd, void *data);
int mtk_data_init(struct mtk_md_dev *mdev);
int mtk_data_exit(struct mtk_md_dev *mdev);
+extern struct mtk_data_port_ops data_port_ops;
extern struct mtk_data_trans_ops data_trans_ops;
#endif /* __MTK_DATA_PLANE_H__ */
diff --git a/drivers/net/wwan/mediatek/mtk_dpmaif.c b/drivers/net/wwan/mediatek/mtk_dpmaif.c
index 10d1a0255ccc..bf09486630de 100644
--- a/drivers/net/wwan/mediatek/mtk_dpmaif.c
+++ b/drivers/net/wwan/mediatek/mtk_dpmaif.c
@@ -319,6 +319,7 @@ enum dpmaif_dump_flag {
struct mtk_dpmaif_ctlb {
struct mtk_data_blk *data_blk;
+ struct mtk_data_port_ops *port_ops;
struct dpmaif_drv_info *drv_info;
struct napi_struct *napi[DPMAIF_RXQ_CNT_MAX];
@@ -761,9 +762,13 @@ static void mtk_dpmaif_bat_exit(struct mtk_dpmaif_ctlb *dcb, struct dpmaif_bat_r
if (bat_ring->sw_record_base) {
for (i = 0; i < bat_ring->bat_cnt; i++) {
bat_record = bat_ring->sw_record_base + i;
- dma_unmap_single(DCB_TO_DEV(dcb), bat_record->normal.data_dma_addr,
- bat_record->normal.data_len, DMA_FROM_DEVICE);
- dev_kfree_skb_any(bat_record->normal.skb);
+ if (bat_record->normal.skb) {
+ dma_unmap_single(DCB_TO_DEV(dcb),
+ bat_record->normal.data_dma_addr,
+ bat_record->normal.data_len,
+ DMA_FROM_DEVICE);
+ dev_kfree_skb_any(bat_record->normal.skb);
+ }
}
devm_kfree(DCB_TO_DEV(dcb), bat_ring->sw_record_base);
@@ -1058,6 +1063,8 @@ static int mtk_dpmaif_tx_rel_internal(struct dpmaif_txq *txq,
txq->drb_rel_rd_idx = mtk_dpmaif_ring_buf_get_next_idx(txq->drb_cnt, cur_idx);
atomic_inc(&txq->budget);
+ if (atomic_read(&txq->budget) > txq->drb_cnt / 8)
+ dcb->port_ops->notify(dcb->data_blk, DATA_EVT_TX_START, (u64)1 << txq->id);
}
*real_rel_cnt = i;
@@ -2033,6 +2040,38 @@ static int mtk_dpmaif_irq_exit(struct mtk_dpmaif_ctlb *dcb)
return 0;
}
+static int mtk_dpmaif_port_init(struct mtk_dpmaif_ctlb *dcb)
+{
+ struct mtk_data_trans_info trans_info;
+ struct dpmaif_rxq *rxq;
+ int ret;
+ int i;
+
+ memset(&trans_info, 0x00, sizeof(struct mtk_data_trans_info));
+ trans_info.max_mtu = dcb->bat_info.max_mtu;
+ trans_info.txq_cnt = dcb->res_cfg->txq_cnt;
+ trans_info.rxq_cnt = dcb->res_cfg->rxq_cnt;
+
+ for (i = 0; i < trans_info.rxq_cnt; i++) {
+ rxq = &dcb->rxqs[i];
+ dcb->napi[i] = &rxq->napi;
+ }
+ trans_info.napis = dcb->napi;
+
+ dcb->port_ops = &data_port_ops;
+ ret = dcb->port_ops->init(dcb->data_blk, &trans_info);
+ if (ret < 0)
+ dev_err(DCB_TO_DEV(dcb),
+ "Failed to initialize data port layer, ret=%d\n", ret);
+
+ return ret;
+}
+
+static void mtk_dpmaif_port_exit(struct mtk_dpmaif_ctlb *dcb)
+{
+ dcb->port_ops->exit(dcb->data_blk);
+}
+
static int mtk_dpmaif_hw_init(struct mtk_dpmaif_ctlb *dcb)
{
struct dpmaif_bat_ring *bat_ring;
@@ -2135,9 +2174,13 @@ static int mtk_dpmaif_stop(struct mtk_dpmaif_ctlb *dcb)
goto out;
dcb->dpmaif_state = DPMAIF_STATE_PWROFF;
+ dcb->port_ops->notify(dcb->data_blk, DATA_EVT_TX_STOP, 0xff);
mtk_dpmaif_tx_srvs_stop(dcb);
mtk_dpmaif_trans_ctl(dcb, false);
+
+ dcb->port_ops->notify(dcb->data_blk, DATA_EVT_RX_STOP, 0xff);
+
out:
return 0;
}
@@ -2150,6 +2193,7 @@ static void mtk_dpmaif_fsm_callback(struct mtk_fsm_param *fsm_param, void *data)
case FSM_STATE_OFF:
mtk_dpmaif_stop(dcb);
+ dcb->port_ops->notify(dcb->data_blk, DATA_EVT_UNREG_DEV, 0);
flush_work(&dcb->cmd_srv.work);
mtk_dpmaif_sw_reset(dcb);
@@ -2159,6 +2203,7 @@ static void mtk_dpmaif_fsm_callback(struct mtk_fsm_param *fsm_param, void *data)
mtk_dpmaif_start(dcb);
break;
case FSM_STATE_READY:
+ dcb->port_ops->notify(dcb->data_blk, DATA_EVT_REG_DEV, 0);
break;
default:
break;
@@ -2231,6 +2276,12 @@ static int mtk_dpmaif_sw_init(struct mtk_data_blk *data_blk, const struct dpmaif
goto free_drv_res;
}
+ ret = mtk_dpmaif_port_init(dcb);
+ if (ret < 0) {
+ dev_err(DCB_TO_DEV(dcb), "Failed to initialize data port, ret=%d\n", ret);
+ goto free_port;
+ }
+
ret = mtk_dpmaif_fsm_init(dcb);
if (ret < 0) {
dev_err(DCB_TO_DEV(dcb), "Failed to initialize dpmaif fsm, ret=%d\n", ret);
@@ -2248,6 +2299,8 @@ static int mtk_dpmaif_sw_init(struct mtk_data_blk *data_blk, const struct dpmaif
free_irq:
mtk_dpmaif_fsm_exit(dcb);
free_fsm:
+ mtk_dpmaif_port_exit(dcb);
+free_port:
mtk_dpmaif_drv_res_exit(dcb);
free_drv_res:
mtk_dpmaif_cmd_srvs_exit(dcb);
@@ -2270,6 +2323,7 @@ static int mtk_dpmaif_sw_exit(struct mtk_data_blk *data_blk)
mtk_dpmaif_irq_exit(dcb);
mtk_dpmaif_fsm_exit(dcb);
+ mtk_dpmaif_port_exit(dcb);
mtk_dpmaif_drv_res_exit(dcb);
mtk_dpmaif_cmd_srvs_exit(dcb);
mtk_dpmaif_tx_srvs_exit(dcb);
@@ -2490,6 +2544,7 @@ static void mtk_dpmaif_set_rcsum(struct sk_buff *skb, unsigned int hw_checksum_s
static int mtk_dpmaif_rx_skb(struct dpmaif_rxq *rxq, struct dpmaif_rx_record *rx_record)
{
struct sk_buff *new_skb = rx_record->cur_skb;
+ struct mtk_dpmaif_ctlb *dcb = rxq->dcb;
int ret = 0;
if (unlikely(rx_record->pit_dp)) {
@@ -2500,6 +2555,7 @@ static int mtk_dpmaif_rx_skb(struct dpmaif_rxq *rxq, struct dpmaif_rx_record *rx
mtk_dpmaif_set_rcsum(new_skb, rx_record->checksum);
skb_record_rx_queue(new_skb, rxq->id);
+ ret = dcb->port_ops->recv(dcb->data_blk, new_skb, rxq->id, rx_record->cur_ch_id);
out:
return ret;
}
@@ -2712,10 +2768,12 @@ static int mtk_dpmaif_send_pkt(struct mtk_dpmaif_ctlb *dcb, struct sk_buff *skb,
vq = &dcb->tx_vqs[vq_id];
srv_id = dcb->res_cfg->tx_vq_srv_map[vq_id];
- if (likely(skb_queue_len(&vq->list) < vq->max_len))
+ if (likely(skb_queue_len(&vq->list) < vq->max_len)) {
skb_queue_tail(&vq->list, skb);
- else
+ } else {
+ dcb->port_ops->notify(dcb->data_blk, DATA_EVT_TX_STOP, (u64)1 << vq_id);
ret = -EBUSY;
+ }
wake_up(&dcb->tx_srvs[srv_id].wait);
diff --git a/drivers/net/wwan/mediatek/mtk_wwan.c b/drivers/net/wwan/mediatek/mtk_wwan.c
new file mode 100644
index 000000000000..a0f31cb33271
--- /dev/null
+++ b/drivers/net/wwan/mediatek/mtk_wwan.c
@@ -0,0 +1,511 @@
+// SPDX-License-Identifier: BSD-3-Clause-Clear
+/*
+ * Copyright (c) 2022, MediaTek Inc.
+ */
+
+#include <linux/completion.h>
+#include <linux/etherdevice.h>
+#include <linux/netdevice.h>
+#include <linux/skbuff.h>
+#include <linux/types.h>
+#include <linux/wwan.h>
+#include <net/pkt_sched.h>
+#include <uapi/linux/if.h>
+#include <uapi/linux/if_arp.h>
+#include <uapi/linux/if_link.h>
+
+#include "mtk_data_plane.h"
+#include "mtk_dev.h"
+
+#define MTK_NETDEV_MAX 20
+#define MTK_DFLT_INTF_ID 0
+#define MTK_NETDEV_WDT (HZ)
+#define MTK_CMD_WDT (HZ)
+#define MTK_MAX_INTF_ID (MTK_NETDEV_MAX - 1)
+
+static unsigned int napi_budget = 128;
+
+struct mtk_wwan_instance {
+ struct mtk_wwan_ctlb *wcb;
+ struct net_device *netdev;
+ unsigned int intf_id;
+};
+
+struct mtk_wwan_ctlb {
+ struct mtk_data_blk *data_blk;
+ struct mtk_md_dev *mdev;
+ struct mtk_data_trans_ops *trans_ops;
+ struct mtk_wwan_instance __rcu *wwan_inst[MTK_NETDEV_MAX];
+ struct napi_struct **napis;
+ struct net_device dummy_dev;
+
+ u32 cap;
+ atomic_t napi_enabled;
+ unsigned int max_mtu;
+ unsigned int active_cnt;
+ unsigned char txq_num;
+ unsigned char rxq_num;
+ bool reg_done;
+};
+
+static void mtk_wwan_set_skb(struct sk_buff *skb, struct net_device *netdev)
+{
+ unsigned int pkt_type;
+
+ pkt_type = skb->data[0] & 0xF0;
+
+ if (pkt_type == IPV4_VERSION)
+ skb->protocol = htons(ETH_P_IP);
+ else
+ skb->protocol = htons(ETH_P_IPV6);
+
+ skb->dev = netdev;
+}
+
+static int mtk_wwan_data_recv(struct mtk_data_blk *data_blk, struct sk_buff *skb,
+ unsigned char q_id, unsigned char intf_id)
+{
+ struct mtk_wwan_instance *wwan_inst;
+ struct net_device *netdev;
+ struct napi_struct *napi;
+
+ rcu_read_lock();
+ wwan_inst = rcu_dereference(data_blk->wcb->wwan_inst[intf_id]);
+
+ napi = data_blk->wcb->napis[q_id];
+ netdev = wwan_inst->netdev;
+
+ mtk_wwan_set_skb(skb, netdev);
+
+ napi_gro_receive(napi, skb);
+
+ rcu_read_unlock();
+ return 0;
+}
+
+static void mtk_wwan_napi_enable(struct mtk_wwan_ctlb *wcb)
+{
+ int i;
+
+ if (atomic_cmpxchg(&wcb->napi_enabled, 0, 1) == 0) {
+ for (i = 0; i < wcb->rxq_num; i++)
+ napi_enable(wcb->napis[i]);
+ }
+}
+
+static void mtk_wwan_napi_disable(struct mtk_wwan_ctlb *wcb)
+{
+ int i;
+
+ if (atomic_cmpxchg(&wcb->napi_enabled, 1, 0) == 1) {
+ for (i = 0; i < wcb->rxq_num; i++) {
+ napi_synchronize(wcb->napis[i]);
+ napi_disable(wcb->napis[i]);
+ }
+ }
+}
+
+static int mtk_wwan_open(struct net_device *dev)
+{
+ struct mtk_wwan_instance *wwan_inst = wwan_netdev_drvpriv(dev);
+ struct mtk_wwan_ctlb *wcb = wwan_inst->wcb;
+ struct mtk_data_trans_ctl trans_ctl;
+ int ret;
+
+ if (wcb->active_cnt == 0) {
+ mtk_wwan_napi_enable(wcb);
+ trans_ctl.enable = true;
+ ret = mtk_wwan_cmd_execute(dev, DATA_CMD_TRANS_CTL, &trans_ctl);
+ if (ret < 0) {
+ dev_err(wcb->mdev->dev, "Failed to enable trans\n");
+ goto out;
+ }
+ }
+
+ wcb->active_cnt++;
+
+ netif_tx_start_all_queues(dev);
+ netif_carrier_on(dev);
+
+ return 0;
+
+out:
+ mtk_wwan_napi_disable(wcb);
+ return ret;
+}
+
+static int mtk_wwan_stop(struct net_device *dev)
+{
+ struct mtk_wwan_instance *wwan_inst = wwan_netdev_drvpriv(dev);
+ struct mtk_wwan_ctlb *wcb = wwan_inst->wcb;
+ struct mtk_data_trans_ctl trans_ctl;
+ int ret;
+
+ netif_carrier_off(dev);
+ netif_tx_disable(dev);
+
+ if (wcb->active_cnt == 1) {
+ trans_ctl.enable = false;
+ ret = mtk_wwan_cmd_execute(dev, DATA_CMD_TRANS_CTL, &trans_ctl);
+ if (ret < 0)
+ dev_err(wcb->mdev->dev, "Failed to disable trans\n");
+ mtk_wwan_napi_disable(wcb);
+ }
+ wcb->active_cnt--;
+
+ return 0;
+}
+
+static netdev_tx_t mtk_wwan_start_xmit(struct sk_buff *skb, struct net_device *dev)
+{
+ struct mtk_wwan_instance *wwan_inst = wwan_netdev_drvpriv(dev);
+ unsigned int intf_id = wwan_inst->intf_id;
+ int ret;
+
+ skb_set_queue_mapping(skb, 0);
+
+ ret = wwan_inst->wcb->trans_ops->send(wwan_inst->wcb->data_blk, DATA_PKT, skb, intf_id);
+ if (ret == -EBUSY)
+ return NETDEV_TX_BUSY;
+
+ return NETDEV_TX_OK;
+}
+
+static const struct net_device_ops mtk_netdev_ops = {
+ .ndo_open = mtk_wwan_open,
+ .ndo_stop = mtk_wwan_stop,
+ .ndo_start_xmit = mtk_wwan_start_xmit,
+};
+
+static void mtk_wwan_cmd_complete(void *data)
+{
+ struct mtk_data_cmd *event;
+ struct sk_buff *skb = data;
+
+ event = (struct mtk_data_cmd *)skb->data;
+ complete(&event->done);
+}
+
+static int mtk_wwan_cmd_check(struct net_device *dev, enum mtk_data_cmd_type cmd)
+{
+ int ret = 0;
+
+ switch (cmd) {
+ case DATA_CMD_TRANS_CTL:
+ break;
+ default:
+ ret = -EOPNOTSUPP;
+ break;
+ }
+
+ return ret;
+}
+
+static struct sk_buff *mtk_wwan_cmd_alloc(enum mtk_data_cmd_type cmd, unsigned int len)
+
+{
+ struct mtk_data_cmd *event;
+ struct sk_buff *skb;
+
+ skb = dev_alloc_skb(sizeof(*event) + len);
+ if (unlikely(!skb))
+ return NULL;
+
+ skb_put(skb, len + sizeof(*event));
+ event = (struct mtk_data_cmd *)skb->data;
+ event->cmd = cmd;
+ event->len = len;
+
+ init_completion(&event->done);
+ event->data_complete = mtk_wwan_cmd_complete;
+
+ return skb;
+}
+
+static int mtk_wwan_cmd_send(struct net_device *dev, struct sk_buff *skb)
+{
+ struct mtk_wwan_instance *wwan_inst = wwan_netdev_drvpriv(dev);
+ struct mtk_data_cmd *event = (struct mtk_data_cmd *)skb->data;
+ int ret;
+
+ ret = wwan_inst->wcb->trans_ops->send(wwan_inst->wcb->data_blk, DATA_CMD, skb, 0);
+ if (ret < 0)
+ return ret;
+
+ if (!wait_for_completion_timeout(&event->done, MTK_CMD_WDT))
+ return -ETIMEDOUT;
+
+ if (event->ret < 0)
+ return event->ret;
+
+ return 0;
+}
+
+int mtk_wwan_cmd_execute(struct net_device *dev,
+ enum mtk_data_cmd_type cmd, void *data)
+{
+ struct mtk_wwan_instance *wwan_inst;
+ struct sk_buff *skb;
+ int ret;
+
+ if (mtk_wwan_cmd_check(dev, cmd))
+ return -EOPNOTSUPP;
+
+ skb = mtk_wwan_cmd_alloc(cmd, sizeof(void *));
+ if (unlikely(!skb))
+ return -ENOMEM;
+
+ SKB_TO_CMD_DATA(skb) = data;
+
+ ret = mtk_wwan_cmd_send(dev, skb);
+ if (ret < 0) {
+ wwan_inst = wwan_netdev_drvpriv(dev);
+ dev_err(wwan_inst->wcb->mdev->dev,
+ "Failed to excute command:ret=%d,cmd=%d\n", ret, cmd);
+ }
+
+ if (likely(skb))
+ dev_kfree_skb_any(skb);
+
+ return ret;
+}
+
+static int mtk_wwan_start_txq(struct mtk_wwan_ctlb *wcb, u32 qmask)
+{
+ struct mtk_wwan_instance *wwan_inst;
+ struct net_device *dev;
+ int i;
+
+ rcu_read_lock();
+ for (i = 0; i < MTK_NETDEV_MAX; i++) {
+ wwan_inst = rcu_dereference(wcb->wwan_inst[i]);
+ if (!wwan_inst)
+ continue;
+
+ dev = wwan_inst->netdev;
+
+ if (!(dev->flags & IFF_UP))
+ continue;
+
+ netif_tx_wake_all_queues(dev);
+ netif_carrier_on(dev);
+ }
+ rcu_read_unlock();
+
+ return 0;
+}
+
+static int mtk_wwan_stop_txq(struct mtk_wwan_ctlb *wcb, u32 qmask)
+{
+ struct mtk_wwan_instance *wwan_inst;
+ struct net_device *dev;
+ int i;
+
+ rcu_read_lock();
+ for (i = 0; i < MTK_NETDEV_MAX; i++) {
+ wwan_inst = rcu_dereference(wcb->wwan_inst[i]);
+ if (!wwan_inst)
+ continue;
+
+ dev = wwan_inst->netdev;
+
+ if (!(dev->flags & IFF_UP))
+ continue;
+
+ netif_carrier_off(dev);
+ netif_tx_stop_all_queues(dev);
+ }
+ rcu_read_unlock();
+
+ return 0;
+}
+
+static void mtk_wwan_napi_exit(struct mtk_wwan_ctlb *wcb)
+{
+ int i;
+
+ for (i = 0; i < wcb->rxq_num; i++) {
+ if (!wcb->napis[i])
+ continue;
+ netif_napi_del(wcb->napis[i]);
+ }
+}
+
+static int mtk_wwan_napi_init(struct mtk_wwan_ctlb *wcb, struct net_device *dev)
+{
+ int i;
+
+ for (i = 0; i < wcb->rxq_num; i++) {
+ if (!wcb->napis[i]) {
+ dev_err(wcb->mdev->dev, "Invalid napi pointer, napi=%d", i);
+ goto out;
+ }
+ netif_napi_add_weight(dev, wcb->napis[i], wcb->trans_ops->poll, napi_budget);
+ }
+
+ return 0;
+
+out:
+ for (--i; i >= 0; i--)
+ netif_napi_del(wcb->napis[i]);
+ return -EINVAL;
+}
+
+static void mtk_wwan_setup(struct net_device *dev)
+{
+ dev->watchdog_timeo = MTK_NETDEV_WDT;
+ dev->mtu = ETH_DATA_LEN;
+ dev->min_mtu = ETH_MIN_MTU;
+
+ dev->features |= NETIF_F_HW_CSUM;
+ dev->hw_features |= NETIF_F_HW_CSUM;
+
+ dev->features |= NETIF_F_RXCSUM;
+ dev->hw_features |= NETIF_F_RXCSUM;
+
+ dev->addr_len = ETH_ALEN;
+ dev->tx_queue_len = DEFAULT_TX_QUEUE_LEN;
+
+ dev->flags = IFF_NOARP;
+ dev->type = ARPHRD_NONE;
+
+ dev->needs_free_netdev = true;
+
+ dev->netdev_ops = &mtk_netdev_ops;
+}
+
+static int mtk_wwan_newlink(void *ctxt, struct net_device *dev, u32 intf_id,
+ struct netlink_ext_ack *extack)
+{
+ struct mtk_wwan_instance *wwan_inst = wwan_netdev_drvpriv(dev);
+ struct mtk_wwan_ctlb *wcb = ctxt;
+ int ret;
+
+ dev->max_mtu = wcb->max_mtu;
+
+ wwan_inst->wcb = wcb;
+ wwan_inst->netdev = dev;
+ wwan_inst->intf_id = intf_id;
+
+ if (rcu_access_pointer(wcb->wwan_inst[intf_id])) {
+ ret = -EBUSY;
+ goto out;
+ }
+
+ ret = register_netdevice(dev);
+ if (ret)
+ goto out;
+
+ rcu_assign_pointer(wcb->wwan_inst[intf_id], wwan_inst);
+
+ netif_device_attach(dev);
+
+ return 0;
+out:
+ return ret;
+}
+
+static void mtk_wwan_dellink(void *ctxt, struct net_device *dev,
+ struct list_head *head)
+{
+ struct mtk_wwan_instance *wwan_inst = wwan_netdev_drvpriv(dev);
+ int intf_id = wwan_inst->intf_id;
+ struct mtk_wwan_ctlb *wcb = ctxt;
+
+ if (WARN_ON(rcu_access_pointer(wcb->wwan_inst[intf_id]) != wwan_inst))
+ return;
+
+ RCU_INIT_POINTER(wcb->wwan_inst[intf_id], NULL);
+ unregister_netdevice_queue(dev, head);
+}
+
+static const struct wwan_ops mtk_wwan_ops = {
+ .priv_size = sizeof(struct mtk_wwan_instance),
+ .setup = mtk_wwan_setup,
+ .newlink = mtk_wwan_newlink,
+ .dellink = mtk_wwan_dellink,
+};
+
+static void mtk_wwan_notify(struct mtk_data_blk *data_blk, enum mtk_data_evt evt, u64 data)
+{
+ struct mtk_wwan_ctlb *wcb;
+
+ wcb = data_blk->wcb;
+
+ switch (evt) {
+ case DATA_EVT_TX_START:
+ mtk_wwan_start_txq(wcb, data);
+ break;
+ case DATA_EVT_TX_STOP:
+ mtk_wwan_stop_txq(wcb, data);
+ break;
+ case DATA_EVT_RX_STOP:
+ mtk_wwan_napi_disable(wcb);
+ break;
+ case DATA_EVT_REG_DEV:
+ if (!wcb->reg_done) {
+ wwan_register_ops(wcb->mdev->dev, &mtk_wwan_ops, wcb, MTK_DFLT_INTF_ID);
+ wcb->reg_done = true;
+ }
+ break;
+ case DATA_EVT_UNREG_DEV:
+ if (wcb->reg_done) {
+ wwan_unregister_ops(wcb->mdev->dev);
+ wcb->reg_done = false;
+ }
+ break;
+ default:
+ break;
+ }
+}
+
+static int mtk_wwan_init(struct mtk_data_blk *data_blk, struct mtk_data_trans_info *trans_info)
+{
+ struct mtk_wwan_ctlb *wcb;
+ int ret;
+
+ wcb = devm_kzalloc(data_blk->mdev->dev, sizeof(*wcb), GFP_KERNEL);
+ if (unlikely(!wcb))
+ return -ENOMEM;
+
+ wcb->trans_ops = &data_trans_ops;
+ wcb->mdev = data_blk->mdev;
+ wcb->data_blk = data_blk;
+ wcb->napis = trans_info->napis;
+ wcb->max_mtu = trans_info->max_mtu;
+ wcb->cap = trans_info->cap;
+ wcb->rxq_num = trans_info->rxq_cnt;
+ wcb->txq_num = trans_info->txq_cnt;
+ atomic_set(&wcb->napi_enabled, 0);
+ init_dummy_netdev(&wcb->dummy_dev);
+
+ data_blk->wcb = wcb;
+
+ ret = mtk_wwan_napi_init(wcb, &wcb->dummy_dev);
+ if (ret < 0)
+ goto out;
+
+ return 0;
+out:
+ devm_kfree(data_blk->mdev->dev, wcb);
+ data_blk->wcb = NULL;
+
+ return ret;
+}
+
+static void mtk_wwan_exit(struct mtk_data_blk *data_blk)
+{
+ struct mtk_wwan_ctlb *wcb;
+
+ wcb = data_blk->wcb;
+ mtk_wwan_napi_exit(wcb);
+ devm_kfree(data_blk->mdev->dev, wcb);
+ data_blk->wcb = NULL;
+}
+
+struct mtk_data_port_ops data_port_ops = {
+ .init = mtk_wwan_init,
+ .exit = mtk_wwan_exit,
+ .recv = mtk_wwan_data_recv,
+ .notify = mtk_wwan_notify,
+};
--
2.32.0
More information about the Linux-mediatek
mailing list