162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/* Target based USB-Gadget
362306a36Sopenharmony_ci *
462306a36Sopenharmony_ci * UAS protocol handling, target callbacks, configfs handling,
562306a36Sopenharmony_ci * BBB (USB Mass Storage Class Bulk-Only (BBB) and Transport protocol handling.
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * Author: Sebastian Andrzej Siewior <bigeasy at linutronix dot de>
862306a36Sopenharmony_ci */
962306a36Sopenharmony_ci#include <linux/kernel.h>
1062306a36Sopenharmony_ci#include <linux/module.h>
1162306a36Sopenharmony_ci#include <linux/types.h>
1262306a36Sopenharmony_ci#include <linux/string.h>
1362306a36Sopenharmony_ci#include <linux/configfs.h>
1462306a36Sopenharmony_ci#include <linux/ctype.h>
1562306a36Sopenharmony_ci#include <linux/usb/ch9.h>
1662306a36Sopenharmony_ci#include <linux/usb/composite.h>
1762306a36Sopenharmony_ci#include <linux/usb/gadget.h>
1862306a36Sopenharmony_ci#include <linux/usb/storage.h>
1962306a36Sopenharmony_ci#include <scsi/scsi_tcq.h>
2062306a36Sopenharmony_ci#include <target/target_core_base.h>
2162306a36Sopenharmony_ci#include <target/target_core_fabric.h>
2262306a36Sopenharmony_ci#include <asm/unaligned.h>
2362306a36Sopenharmony_ci
2462306a36Sopenharmony_ci#include "u_tcm.h"
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ciUSB_GADGET_COMPOSITE_OPTIONS();
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_ci#define UAS_VENDOR_ID	0x0525	/* NetChip */
2962306a36Sopenharmony_ci#define UAS_PRODUCT_ID	0xa4a5	/* Linux-USB File-backed Storage Gadget */
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_cistatic struct usb_device_descriptor usbg_device_desc = {
3262306a36Sopenharmony_ci	.bLength =		sizeof(usbg_device_desc),
3362306a36Sopenharmony_ci	.bDescriptorType =	USB_DT_DEVICE,
3462306a36Sopenharmony_ci	/* .bcdUSB = DYNAMIC */
3562306a36Sopenharmony_ci	.bDeviceClass =		USB_CLASS_PER_INTERFACE,
3662306a36Sopenharmony_ci	.idVendor =		cpu_to_le16(UAS_VENDOR_ID),
3762306a36Sopenharmony_ci	.idProduct =		cpu_to_le16(UAS_PRODUCT_ID),
3862306a36Sopenharmony_ci	.bNumConfigurations =   1,
3962306a36Sopenharmony_ci};
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_ci#define USB_G_STR_CONFIG USB_GADGET_FIRST_AVAIL_IDX
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_cistatic struct usb_string	usbg_us_strings[] = {
4462306a36Sopenharmony_ci	[USB_GADGET_MANUFACTURER_IDX].s	= "Target Manufacturer",
4562306a36Sopenharmony_ci	[USB_GADGET_PRODUCT_IDX].s	= "Target Product",
4662306a36Sopenharmony_ci	[USB_GADGET_SERIAL_IDX].s	= "000000000001",
4762306a36Sopenharmony_ci	[USB_G_STR_CONFIG].s		= "default config",
4862306a36Sopenharmony_ci	{ },
4962306a36Sopenharmony_ci};
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_cistatic struct usb_gadget_strings usbg_stringtab = {
5262306a36Sopenharmony_ci	.language = 0x0409,
5362306a36Sopenharmony_ci	.strings = usbg_us_strings,
5462306a36Sopenharmony_ci};
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_cistatic struct usb_gadget_strings *usbg_strings[] = {
5762306a36Sopenharmony_ci	&usbg_stringtab,
5862306a36Sopenharmony_ci	NULL,
5962306a36Sopenharmony_ci};
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_cistatic struct usb_function_instance *fi_tcm;
6262306a36Sopenharmony_cistatic struct usb_function *f_tcm;
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_cistatic int guas_unbind(struct usb_composite_dev *cdev)
6562306a36Sopenharmony_ci{
6662306a36Sopenharmony_ci	if (!IS_ERR_OR_NULL(f_tcm))
6762306a36Sopenharmony_ci		usb_put_function(f_tcm);
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_ci	return 0;
7062306a36Sopenharmony_ci}
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_cistatic int tcm_do_config(struct usb_configuration *c)
7362306a36Sopenharmony_ci{
7462306a36Sopenharmony_ci	int status;
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci	f_tcm = usb_get_function(fi_tcm);
7762306a36Sopenharmony_ci	if (IS_ERR(f_tcm))
7862306a36Sopenharmony_ci		return PTR_ERR(f_tcm);
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci	status = usb_add_function(c, f_tcm);
8162306a36Sopenharmony_ci	if (status < 0) {
8262306a36Sopenharmony_ci		usb_put_function(f_tcm);
8362306a36Sopenharmony_ci		return status;
8462306a36Sopenharmony_ci	}
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_ci	return 0;
8762306a36Sopenharmony_ci}
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_cistatic struct usb_configuration usbg_config_driver = {
9062306a36Sopenharmony_ci	.label                  = "Linux Target",
9162306a36Sopenharmony_ci	.bConfigurationValue    = 1,
9262306a36Sopenharmony_ci	.bmAttributes           = USB_CONFIG_ATT_SELFPOWER,
9362306a36Sopenharmony_ci};
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_cistatic int usbg_attach(struct usb_function_instance *f);
9662306a36Sopenharmony_cistatic void usbg_detach(struct usb_function_instance *f);
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_cistatic int usb_target_bind(struct usb_composite_dev *cdev)
9962306a36Sopenharmony_ci{
10062306a36Sopenharmony_ci	int ret;
10162306a36Sopenharmony_ci
10262306a36Sopenharmony_ci	ret = usb_string_ids_tab(cdev, usbg_us_strings);
10362306a36Sopenharmony_ci	if (ret)
10462306a36Sopenharmony_ci		return ret;
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_ci	usbg_device_desc.iManufacturer =
10762306a36Sopenharmony_ci		usbg_us_strings[USB_GADGET_MANUFACTURER_IDX].id;
10862306a36Sopenharmony_ci	usbg_device_desc.iProduct = usbg_us_strings[USB_GADGET_PRODUCT_IDX].id;
10962306a36Sopenharmony_ci	usbg_device_desc.iSerialNumber =
11062306a36Sopenharmony_ci		usbg_us_strings[USB_GADGET_SERIAL_IDX].id;
11162306a36Sopenharmony_ci	usbg_config_driver.iConfiguration =
11262306a36Sopenharmony_ci		usbg_us_strings[USB_G_STR_CONFIG].id;
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_ci	ret = usb_add_config(cdev, &usbg_config_driver, tcm_do_config);
11562306a36Sopenharmony_ci	if (ret)
11662306a36Sopenharmony_ci		return ret;
11762306a36Sopenharmony_ci	usb_composite_overwrite_options(cdev, &coverwrite);
11862306a36Sopenharmony_ci	return 0;
11962306a36Sopenharmony_ci}
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_cistatic struct usb_composite_driver usbg_driver = {
12262306a36Sopenharmony_ci	.name           = "g_target",
12362306a36Sopenharmony_ci	.dev            = &usbg_device_desc,
12462306a36Sopenharmony_ci	.strings        = usbg_strings,
12562306a36Sopenharmony_ci	.max_speed      = USB_SPEED_SUPER,
12662306a36Sopenharmony_ci	.bind		= usb_target_bind,
12762306a36Sopenharmony_ci	.unbind         = guas_unbind,
12862306a36Sopenharmony_ci};
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_cistatic int usbg_attach(struct usb_function_instance *f)
13162306a36Sopenharmony_ci{
13262306a36Sopenharmony_ci	return usb_composite_probe(&usbg_driver);
13362306a36Sopenharmony_ci}
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_cistatic void usbg_detach(struct usb_function_instance *f)
13662306a36Sopenharmony_ci{
13762306a36Sopenharmony_ci	usb_composite_unregister(&usbg_driver);
13862306a36Sopenharmony_ci}
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_cistatic int __init usb_target_gadget_init(void)
14162306a36Sopenharmony_ci{
14262306a36Sopenharmony_ci	struct f_tcm_opts *tcm_opts;
14362306a36Sopenharmony_ci
14462306a36Sopenharmony_ci	fi_tcm = usb_get_function_instance("tcm");
14562306a36Sopenharmony_ci	if (IS_ERR(fi_tcm))
14662306a36Sopenharmony_ci		return PTR_ERR(fi_tcm);
14762306a36Sopenharmony_ci
14862306a36Sopenharmony_ci	tcm_opts = container_of(fi_tcm, struct f_tcm_opts, func_inst);
14962306a36Sopenharmony_ci	mutex_lock(&tcm_opts->dep_lock);
15062306a36Sopenharmony_ci	tcm_opts->tcm_register_callback = usbg_attach;
15162306a36Sopenharmony_ci	tcm_opts->tcm_unregister_callback = usbg_detach;
15262306a36Sopenharmony_ci	tcm_opts->dependent = THIS_MODULE;
15362306a36Sopenharmony_ci	tcm_opts->can_attach = true;
15462306a36Sopenharmony_ci	tcm_opts->has_dep = true;
15562306a36Sopenharmony_ci	mutex_unlock(&tcm_opts->dep_lock);
15662306a36Sopenharmony_ci
15762306a36Sopenharmony_ci	fi_tcm->set_inst_name(fi_tcm, "tcm-legacy");
15862306a36Sopenharmony_ci
15962306a36Sopenharmony_ci	return 0;
16062306a36Sopenharmony_ci}
16162306a36Sopenharmony_cimodule_init(usb_target_gadget_init);
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_cistatic void __exit usb_target_gadget_exit(void)
16462306a36Sopenharmony_ci{
16562306a36Sopenharmony_ci	if (!IS_ERR_OR_NULL(fi_tcm))
16662306a36Sopenharmony_ci		usb_put_function_instance(fi_tcm);
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci}
16962306a36Sopenharmony_cimodule_exit(usb_target_gadget_exit);
17062306a36Sopenharmony_ci
17162306a36Sopenharmony_ciMODULE_AUTHOR("Sebastian Andrzej Siewior <bigeasy@linutronix.de>");
17262306a36Sopenharmony_ciMODULE_DESCRIPTION("usb-gadget fabric");
17362306a36Sopenharmony_ciMODULE_LICENSE("GPL v2");
174