diff mbox series

net: Add mhi-net driver

Message ID 1602275611-7440-1-git-send-email-loic.poulain@linaro.org
State New
Headers show
Series net: Add mhi-net driver | expand

Commit Message

Loic Poulain Oct. 9, 2020, 8:33 p.m. UTC
This patch adds a new network driver implementing MHI transport for
network packets. Packets can be in any format, though QMAP (rmnet)
is the usual protocol (flow control + PDN mux).

It support two MHI devices, IP_HW0 which is, the path to the IPA
(IP accelerator) on qcom modem, And IP_SW0 which is the software
driven IP path (to modem CPU).

Signed-off-by: Loic Poulain <loic.poulain@linaro.org>
---
 drivers/net/Kconfig   |   7 ++
 drivers/net/Makefile  |   1 +
 drivers/net/mhi_net.c | 281 ++++++++++++++++++++++++++++++++++++++++++++++++++
 3 files changed, 289 insertions(+)
 create mode 100644 drivers/net/mhi_net.c

Comments

Jakub Kicinski Oct. 10, 2020, 1:48 a.m. UTC | #1
On Fri,  9 Oct 2020 22:33:31 +0200 Loic Poulain wrote:
> This patch adds a new network driver implementing MHI transport for

> network packets. Packets can be in any format, though QMAP (rmnet)

> is the usual protocol (flow control + PDN mux).

> 

> It support two MHI devices, IP_HW0 which is, the path to the IPA

> (IP accelerator) on qcom modem, And IP_SW0 which is the software

> driven IP path (to modem CPU).

> 

> Signed-off-by: Loic Poulain <loic.poulain@linaro.org>


Does not appear to build in net-next - presumably you have some
dependency in another tree?

make: *** [__sub-make] Error 2
../drivers/net/mhi_net.c: In function ‘mhi_net_probe’:
../drivers/net/mhi_net.c:234:8: error: too many arguments to function ‘mhi_prepare_for_transfer’
  234 |  err = mhi_prepare_for_transfer(mhi_dev, 0);
      |        ^~~~~~~~~~~~~~~~~~~~~~~~
In file included from ../drivers/net/mhi_net.c:8:
../include/linux/mhi.h:669:5: note: declared here
  669 | int mhi_prepare_for_transfer(struct mhi_device *mhi_dev);
      |     ^~~~~~~~~~~~~~~~~~~~~~~~
make[3]: *** [drivers/net/mhi_net.o] Error 1
make[2]: *** [drivers/net] Error 2
make[2]: *** Waiting for unfinished jobs....
make[1]: *** [drivers] Error 2
make[1]: *** Waiting for unfinished jobs....
make: *** [__sub-make] Error 2
New errors added
Jakub Kicinski Oct. 11, 2020, 6:59 p.m. UTC | #2
On Fri,  9 Oct 2020 22:33:31 +0200 Loic Poulain wrote:
> This patch adds a new network driver implementing MHI transport for

> network packets. Packets can be in any format, though QMAP (rmnet)

> is the usual protocol (flow control + PDN mux).

> 

> It support two MHI devices, IP_HW0 which is, the path to the IPA

> (IP accelerator) on qcom modem, And IP_SW0 which is the software

> driven IP path (to modem CPU).

> 

> Signed-off-by: Loic Poulain <loic.poulain@linaro.org>


> +static int mhi_ndo_xmit(struct sk_buff *skb, struct net_device *ndev)

> +{

> +	struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);

> +	struct mhi_device *mdev = mhi_netdev->mdev;

> +	int err;

> +

> +	/* Only support for single buffer transfer for now */

> +	err = skb_linearize(skb);


Since you don't advertise NETIF_F_SG you shouldn't have to call this,
no?

> +	if (unlikely(err)) {

> +		kfree_skb(skb);

> +		mhi_netdev->stats.tx_dropped++;

> +		return NETDEV_TX_OK;

> +	}

> +

> +	skb_tx_timestamp(skb);

> +

> +	/* mhi_queue_skb is not thread-safe, but xmit is serialized by the

> +	 * network core. Once MHI core will be thread save, migrate to

> +	 * NETIF_F_LLTX support.

> +	 */

> +	err = mhi_queue_skb(mdev, DMA_TO_DEVICE, skb, skb->len, MHI_EOT);

> +	if (err) {

> +		netdev_err(ndev, "mhi_queue_skb err %d\n", err);


This needs to be at least rate limited. 

> +		netif_stop_queue(ndev);


What's going to start the queue if it's a transient errors and not
NETDEV_TX_BUSY?

> +		return (err == -ENOMEM) ? NETDEV_TX_BUSY : err;


You should drop the packet if it's not NETDEV_TX_BUSY, and return
NETDEV_TX_OK. Don't return negative errors from ndo_xmit. 

> +	}

> +

> +	return NETDEV_TX_OK;

> +}

> +

> +static void mhi_ndo_get_stats64(struct net_device *ndev,

> +				struct rtnl_link_stats64 *stats)

> +{

> +	struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);

> +

> +	stats->rx_packets = mhi_netdev->stats.rx_packets;

> +	stats->rx_bytes = mhi_netdev->stats.rx_bytes;

> +	stats->rx_errors = mhi_netdev->stats.rx_errors;

> +	stats->rx_dropped = mhi_netdev->stats.rx_dropped;

> +	stats->tx_packets = mhi_netdev->stats.tx_packets;

> +	stats->tx_bytes = mhi_netdev->stats.tx_bytes;

> +	stats->tx_errors = mhi_netdev->stats.tx_errors;

> +	stats->tx_dropped = mhi_netdev->stats.tx_dropped;

> +}


Can you use 

