1 /*
2 * 7 Segment LED routines
3 * Based on RBTX49xx patch from CELF patch archive.
4 *
5 * This file is subject to the terms and conditions of the GNU General Public
6 * License. See the file "COPYING" in the main directory of this archive
7 * for more details.
8 *
9 * (C) Copyright TOSHIBA CORPORATION 2005-2007
10 * All Rights Reserved.
11 */
12 #include <linux/device.h>
13 #include <linux/slab.h>
14 #include <linux/map_to_7segment.h>
15 #include <asm/txx9/generic.h>
16
17 static unsigned int tx_7segled_num;
18 static void (*tx_7segled_putc)(unsigned int pos, unsigned char val);
19
txx9_7segled_init(unsigned int num,void (* putc)(unsigned int pos,unsigned char val))20 void __init txx9_7segled_init(unsigned int num,
21 void (*putc)(unsigned int pos, unsigned char val))
22 {
23 tx_7segled_num = num;
24 tx_7segled_putc = putc;
25 }
26
27 static SEG7_CONVERSION_MAP(txx9_seg7map, MAP_ASCII7SEG_ALPHANUM_LC);
28
txx9_7segled_putc(unsigned int pos,char c)29 int txx9_7segled_putc(unsigned int pos, char c)
30 {
31 if (pos >= tx_7segled_num)
32 return -EINVAL;
33 c = map_to_seg7(&txx9_seg7map, c);
34 if (c < 0)
35 return c;
36 tx_7segled_putc(pos, c);
37 return 0;
38 }
39
ascii_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t size)40 static ssize_t ascii_store(struct device *dev,
41 struct device_attribute *attr,
42 const char *buf, size_t size)
43 {
44 unsigned int ch = dev->id;
45 txx9_7segled_putc(ch, buf[0]);
46 return size;
47 }
48
raw_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t size)49 static ssize_t raw_store(struct device *dev,
50 struct device_attribute *attr,
51 const char *buf, size_t size)
52 {
53 unsigned int ch = dev->id;
54 tx_7segled_putc(ch, buf[0]);
55 return size;
56 }
57
58 static DEVICE_ATTR(ascii, 0200, NULL, ascii_store);
59 static DEVICE_ATTR(raw, 0200, NULL, raw_store);
60
map_seg7_show(struct device * dev,struct device_attribute * attr,char * buf)61 static ssize_t map_seg7_show(struct device *dev,
62 struct device_attribute *attr,
63 char *buf)
64 {
65 memcpy(buf, &txx9_seg7map, sizeof(txx9_seg7map));
66 return sizeof(txx9_seg7map);
67 }
68
map_seg7_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t size)69 static ssize_t map_seg7_store(struct device *dev,
70 struct device_attribute *attr,
71 const char *buf, size_t size)
72 {
73 if (size != sizeof(txx9_seg7map))
74 return -EINVAL;
75 memcpy(&txx9_seg7map, buf, size);
76 return size;
77 }
78
79 static DEVICE_ATTR(map_seg7, 0600, map_seg7_show, map_seg7_store);
80
81 static struct bus_type tx_7segled_subsys = {
82 .name = "7segled",
83 .dev_name = "7segled",
84 };
85
tx_7segled_init_sysfs(void)86 static int __init tx_7segled_init_sysfs(void)
87 {
88 int error, i;
89 if (!tx_7segled_num)
90 return -ENODEV;
91 error = subsys_system_register(&tx_7segled_subsys, NULL);
92 if (error)
93 return error;
94 error = device_create_file(tx_7segled_subsys.dev_root, &dev_attr_map_seg7);
95 if (error)
96 return error;
97 for (i = 0; i < tx_7segled_num; i++) {
98 struct device *dev;
99 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
100 if (!dev) {
101 error = -ENODEV;
102 break;
103 }
104 dev->id = i;
105 dev->bus = &tx_7segled_subsys;
106 error = device_register(dev);
107 if (!error) {
108 device_create_file(dev, &dev_attr_ascii);
109 device_create_file(dev, &dev_attr_raw);
110 }
111 }
112 return error;
113 }
114
115 device_initcall(tx_7segled_init_sysfs);
116