[linux-block.git] / net / caif / caif_usb.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * CAIF USB handler
 * Copyright (C) ST-Ericsson AB 2011
 * Author:	Sjur Brendeland
 */

#define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__

#include <linux/module.h>
#include <linux/netdevice.h>
#include <linux/slab.h>
#include <linux/mii.h>
#include <linux/usb.h>
#include <linux/usb/usbnet.h>
#include <linux/etherdevice.h>
#include <net/netns/generic.h>
#include <net/caif/caif_dev.h>
#include <net/caif/caif_layer.h>
#include <net/caif/cfpkt.h>
#include <net/caif/cfcnfg.h>

MODULE_LICENSE("GPL");

#define CFUSB_PAD_DESCR_SZ 1	/* Alignment descriptor length */
#define CFUSB_ALIGNMENT 4	/* Number of bytes to align. */
#define CFUSB_MAX_HEADLEN (CFUSB_PAD_DESCR_SZ + CFUSB_ALIGNMENT-1)
#define STE_USB_VID 0x04cc	/* USB Product ID for ST-Ericsson */
#define STE_USB_PID_CAIF 0x230f	/* Product id for CAIF Modems */

struct cfusbl {
	struct cflayer layer;
	u8 tx_eth_hdr[ETH_HLEN];
};

static bool pack_added;

static int cfusbl_receive(struct cflayer *layr, struct cfpkt *pkt)
{
	u8 hpad;

	/* Remove padding. */
	cfpkt_extr_head(pkt, &hpad, 1);
	cfpkt_extr_head(pkt, NULL, hpad);
	return layr->up->receive(layr->up, pkt);
}

static int cfusbl_transmit(struct cflayer *layr, struct cfpkt *pkt)
{
	struct caif_payload_info *info;
	u8 hpad;
	u8 zeros[CFUSB_ALIGNMENT];
	struct sk_buff *skb;
	struct cfusbl *usbl = container_of(layr, struct cfusbl, layer);

	skb = cfpkt_tonative(pkt);

	skb_reset_network_header(skb);
	skb->protocol = htons(ETH_P_IP);

	info = cfpkt_info(pkt);
	hpad = (info->hdr_len + CFUSB_PAD_DESCR_SZ) & (CFUSB_ALIGNMENT - 1);

	if (skb_headroom(skb) < ETH_HLEN + CFUSB_PAD_DESCR_SZ + hpad) {
		pr_warn("Headroom too small\n");
		kfree_skb(skb);
		return -EIO;
	}
	memset(zeros, 0, hpad);

	cfpkt_add_head(pkt, zeros, hpad);
	cfpkt_add_head(pkt, &hpad, 1);
	cfpkt_add_head(pkt, usbl->tx_eth_hdr, sizeof(usbl->tx_eth_hdr));
	return layr->dn->transmit(layr->dn, pkt);
}

static void cfusbl_ctrlcmd(struct cflayer *layr, enum caif_ctrlcmd ctrl,
			   int phyid)
{
	if (layr->up && layr->up->ctrlcmd)
		layr->up->ctrlcmd(layr->up, ctrl, layr->id);
}

static struct cflayer *cfusbl_create(int phyid, const u8 ethaddr[ETH_ALEN],
				      u8 braddr[ETH_ALEN])
{
	struct cfusbl *this = kmalloc(sizeof(struct cfusbl), GFP_ATOMIC);

	if (!this)
		return NULL;

	caif_assert(offsetof(struct cfusbl, layer) == 0);

	memset(&this->layer, 0, sizeof(this->layer));
	this->layer.receive = cfusbl_receive;
	this->layer.transmit = cfusbl_transmit;
	this->layer.ctrlcmd = cfusbl_ctrlcmd;
	snprintf(this->layer.name, CAIF_LAYER_NAME_SZ, "usb%d", phyid);
	this->layer.id = phyid;

	/*
	 * Construct TX ethernet header:
	 *	0-5	destination address
	 *	5-11	source address
	 *	12-13	protocol type
	 */
	ether_addr_copy(&this->tx_eth_hdr[ETH_ALEN], braddr);
	ether_addr_copy(&this->tx_eth_hdr[ETH_ALEN], ethaddr);
	this->tx_eth_hdr[12] = cpu_to_be16(ETH_P_802_EX1) & 0xff;
	this->tx_eth_hdr[13] = (cpu_to_be16(ETH_P_802_EX1) >> 8) & 0xff;
	pr_debug("caif ethernet TX-header dst:%pM src:%pM type:%02x%02x\n",
			this->tx_eth_hdr, this->tx_eth_hdr + ETH_ALEN,
			this->tx_eth_hdr[12], this->tx_eth_hdr[13]);

	return (struct cflayer *) this;
}