> +static void mhi_net_dl_callback(struct mhi_device *mhi_dev,

> +				struct mhi_result *mhi_res)

> +{

> +	struct mhi_net_dev *mhi_netdev = dev_get_drvdata(&mhi_dev->dev);

> +	struct sk_buff *skb = mhi_res->buf_addr;

> +

> +	atomic_dec(&mhi_netdev->stats.rx_queued);

> +

> +	if (mhi_res->transaction_status) {

> +		mhi_netdev->stats.rx_errors++;

> +		kfree_skb(skb);

> +	} else {

> +		mhi_netdev->stats.rx_packets++;

> +		mhi_netdev->stats.rx_bytes += mhi_res->bytes_xferd;

> +

> +		skb->protocol = htons(ETH_P_MAP);

> +		skb_put(skb, mhi_res->bytes_xferd);

> +		netif_rx(skb);

> +	}

> +

> +	schedule_delayed_work(&mhi_netdev->rx_refill, 0);


Scheduling a work to replace every single RX buffer looks quite 
inefficient. Any chance you can do batching? I assume mhi_queue_skb()
has to be able to sleep?

> +static void mhi_net_rx_refill_work(struct work_struct *work)

> +{

> +	struct mhi_net_dev *mhi_netdev = container_of(work, struct mhi_net_dev,

> +						      rx_refill.work);

> +	struct net_device *ndev = mhi_netdev->ndev;

> +	struct mhi_device *mdev = mhi_netdev->mdev;

> +	struct sk_buff *skb;

> +	int err;

> +

> +	if (!netif_running(ndev))

> +		return;


How can this happen? You cancel the work from ndo_stop.

> +	do {

> +		skb = netdev_alloc_skb(ndev, READ_ONCE(ndev->mtu));

> +		if (unlikely(!skb)) {

> +			/* If we are starved of RX buffers, retry later */

> +			if (!atomic_read(&mhi_netdev->stats.rx_queued))

> +				schedule_delayed_work(&mhi_netdev->rx_refill, HZ / 2);

> +			break;

> +		}

> +

> +		err = mhi_queue_skb(mdev, DMA_FROM_DEVICE, skb, ndev->mtu,

> +				    MHI_EOT);

> +		if (err) {

> +			atomic_dec(&mhi_netdev->stats.rx_queued);


This can never fail with an empty ring? No need to potentially
reschedule the work here?

> +			kfree_skb(skb);

> +			break;

> +		}

> +

> +		atomic_inc(&mhi_netdev->stats.rx_queued);

> +

> +	} while (1);

> +}

> +

> +static int mhi_net_probe(struct mhi_device *mhi_dev,

> +			 const struct mhi_device_id *id)

> +{

> +	const char *netname = (char *)id->driver_data;

> +	struct mhi_net_dev *mhi_netdev;

> +	struct net_device *ndev;

> +	struct device *dev = &mhi_dev->dev;

> +	int err;

> +

> +	ndev = alloc_netdev(sizeof(*mhi_netdev), netname, NET_NAME_PREDICTABLE,

> +			    mhi_net_setup);

> +	if (!ndev) {

> +		err = -ENOMEM;

> +		return err;


return -ENOMEM;

> +	}

> +

> +	mhi_netdev = netdev_priv(ndev);

> +	dev_set_drvdata(dev, mhi_netdev);

> +	mhi_netdev->ndev = ndev;

> +	mhi_netdev->mdev = mhi_dev;


SET_NETDEV_DEV() ?

> +	INIT_DELAYED_WORK(&mhi_netdev->rx_refill, mhi_net_rx_refill_work);

> +

> +	/* Start MHI channels */

> +	err = mhi_prepare_for_transfer(mhi_dev, 0);

> +	if (err) {

> +		free_netdev(ndev);

> +		return err;

> +	}

> +

> +	err = register_netdev(ndev);

> +	if (err) {

> +		dev_err(dev, "mhi_net: registering device failed\n");

> +		free_netdev(ndev);

> +		return -EINVAL;


Why not propagate the error?

> +	}

> +

> +	return 0;

> +}

> +

> +static void mhi_net_remove(struct mhi_device *mhi_dev)

> +{

> +	struct mhi_net_dev *mhi_netdev = dev_get_drvdata(&mhi_dev->dev);

> +

> +	mhi_unprepare_from_transfer(mhi_netdev->mdev);

> +	unregister_netdev(mhi_netdev->ndev);


Isn't this the wrong way around?

Should you not unregister the netdev before you stop transfers?

> +	/* netdev released from unregister */


> +}
Loic Poulain Oct. 12, 2020, 9:30 a.m. UTC | #3
Hi Jakub, and thanks for your review.

On Sun, 11 Oct 2020 at 20:59, Jakub Kicinski <kuba@kernel.org> wrote:
>

> On Fri,  9 Oct 2020 22:33:31 +0200 Loic Poulain wrote:

> > This patch adds a new network driver implementing MHI transport for

> > network packets. Packets can be in any format, though QMAP (rmnet)

> > is the usual protocol (flow control + PDN mux).

> >

> > It support two MHI devices, IP_HW0 which is, the path to the IPA

> > (IP accelerator) on qcom modem, And IP_SW0 which is the software

> > driven IP path (to modem CPU).

> >

> > Signed-off-by: Loic Poulain <loic.poulain@linaro.org>

>

> > +static int mhi_ndo_xmit(struct sk_buff *skb, struct net_device *ndev)

> > +{

> > +     struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);

> > +     struct mhi_device *mdev = mhi_netdev->mdev;

> > +     int err;

> > +

> > +     /* Only support for single buffer transfer for now */

> > +     err = skb_linearize(skb);

>

> Since you don't advertise NETIF_F_SG you shouldn't have to call this,

> no?


Right, good to know.

>

> > +     if (unlikely(err)) {

> > +             kfree_skb(skb);

> > +             mhi_netdev->stats.tx_dropped++;

> > +             return NETDEV_TX_OK;

> > +     }

> > +

> > +     skb_tx_timestamp(skb);

> > +

> > +     /* mhi_queue_skb is not thread-safe, but xmit is serialized by the

> > +      * network core. Once MHI core will be thread save, migrate to

> > +      * NETIF_F_LLTX support.

> > +      */

> > +     err = mhi_queue_skb(mdev, DMA_TO_DEVICE, skb, skb->len, MHI_EOT);

> > +     if (err) {

> > +             netdev_err(ndev, "mhi_queue_skb err %d\n", err);

>

> This needs to be at least rate limited.


Yes, I've missed removing that message, going to keep rate-limited version
for non-busy error case.

>

> > +             netif_stop_queue(ndev);

>

> What's going to start the queue if it's a transient errors and not

> NETDEV_TX_BUSY?

>

> > +             return (err == -ENOMEM) ? NETDEV_TX_BUSY : err;

>

> You should drop the packet if it's not NETDEV_TX_BUSY, and return

> NETDEV_TX_OK. Don't return negative errors from ndo_xmit.


Ok, going to determine which error it is and act accordingly.

>

> > +     }

> > +

> > +     return NETDEV_TX_OK;

> > +}

