1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include <linux/init.h>
27#include <linux/module.h>
28#include <linux/kernel.h>
29#include <linux/delay.h>
30#include <linux/fs.h>
31#include <linux/io.h>
32#include <linux/parport.h>
33#include <linux/uaccess.h>
34#include <linux/ks0108.h>
35
36#define KS0108_NAME "ks0108"
37
38
39
40
41
42static unsigned int ks0108_port = CONFIG_KS0108_PORT;
43module_param(ks0108_port, uint, S_IRUGO);
44MODULE_PARM_DESC(ks0108_port, "Parallel port where the LCD is connected");
45
46static unsigned int ks0108_delay = CONFIG_KS0108_DELAY;
47module_param(ks0108_delay, uint, S_IRUGO);
48MODULE_PARM_DESC(ks0108_delay, "Delay between each control writing (microseconds)");
49
50
51
52
53
54static struct parport *ks0108_parport;
55static struct pardevice *ks0108_pardevice;
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73#define bit(n) (((unsigned char)1)<<(n))
74
75void ks0108_writedata(unsigned char byte)
76{
77 parport_write_data(ks0108_parport, byte);
78}
79
80void ks0108_writecontrol(unsigned char byte)
81{
82 udelay(ks0108_delay);
83 parport_write_control(ks0108_parport, byte ^ (bit(0) | bit(1) | bit(3)));
84}
85
86void ks0108_displaystate(unsigned char state)
87{
88 ks0108_writedata((state ? bit(0) : 0) | bit(1) | bit(2) | bit(3) | bit(4) | bit(5));
89}
90
91void ks0108_startline(unsigned char startline)
92{
93 ks0108_writedata(min(startline,(unsigned char)63) | bit(6) | bit(7));
94}
95
96void ks0108_address(unsigned char address)
97{
98 ks0108_writedata(min(address,(unsigned char)63) | bit(6));
99}
100
101void ks0108_page(unsigned char page)
102{
103 ks0108_writedata(min(page,(unsigned char)7) | bit(3) | bit(4) | bit(5) | bit(7));
104}
105
106EXPORT_SYMBOL_GPL(ks0108_writedata);
107EXPORT_SYMBOL_GPL(ks0108_writecontrol);
108EXPORT_SYMBOL_GPL(ks0108_displaystate);
109EXPORT_SYMBOL_GPL(ks0108_startline);
110EXPORT_SYMBOL_GPL(ks0108_address);
111EXPORT_SYMBOL_GPL(ks0108_page);
112
113
114
115
116
117static unsigned char ks0108_inited;
118unsigned char ks0108_isinited(void)
119{
120 return ks0108_inited;
121}
122EXPORT_SYMBOL_GPL(ks0108_isinited);
123
124
125
126
127
128static int __init ks0108_init(void)
129{
130 int result;
131 int ret = -EINVAL;
132
133 ks0108_parport = parport_find_base(ks0108_port);
134 if (ks0108_parport == NULL) {
135 printk(KERN_ERR KS0108_NAME ": ERROR: "
136 "parport didn't find %i port\n", ks0108_port);
137 goto none;
138 }
139
140 ks0108_pardevice = parport_register_device(ks0108_parport, KS0108_NAME,
141 NULL, NULL, NULL, PARPORT_DEV_EXCL, NULL);
142 if (ks0108_pardevice == NULL) {
143 printk(KERN_ERR KS0108_NAME ": ERROR: "
144 "parport didn't register new device\n");
145 goto none;
146 }
147
148 result = parport_claim(ks0108_pardevice);
149 if (result != 0) {
150 printk(KERN_ERR KS0108_NAME ": ERROR: "
151 "can't claim %i parport, maybe in use\n", ks0108_port);
152 ret = result;
153 goto registered;
154 }
155
156 ks0108_inited = 1;
157 return 0;
158
159registered:
160 parport_unregister_device(ks0108_pardevice);
161
162none:
163 return ret;
164}
165
166static void __exit ks0108_exit(void)
167{
168 parport_release(ks0108_pardevice);
169 parport_unregister_device(ks0108_pardevice);
170}
171
172module_init(ks0108_init);
173module_exit(ks0108_exit);
174
175MODULE_LICENSE("GPL v2");
176MODULE_AUTHOR("Miguel Ojeda Sandonis <miguel.ojeda.sandonis@gmail.com>");
177MODULE_DESCRIPTION("ks0108 LCD Controller driver");
178
179