static void cfusbl_release(struct cflayer *layer)
{
	kfree(layer);
}

static struct packet_type caif_usb_type __read_mostly = {
	.type = cpu_to_be16(ETH_P_802_EX1),
};

static int cfusbl_device_notify(struct notifier_block *me, unsigned long what,
				void *ptr)
{
	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
	struct caif_dev_common common;
	struct cflayer *layer, *link_support;
	struct usbnet *usbnet;
	struct usb_device *usbdev;
	int res;

	if (what == NETDEV_UNREGISTER && dev->reg_state >= NETREG_UNREGISTERED)
		return 0;

	/* Check whether we have a NCM device, and find its VID/PID. */
	if (!(dev->dev.parent && dev->dev.parent->driver &&
	      strcmp(dev->dev.parent->driver->name, "cdc_ncm") == 0))
		return 0;

	usbnet = netdev_priv(dev);
	usbdev = usbnet->udev;

	pr_debug("USB CDC NCM device VID:0x%4x PID:0x%4x\n",
		le16_to_cpu(usbdev->descriptor.idVendor),
		le16_to_cpu(usbdev->descriptor.idProduct));

	/* Check for VID/PID that supports CAIF */
	if (!(le16_to_cpu(usbdev->descriptor.idVendor) == STE_USB_VID &&
		le16_to_cpu(usbdev->descriptor.idProduct) == STE_USB_PID_CAIF))
		return 0;

	if (what == NETDEV_UNREGISTER)
		module_put(THIS_MODULE);

	if (what != NETDEV_REGISTER)
		return 0;

	__module_get(THIS_MODULE);

	memset(&common, 0, sizeof(common));
	common.use_frag = false;
	common.use_fcs = false;
	common.use_stx = false;
	common.link_select = CAIF_LINK_HIGH_BANDW;
	common.flowctrl = NULL;

	link_support = cfusbl_create(dev->ifindex, dev->dev_addr,
					dev->broadcast);

	if (!link_support)
		return -ENOMEM;

	if (dev->num_tx_queues > 1)
		pr_warn("USB device uses more than one tx queue\n");

	res = caif_enroll_dev(dev, &common, link_support, CFUSB_MAX_HEADLEN,
			&layer, &caif_usb_type.func);
	if (res)
		goto err;

	if (!pack_added)
		dev_add_pack(&caif_usb_type);
	pack_added = true;

	strscpy(layer->name, dev->name, sizeof(layer->name));

	return 0;
err:
	cfusbl_release(link_support);
	return res;
}

static struct notifier_block caif_device_notifier = {
	.notifier_call = cfusbl_device_notify,
	.priority = 0,
};

static int __init cfusbl_init(void)
{
	return register_netdevice_notifier(&caif_device_notifier);
}

static void __exit cfusbl_exit(void)
{
	unregister_netdevice_notifier(&caif_device_notifier);
	dev_remove_pack(&caif_usb_type);
}

module_init(cfusbl_init);
module_exit(cfusbl_exit);
Commit	Line	Data
af873fce	1	// SPDX-License-Identifier: GPL-2.0-only
7ad65bf6	2	/*
	3	* CAIF USB handler
	4	* Copyright (C) ST-Ericsson AB 2011
26ee65e6	5	* Author: Sjur Brendeland
7ad65bf6	6	*/
	7
	8	#define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__
	9
	10	#include <linux/module.h>
	11	#include <linux/netdevice.h>
	12	#include <linux/slab.h>
7ad65bf6	13	#include <linux/mii.h>
	14	#include <linux/usb.h>
	15	#include <linux/usb/usbnet.h>
14e48144	16	#include <linux/etherdevice.h>
7ad65bf6	17	#include <net/netns/generic.h>
	18	#include <net/caif/caif_dev.h>
	19	#include <net/caif/caif_layer.h>
	20	#include <net/caif/cfpkt.h>
	21	#include <net/caif/cfcnfg.h>
	22
	23	MODULE_LICENSE("GPL");
	24
	25	#define CFUSB_PAD_DESCR_SZ 1 /* Alignment descriptor length */
	26	#define CFUSB_ALIGNMENT 4 /* Number of bytes to align. */
	27	#define CFUSB_MAX_HEADLEN (CFUSB_PAD_DESCR_SZ + CFUSB_ALIGNMENT-1)
	28	#define STE_USB_VID 0x04cc /* USB Product ID for ST-Ericsson */