> > +

> > +static void mhi_ndo_get_stats64(struct net_device *ndev,

> > +                             struct rtnl_link_stats64 *stats)

> > +{

> > +     struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);

> > +

> > +     stats->rx_packets = mhi_netdev->stats.rx_packets;

> > +     stats->rx_bytes = mhi_netdev->stats.rx_bytes;

> > +     stats->rx_errors = mhi_netdev->stats.rx_errors;

> > +     stats->rx_dropped = mhi_netdev->stats.rx_dropped;

> > +     stats->tx_packets = mhi_netdev->stats.tx_packets;

> > +     stats->tx_bytes = mhi_netdev->stats.tx_bytes;

> > +     stats->tx_errors = mhi_netdev->stats.tx_errors;

> > +     stats->tx_dropped = mhi_netdev->stats.tx_dropped;

> > +}

>

> Can you use


?

>

> > +static void mhi_net_dl_callback(struct mhi_device *mhi_dev,

> > +                             struct mhi_result *mhi_res)

> > +{

> > +     struct mhi_net_dev *mhi_netdev = dev_get_drvdata(&mhi_dev->dev);

> > +     struct sk_buff *skb = mhi_res->buf_addr;

> > +

> > +     atomic_dec(&mhi_netdev->stats.rx_queued);

> > +

> > +     if (mhi_res->transaction_status) {

> > +             mhi_netdev->stats.rx_errors++;

> > +             kfree_skb(skb);

> > +     } else {

> > +             mhi_netdev->stats.rx_packets++;

> > +             mhi_netdev->stats.rx_bytes += mhi_res->bytes_xferd;

> > +

> > +             skb->protocol = htons(ETH_P_MAP);

> > +             skb_put(skb, mhi_res->bytes_xferd);

> > +             netif_rx(skb);

> > +     }

> > +

> > +     schedule_delayed_work(&mhi_netdev->rx_refill, 0);

>

> Scheduling a work to replace every single RX buffer looks quite

> inefficient. Any chance you can do batching? I assume mhi_queue_skb()

> has to be able to sleep?


There is already some kind of batching, the hardware can perform interrupt
coalescing (called interrupt mitigation in case of MHI), which, in high traffic
case will cause the dl_callback to be called in row for multiple packets, and
so the work to be scheduled only once. mhi_queue_skb does not sleep.

However we could implement some additional mitigation by e.g. only scheduling
the work if the current rx-queue fall under a certain limit (e.g.
queue size / 2), like it is
done in virtio-net. What do you think?

>

> > +static void mhi_net_rx_refill_work(struct work_struct *work)

> > +{

> > +     struct mhi_net_dev *mhi_netdev = container_of(work, struct mhi_net_dev,

> > +                                                   rx_refill.work);

> > +     struct net_device *ndev = mhi_netdev->ndev;

> > +     struct mhi_device *mdev = mhi_netdev->mdev;

> > +     struct sk_buff *skb;

> > +     int err;

> > +

> > +     if (!netif_running(ndev))

> > +             return;

>

> How can this happen? You cancel the work from ndo_stop.


Right, If the work is executed while we are currently canceling it, I wanted
to prevent the work to fully run and reschedule. But yes it's not strictly
necessary since cancel_work_sync will 1. wait for the job to exit and
2. dequeue the work. Will remove that.

>

> > +     do {

> > +             skb = netdev_alloc_skb(ndev, READ_ONCE(ndev->mtu));

> > +             if (unlikely(!skb)) {

> > +                     /* If we are starved of RX buffers, retry later */

> > +                     if (!atomic_read(&mhi_netdev->stats.rx_queued))

> > +                             schedule_delayed_work(&mhi_netdev->rx_refill, HZ / 2);

> > +                     break;

> > +             }

> > +

> > +             err = mhi_queue_skb(mdev, DMA_FROM_DEVICE, skb, ndev->mtu,

> > +                                 MHI_EOT);

> > +             if (err) {

> > +                     atomic_dec(&mhi_netdev->stats.rx_queued);

>

> This can never fail with an empty ring? No need to potentially

> reschedule the work here?


Well, it can fail because IO/transient error, so yes, I need to check that
case and reschedule if necessary.

>

> > +                     kfree_skb(skb);

> > +                     break;

> > +             }

> > +

> > +             atomic_inc(&mhi_netdev->stats.rx_queued);

> > +

> > +     } while (1);

> > +}

> > +

> > +static int mhi_net_probe(struct mhi_device *mhi_dev,

> > +                      const struct mhi_device_id *id)

> > +{

> > +     const char *netname = (char *)id->driver_data;

> > +     struct mhi_net_dev *mhi_netdev;

> > +     struct net_device *ndev;

> > +     struct device *dev = &mhi_dev->dev;

> > +     int err;

> > +

> > +     ndev = alloc_netdev(sizeof(*mhi_netdev), netname, NET_NAME_PREDICTABLE,

> > +                         mhi_net_setup);

> > +     if (!ndev) {

> > +             err = -ENOMEM;

> > +             return err;

>

> return -ENOMEM;

>

> > +     }

> > +

> > +     mhi_netdev = netdev_priv(ndev);

> > +     dev_set_drvdata(dev, mhi_netdev);

> > +     mhi_netdev->ndev = ndev;

> > +     mhi_netdev->mdev = mhi_dev;

>

> SET_NETDEV_DEV() ?


Ok.

>

> > +     INIT_DELAYED_WORK(&mhi_netdev->rx_refill, mhi_net_rx_refill_work);

> > +

> > +     /* Start MHI channels */

> > +     err = mhi_prepare_for_transfer(mhi_dev, 0);

> > +     if (err) {

> > +             free_netdev(ndev);

> > +             return err;

> > +     }

> > +

> > +     err = register_netdev(ndev);

> > +     if (err) {

> > +             dev_err(dev, "mhi_net: registering device failed\n");

> > +             free_netdev(ndev);

> > +             return -EINVAL;

>

> Why not propagate the error?


Will do.

>

> > +     }

> > +

> > +     return 0;

> > +}

> > +

> > +static void mhi_net_remove(struct mhi_device *mhi_dev)

> > +{

> > +     struct mhi_net_dev *mhi_netdev = dev_get_drvdata(&mhi_dev->dev);

> > +

> > +     mhi_unprepare_from_transfer(mhi_netdev->mdev);

> > +     unregister_netdev(mhi_netdev->ndev);

>

> Isn't this the wrong way around?

>

> Should you not unregister the netdev before you stop transfers?


That can be done that way, but wanted to be sure that no transfer callback
is called after netdev has been released (freed in unregister), though the MHI
core takes care of that in its remove procedure.

>

> > +     /* netdev released from unregister */

>

> > +}


Thanks,
Loic
Dan Williams Oct. 12, 2020, 2:34 p.m. UTC | #4
On Fri, 2020-10-09 at 22:33 +0200, Loic Poulain wrote:
> This patch adds a new network driver implementing MHI transport for

> network packets. Packets can be in any format, though QMAP (rmnet)

> is the usual protocol (flow control + PDN mux).

> 

> It support two MHI devices, IP_HW0 which is, the path to the IPA

> (IP accelerator) on qcom modem, And IP_SW0 which is the software

> driven IP path (to modem CPU).

> 

> Signed-off-by: Loic Poulain <loic.poulain@linaro.org>

> ---

>  drivers/net/Kconfig   |   7 ++

>  drivers/net/Makefile  |   1 +

>  drivers/net/mhi_net.c | 281

> ++++++++++++++++++++++++++++++++++++++++++++++++++

>  3 files changed, 289 insertions(+)

>  create mode 100644 drivers/net/mhi_net.c

> 

> diff --git a/drivers/net/Kconfig b/drivers/net/Kconfig

> index 1368d1d..11a6357 100644

> --- a/drivers/net/Kconfig

> +++ b/drivers/net/Kconfig

> @@ -426,6 +426,13 @@ config VSOCKMON

>  	  mostly intended for developers or support to debug vsock

> issues. If

>  	  unsure, say N.

>  

> +config MHI_NET

> +	tristate "MHI network driver"

> +	depends on MHI_BUS

> +	help

> +	  This is the network driver for MHI.  It can be used with

> +	  QCOM based WWAN modems (like SDX55).  Say Y or M.

> +

>  endif # NET_CORE

>  

>  config SUNGEM_PHY

> diff --git a/drivers/net/Makefile b/drivers/net/Makefile

> index 94b6080..8312037 100644

> --- a/drivers/net/Makefile

> +++ b/drivers/net/Makefile

> @@ -34,6 +34,7 @@ obj-$(CONFIG_GTP) += gtp.o

>  obj-$(CONFIG_NLMON) += nlmon.o

>  obj-$(CONFIG_NET_VRF) += vrf.o

>  obj-$(CONFIG_VSOCKMON) += vsockmon.o

> +obj-$(CONFIG_MHI_NET) += mhi_net.o

>  

>  #

>  # Networking Drivers

> diff --git a/drivers/net/mhi_net.c b/drivers/net/mhi_net.c

> new file mode 100644

> index 0000000..f66248e

> --- /dev/null

> +++ b/drivers/net/mhi_net.c

> @@ -0,0 +1,281 @@

> +// SPDX-License-Identifier: GPL-2.0-or-later

> +/* MHI Network driver - Network over MHI

> + *

> + * Copyright (C) 2020 Linaro Ltd <loic.poulain@linaro.org>

> + */

> +

> +#include <linux/if_arp.h>

> +#include <linux/mhi.h>

> +#include <linux/mod_devicetable.h>

> +#include <linux/module.h>

> +#include <linux/netdevice.h>

> +#include <linux/skbuff.h>

> +

> +#define MIN_MTU		ETH_MIN_MTU

> +#define MAX_MTU		0xffff

> +#define DEFAULT_MTU	8192

> +

> +struct mhi_net_stats {

> +	u64 rx_packets;

> +	u64 rx_bytes;

> +	u64 rx_errors;

> +	u64 rx_dropped;

> +	u64 tx_packets;

> +	u64 tx_bytes;

> +	u64 tx_errors;

> +	u64 tx_dropped;

> +	atomic_t rx_queued;

> +};

> +

> +struct mhi_net_dev {

> +	struct mhi_device *mdev;

> +	struct net_device *ndev;

> +	struct delayed_work rx_refill;

> +	struct mhi_net_stats stats;

> +};

> +

> +static int mhi_ndo_open(struct net_device *ndev)

> +{

> +	struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);

> +

> +	/* Feed the rx buffer pool */

> +	schedule_delayed_work(&mhi_netdev->rx_refill, 0);

> +

> +	/* Carrier is established via out-of-band channel (e.g. qmi) */

> +	netif_carrier_on(ndev);

> +

> +	netif_start_queue(ndev);

> +

> +	return 0;

> +}

