Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
7segled.c
Go to the documentation of this file.
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 
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 
28 
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 
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 
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 
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 
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 
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);