treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / auxdisplay / cfag12864b.c
blob7eebae7e322c605e97d2592223beb92ab82054c3
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Filename: cfag12864b.c
4 * Version: 0.1.0
5 * Description: cfag12864b LCD driver
6 * Depends: ks0108
8 * Author: Copyright (C) Miguel Ojeda Sandonis
9 * Date: 2006-10-31
12 #include <linux/init.h>
13 #include <linux/module.h>
14 #include <linux/kernel.h>
15 #include <linux/fs.h>
16 #include <linux/slab.h>
17 #include <linux/cdev.h>
18 #include <linux/delay.h>
19 #include <linux/device.h>
20 #include <linux/jiffies.h>
21 #include <linux/mutex.h>
22 #include <linux/uaccess.h>
23 #include <linux/vmalloc.h>
24 #include <linux/workqueue.h>
25 #include <linux/ks0108.h>
26 #include <linux/cfag12864b.h>
29 #define CFAG12864B_NAME "cfag12864b"
32 * Module Parameters
35 static unsigned int cfag12864b_rate = CONFIG_CFAG12864B_RATE;
36 module_param(cfag12864b_rate, uint, S_IRUGO);
37 MODULE_PARM_DESC(cfag12864b_rate,
38 "Refresh rate (hertz)");
40 unsigned int cfag12864b_getrate(void)
42 return cfag12864b_rate;
46 * cfag12864b Commands
48 * E = Enable signal
49 * Every time E switch from low to high,
50 * cfag12864b/ks0108 reads the command/data.
52 * CS1 = First ks0108controller.
53 * If high, the first ks0108 controller receives commands/data.
55 * CS2 = Second ks0108 controller
56 * If high, the second ks0108 controller receives commands/data.
58 * DI = Data/Instruction
59 * If low, cfag12864b will expect commands.
60 * If high, cfag12864b will expect data.
64 #define bit(n) (((unsigned char)1)<<(n))
66 #define CFAG12864B_BIT_E (0)
67 #define CFAG12864B_BIT_CS1 (2)
68 #define CFAG12864B_BIT_CS2 (1)
69 #define CFAG12864B_BIT_DI (3)
71 static unsigned char cfag12864b_state;
73 static void cfag12864b_set(void)
75 ks0108_writecontrol(cfag12864b_state);
78 static void cfag12864b_setbit(unsigned char state, unsigned char n)
80 if (state)
81 cfag12864b_state |= bit(n);
82 else
83 cfag12864b_state &= ~bit(n);
86 static void cfag12864b_e(unsigned char state)
88 cfag12864b_setbit(state, CFAG12864B_BIT_E);
89 cfag12864b_set();
92 static void cfag12864b_cs1(unsigned char state)
94 cfag12864b_setbit(state, CFAG12864B_BIT_CS1);
97 static void cfag12864b_cs2(unsigned char state)
99 cfag12864b_setbit(state, CFAG12864B_BIT_CS2);
102 static void cfag12864b_di(unsigned char state)
104 cfag12864b_setbit(state, CFAG12864B_BIT_DI);
107 static void cfag12864b_setcontrollers(unsigned char first,
108 unsigned char second)
110 if (first)
111 cfag12864b_cs1(0);
112 else
113 cfag12864b_cs1(1);
115 if (second)
116 cfag12864b_cs2(0);
117 else
118 cfag12864b_cs2(1);
121 static void cfag12864b_controller(unsigned char which)
123 if (which == 0)
124 cfag12864b_setcontrollers(1, 0);
125 else if (which == 1)
126 cfag12864b_setcontrollers(0, 1);
129 static void cfag12864b_displaystate(unsigned char state)
131 cfag12864b_di(0);
132 cfag12864b_e(1);
133 ks0108_displaystate(state);
134 cfag12864b_e(0);
137 static void cfag12864b_address(unsigned char address)
139 cfag12864b_di(0);
140 cfag12864b_e(1);
141 ks0108_address(address);
142 cfag12864b_e(0);
145 static void cfag12864b_page(unsigned char page)
147 cfag12864b_di(0);
148 cfag12864b_e(1);
149 ks0108_page(page);
150 cfag12864b_e(0);
153 static void cfag12864b_startline(unsigned char startline)
155 cfag12864b_di(0);
156 cfag12864b_e(1);
157 ks0108_startline(startline);
158 cfag12864b_e(0);
161 static void cfag12864b_writebyte(unsigned char byte)
163 cfag12864b_di(1);
164 cfag12864b_e(1);
165 ks0108_writedata(byte);
166 cfag12864b_e(0);
169 static void cfag12864b_nop(void)
171 cfag12864b_startline(0);
175 * cfag12864b Internal Commands
178 static void cfag12864b_on(void)
180 cfag12864b_setcontrollers(1, 1);
181 cfag12864b_displaystate(1);
184 static void cfag12864b_off(void)
186 cfag12864b_setcontrollers(1, 1);
187 cfag12864b_displaystate(0);
190 static void cfag12864b_clear(void)
192 unsigned char i, j;
194 cfag12864b_setcontrollers(1, 1);
195 for (i = 0; i < CFAG12864B_PAGES; i++) {
196 cfag12864b_page(i);
197 cfag12864b_address(0);
198 for (j = 0; j < CFAG12864B_ADDRESSES; j++)
199 cfag12864b_writebyte(0);
204 * Update work
207 unsigned char *cfag12864b_buffer;
208 static unsigned char *cfag12864b_cache;
209 static DEFINE_MUTEX(cfag12864b_mutex);
210 static unsigned char cfag12864b_updating;
211 static void cfag12864b_update(struct work_struct *delayed_work);
212 static struct workqueue_struct *cfag12864b_workqueue;
213 static DECLARE_DELAYED_WORK(cfag12864b_work, cfag12864b_update);
215 static void cfag12864b_queue(void)
217 queue_delayed_work(cfag12864b_workqueue, &cfag12864b_work,
218 HZ / cfag12864b_rate);
221 unsigned char cfag12864b_enable(void)
223 unsigned char ret;
225 mutex_lock(&cfag12864b_mutex);
227 if (!cfag12864b_updating) {
228 cfag12864b_updating = 1;
229 cfag12864b_queue();
230 ret = 0;
231 } else
232 ret = 1;
234 mutex_unlock(&cfag12864b_mutex);
236 return ret;
239 void cfag12864b_disable(void)
241 mutex_lock(&cfag12864b_mutex);
243 if (cfag12864b_updating) {
244 cfag12864b_updating = 0;
245 cancel_delayed_work(&cfag12864b_work);
246 flush_workqueue(cfag12864b_workqueue);
249 mutex_unlock(&cfag12864b_mutex);
252 unsigned char cfag12864b_isenabled(void)
254 return cfag12864b_updating;
257 static void cfag12864b_update(struct work_struct *work)
259 unsigned char c;
260 unsigned short i, j, k, b;
262 if (memcmp(cfag12864b_cache, cfag12864b_buffer, CFAG12864B_SIZE)) {
263 for (i = 0; i < CFAG12864B_CONTROLLERS; i++) {
264 cfag12864b_controller(i);
265 cfag12864b_nop();
266 for (j = 0; j < CFAG12864B_PAGES; j++) {
267 cfag12864b_page(j);
268 cfag12864b_nop();
269 cfag12864b_address(0);
270 cfag12864b_nop();
271 for (k = 0; k < CFAG12864B_ADDRESSES; k++) {
272 for (c = 0, b = 0; b < 8; b++)
273 if (cfag12864b_buffer
274 [i * CFAG12864B_ADDRESSES / 8
275 + k / 8 + (j * 8 + b) *
276 CFAG12864B_WIDTH / 8]
277 & bit(k % 8))
278 c |= bit(b);
279 cfag12864b_writebyte(c);
284 memcpy(cfag12864b_cache, cfag12864b_buffer, CFAG12864B_SIZE);
287 if (cfag12864b_updating)
288 cfag12864b_queue();
292 * cfag12864b Exported Symbols
295 EXPORT_SYMBOL_GPL(cfag12864b_buffer);
296 EXPORT_SYMBOL_GPL(cfag12864b_getrate);
297 EXPORT_SYMBOL_GPL(cfag12864b_enable);
298 EXPORT_SYMBOL_GPL(cfag12864b_disable);
299 EXPORT_SYMBOL_GPL(cfag12864b_isenabled);
302 * Is the module inited?
305 static unsigned char cfag12864b_inited;
306 unsigned char cfag12864b_isinited(void)
308 return cfag12864b_inited;
310 EXPORT_SYMBOL_GPL(cfag12864b_isinited);
313 * Module Init & Exit
316 static int __init cfag12864b_init(void)
318 int ret = -EINVAL;
320 /* ks0108_init() must be called first */
321 if (!ks0108_isinited()) {
322 printk(KERN_ERR CFAG12864B_NAME ": ERROR: "
323 "ks0108 is not initialized\n");
324 goto none;
326 BUILD_BUG_ON(PAGE_SIZE < CFAG12864B_SIZE);
328 cfag12864b_buffer = (unsigned char *) get_zeroed_page(GFP_KERNEL);
329 if (cfag12864b_buffer == NULL) {
330 printk(KERN_ERR CFAG12864B_NAME ": ERROR: "
331 "can't get a free page\n");
332 ret = -ENOMEM;
333 goto none;
336 cfag12864b_cache = kmalloc(CFAG12864B_SIZE,
337 GFP_KERNEL);
338 if (cfag12864b_cache == NULL) {
339 printk(KERN_ERR CFAG12864B_NAME ": ERROR: "
340 "can't alloc cache buffer (%i bytes)\n",
341 CFAG12864B_SIZE);
342 ret = -ENOMEM;
343 goto bufferalloced;
346 cfag12864b_workqueue = create_singlethread_workqueue(CFAG12864B_NAME);
347 if (cfag12864b_workqueue == NULL)
348 goto cachealloced;
350 cfag12864b_clear();
351 cfag12864b_on();
353 cfag12864b_inited = 1;
354 return 0;
356 cachealloced:
357 kfree(cfag12864b_cache);
359 bufferalloced:
360 free_page((unsigned long) cfag12864b_buffer);
362 none:
363 return ret;
366 static void __exit cfag12864b_exit(void)
368 cfag12864b_disable();
369 cfag12864b_off();
370 destroy_workqueue(cfag12864b_workqueue);
371 kfree(cfag12864b_cache);
372 free_page((unsigned long) cfag12864b_buffer);
375 module_init(cfag12864b_init);
376 module_exit(cfag12864b_exit);
378 MODULE_LICENSE("GPL v2");
379 MODULE_AUTHOR("Miguel Ojeda Sandonis <miguel.ojeda.sandonis@gmail.com>");
380 MODULE_DESCRIPTION("cfag12864b LCD driver");