> +

> +static int mhi_ndo_stop(struct net_device *ndev)

> +{

> +	struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);

> +

> +	netif_stop_queue(ndev);

> +	netif_carrier_off(ndev);

> +	cancel_delayed_work_sync(&mhi_netdev->rx_refill);

> +

> +	return 0;

> +}

> +

> +static int mhi_ndo_xmit(struct sk_buff *skb, struct net_device

> *ndev)

> +{

> +	struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);

> +	struct mhi_device *mdev = mhi_netdev->mdev;

> +	int err;

> +

> +	/* Only support for single buffer transfer for now */

> +	err = skb_linearize(skb);

> +	if (unlikely(err)) {

> +		kfree_skb(skb);

> +		mhi_netdev->stats.tx_dropped++;

> +		return NETDEV_TX_OK;

> +	}

> +

> +	skb_tx_timestamp(skb);

> +

> +	/* mhi_queue_skb is not thread-safe, but xmit is serialized by

> the

> +	 * network core. Once MHI core will be thread save, migrate to

> +	 * NETIF_F_LLTX support.

> +	 */

> +	err = mhi_queue_skb(mdev, DMA_TO_DEVICE, skb, skb->len,

> MHI_EOT);

> +	if (err) {

> +		netdev_err(ndev, "mhi_queue_skb err %d\n", err);

> +		netif_stop_queue(ndev);

> +		return (err == -ENOMEM) ? NETDEV_TX_BUSY : err;

> +	}