3371bb3f	29	#define STE_USB_PID_CAIF 0x230f /* Product id for CAIF Modems */
7ad65bf6	30
	31	struct cfusbl {
	32	struct cflayer layer;
	33	u8 tx_eth_hdr[ETH_HLEN];
	34	};
	35
	36	static bool pack_added;
	37
	38	static int cfusbl_receive(struct cflayer layr, struct cfpkt pkt)
	39	{
	40	u8 hpad;
	41
	42	/* Remove padding. */
	43	cfpkt_extr_head(pkt, &hpad, 1);
	44	cfpkt_extr_head(pkt, NULL, hpad);
	45	return layr->up->receive(layr->up, pkt);
	46	}
	47
	48	static int cfusbl_transmit(struct cflayer layr, struct cfpkt pkt)
	49	{
	50	struct caif_payload_info *info;
	51	u8 hpad;
	52	u8 zeros[CFUSB_ALIGNMENT];
	53	struct sk_buff *skb;
	54	struct cfusbl *usbl = container_of(layr, struct cfusbl, layer);
	55
	56	skb = cfpkt_tonative(pkt);
	57
	58	skb_reset_network_header(skb);
	59	skb->protocol = htons(ETH_P_IP);
	60
	61	info = cfpkt_info(pkt);
	62	hpad = (info->hdr_len + CFUSB_PAD_DESCR_SZ) & (CFUSB_ALIGNMENT - 1);
	63
	64	if (skb_headroom(skb) < ETH_HLEN + CFUSB_PAD_DESCR_SZ + hpad) {
43d88774	65	pr_warn("Headroom too small\n");
7ad65bf6	66	kfree_skb(skb);
	67	return -EIO;
	68	}
	69	memset(zeros, 0, hpad);
	70
	71	cfpkt_add_head(pkt, zeros, hpad);
	72	cfpkt_add_head(pkt, &hpad, 1);
	73	cfpkt_add_head(pkt, usbl->tx_eth_hdr, sizeof(usbl->tx_eth_hdr));
	74	return layr->dn->transmit(layr->dn, pkt);
	75	}
	76
	77	static void cfusbl_ctrlcmd(struct cflayer *layr, enum caif_ctrlcmd ctrl,
3bffc475	78	int phyid)
7ad65bf6	79	{
	80	if (layr->up && layr->up->ctrlcmd)
	81	layr->up->ctrlcmd(layr->up, ctrl, layr->id);
	82	}
	83
5520fb42	84	static struct cflayer *cfusbl_create(int phyid, const u8 ethaddr[ETH_ALEN],
d2123be0	85	u8 braddr[ETH_ALEN])
7ad65bf6	86	{
	87	struct cfusbl *this = kmalloc(sizeof(struct cfusbl), GFP_ATOMIC);
	88
7970f191	89	if (!this)
7ad65bf6	90	return NULL;
7970f191	91
7ad65bf6	92	caif_assert(offsetof(struct cfusbl, layer) == 0);
7ad65bf6	93
91c4467e	94	memset(&this->layer, 0, sizeof(this->layer));
7ad65bf6	95	this->layer.receive = cfusbl_receive;
	96	this->layer.transmit = cfusbl_transmit;
	97	this->layer.ctrlcmd = cfusbl_ctrlcmd;
	98	snprintf(this->layer.name, CAIF_LAYER_NAME_SZ, "usb%d", phyid);
	99	this->layer.id = phyid;
	100
	101	/*
	102	* Construct TX ethernet header:
	103	* 0-5 destination address
	104	* 5-11 source address
	105	* 12-13 protocol type
	106	*/
34b2cff4 JP	107	ether_addr_copy(&this->tx_eth_hdr[ETH_ALEN], braddr);
34b2cff4 JP	108	ether_addr_copy(&this->tx_eth_hdr[ETH_ALEN], ethaddr);
7ad65bf6	109	this->tx_eth_hdr[12] = cpu_to_be16(ETH_P_802_EX1) & 0xff;
	110	this->tx_eth_hdr[13] = (cpu_to_be16(ETH_P_802_EX1) >> 8) & 0xff;
	111	pr_debug("caif ethernet TX-header dst:%pM src:%pM type:%02x%02x\n",
	112	this->tx_eth_hdr, this->tx_eth_hdr + ETH_ALEN,
	113	this->tx_eth_hdr[12], this->tx_eth_hdr[13]);
	114
	115	return (struct cflayer *) this;
	116	}
	117
