Loading...
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * USB 7 Segment Driver
4 *
5 * Copyright (C) 2008 Harrison Metzger <harrisonmetz@gmail.com>
6 * Based on usbled.c by Greg Kroah-Hartman (greg@kroah.com)
7 */
8
9#include <linux/kernel.h>
10#include <linux/errno.h>
11#include <linux/slab.h>
12#include <linux/module.h>
13#include <linux/string.h>
14#include <linux/usb.h>
15
16
17#define DRIVER_AUTHOR "Harrison Metzger <harrisonmetz@gmail.com>"
18#define DRIVER_DESC "USB 7 Segment Driver"
19
20#define VENDOR_ID 0x0fc5
21#define PRODUCT_ID 0x1227
22#define MAXLEN 8
23
24/* table of devices that work with this driver */
25static const struct usb_device_id id_table[] = {
26 { USB_DEVICE(VENDOR_ID, PRODUCT_ID) },
27 { },
28};
29MODULE_DEVICE_TABLE(usb, id_table);
30
31/* the different text display modes the device is capable of */
32static const char *display_textmodes[] = {"raw", "hex", "ascii"};
33
34struct usb_sevsegdev {
35 struct usb_device *udev;
36 struct usb_interface *intf;
37
38 u8 powered;
39 u8 mode_msb;
40 u8 mode_lsb;
41 u8 decimals[MAXLEN];
42 u8 textmode;
43 u8 text[MAXLEN];
44 u16 textlength;
45
46 u8 shadow_power; /* for PM */
47 u8 has_interface_pm;
48};
49
50/* sysfs_streq can't replace this completely
51 * If the device was in hex mode, and the user wanted a 0,
52 * if str commands are used, we would assume the end of string
53 * so mem commands are used.
54 */
55static inline size_t my_memlen(const char *buf, size_t count)
56{
57 if (count > 0 && buf[count-1] == '\n')
58 return count - 1;
59 else
60 return count;
61}
62
63static void update_display_powered(struct usb_sevsegdev *mydev)
64{
65 int rc;
66
67 if (mydev->powered && !mydev->has_interface_pm) {
68 rc = usb_autopm_get_interface(mydev->intf);
69 if (rc < 0)
70 return;
71 mydev->has_interface_pm = 1;
72 }
73
74 if (mydev->shadow_power != 1)
75 return;
76
77 rc = usb_control_msg_send(mydev->udev, 0, 0x12, 0x48,
78 (80 * 0x100) + 10, /* (power mode) */
79 (0x00 * 0x100) + (mydev->powered ? 1 : 0),
80 NULL, 0, 2000, GFP_KERNEL);
81 if (rc < 0)
82 dev_dbg(&mydev->udev->dev, "power retval = %d\n", rc);
83
84 if (!mydev->powered && mydev->has_interface_pm) {
85 usb_autopm_put_interface(mydev->intf);
86 mydev->has_interface_pm = 0;
87 }
88}
89
90static void update_display_mode(struct usb_sevsegdev *mydev)
91{
92 int rc;
93
94 if(mydev->shadow_power != 1)
95 return;
96
97 rc = usb_control_msg_send(mydev->udev, 0, 0x12, 0x48,
98 (82 * 0x100) + 10, /* (set mode) */
99 (mydev->mode_msb * 0x100) + mydev->mode_lsb,
100 NULL, 0, 2000, GFP_NOIO);
101
102 if (rc < 0)
103 dev_dbg(&mydev->udev->dev, "mode retval = %d\n", rc);
104}
105
106static void update_display_visual(struct usb_sevsegdev *mydev, gfp_t mf)
107{
108 int rc;
109 int i;
110 unsigned char buffer[MAXLEN] = {0};
111 u8 decimals = 0;
112
113 if(mydev->shadow_power != 1)
114 return;
115
116 /* The device is right to left, where as you write left to right */
117 for (i = 0; i < mydev->textlength; i++)
118 buffer[i] = mydev->text[mydev->textlength-1-i];
119
120 rc = usb_control_msg_send(mydev->udev, 0, 0x12, 0x48,
121 (85 * 0x100) + 10, /* (write text) */
122 (0 * 0x100) + mydev->textmode, /* mode */
123 &buffer, mydev->textlength, 2000, mf);
124
125 if (rc < 0)
126 dev_dbg(&mydev->udev->dev, "write retval = %d\n", rc);
127
128 /* The device is right to left, where as you write left to right */
129 for (i = 0; i < sizeof(mydev->decimals); i++)
130 decimals |= mydev->decimals[i] << i;
131
132 rc = usb_control_msg_send(mydev->udev, 0, 0x12, 0x48,
133 (86 * 0x100) + 10, /* (set decimal) */
134 (0 * 0x100) + decimals, /* decimals */
135 NULL, 0, 2000, mf);
136
137 if (rc < 0)
138 dev_dbg(&mydev->udev->dev, "decimal retval = %d\n", rc);
139}
140
141#define MYDEV_ATTR_SIMPLE_UNSIGNED(name, update_fcn) \
142static ssize_t name##_show(struct device *dev, \
143 struct device_attribute *attr, char *buf) \
144{ \
145 struct usb_interface *intf = to_usb_interface(dev); \
146 struct usb_sevsegdev *mydev = usb_get_intfdata(intf); \
147 \
148 return sprintf(buf, "%u\n", mydev->name); \
149} \
150 \
151static ssize_t name##_store(struct device *dev, \
152 struct device_attribute *attr, const char *buf, size_t count) \
153{ \
154 struct usb_interface *intf = to_usb_interface(dev); \
155 struct usb_sevsegdev *mydev = usb_get_intfdata(intf); \
156 \
157 mydev->name = simple_strtoul(buf, NULL, 10); \
158 update_fcn(mydev); \
159 \
160 return count; \
161} \
162static DEVICE_ATTR_RW(name);
163
164static ssize_t text_show(struct device *dev,
165 struct device_attribute *attr, char *buf)
166{
167 struct usb_interface *intf = to_usb_interface(dev);
168 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
169
170 return sysfs_emit(buf, "%s\n", mydev->text);
171}
172
173static ssize_t text_store(struct device *dev,
174 struct device_attribute *attr, const char *buf, size_t count)
175{
176 struct usb_interface *intf = to_usb_interface(dev);
177 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
178 size_t end = my_memlen(buf, count);
179
180 if (end > sizeof(mydev->text))
181 return -EINVAL;
182
183 memset(mydev->text, 0, sizeof(mydev->text));
184 mydev->textlength = end;
185
186 if (end > 0)
187 memcpy(mydev->text, buf, end);
188
189 update_display_visual(mydev, GFP_KERNEL);
190 return count;
191}
192
193static DEVICE_ATTR_RW(text);
194
195static ssize_t decimals_show(struct device *dev,
196 struct device_attribute *attr, char *buf)
197{
198 struct usb_interface *intf = to_usb_interface(dev);
199 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
200 int i;
201 int pos;
202
203 for (i = 0; i < sizeof(mydev->decimals); i++) {
204 pos = sizeof(mydev->decimals) - 1 - i;
205 if (mydev->decimals[i] == 0)
206 buf[pos] = '0';
207 else if (mydev->decimals[i] == 1)
208 buf[pos] = '1';
209 else
210 buf[pos] = 'x';
211 }
212
213 buf[sizeof(mydev->decimals)] = '\n';
214 return sizeof(mydev->decimals) + 1;
215}
216
217static ssize_t decimals_store(struct device *dev,
218 struct device_attribute *attr, const char *buf, size_t count)
219{
220 struct usb_interface *intf = to_usb_interface(dev);
221 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
222 size_t end = my_memlen(buf, count);
223 int i;
224
225 if (end > sizeof(mydev->decimals))
226 return -EINVAL;
227
228 for (i = 0; i < end; i++)
229 if (buf[i] != '0' && buf[i] != '1')
230 return -EINVAL;
231
232 memset(mydev->decimals, 0, sizeof(mydev->decimals));
233 for (i = 0; i < end; i++)
234 if (buf[i] == '1')
235 mydev->decimals[end-1-i] = 1;
236
237 update_display_visual(mydev, GFP_KERNEL);
238
239 return count;
240}
241
242static DEVICE_ATTR_RW(decimals);
243
244static ssize_t textmode_show(struct device *dev,
245 struct device_attribute *attr, char *buf)
246{
247 struct usb_interface *intf = to_usb_interface(dev);
248 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
249 int i;
250
251 buf[0] = 0;
252
253 for (i = 0; i < ARRAY_SIZE(display_textmodes); i++) {
254 if (mydev->textmode == i) {
255 strcat(buf, " [");
256 strcat(buf, display_textmodes[i]);
257 strcat(buf, "] ");
258 } else {
259 strcat(buf, " ");
260 strcat(buf, display_textmodes[i]);
261 strcat(buf, " ");
262 }
263 }
264 strcat(buf, "\n");
265
266
267 return strlen(buf);
268}
269
270static ssize_t textmode_store(struct device *dev,
271 struct device_attribute *attr, const char *buf, size_t count)
272{
273 struct usb_interface *intf = to_usb_interface(dev);
274 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
275 int i;
276
277 i = sysfs_match_string(display_textmodes, buf);
278 if (i < 0)
279 return i;
280
281 mydev->textmode = i;
282 update_display_visual(mydev, GFP_KERNEL);
283 return count;
284}
285
286static DEVICE_ATTR_RW(textmode);
287
288
289MYDEV_ATTR_SIMPLE_UNSIGNED(powered, update_display_powered);
290MYDEV_ATTR_SIMPLE_UNSIGNED(mode_msb, update_display_mode);
291MYDEV_ATTR_SIMPLE_UNSIGNED(mode_lsb, update_display_mode);
292
293static struct attribute *sevseg_attrs[] = {
294 &dev_attr_powered.attr,
295 &dev_attr_text.attr,
296 &dev_attr_textmode.attr,
297 &dev_attr_decimals.attr,
298 &dev_attr_mode_msb.attr,
299 &dev_attr_mode_lsb.attr,
300 NULL
301};
302ATTRIBUTE_GROUPS(sevseg);
303
304static int sevseg_probe(struct usb_interface *interface,
305 const struct usb_device_id *id)
306{
307 struct usb_device *udev = interface_to_usbdev(interface);
308 struct usb_sevsegdev *mydev;
309 int rc = -ENOMEM;
310
311 mydev = kzalloc(sizeof(struct usb_sevsegdev), GFP_KERNEL);
312 if (!mydev)
313 goto error_mem;
314
315 mydev->udev = usb_get_dev(udev);
316 mydev->intf = interface;
317 usb_set_intfdata(interface, mydev);
318
319 /* PM */
320 mydev->shadow_power = 1; /* currently active */
321 mydev->has_interface_pm = 0; /* have not issued autopm_get */
322
323 /*set defaults */
324 mydev->textmode = 0x02; /* ascii mode */
325 mydev->mode_msb = 0x06; /* 6 characters */
326 mydev->mode_lsb = 0x3f; /* scanmode for 6 chars */
327
328 dev_info(&interface->dev, "USB 7 Segment device now attached\n");
329 return 0;
330
331error_mem:
332 return rc;
333}
334
335static void sevseg_disconnect(struct usb_interface *interface)
336{
337 struct usb_sevsegdev *mydev;
338
339 mydev = usb_get_intfdata(interface);
340 usb_set_intfdata(interface, NULL);
341 usb_put_dev(mydev->udev);
342 kfree(mydev);
343 dev_info(&interface->dev, "USB 7 Segment now disconnected\n");
344}
345
346static int sevseg_suspend(struct usb_interface *intf, pm_message_t message)
347{
348 struct usb_sevsegdev *mydev;
349
350 mydev = usb_get_intfdata(intf);
351 mydev->shadow_power = 0;
352
353 return 0;
354}
355
356static int sevseg_resume(struct usb_interface *intf)
357{
358 struct usb_sevsegdev *mydev;
359
360 mydev = usb_get_intfdata(intf);
361 mydev->shadow_power = 1;
362 update_display_mode(mydev);
363 update_display_visual(mydev, GFP_NOIO);
364
365 return 0;
366}
367
368static int sevseg_reset_resume(struct usb_interface *intf)
369{
370 struct usb_sevsegdev *mydev;
371
372 mydev = usb_get_intfdata(intf);
373 mydev->shadow_power = 1;
374 update_display_mode(mydev);
375 update_display_visual(mydev, GFP_NOIO);
376
377 return 0;
378}
379
380static struct usb_driver sevseg_driver = {
381 .name = "usbsevseg",
382 .probe = sevseg_probe,
383 .disconnect = sevseg_disconnect,
384 .suspend = sevseg_suspend,
385 .resume = sevseg_resume,
386 .reset_resume = sevseg_reset_resume,
387 .id_table = id_table,
388 .dev_groups = sevseg_groups,
389 .supports_autosuspend = 1,
390};
391
392module_usb_driver(sevseg_driver);
393
394MODULE_AUTHOR(DRIVER_AUTHOR);
395MODULE_DESCRIPTION(DRIVER_DESC);
396MODULE_LICENSE("GPL");
1/*
2 * USB 7 Segment Driver
3 *
4 * Copyright (C) 2008 Harrison Metzger <harrisonmetz@gmail.com>
5 * Based on usbled.c by Greg Kroah-Hartman (greg@kroah.com)
6 *
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License as
9 * published by the Free Software Foundation, version 2.
10 *
11 */
12
13#include <linux/kernel.h>
14#include <linux/errno.h>
15#include <linux/slab.h>
16#include <linux/module.h>
17#include <linux/string.h>
18#include <linux/usb.h>
19
20
21#define DRIVER_AUTHOR "Harrison Metzger <harrisonmetz@gmail.com>"
22#define DRIVER_DESC "USB 7 Segment Driver"
23
24#define VENDOR_ID 0x0fc5
25#define PRODUCT_ID 0x1227
26#define MAXLEN 8
27
28/* table of devices that work with this driver */
29static const struct usb_device_id id_table[] = {
30 { USB_DEVICE(VENDOR_ID, PRODUCT_ID) },
31 { },
32};
33MODULE_DEVICE_TABLE(usb, id_table);
34
35/* the different text display modes the device is capable of */
36static char *display_textmodes[] = {"raw", "hex", "ascii", NULL};
37
38struct usb_sevsegdev {
39 struct usb_device *udev;
40 struct usb_interface *intf;
41
42 u8 powered;
43 u8 mode_msb;
44 u8 mode_lsb;
45 u8 decimals[MAXLEN];
46 u8 textmode;
47 u8 text[MAXLEN];
48 u16 textlength;
49
50 u8 shadow_power; /* for PM */
51 u8 has_interface_pm;
52};
53
54/* sysfs_streq can't replace this completely
55 * If the device was in hex mode, and the user wanted a 0,
56 * if str commands are used, we would assume the end of string
57 * so mem commands are used.
58 */
59static inline size_t my_memlen(const char *buf, size_t count)
60{
61 if (count > 0 && buf[count-1] == '\n')
62 return count - 1;
63 else
64 return count;
65}
66
67static void update_display_powered(struct usb_sevsegdev *mydev)
68{
69 int rc;
70
71 if (mydev->powered && !mydev->has_interface_pm) {
72 rc = usb_autopm_get_interface(mydev->intf);
73 if (rc < 0)
74 return;
75 mydev->has_interface_pm = 1;
76 }
77
78 if (mydev->shadow_power != 1)
79 return;
80
81 rc = usb_control_msg(mydev->udev,
82 usb_sndctrlpipe(mydev->udev, 0),
83 0x12,
84 0x48,
85 (80 * 0x100) + 10, /* (power mode) */
86 (0x00 * 0x100) + (mydev->powered ? 1 : 0),
87 NULL,
88 0,
89 2000);
90 if (rc < 0)
91 dev_dbg(&mydev->udev->dev, "power retval = %d\n", rc);
92
93 if (!mydev->powered && mydev->has_interface_pm) {
94 usb_autopm_put_interface(mydev->intf);
95 mydev->has_interface_pm = 0;
96 }
97}
98
99static void update_display_mode(struct usb_sevsegdev *mydev)
100{
101 int rc;
102
103 if(mydev->shadow_power != 1)
104 return;
105
106 rc = usb_control_msg(mydev->udev,
107 usb_sndctrlpipe(mydev->udev, 0),
108 0x12,
109 0x48,
110 (82 * 0x100) + 10, /* (set mode) */
111 (mydev->mode_msb * 0x100) + mydev->mode_lsb,
112 NULL,
113 0,
114 2000);
115
116 if (rc < 0)
117 dev_dbg(&mydev->udev->dev, "mode retval = %d\n", rc);
118}
119
120static void update_display_visual(struct usb_sevsegdev *mydev, gfp_t mf)
121{
122 int rc;
123 int i;
124 unsigned char *buffer;
125 u8 decimals = 0;
126
127 if(mydev->shadow_power != 1)
128 return;
129
130 buffer = kzalloc(MAXLEN, mf);
131 if (!buffer)
132 return;
133
134 /* The device is right to left, where as you write left to right */
135 for (i = 0; i < mydev->textlength; i++)
136 buffer[i] = mydev->text[mydev->textlength-1-i];
137
138 rc = usb_control_msg(mydev->udev,
139 usb_sndctrlpipe(mydev->udev, 0),
140 0x12,
141 0x48,
142 (85 * 0x100) + 10, /* (write text) */
143 (0 * 0x100) + mydev->textmode, /* mode */
144 buffer,
145 mydev->textlength,
146 2000);
147
148 if (rc < 0)
149 dev_dbg(&mydev->udev->dev, "write retval = %d\n", rc);
150
151 kfree(buffer);
152
153 /* The device is right to left, where as you write left to right */
154 for (i = 0; i < sizeof(mydev->decimals); i++)
155 decimals |= mydev->decimals[i] << i;
156
157 rc = usb_control_msg(mydev->udev,
158 usb_sndctrlpipe(mydev->udev, 0),
159 0x12,
160 0x48,
161 (86 * 0x100) + 10, /* (set decimal) */
162 (0 * 0x100) + decimals, /* decimals */
163 NULL,
164 0,
165 2000);
166
167 if (rc < 0)
168 dev_dbg(&mydev->udev->dev, "decimal retval = %d\n", rc);
169}
170
171#define MYDEV_ATTR_SIMPLE_UNSIGNED(name, update_fcn) \
172static ssize_t show_attr_##name(struct device *dev, \
173 struct device_attribute *attr, char *buf) \
174{ \
175 struct usb_interface *intf = to_usb_interface(dev); \
176 struct usb_sevsegdev *mydev = usb_get_intfdata(intf); \
177 \
178 return sprintf(buf, "%u\n", mydev->name); \
179} \
180 \
181static ssize_t set_attr_##name(struct device *dev, \
182 struct device_attribute *attr, const char *buf, size_t count) \
183{ \
184 struct usb_interface *intf = to_usb_interface(dev); \
185 struct usb_sevsegdev *mydev = usb_get_intfdata(intf); \
186 \
187 mydev->name = simple_strtoul(buf, NULL, 10); \
188 update_fcn(mydev); \
189 \
190 return count; \
191} \
192static DEVICE_ATTR(name, S_IRUGO | S_IWUSR, show_attr_##name, set_attr_##name);
193
194static ssize_t show_attr_text(struct device *dev,
195 struct device_attribute *attr, char *buf)
196{
197 struct usb_interface *intf = to_usb_interface(dev);
198 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
199
200 return snprintf(buf, mydev->textlength, "%s\n", mydev->text);
201}
202
203static ssize_t set_attr_text(struct device *dev,
204 struct device_attribute *attr, const char *buf, size_t count)
205{
206 struct usb_interface *intf = to_usb_interface(dev);
207 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
208 size_t end = my_memlen(buf, count);
209
210 if (end > sizeof(mydev->text))
211 return -EINVAL;
212
213 memset(mydev->text, 0, sizeof(mydev->text));
214 mydev->textlength = end;
215
216 if (end > 0)
217 memcpy(mydev->text, buf, end);
218
219 update_display_visual(mydev, GFP_KERNEL);
220 return count;
221}
222
223static DEVICE_ATTR(text, S_IRUGO | S_IWUSR, show_attr_text, set_attr_text);
224
225static ssize_t show_attr_decimals(struct device *dev,
226 struct device_attribute *attr, char *buf)
227{
228 struct usb_interface *intf = to_usb_interface(dev);
229 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
230 int i;
231 int pos;
232
233 for (i = 0; i < sizeof(mydev->decimals); i++) {
234 pos = sizeof(mydev->decimals) - 1 - i;
235 if (mydev->decimals[i] == 0)
236 buf[pos] = '0';
237 else if (mydev->decimals[i] == 1)
238 buf[pos] = '1';
239 else
240 buf[pos] = 'x';
241 }
242
243 buf[sizeof(mydev->decimals)] = '\n';
244 return sizeof(mydev->decimals) + 1;
245}
246
247static ssize_t set_attr_decimals(struct device *dev,
248 struct device_attribute *attr, const char *buf, size_t count)
249{
250 struct usb_interface *intf = to_usb_interface(dev);
251 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
252 size_t end = my_memlen(buf, count);
253 int i;
254
255 if (end > sizeof(mydev->decimals))
256 return -EINVAL;
257
258 for (i = 0; i < end; i++)
259 if (buf[i] != '0' && buf[i] != '1')
260 return -EINVAL;
261
262 memset(mydev->decimals, 0, sizeof(mydev->decimals));
263 for (i = 0; i < end; i++)
264 if (buf[i] == '1')
265 mydev->decimals[end-1-i] = 1;
266
267 update_display_visual(mydev, GFP_KERNEL);
268
269 return count;
270}
271
272static DEVICE_ATTR(decimals, S_IRUGO | S_IWUSR, show_attr_decimals, set_attr_decimals);
273
274static ssize_t show_attr_textmode(struct device *dev,
275 struct device_attribute *attr, char *buf)
276{
277 struct usb_interface *intf = to_usb_interface(dev);
278 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
279 int i;
280
281 buf[0] = 0;
282
283 for (i = 0; display_textmodes[i]; i++) {
284 if (mydev->textmode == i) {
285 strcat(buf, " [");
286 strcat(buf, display_textmodes[i]);
287 strcat(buf, "] ");
288 } else {
289 strcat(buf, " ");
290 strcat(buf, display_textmodes[i]);
291 strcat(buf, " ");
292 }
293 }
294 strcat(buf, "\n");
295
296
297 return strlen(buf);
298}
299
300static ssize_t set_attr_textmode(struct device *dev,
301 struct device_attribute *attr, const char *buf, size_t count)
302{
303 struct usb_interface *intf = to_usb_interface(dev);
304 struct usb_sevsegdev *mydev = usb_get_intfdata(intf);
305 int i;
306
307 for (i = 0; display_textmodes[i]; i++) {
308 if (sysfs_streq(display_textmodes[i], buf)) {
309 mydev->textmode = i;
310 update_display_visual(mydev, GFP_KERNEL);
311 return count;
312 }
313 }
314
315 return -EINVAL;
316}
317
318static DEVICE_ATTR(textmode, S_IRUGO | S_IWUSR, show_attr_textmode, set_attr_textmode);
319
320
321MYDEV_ATTR_SIMPLE_UNSIGNED(powered, update_display_powered);
322MYDEV_ATTR_SIMPLE_UNSIGNED(mode_msb, update_display_mode);
323MYDEV_ATTR_SIMPLE_UNSIGNED(mode_lsb, update_display_mode);
324
325static struct attribute *dev_attrs[] = {
326 &dev_attr_powered.attr,
327 &dev_attr_text.attr,
328 &dev_attr_textmode.attr,
329 &dev_attr_decimals.attr,
330 &dev_attr_mode_msb.attr,
331 &dev_attr_mode_lsb.attr,
332 NULL
333};
334
335static struct attribute_group dev_attr_grp = {
336 .attrs = dev_attrs,
337};
338
339static int sevseg_probe(struct usb_interface *interface,
340 const struct usb_device_id *id)
341{
342 struct usb_device *udev = interface_to_usbdev(interface);
343 struct usb_sevsegdev *mydev = NULL;
344 int rc = -ENOMEM;
345
346 mydev = kzalloc(sizeof(struct usb_sevsegdev), GFP_KERNEL);
347 if (!mydev)
348 goto error_mem;
349
350 mydev->udev = usb_get_dev(udev);
351 mydev->intf = interface;
352 usb_set_intfdata(interface, mydev);
353
354 /* PM */
355 mydev->shadow_power = 1; /* currently active */
356 mydev->has_interface_pm = 0; /* have not issued autopm_get */
357
358 /*set defaults */
359 mydev->textmode = 0x02; /* ascii mode */
360 mydev->mode_msb = 0x06; /* 6 characters */
361 mydev->mode_lsb = 0x3f; /* scanmode for 6 chars */
362
363 rc = sysfs_create_group(&interface->dev.kobj, &dev_attr_grp);
364 if (rc)
365 goto error;
366
367 dev_info(&interface->dev, "USB 7 Segment device now attached\n");
368 return 0;
369
370error:
371 usb_set_intfdata(interface, NULL);
372 usb_put_dev(mydev->udev);
373 kfree(mydev);
374error_mem:
375 return rc;
376}
377
378static void sevseg_disconnect(struct usb_interface *interface)
379{
380 struct usb_sevsegdev *mydev;
381
382 mydev = usb_get_intfdata(interface);
383 sysfs_remove_group(&interface->dev.kobj, &dev_attr_grp);
384 usb_set_intfdata(interface, NULL);
385 usb_put_dev(mydev->udev);
386 kfree(mydev);
387 dev_info(&interface->dev, "USB 7 Segment now disconnected\n");
388}
389
390static int sevseg_suspend(struct usb_interface *intf, pm_message_t message)
391{
392 struct usb_sevsegdev *mydev;
393
394 mydev = usb_get_intfdata(intf);
395 mydev->shadow_power = 0;
396
397 return 0;
398}
399
400static int sevseg_resume(struct usb_interface *intf)
401{
402 struct usb_sevsegdev *mydev;
403
404 mydev = usb_get_intfdata(intf);
405 mydev->shadow_power = 1;
406 update_display_mode(mydev);
407 update_display_visual(mydev, GFP_NOIO);
408
409 return 0;
410}
411
412static int sevseg_reset_resume(struct usb_interface *intf)
413{
414 struct usb_sevsegdev *mydev;
415
416 mydev = usb_get_intfdata(intf);
417 mydev->shadow_power = 1;
418 update_display_mode(mydev);
419 update_display_visual(mydev, GFP_NOIO);
420
421 return 0;
422}
423
424static struct usb_driver sevseg_driver = {
425 .name = "usbsevseg",
426 .probe = sevseg_probe,
427 .disconnect = sevseg_disconnect,
428 .suspend = sevseg_suspend,
429 .resume = sevseg_resume,
430 .reset_resume = sevseg_reset_resume,
431 .id_table = id_table,
432 .supports_autosuspend = 1,
433};
434
435module_usb_driver(sevseg_driver);
436
437MODULE_AUTHOR(DRIVER_AUTHOR);
438MODULE_DESCRIPTION(DRIVER_DESC);
439MODULE_LICENSE("GPL");