> +

> +	return NETDEV_TX_OK;

> +}

> +

> +static void mhi_ndo_get_stats64(struct net_device *ndev,

> +				struct rtnl_link_stats64 *stats)

> +{

> +	struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);

> +

> +	stats->rx_packets = mhi_netdev->stats.rx_packets;

> +	stats->rx_bytes = mhi_netdev->stats.rx_bytes;

> +	stats->rx_errors = mhi_netdev->stats.rx_errors;

> +	stats->rx_dropped = mhi_netdev->stats.rx_dropped;

> +	stats->tx_packets = mhi_netdev->stats.tx_packets;

> +	stats->tx_bytes = mhi_netdev->stats.tx_bytes;

> +	stats->tx_errors = mhi_netdev->stats.tx_errors;

> +	stats->tx_dropped = mhi_netdev->stats.tx_dropped;

> +}

> +

> +static const struct net_device_ops mhi_netdev_ops = {

> +	.ndo_open               = mhi_ndo_open,

> +	.ndo_stop               = mhi_ndo_stop,

> +	.ndo_start_xmit         = mhi_ndo_xmit,

> +	.ndo_get_stats64	= mhi_ndo_get_stats64,

> +};

> +

> +static void mhi_net_setup(struct net_device *ndev)

> +{

> +	ndev->header_ops = NULL;  /* No header */

> +	ndev->type = ARPHRD_NONE; /* QMAP... */

> +	ndev->hard_header_len = 0;

> +	ndev->addr_len = 0;

> +	ndev->flags &= ~(IFF_BROADCAST | IFF_MULTICAST);

> +	ndev->netdev_ops = &mhi_netdev_ops;

> +	ndev->mtu = DEFAULT_MTU;

> +	ndev->min_mtu = MIN_MTU;

> +	ndev->max_mtu = MAX_MTU;

> +	ndev->needs_free_netdev = true;

> +	ndev->tx_queue_len = 1000;

> +}

> +

> +static void mhi_net_dl_callback(struct mhi_device *mhi_dev,

> +				struct mhi_result *mhi_res)

> +{

> +	struct mhi_net_dev *mhi_netdev = dev_get_drvdata(&mhi_dev-

> >dev);

> +	struct sk_buff *skb = mhi_res->buf_addr;

> +

> +	atomic_dec(&mhi_netdev->stats.rx_queued);

> +

> +	if (mhi_res->transaction_status) {

> +		mhi_netdev->stats.rx_errors++;

> +		kfree_skb(skb);

> +	} else {

> +		mhi_netdev->stats.rx_packets++;

> +		mhi_netdev->stats.rx_bytes += mhi_res->bytes_xferd;

> +

> +		skb->protocol = htons(ETH_P_MAP);

> +		skb_put(skb, mhi_res->bytes_xferd);

> +		netif_rx(skb);

> +	}

> +

> +	schedule_delayed_work(&mhi_netdev->rx_refill, 0);

> +}

> +

> +static void mhi_net_ul_callback(struct mhi_device *mhi_dev,

> +				struct mhi_result *mhi_res)

