162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0+
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * ncm.c -- NCM gadget driver
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2010 Nokia Corporation
662306a36Sopenharmony_ci * Contact: Yauheni Kaliuta <yauheni.kaliuta@nokia.com>
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * The driver borrows from ether.c which is:
962306a36Sopenharmony_ci *
1062306a36Sopenharmony_ci * Copyright (C) 2003-2005,2008 David Brownell
1162306a36Sopenharmony_ci * Copyright (C) 2003-2004 Robert Schwebel, Benedikt Spranger
1262306a36Sopenharmony_ci * Copyright (C) 2008 Nokia Corporation
1362306a36Sopenharmony_ci */
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci/* #define DEBUG */
1662306a36Sopenharmony_ci/* #define VERBOSE_DEBUG */
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci#include <linux/kernel.h>
1962306a36Sopenharmony_ci#include <linux/module.h>
2062306a36Sopenharmony_ci#include <linux/usb/composite.h>
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci#include "u_ether.h"
2362306a36Sopenharmony_ci#include "u_ncm.h"
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_ci#define DRIVER_DESC		"NCM Gadget"
2662306a36Sopenharmony_ci
2762306a36Sopenharmony_ci/*-------------------------------------------------------------------------*/
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci/* DO NOT REUSE THESE IDs with a protocol-incompatible driver!!  Ever!!
3062306a36Sopenharmony_ci * Instead:  allocate your own, using normal USB-IF procedures.
3162306a36Sopenharmony_ci */
3262306a36Sopenharmony_ci
3362306a36Sopenharmony_ci/* Thanks to NetChip Technologies for donating this product ID.
3462306a36Sopenharmony_ci * It's for devices with only CDC Ethernet configurations.
3562306a36Sopenharmony_ci */
3662306a36Sopenharmony_ci#define CDC_VENDOR_NUM		0x0525	/* NetChip */
3762306a36Sopenharmony_ci#define CDC_PRODUCT_NUM		0xa4a1	/* Linux-USB Ethernet Gadget */
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci/*-------------------------------------------------------------------------*/
4062306a36Sopenharmony_ciUSB_GADGET_COMPOSITE_OPTIONS();
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ciUSB_ETHERNET_MODULE_PARAMETERS();
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_cistatic struct usb_device_descriptor device_desc = {
4562306a36Sopenharmony_ci	.bLength =		sizeof device_desc,
4662306a36Sopenharmony_ci	.bDescriptorType =	USB_DT_DEVICE,
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_ci	/* .bcdUSB = DYNAMIC */
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_ci	.bDeviceClass =		USB_CLASS_COMM,
5162306a36Sopenharmony_ci	.bDeviceSubClass =	0,
5262306a36Sopenharmony_ci	.bDeviceProtocol =	0,
5362306a36Sopenharmony_ci	/* .bMaxPacketSize0 = f(hardware) */
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci	/* Vendor and product id defaults change according to what configs
5662306a36Sopenharmony_ci	 * we support.  (As does bNumConfigurations.)  These values can
5762306a36Sopenharmony_ci	 * also be overridden by module parameters.
5862306a36Sopenharmony_ci	 */
5962306a36Sopenharmony_ci	.idVendor =		cpu_to_le16 (CDC_VENDOR_NUM),
6062306a36Sopenharmony_ci	.idProduct =		cpu_to_le16 (CDC_PRODUCT_NUM),
6162306a36Sopenharmony_ci	/* .bcdDevice = f(hardware) */
6262306a36Sopenharmony_ci	/* .iManufacturer = DYNAMIC */
6362306a36Sopenharmony_ci	/* .iProduct = DYNAMIC */
6462306a36Sopenharmony_ci	/* NO SERIAL NUMBER */
6562306a36Sopenharmony_ci	.bNumConfigurations =	1,
6662306a36Sopenharmony_ci};
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_cistatic const struct usb_descriptor_header *otg_desc[2];
6962306a36Sopenharmony_ci
7062306a36Sopenharmony_ci/* string IDs are assigned dynamically */
7162306a36Sopenharmony_cistatic struct usb_string strings_dev[] = {
7262306a36Sopenharmony_ci	[USB_GADGET_MANUFACTURER_IDX].s = "",
7362306a36Sopenharmony_ci	[USB_GADGET_PRODUCT_IDX].s = DRIVER_DESC,
7462306a36Sopenharmony_ci	[USB_GADGET_SERIAL_IDX].s = "",
7562306a36Sopenharmony_ci	{  } /* end of list */
7662306a36Sopenharmony_ci};
7762306a36Sopenharmony_ci
7862306a36Sopenharmony_cistatic struct usb_gadget_strings stringtab_dev = {
7962306a36Sopenharmony_ci	.language	= 0x0409,	/* en-us */
8062306a36Sopenharmony_ci	.strings	= strings_dev,
8162306a36Sopenharmony_ci};
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_cistatic struct usb_gadget_strings *dev_strings[] = {
8462306a36Sopenharmony_ci	&stringtab_dev,
8562306a36Sopenharmony_ci	NULL,
8662306a36Sopenharmony_ci};
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_cistatic struct usb_function_instance *f_ncm_inst;
8962306a36Sopenharmony_cistatic struct usb_function *f_ncm;
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_ci/*-------------------------------------------------------------------------*/
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_cistatic int ncm_do_config(struct usb_configuration *c)
9462306a36Sopenharmony_ci{
9562306a36Sopenharmony_ci	int status;
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_ci	/* FIXME alloc iConfiguration string, set it in c->strings */
9862306a36Sopenharmony_ci
9962306a36Sopenharmony_ci	if (gadget_is_otg(c->cdev->gadget)) {
10062306a36Sopenharmony_ci		c->descriptors = otg_desc;
10162306a36Sopenharmony_ci		c->bmAttributes |= USB_CONFIG_ATT_WAKEUP;
10262306a36Sopenharmony_ci	}
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	f_ncm = usb_get_function(f_ncm_inst);
10562306a36Sopenharmony_ci	if (IS_ERR(f_ncm))
10662306a36Sopenharmony_ci		return PTR_ERR(f_ncm);
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_ci	status = usb_add_function(c, f_ncm);
10962306a36Sopenharmony_ci	if (status < 0) {
11062306a36Sopenharmony_ci		usb_put_function(f_ncm);
11162306a36Sopenharmony_ci		return status;
11262306a36Sopenharmony_ci	}
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_ci	return 0;
11562306a36Sopenharmony_ci}
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_cistatic struct usb_configuration ncm_config_driver = {
11862306a36Sopenharmony_ci	/* .label = f(hardware) */
11962306a36Sopenharmony_ci	.label			= "CDC Ethernet (NCM)",
12062306a36Sopenharmony_ci	.bConfigurationValue	= 1,
12162306a36Sopenharmony_ci	/* .iConfiguration = DYNAMIC */
12262306a36Sopenharmony_ci	.bmAttributes		= USB_CONFIG_ATT_SELFPOWER,
12362306a36Sopenharmony_ci};
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_ci/*-------------------------------------------------------------------------*/
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_cistatic int gncm_bind(struct usb_composite_dev *cdev)
12862306a36Sopenharmony_ci{
12962306a36Sopenharmony_ci	struct usb_gadget	*gadget = cdev->gadget;
13062306a36Sopenharmony_ci	struct f_ncm_opts	*ncm_opts;
13162306a36Sopenharmony_ci	int			status;
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_ci	f_ncm_inst = usb_get_function_instance("ncm");
13462306a36Sopenharmony_ci	if (IS_ERR(f_ncm_inst))
13562306a36Sopenharmony_ci		return PTR_ERR(f_ncm_inst);
13662306a36Sopenharmony_ci
13762306a36Sopenharmony_ci	ncm_opts = container_of(f_ncm_inst, struct f_ncm_opts, func_inst);
13862306a36Sopenharmony_ci
13962306a36Sopenharmony_ci	gether_set_qmult(ncm_opts->net, qmult);
14062306a36Sopenharmony_ci	if (!gether_set_host_addr(ncm_opts->net, host_addr))
14162306a36Sopenharmony_ci		pr_info("using host ethernet address: %s", host_addr);
14262306a36Sopenharmony_ci	if (!gether_set_dev_addr(ncm_opts->net, dev_addr))
14362306a36Sopenharmony_ci		pr_info("using self ethernet address: %s", dev_addr);
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci	/* Allocate string descriptor numbers ... note that string
14662306a36Sopenharmony_ci	 * contents can be overridden by the composite_dev glue.
14762306a36Sopenharmony_ci	 */
14862306a36Sopenharmony_ci
14962306a36Sopenharmony_ci	status = usb_string_ids_tab(cdev, strings_dev);
15062306a36Sopenharmony_ci	if (status < 0)
15162306a36Sopenharmony_ci		goto fail;
15262306a36Sopenharmony_ci	device_desc.iManufacturer = strings_dev[USB_GADGET_MANUFACTURER_IDX].id;
15362306a36Sopenharmony_ci	device_desc.iProduct = strings_dev[USB_GADGET_PRODUCT_IDX].id;
15462306a36Sopenharmony_ci
15562306a36Sopenharmony_ci	if (gadget_is_otg(gadget) && !otg_desc[0]) {
15662306a36Sopenharmony_ci		struct usb_descriptor_header *usb_desc;
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci		usb_desc = usb_otg_descriptor_alloc(gadget);
15962306a36Sopenharmony_ci		if (!usb_desc) {
16062306a36Sopenharmony_ci			status = -ENOMEM;
16162306a36Sopenharmony_ci			goto fail;
16262306a36Sopenharmony_ci		}
16362306a36Sopenharmony_ci		usb_otg_descriptor_init(gadget, usb_desc);
16462306a36Sopenharmony_ci		otg_desc[0] = usb_desc;
16562306a36Sopenharmony_ci		otg_desc[1] = NULL;
16662306a36Sopenharmony_ci	}
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci	status = usb_add_config(cdev, &ncm_config_driver,
16962306a36Sopenharmony_ci				ncm_do_config);
17062306a36Sopenharmony_ci	if (status < 0)
17162306a36Sopenharmony_ci		goto fail1;
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ci	usb_composite_overwrite_options(cdev, &coverwrite);
17462306a36Sopenharmony_ci	dev_info(&gadget->dev, "%s\n", DRIVER_DESC);
17562306a36Sopenharmony_ci
17662306a36Sopenharmony_ci	return 0;
17762306a36Sopenharmony_ci
17862306a36Sopenharmony_cifail1:
17962306a36Sopenharmony_ci	kfree(otg_desc[0]);
18062306a36Sopenharmony_ci	otg_desc[0] = NULL;
18162306a36Sopenharmony_cifail:
18262306a36Sopenharmony_ci	usb_put_function_instance(f_ncm_inst);
18362306a36Sopenharmony_ci	return status;
18462306a36Sopenharmony_ci}
18562306a36Sopenharmony_ci
18662306a36Sopenharmony_cistatic int gncm_unbind(struct usb_composite_dev *cdev)
18762306a36Sopenharmony_ci{
18862306a36Sopenharmony_ci	if (!IS_ERR_OR_NULL(f_ncm))
18962306a36Sopenharmony_ci		usb_put_function(f_ncm);
19062306a36Sopenharmony_ci	if (!IS_ERR_OR_NULL(f_ncm_inst))
19162306a36Sopenharmony_ci		usb_put_function_instance(f_ncm_inst);
19262306a36Sopenharmony_ci	kfree(otg_desc[0]);
19362306a36Sopenharmony_ci	otg_desc[0] = NULL;
19462306a36Sopenharmony_ci
19562306a36Sopenharmony_ci	return 0;
19662306a36Sopenharmony_ci}
19762306a36Sopenharmony_ci
19862306a36Sopenharmony_cistatic struct usb_composite_driver ncm_driver = {
19962306a36Sopenharmony_ci	.name		= "g_ncm",
20062306a36Sopenharmony_ci	.dev		= &device_desc,
20162306a36Sopenharmony_ci	.strings	= dev_strings,
20262306a36Sopenharmony_ci	.max_speed	= USB_SPEED_SUPER,
20362306a36Sopenharmony_ci	.bind		= gncm_bind,
20462306a36Sopenharmony_ci	.unbind		= gncm_unbind,
20562306a36Sopenharmony_ci};
20662306a36Sopenharmony_ci
20762306a36Sopenharmony_cimodule_usb_composite_driver(ncm_driver);
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_ciMODULE_DESCRIPTION(DRIVER_DESC);
21062306a36Sopenharmony_ciMODULE_AUTHOR("Yauheni Kaliuta");
21162306a36Sopenharmony_ciMODULE_LICENSE("GPL");
212