7f5d8666 PS	118	static void cfusbl_release(struct cflayer *layer)
	119	{
	120	kfree(layer);
	121	}
	122
7ad65bf6	123	static struct packet_type caif_usb_type __read_mostly = {
	124	.type = cpu_to_be16(ETH_P_802_EX1),
	125	};
	126
	127	static int cfusbl_device_notify(struct notifier_block *me, unsigned long what,
351638e7	128	void *ptr)
7ad65bf6	129	{
351638e7	130	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
7ad65bf6	131	struct caif_dev_common common;
7ad65bf6	132	struct cflayer layer, link_support;
40663634 BH	133	struct usbnet *usbnet;
40663634 BH	134	struct usb_device *usbdev;
7f5d8666	135	int res;
7ad65bf6	136
9781e98a SY	137	if (what == NETDEV_UNREGISTER && dev->reg_state >= NETREG_UNREGISTERED)
	138	return 0;
	139
65d2897c BH	140	/* Check whether we have a NCM device, and find its VID/PID. */
	141	if (!(dev->dev.parent && dev->dev.parent->driver &&
	142	strcmp(dev->dev.parent->driver->name, "cdc_ncm") == 0))
7ad65bf6	143	return 0;
7ad65bf6	144
40663634 BH	145	usbnet = netdev_priv(dev);
	146	usbdev = usbnet->udev;
	147
7ad65bf6	148	pr_debug("USB CDC NCM device VID:0x%4x PID:0x%4x\n",
	149	le16_to_cpu(usbdev->descriptor.idVendor),
	150	le16_to_cpu(usbdev->descriptor.idProduct));
	151
	152	/* Check for VID/PID that supports CAIF */
	153	if (!(le16_to_cpu(usbdev->descriptor.idVendor) == STE_USB_VID &&
	154	le16_to_cpu(usbdev->descriptor.idProduct) == STE_USB_PID_CAIF))
	155	return 0;
	156
	157	if (what == NETDEV_UNREGISTER)
	158	module_put(THIS_MODULE);
	159
	160	if (what != NETDEV_REGISTER)
	161	return 0;
	162
	163	__module_get(THIS_MODULE);
	164
	165	memset(&common, 0, sizeof(common));
	166	common.use_frag = false;
	167	common.use_fcs = false;
	168	common.use_stx = false;
	169	common.link_select = CAIF_LINK_HIGH_BANDW;
	170	common.flowctrl = NULL;
	171
	172	link_support = cfusbl_create(dev->ifindex, dev->dev_addr,
	173	dev->broadcast);
	174
	175	if (!link_support)
	176	return -ENOMEM;
	177
	178	if (dev->num_tx_queues > 1)
	179	pr_warn("USB device uses more than one tx queue\n");
	180
7f5d8666	181	res = caif_enroll_dev(dev, &common, link_support, CFUSB_MAX_HEADLEN,
7ad65bf6	182	&layer, &caif_usb_type.func);
7f5d8666 PS	183	if (res)
	184	goto err;
	185
7ad65bf6	186	if (!pack_added)
7ad65bf6	187	dev_add_pack(&caif_usb_type);
3db1cd5c	188	pack_added = true;
7ad65bf6	189
df207b00	190	strscpy(layer->name, dev->name, sizeof(layer->name));
7ad65bf6	191
7ad65bf6	192	return 0;
7f5d8666 PS	193	err:
	194	cfusbl_release(link_support);
	195	return res;
7ad65bf6	196	}
	197
	198	static struct notifier_block caif_device_notifier = {
	199	.notifier_call = cfusbl_device_notify,
	200	.priority = 0,
	201	};
	202
	203	static int __init cfusbl_init(void)
	204	{
	205	return register_netdevice_notifier(&caif_device_notifier);
	206	}
	207
	208	static void __exit cfusbl_exit(void)
	209	{
	210	unregister_netdevice_notifier(&caif_device_notifier);
	211	dev_remove_pack(&caif_usb_type);
	212	}
	213
	214	module_init(cfusbl_init);
	215	module_exit(cfusbl_exit);