> +{

> +	struct mhi_net_dev *mhi_netdev = dev_get_drvdata(&mhi_dev-

> >dev);

> +	struct net_device *ndev = mhi_netdev->ndev;

> +	struct sk_buff *skb = mhi_res->buf_addr;

> +

> +	/* Hardware has consumed the buffer, so free the skb (which is

> not

> +	 * freed by the MHI stack) and perform accounting.

> +	 */

> +	consume_skb(skb);

> +

> +	if (unlikely(mhi_res->transaction_status)) {

> +		mhi_netdev->stats.tx_errors++;

> +	} else {

> +		mhi_netdev->stats.tx_packets++;

> +		mhi_netdev->stats.tx_bytes += mhi_res->bytes_xferd;

> +	}

> +

> +	if (netif_queue_stopped(ndev))

> +		netif_wake_queue(ndev);

> +}

> +

> +static void mhi_net_rx_refill_work(struct work_struct *work)

> +{

> +	struct mhi_net_dev *mhi_netdev = container_of(work, struct

> mhi_net_dev,

> +						      rx_refill.work);

> +	struct net_device *ndev = mhi_netdev->ndev;

> +	struct mhi_device *mdev = mhi_netdev->mdev;

> +	struct sk_buff *skb;

> +	int err;

> +

> +	if (!netif_running(ndev))

> +		return;

> +

> +	do {

> +		skb = netdev_alloc_skb(ndev, READ_ONCE(ndev->mtu));

> +		if (unlikely(!skb)) {

> +			/* If we are starved of RX buffers, retry later

> */

> +			if (!atomic_read(&mhi_netdev->stats.rx_queued))

> +				schedule_delayed_work(&mhi_netdev-

> >rx_refill, HZ / 2);

> +			break;

> +		}

> +

> +		err = mhi_queue_skb(mdev, DMA_FROM_DEVICE, skb, ndev-

> >mtu,

> +				    MHI_EOT);

> +		if (err) {

> +			atomic_dec(&mhi_netdev->stats.rx_queued);

> +			kfree_skb(skb);

> +			break;

> +		}

> +

> +		atomic_inc(&mhi_netdev->stats.rx_queued);

> +

> +	} while (1);

> +}

> +

> +static int mhi_net_probe(struct mhi_device *mhi_dev,

> +			 const struct mhi_device_id *id)

> +{

> +	const char *netname = (char *)id->driver_data;

> +	struct mhi_net_dev *mhi_netdev;

> +	struct net_device *ndev;

> +	struct device *dev = &mhi_dev->dev;

> +	int err;

> +

> +	ndev = alloc_netdev(sizeof(*mhi_netdev), netname,

> NET_NAME_PREDICTABLE,

> +			    mhi_net_setup);

> +	if (!ndev) {

> +		err = -ENOMEM;

> +		return err;

> +	}

> +

> +	mhi_netdev = netdev_priv(ndev);

> +	dev_set_drvdata(dev, mhi_netdev);

> +	mhi_netdev->ndev = ndev;

> +	mhi_netdev->mdev = mhi_dev;


SET_NETDEV_DEV(netdev, &mhi_dev->dev); ?

Let's at least set the sysfs links up right...

> +

> +	INIT_DELAYED_WORK(&mhi_netdev->rx_refill,

> mhi_net_rx_refill_work);

> +

> +	/* Start MHI channels */

> +	err = mhi_prepare_for_transfer(mhi_dev, 0);

> +	if (err) {

> +		free_netdev(ndev);

> +		return err;

> +	}

> +

> +	err = register_netdev(ndev);

> +	if (err) {

> +		dev_err(dev, "mhi_net: registering device failed\n");

> +		free_netdev(ndev);

> +		return -EINVAL;

> +	}

> +

> +	return 0;

> +}

> +

> +static void mhi_net_remove(struct mhi_device *mhi_dev)

> +{

> +	struct mhi_net_dev *mhi_netdev = dev_get_drvdata(&mhi_dev-

> >dev);

> +

> +	mhi_unprepare_from_transfer(mhi_netdev->mdev);

> +	unregister_netdev(mhi_netdev->ndev);

> +	/* netdev released from unregister */

> +}

> +

> +static const struct mhi_device_id mhi_net_id_table[] = {

> +	{ .chan = "IP_HW0", .driver_data = (kernel_ulong_t)"mhi_hwip%d"

> },

> +	{ .chan = "IP_SW0", .driver_data = (kernel_ulong_t)"mhi_swip%d"

> },

> +	{}

> +};

> +MODULE_DEVICE_TABLE(mhi, mhi_net_id_table);

> +

> +static struct mhi_driver mhi_net_driver = {

> +	.probe = mhi_net_probe,

> +	.remove = mhi_net_remove,

> +	.dl_xfer_cb = mhi_net_dl_callback,

> +	.ul_xfer_cb = mhi_net_ul_callback,

> +	.id_table = mhi_net_id_table,

> +	.driver = {

> +		.name = "mhi_net",

> +	},

> +};

> +

> +module_mhi_driver(mhi_net_driver);

> +

> +MODULE_AUTHOR("Loic Poulain <loic.poulain@linaro.org>");

> +MODULE_DESCRIPTION("Network over MHI");

> +MODULE_LICENSE("GPL v2");
diff mbox series

Patch

diff --git a/drivers/net/Kconfig b/drivers/net/Kconfig
index 1368d1d..11a6357 100644
--- a/drivers/net/Kconfig
+++ b/drivers/net/Kconfig
@@ -426,6 +426,13 @@  config VSOCKMON
 	  mostly intended for developers or support to debug vsock issues. If
 	  unsure, say N.
 
+config MHI_NET
+	tristate "MHI network driver"
+	depends on MHI_BUS
+	help
+	  This is the network driver for MHI.  It can be used with
+	  QCOM based WWAN modems (like SDX55).  Say Y or M.
+
 endif # NET_CORE
 
 config SUNGEM_PHY
