162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright (C) 2011 matt mooney <mfm@muteddisk.com>
462306a36Sopenharmony_ci *               2005-2007 Takahiro Hirofuchi
562306a36Sopenharmony_ci */
662306a36Sopenharmony_ci
762306a36Sopenharmony_ci#include <libudev.h>
862306a36Sopenharmony_ci
962306a36Sopenharmony_ci#include <errno.h>
1062306a36Sopenharmony_ci#include <stdio.h>
1162306a36Sopenharmony_ci#include <string.h>
1262306a36Sopenharmony_ci
1362306a36Sopenharmony_ci#include <getopt.h>
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci#include "usbip_common.h"
1662306a36Sopenharmony_ci#include "utils.h"
1762306a36Sopenharmony_ci#include "usbip.h"
1862306a36Sopenharmony_ci#include "sysfs_utils.h"
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_cistatic const char usbip_unbind_usage_string[] =
2162306a36Sopenharmony_ci	"usbip unbind <args>\n"
2262306a36Sopenharmony_ci	"    -b, --busid=<busid>    Unbind " USBIP_HOST_DRV_NAME ".ko from "
2362306a36Sopenharmony_ci	"device on <busid>\n";
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_civoid usbip_unbind_usage(void)
2662306a36Sopenharmony_ci{
2762306a36Sopenharmony_ci	printf("usage: %s", usbip_unbind_usage_string);
2862306a36Sopenharmony_ci}
2962306a36Sopenharmony_ci
3062306a36Sopenharmony_cistatic int unbind_device(char *busid)
3162306a36Sopenharmony_ci{
3262306a36Sopenharmony_ci	char bus_type[] = "usb";
3362306a36Sopenharmony_ci	int rc, ret = -1;
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_ci	char unbind_attr_name[] = "unbind";
3662306a36Sopenharmony_ci	char unbind_attr_path[SYSFS_PATH_MAX];
3762306a36Sopenharmony_ci	char rebind_attr_name[] = "rebind";
3862306a36Sopenharmony_ci	char rebind_attr_path[SYSFS_PATH_MAX];
3962306a36Sopenharmony_ci
4062306a36Sopenharmony_ci	struct udev *udev;
4162306a36Sopenharmony_ci	struct udev_device *dev;
4262306a36Sopenharmony_ci	const char *driver;
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_ci	/* Create libudev context. */
4562306a36Sopenharmony_ci	udev = udev_new();
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_ci	/* Check whether the device with this bus ID exists. */
4862306a36Sopenharmony_ci	dev = udev_device_new_from_subsystem_sysname(udev, "usb", busid);
4962306a36Sopenharmony_ci	if (!dev) {
5062306a36Sopenharmony_ci		err("device with the specified bus ID does not exist");
5162306a36Sopenharmony_ci		goto err_close_udev;
5262306a36Sopenharmony_ci	}
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_ci	/* Check whether the device is using usbip-host driver. */
5562306a36Sopenharmony_ci	driver = udev_device_get_driver(dev);
5662306a36Sopenharmony_ci	if (!driver || strcmp(driver, "usbip-host")) {
5762306a36Sopenharmony_ci		err("device is not bound to usbip-host driver");
5862306a36Sopenharmony_ci		goto err_close_udev;
5962306a36Sopenharmony_ci	}
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_ci	/* Unbind device from driver. */
6262306a36Sopenharmony_ci	snprintf(unbind_attr_path, sizeof(unbind_attr_path), "%s/%s/%s/%s/%s/%s",
6362306a36Sopenharmony_ci		 SYSFS_MNT_PATH, SYSFS_BUS_NAME, bus_type, SYSFS_DRIVERS_NAME,
6462306a36Sopenharmony_ci		 USBIP_HOST_DRV_NAME, unbind_attr_name);
6562306a36Sopenharmony_ci
6662306a36Sopenharmony_ci	rc = write_sysfs_attribute(unbind_attr_path, busid, strlen(busid));
6762306a36Sopenharmony_ci	if (rc < 0) {
6862306a36Sopenharmony_ci		err("error unbinding device %s from driver", busid);
6962306a36Sopenharmony_ci		goto err_close_udev;
7062306a36Sopenharmony_ci	}
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_ci	/* Notify driver of unbind. */
7362306a36Sopenharmony_ci	rc = modify_match_busid(busid, 0);
7462306a36Sopenharmony_ci	if (rc < 0) {
7562306a36Sopenharmony_ci		err("unable to unbind device on %s", busid);
7662306a36Sopenharmony_ci		goto err_close_udev;
7762306a36Sopenharmony_ci	}
7862306a36Sopenharmony_ci
7962306a36Sopenharmony_ci	/* Trigger new probing. */
8062306a36Sopenharmony_ci	snprintf(rebind_attr_path, sizeof(unbind_attr_path), "%s/%s/%s/%s/%s/%s",
8162306a36Sopenharmony_ci			SYSFS_MNT_PATH, SYSFS_BUS_NAME, bus_type, SYSFS_DRIVERS_NAME,
8262306a36Sopenharmony_ci			USBIP_HOST_DRV_NAME, rebind_attr_name);
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci	rc = write_sysfs_attribute(rebind_attr_path, busid, strlen(busid));
8562306a36Sopenharmony_ci	if (rc < 0) {
8662306a36Sopenharmony_ci		err("error rebinding");
8762306a36Sopenharmony_ci		goto err_close_udev;
8862306a36Sopenharmony_ci	}
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci	ret = 0;
9162306a36Sopenharmony_ci	info("unbind device on busid %s: complete", busid);
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_cierr_close_udev:
9462306a36Sopenharmony_ci	udev_device_unref(dev);
9562306a36Sopenharmony_ci	udev_unref(udev);
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_ci	return ret;
9862306a36Sopenharmony_ci}
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ciint usbip_unbind(int argc, char *argv[])
10162306a36Sopenharmony_ci{
10262306a36Sopenharmony_ci	static const struct option opts[] = {
10362306a36Sopenharmony_ci		{ "busid", required_argument, NULL, 'b' },
10462306a36Sopenharmony_ci		{ NULL,    0,                 NULL,  0  }
10562306a36Sopenharmony_ci	};
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_ci	int opt;
10862306a36Sopenharmony_ci	int ret = -1;
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci	for (;;) {
11162306a36Sopenharmony_ci		opt = getopt_long(argc, argv, "b:", opts, NULL);
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ci		if (opt == -1)
11462306a36Sopenharmony_ci			break;
11562306a36Sopenharmony_ci
11662306a36Sopenharmony_ci		switch (opt) {
11762306a36Sopenharmony_ci		case 'b':
11862306a36Sopenharmony_ci			ret = unbind_device(optarg);
11962306a36Sopenharmony_ci			goto out;
12062306a36Sopenharmony_ci		default:
12162306a36Sopenharmony_ci			goto err_out;
12262306a36Sopenharmony_ci		}
12362306a36Sopenharmony_ci	}
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_cierr_out:
12662306a36Sopenharmony_ci	usbip_unbind_usage();
12762306a36Sopenharmony_ciout:
12862306a36Sopenharmony_ci	return ret;
12962306a36Sopenharmony_ci}
130