| // SPDX-License-Identifier: GPL-2.0 | 
 | /* | 
 |  * USB 7 Segment Driver | 
 |  * | 
 |  * Copyright (C) 2008 Harrison Metzger <harrisonmetz@gmail.com> | 
 |  * Based on usbled.c by Greg Kroah-Hartman (greg@kroah.com) | 
 |  */ | 
 |  | 
 | #include <linux/kernel.h> | 
 | #include <linux/errno.h> | 
 | #include <linux/slab.h> | 
 | #include <linux/module.h> | 
 | #include <linux/string.h> | 
 | #include <linux/usb.h> | 
 |  | 
 |  | 
 | #define DRIVER_AUTHOR "Harrison Metzger <harrisonmetz@gmail.com>" | 
 | #define DRIVER_DESC "USB 7 Segment Driver" | 
 |  | 
 | #define VENDOR_ID	0x0fc5 | 
 | #define PRODUCT_ID	0x1227 | 
 | #define MAXLEN		8 | 
 |  | 
 | /* table of devices that work with this driver */ | 
 | static const struct usb_device_id id_table[] = { | 
 | 	{ USB_DEVICE(VENDOR_ID, PRODUCT_ID) }, | 
 | 	{ }, | 
 | }; | 
 | MODULE_DEVICE_TABLE(usb, id_table); | 
 |  | 
 | /* the different text display modes the device is capable of */ | 
 | static const char *display_textmodes[] = {"raw", "hex", "ascii"}; | 
 |  | 
 | struct usb_sevsegdev { | 
 | 	struct usb_device *udev; | 
 | 	struct usb_interface *intf; | 
 |  | 
 | 	u8 powered; | 
 | 	u8 mode_msb; | 
 | 	u8 mode_lsb; | 
 | 	u8 decimals[MAXLEN]; | 
 | 	u8 textmode; | 
 | 	u8 text[MAXLEN]; | 
 | 	u16 textlength; | 
 |  | 
 | 	u8 shadow_power; /* for PM */ | 
 | 	u8 has_interface_pm; | 
 | }; | 
 |  | 
 | /* sysfs_streq can't replace this completely | 
 |  * If the device was in hex mode, and the user wanted a 0, | 
 |  * if str commands are used, we would assume the end of string | 
 |  * so mem commands are used. | 
 |  */ | 
 | static inline size_t my_memlen(const char *buf, size_t count) | 
 | { | 
 | 	if (count > 0 && buf[count-1] == '\n') | 
 | 		return count - 1; | 
 | 	else | 
 | 		return count; | 
 | } | 
 |  | 
 | static void update_display_powered(struct usb_sevsegdev *mydev) | 
 | { | 
 | 	int rc; | 
 |  | 
 | 	if (mydev->powered && !mydev->has_interface_pm) { | 
 | 		rc = usb_autopm_get_interface(mydev->intf); | 
 | 		if (rc < 0) | 
 | 			return; | 
 | 		mydev->has_interface_pm = 1; | 
 | 	} | 
 |  | 
 | 	if (mydev->shadow_power != 1) | 
 | 		return; | 
 |  | 
 | 	rc = usb_control_msg_send(mydev->udev, 0, 0x12, 0x48, | 
 | 				  (80 * 0x100) + 10, /*  (power mode) */ | 
 | 				  (0x00 * 0x100) + (mydev->powered ? 1 : 0), | 
 | 				  NULL, 0, 2000, GFP_KERNEL); | 
 | 	if (rc < 0) | 
 | 		dev_dbg(&mydev->udev->dev, "power retval = %d\n", rc); | 
 |  | 
 | 	if (!mydev->powered && mydev->has_interface_pm) { | 
 | 		usb_autopm_put_interface(mydev->intf); | 
 | 		mydev->has_interface_pm = 0; | 
 | 	} | 
 | } | 
 |  | 
 | static void update_display_mode(struct usb_sevsegdev *mydev) | 
 | { | 
 | 	int rc; | 
 |  | 
 | 	if(mydev->shadow_power != 1) | 
 | 		return; | 
 |  | 
 | 	rc = usb_control_msg_send(mydev->udev, 0, 0x12, 0x48, | 
 | 				  (82 * 0x100) + 10, /* (set mode) */ | 
 | 				  (mydev->mode_msb * 0x100) + mydev->mode_lsb, | 
 | 				  NULL, 0, 2000, GFP_NOIO); | 
 |  | 
 | 	if (rc < 0) | 
 | 		dev_dbg(&mydev->udev->dev, "mode retval = %d\n", rc); | 
 | } | 
 |  | 
 | static void update_display_visual(struct usb_sevsegdev *mydev, gfp_t mf) | 
 | { | 
 | 	int rc; | 
 | 	int i; | 
 | 	unsigned char buffer[MAXLEN] = {0}; | 
 | 	u8 decimals = 0; | 
 |  | 
 | 	if(mydev->shadow_power != 1) | 
 | 		return; | 
 |  | 
 | 	/* The device is right to left, where as you write left to right */ | 
 | 	for (i = 0; i < mydev->textlength; i++) | 
 | 		buffer[i] = mydev->text[mydev->textlength-1-i]; | 
 |  | 
 | 	rc = usb_control_msg_send(mydev->udev, 0, 0x12, 0x48, | 
 | 				  (85 * 0x100) + 10, /* (write text) */ | 
 | 				  (0 * 0x100) + mydev->textmode, /* mode  */ | 
 | 				  &buffer, mydev->textlength, 2000, mf); | 
 |  | 
 | 	if (rc < 0) | 
 | 		dev_dbg(&mydev->udev->dev, "write retval = %d\n", rc); | 
 |  | 
 | 	/* The device is right to left, where as you write left to right */ | 
 | 	for (i = 0; i < sizeof(mydev->decimals); i++) | 
 | 		decimals |= mydev->decimals[i] << i; | 
 |  | 
 | 	rc = usb_control_msg_send(mydev->udev, 0, 0x12, 0x48, | 
 | 				  (86 * 0x100) + 10, /* (set decimal) */ | 
 | 				  (0 * 0x100) + decimals, /* decimals */ | 
 | 				  NULL, 0, 2000, mf); | 
 |  | 
 | 	if (rc < 0) | 
 | 		dev_dbg(&mydev->udev->dev, "decimal retval = %d\n", rc); | 
 | } | 
 |  | 
 | #define MYDEV_ATTR_SIMPLE_UNSIGNED(name, update_fcn)		\ | 
 | static ssize_t name##_show(struct device *dev,			\ | 
 | 	struct device_attribute *attr, char *buf) 		\ | 
 | {								\ | 
 | 	struct usb_interface *intf = to_usb_interface(dev);	\ | 
 | 	struct usb_sevsegdev *mydev = usb_get_intfdata(intf);	\ | 
 | 								\ | 
 | 	return sprintf(buf, "%u\n", mydev->name);		\ | 
 | }								\ | 
 | 								\ | 
 | static ssize_t name##_store(struct device *dev,			\ | 
 | 	struct device_attribute *attr, const char *buf, size_t count) \ | 
 | {								\ | 
 | 	struct usb_interface *intf = to_usb_interface(dev);	\ | 
 | 	struct usb_sevsegdev *mydev = usb_get_intfdata(intf);	\ | 
 | 								\ | 
 | 	mydev->name = simple_strtoul(buf, NULL, 10);		\ | 
 | 	update_fcn(mydev); 					\ | 
 | 								\ | 
 | 	return count;						\ | 
 | }								\ | 
 | static DEVICE_ATTR_RW(name); | 
 |  | 
 | static ssize_t text_show(struct device *dev, | 
 | 	struct device_attribute *attr, char *buf) | 
 | { | 
 | 	struct usb_interface *intf = to_usb_interface(dev); | 
 | 	struct usb_sevsegdev *mydev = usb_get_intfdata(intf); | 
 |  | 
 | 	return sysfs_emit(buf, "%s\n", mydev->text); | 
 | } | 
 |  | 
 | static ssize_t text_store(struct device *dev, | 
 | 	struct device_attribute *attr, const char *buf, size_t count) | 
 | { | 
 | 	struct usb_interface *intf = to_usb_interface(dev); | 
 | 	struct usb_sevsegdev *mydev = usb_get_intfdata(intf); | 
 | 	size_t end = my_memlen(buf, count); | 
 |  | 
 | 	if (end > sizeof(mydev->text)) | 
 | 		return -EINVAL; | 
 |  | 
 | 	memset(mydev->text, 0, sizeof(mydev->text)); | 
 | 	mydev->textlength = end; | 
 |  | 
 | 	if (end > 0) | 
 | 		memcpy(mydev->text, buf, end); | 
 |  | 
 | 	update_display_visual(mydev, GFP_KERNEL); | 
 | 	return count; | 
 | } | 
 |  | 
 | static DEVICE_ATTR_RW(text); | 
 |  | 
 | static ssize_t decimals_show(struct device *dev, | 
 | 	struct device_attribute *attr, char *buf) | 
 | { | 
 | 	struct usb_interface *intf = to_usb_interface(dev); | 
 | 	struct usb_sevsegdev *mydev = usb_get_intfdata(intf); | 
 | 	int i; | 
 | 	int pos; | 
 |  | 
 | 	for (i = 0; i < sizeof(mydev->decimals); i++) { | 
 | 		pos = sizeof(mydev->decimals) - 1 - i; | 
 | 		if (mydev->decimals[i] == 0) | 
 | 			buf[pos] = '0'; | 
 | 		else if (mydev->decimals[i] == 1) | 
 | 			buf[pos] = '1'; | 
 | 		else | 
 | 			buf[pos] = 'x'; | 
 | 	} | 
 |  | 
 | 	buf[sizeof(mydev->decimals)] = '\n'; | 
 | 	return sizeof(mydev->decimals) + 1; | 
 | } | 
 |  | 
 | static ssize_t decimals_store(struct device *dev, | 
 | 	struct device_attribute *attr, const char *buf, size_t count) | 
 | { | 
 | 	struct usb_interface *intf = to_usb_interface(dev); | 
 | 	struct usb_sevsegdev *mydev = usb_get_intfdata(intf); | 
 | 	size_t end = my_memlen(buf, count); | 
 | 	int i; | 
 |  | 
 | 	if (end > sizeof(mydev->decimals)) | 
 | 		return -EINVAL; | 
 |  | 
 | 	for (i = 0; i < end; i++) | 
 | 		if (buf[i] != '0' && buf[i] != '1') | 
 | 			return -EINVAL; | 
 |  | 
 | 	memset(mydev->decimals, 0, sizeof(mydev->decimals)); | 
 | 	for (i = 0; i < end; i++) | 
 | 		if (buf[i] == '1') | 
 | 			mydev->decimals[end-1-i] = 1; | 
 |  | 
 | 	update_display_visual(mydev, GFP_KERNEL); | 
 |  | 
 | 	return count; | 
 | } | 
 |  | 
 | static DEVICE_ATTR_RW(decimals); | 
 |  | 
 | static ssize_t textmode_show(struct device *dev, | 
 | 	struct device_attribute *attr, char *buf) | 
 | { | 
 | 	struct usb_interface *intf = to_usb_interface(dev); | 
 | 	struct usb_sevsegdev *mydev = usb_get_intfdata(intf); | 
 | 	int i; | 
 |  | 
 | 	buf[0] = 0; | 
 |  | 
 | 	for (i = 0; i < ARRAY_SIZE(display_textmodes); i++) { | 
 | 		if (mydev->textmode == i) { | 
 | 			strcat(buf, " ["); | 
 | 			strcat(buf, display_textmodes[i]); | 
 | 			strcat(buf, "] "); | 
 | 		} else { | 
 | 			strcat(buf, " "); | 
 | 			strcat(buf, display_textmodes[i]); | 
 | 			strcat(buf, " "); | 
 | 		} | 
 | 	} | 
 | 	strcat(buf, "\n"); | 
 |  | 
 |  | 
 | 	return strlen(buf); | 
 | } | 
 |  | 
 | static ssize_t textmode_store(struct device *dev, | 
 | 	struct device_attribute *attr, const char *buf, size_t count) | 
 | { | 
 | 	struct usb_interface *intf = to_usb_interface(dev); | 
 | 	struct usb_sevsegdev *mydev = usb_get_intfdata(intf); | 
 | 	int i; | 
 |  | 
 | 	i = sysfs_match_string(display_textmodes, buf); | 
 | 	if (i < 0) | 
 | 		return i; | 
 |  | 
 | 	mydev->textmode = i; | 
 | 	update_display_visual(mydev, GFP_KERNEL); | 
 | 	return count; | 
 | } | 
 |  | 
 | static DEVICE_ATTR_RW(textmode); | 
 |  | 
 |  | 
 | MYDEV_ATTR_SIMPLE_UNSIGNED(powered, update_display_powered); | 
 | MYDEV_ATTR_SIMPLE_UNSIGNED(mode_msb, update_display_mode); | 
 | MYDEV_ATTR_SIMPLE_UNSIGNED(mode_lsb, update_display_mode); | 
 |  | 
 | static struct attribute *sevseg_attrs[] = { | 
 | 	&dev_attr_powered.attr, | 
 | 	&dev_attr_text.attr, | 
 | 	&dev_attr_textmode.attr, | 
 | 	&dev_attr_decimals.attr, | 
 | 	&dev_attr_mode_msb.attr, | 
 | 	&dev_attr_mode_lsb.attr, | 
 | 	NULL | 
 | }; | 
 | ATTRIBUTE_GROUPS(sevseg); | 
 |  | 
 | static int sevseg_probe(struct usb_interface *interface, | 
 | 	const struct usb_device_id *id) | 
 | { | 
 | 	struct usb_device *udev = interface_to_usbdev(interface); | 
 | 	struct usb_sevsegdev *mydev = NULL; | 
 | 	int rc = -ENOMEM; | 
 |  | 
 | 	mydev = kzalloc(sizeof(struct usb_sevsegdev), GFP_KERNEL); | 
 | 	if (!mydev) | 
 | 		goto error_mem; | 
 |  | 
 | 	mydev->udev = usb_get_dev(udev); | 
 | 	mydev->intf = interface; | 
 | 	usb_set_intfdata(interface, mydev); | 
 |  | 
 | 	/* PM */ | 
 | 	mydev->shadow_power = 1; /* currently active */ | 
 | 	mydev->has_interface_pm = 0; /* have not issued autopm_get */ | 
 |  | 
 | 	/*set defaults */ | 
 | 	mydev->textmode = 0x02; /* ascii mode */ | 
 | 	mydev->mode_msb = 0x06; /* 6 characters */ | 
 | 	mydev->mode_lsb = 0x3f; /* scanmode for 6 chars */ | 
 |  | 
 | 	dev_info(&interface->dev, "USB 7 Segment device now attached\n"); | 
 | 	return 0; | 
 |  | 
 | error_mem: | 
 | 	return rc; | 
 | } | 
 |  | 
 | static void sevseg_disconnect(struct usb_interface *interface) | 
 | { | 
 | 	struct usb_sevsegdev *mydev; | 
 |  | 
 | 	mydev = usb_get_intfdata(interface); | 
 | 	usb_set_intfdata(interface, NULL); | 
 | 	usb_put_dev(mydev->udev); | 
 | 	kfree(mydev); | 
 | 	dev_info(&interface->dev, "USB 7 Segment now disconnected\n"); | 
 | } | 
 |  | 
 | static int sevseg_suspend(struct usb_interface *intf, pm_message_t message) | 
 | { | 
 | 	struct usb_sevsegdev *mydev; | 
 |  | 
 | 	mydev = usb_get_intfdata(intf); | 
 | 	mydev->shadow_power = 0; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int sevseg_resume(struct usb_interface *intf) | 
 | { | 
 | 	struct usb_sevsegdev *mydev; | 
 |  | 
 | 	mydev = usb_get_intfdata(intf); | 
 | 	mydev->shadow_power = 1; | 
 | 	update_display_mode(mydev); | 
 | 	update_display_visual(mydev, GFP_NOIO); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int sevseg_reset_resume(struct usb_interface *intf) | 
 | { | 
 | 	struct usb_sevsegdev *mydev; | 
 |  | 
 | 	mydev = usb_get_intfdata(intf); | 
 | 	mydev->shadow_power = 1; | 
 | 	update_display_mode(mydev); | 
 | 	update_display_visual(mydev, GFP_NOIO); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static struct usb_driver sevseg_driver = { | 
 | 	.name =		"usbsevseg", | 
 | 	.probe =	sevseg_probe, | 
 | 	.disconnect =	sevseg_disconnect, | 
 | 	.suspend =	sevseg_suspend, | 
 | 	.resume =	sevseg_resume, | 
 | 	.reset_resume =	sevseg_reset_resume, | 
 | 	.id_table =	id_table, | 
 | 	.dev_groups =	sevseg_groups, | 
 | 	.supports_autosuspend = 1, | 
 | }; | 
 |  | 
 | module_usb_driver(sevseg_driver); | 
 |  | 
 | MODULE_AUTHOR(DRIVER_AUTHOR); | 
 | MODULE_DESCRIPTION(DRIVER_DESC); | 
 | MODULE_LICENSE("GPL"); |