diff --git a/drivers/net/Makefile b/drivers/net/Makefile
index 94b6080..8312037 100644
--- a/drivers/net/Makefile
+++ b/drivers/net/Makefile
@@ -34,6 +34,7 @@  obj-$(CONFIG_GTP) += gtp.o
 obj-$(CONFIG_NLMON) += nlmon.o
 obj-$(CONFIG_NET_VRF) += vrf.o
 obj-$(CONFIG_VSOCKMON) += vsockmon.o
+obj-$(CONFIG_MHI_NET) += mhi_net.o
 
 #
 # Networking Drivers
diff --git a/drivers/net/mhi_net.c b/drivers/net/mhi_net.c
new file mode 100644
index 0000000..f66248e
--- /dev/null
+++ b/drivers/net/mhi_net.c
@@ -0,0 +1,281 @@ 
+// SPDX-License-Identifier: GPL-2.0-or-later
+/* MHI Network driver - Network over MHI
+ *
+ * Copyright (C) 2020 Linaro Ltd <loic.poulain@linaro.org>
+ */
+
+#include <linux/if_arp.h>
+#include <linux/mhi.h>
+#include <linux/mod_devicetable.h>
+#include <linux/module.h>
+#include <linux/netdevice.h>
+#include <linux/skbuff.h>
+
+#define MIN_MTU		ETH_MIN_MTU
+#define MAX_MTU		0xffff
+#define DEFAULT_MTU	8192
+
+struct mhi_net_stats {
+	u64 rx_packets;
+	u64 rx_bytes;
+	u64 rx_errors;
+	u64 rx_dropped;
+	u64 tx_packets;
+	u64 tx_bytes;
+	u64 tx_errors;
+	u64 tx_dropped;
+	atomic_t rx_queued;
+};
+
+struct mhi_net_dev {
+	struct mhi_device *mdev;
+	struct net_device *ndev;
+	struct delayed_work rx_refill;
+	struct mhi_net_stats stats;
+};
+
+static int mhi_ndo_open(struct net_device *ndev)
+{
+	struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);
+
+	/* Feed the rx buffer pool */
+	schedule_delayed_work(&mhi_netdev->rx_refill, 0);
+
+	/* Carrier is established via out-of-band channel (e.g. qmi) */
+	netif_carrier_on(ndev);
+
+	netif_start_queue(ndev);
+
+	return 0;
+}
+
+static int mhi_ndo_stop(struct net_device *ndev)
+{
+	struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);
+
+	netif_stop_queue(ndev);
+	netif_carrier_off(ndev);
+	cancel_delayed_work_sync(&mhi_netdev->rx_refill);
+
+	return 0;
+}
+
+static int mhi_ndo_xmit(struct sk_buff *skb, struct net_device *ndev)
+{
+	struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);
+	struct mhi_device *mdev = mhi_netdev->mdev;
+	int err;
+
+	/* Only support for single buffer transfer for now */
+	err = skb_linearize(skb);
+	if (unlikely(err)) {
+		kfree_skb(skb);
+		mhi_netdev->stats.tx_dropped++;
+		return NETDEV_TX_OK;
+	}
+
+	skb_tx_timestamp(skb);
+
+	/* mhi_queue_skb is not thread-safe, but xmit is serialized by the
+	 * network core. Once MHI core will be thread save, migrate to
+	 * NETIF_F_LLTX support.
+	 */
+	err = mhi_queue_skb(mdev, DMA_TO_DEVICE, skb, skb->len, MHI_EOT);
+	if (err) {
+		netdev_err(ndev, "mhi_queue_skb err %d\n", err);
+		netif_stop_queue(ndev);
+		return (err == -ENOMEM) ? NETDEV_TX_BUSY : err;
+	}
+
+	return NETDEV_TX_OK;
+}
+
+static void mhi_ndo_get_stats64(struct net_device *ndev,
+				struct rtnl_link_stats64 *stats)
+{
+	struct mhi_net_dev *mhi_netdev = netdev_priv(ndev);
+
+	stats->rx_packets = mhi_netdev->stats.rx_packets;
+	stats->rx_bytes = mhi_netdev->stats.rx_bytes;
+	stats->rx_errors = mhi_netdev->stats.rx_errors;
+	stats->rx_dropped = mhi_netdev->stats.rx_dropped;
+	stats->tx_packets = mhi_netdev->stats.tx_packets;
+	stats->tx_bytes = mhi_netdev->stats.tx_bytes;
+	stats->tx_errors = mhi_netdev->stats.tx_errors;
+	stats->tx_dropped = mhi_netdev->stats.tx_dropped;
+}
+
+static const struct net_device_ops mhi_netdev_ops = {
+	.ndo_open               = mhi_ndo_open,
+	.ndo_stop               = mhi_ndo_stop,
+	.ndo_start_xmit         = mhi_ndo_xmit,
+	.ndo_get_stats64	= mhi_ndo_get_stats64,
+};
+
+static void mhi_net_setup(struct net_device *ndev)
+{
+	ndev->header_ops = NULL;  /* No header */
+	ndev->type = ARPHRD_NONE; /* QMAP... */
+	ndev->hard_header_len = 0;
+	ndev->addr_len = 0;
+	ndev->flags &= ~(IFF_BROADCAST | IFF_MULTICAST);
+	ndev->netdev_ops = &mhi_netdev_ops;
+	ndev->mtu = DEFAULT_MTU;
+	ndev->min_mtu = MIN_MTU;
+	ndev->max_mtu = MAX_MTU;
+	ndev->needs_free_netdev = true;
+	ndev->tx_queue_len = 1000;
+}
+
+static void mhi_net_dl_callback(struct mhi_device *mhi_dev,
+				struct mhi_result *mhi_res)
+{
+	struct mhi_net_dev *mhi_netdev = dev_get_drvdata(&mhi_dev->dev);
+	struct sk_buff *skb = mhi_res->buf_addr;
+
+	atomic_dec(&mhi_netdev->stats.rx_queued);
+
+	if (mhi_res->transaction_status) {
+		mhi_netdev->stats.rx_errors++;
+		kfree_skb(skb);
+	} else {
+		mhi_netdev->stats.rx_packets++;
+		mhi_netdev->stats.rx_bytes += mhi_res->bytes_xferd;
+
+		skb->protocol = htons(ETH_P_MAP);
+		skb_put(skb, mhi_res->bytes_xferd);
+		netif_rx(skb);
+	}
+
+	schedule_delayed_work(&mhi_netdev->rx_refill, 0);
+}
+
+static void mhi_net_ul_callback(struct mhi_device *mhi_dev,
+				struct mhi_result *mhi_res)
+{
+	struct mhi_net_dev *mhi_netdev = dev_get_drvdata(&mhi_dev->dev);
+	struct net_device *ndev = mhi_netdev->ndev;
+	struct sk_buff *skb = mhi_res->buf_addr;
+
+	/* Hardware has consumed the buffer, so free the skb (which is not
+	 * freed by the MHI stack) and perform accounting.
+	 */
+	consume_skb(skb);
+
+	if (unlikely(mhi_res->transaction_status)) {
+		mhi_netdev->stats.tx_errors++;
+	} else {
+		mhi_netdev->stats.tx_packets++;
+		mhi_netdev->stats.tx_bytes += mhi_res->bytes_xferd;
+	}
+
+	if (netif_queue_stopped(ndev))
+		netif_wake_queue(ndev);
+}
+
+static void mhi_net_rx_refill_work(struct work_struct *work)
+{
+	struct mhi_net_dev *mhi_netdev = container_of(work, struct mhi_net_dev,
+						      rx_refill.work);
+	struct net_device *ndev = mhi_netdev->ndev;
+	struct mhi_device *mdev = mhi_netdev->mdev;
+	struct sk_buff *skb;
+	int err;
+
+	if (!netif_running(ndev))
+		return;
+
+	do {
+		skb = netdev_alloc_skb(ndev, READ_ONCE(ndev->mtu));
+		if (unlikely(!skb)) {
+			/* If we are starved of RX buffers, retry later */
+			if (!atomic_read(&mhi_netdev->stats.rx_queued))
+				schedule_delayed_work(&mhi_netdev->rx_refill, HZ / 2);
+			break;
+		}
+
+		err = mhi_queue_skb(mdev, DMA_FROM_DEVICE, skb, ndev->mtu,
+				    MHI_EOT);
+		if (err) {
+			atomic_dec(&mhi_netdev->stats.rx_queued);
+			kfree_skb(skb);
+			break;
+		}
+
+		atomic_inc(&mhi_netdev->stats.rx_queued);
+
+	} while (1);
+}
+
+static int mhi_net_probe(struct mhi_device *mhi_dev,
+			 const struct mhi_device_id *id)
+{
+	const char *netname = (char *)id->driver_data;
+	struct mhi_net_dev *mhi_netdev;
+	struct net_device *ndev;
+	struct device *dev = &mhi_dev->dev;
+	int err;
+
+	ndev = alloc_netdev(sizeof(*mhi_netdev), netname, NET_NAME_PREDICTABLE,
+			    mhi_net_setup);
+	if (!ndev) {
+		err = -ENOMEM;
+		return err;
+	}
+
+	mhi_netdev = netdev_priv(ndev);
+	dev_set_drvdata(dev, mhi_netdev);
+	mhi_netdev->ndev = ndev;
+	mhi_netdev->mdev = mhi_dev;
+
+	INIT_DELAYED_WORK(&mhi_netdev->rx_refill, mhi_net_rx_refill_work);
+
+	/* Start MHI channels */
+	err = mhi_prepare_for_transfer(mhi_dev, 0);
+	if (err) {
+		free_netdev(ndev);
+		return err;
+	}
+
+	err = register_netdev(ndev);
+	if (err) {
+		dev_err(dev, "mhi_net: registering device failed\n");
+		free_netdev(ndev);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static void mhi_net_remove(struct mhi_device *mhi_dev)
+{
+	struct mhi_net_dev *mhi_netdev = dev_get_drvdata(&mhi_dev->dev);
+
+	mhi_unprepare_from_transfer(mhi_netdev->mdev);
+	unregister_netdev(mhi_netdev->ndev);
+	/* netdev released from unregister */
+}
+
+static const struct mhi_device_id mhi_net_id_table[] = {
+	{ .chan = "IP_HW0", .driver_data = (kernel_ulong_t)"mhi_hwip%d" },
+	{ .chan = "IP_SW0", .driver_data = (kernel_ulong_t)"mhi_swip%d" },
+	{}
+};
+MODULE_DEVICE_TABLE(mhi, mhi_net_id_table);
+
+static struct mhi_driver mhi_net_driver = {
+	.probe = mhi_net_probe,
+	.remove = mhi_net_remove,
+	.dl_xfer_cb = mhi_net_dl_callback,
+	.ul_xfer_cb = mhi_net_ul_callback,
+	.id_table = mhi_net_id_table,
+	.driver = {
+		.name = "mhi_net",
+	},
+};
+
+module_mhi_driver(mhi_net_driver);
+
+MODULE_AUTHOR("Loic Poulain <loic.poulain@linaro.org>");
+MODULE_DESCRIPTION("Network over MHI");
+MODULE_LICENSE("GPL v2");