xref: /linux/drivers/video/fbdev/arcfb.c (revision 3d0fe49454652117522f60bfbefb978ba0e5300b)
1 /*
2  * linux/drivers/video/arcfb.c -- FB driver for Arc monochrome LCD board
3  *
4  * Copyright (C) 2005, Jaya Kumar <jayalk@intworks.biz>
5  *
6  * This file is subject to the terms and conditions of the GNU General Public
7  * License. See the file COPYING in the main directory of this archive for
8  * more details.
9  *
10  * Layout is based on skeletonfb.c by James Simmons and Geert Uytterhoeven.
11  *
12  * This driver was written to be used with the Arc LCD board. Arc uses a
13  * set of KS108 chips that control individual 64x64 LCD matrices. The board
14  * can be paneled in a variety of setups such as 2x1=128x64, 4x4=256x256 and
15  * so on. The interface between the board and the host is TTL based GPIO. The
16  * GPIO requirements are 8 writable data lines and 4+n lines for control. On a
17  * GPIO-less system, the board can be tested by connecting the respective sigs
18  * up to a parallel port connector. The driver requires the IO addresses for
19  * data and control GPIO at load time. It is unable to probe for the
20  * existence of the LCD so it must be told at load time whether it should
21  * be enabled or not.
22  *
23  * Todo:
24  * - testing with 4x4
25  * - testing with interrupt hw
26  *
27  * General notes:
28  * - User must set tuhold. It's in microseconds. According to the 108 spec,
29  *   the hold time is supposed to be at least 1 microsecond.
30  * - User must set num_cols=x num_rows=y, eg: x=2 means 128
31  * - User must set arcfb_enable=1 to enable it
32  * - User must set dio_addr=0xIOADDR cio_addr=0xIOADDR
33  *
34  */
35 
36 #include <linux/module.h>
37 #include <linux/kernel.h>
38 #include <linux/errno.h>
39 #include <linux/string.h>
40 #include <linux/mm.h>
41 #include <linux/vmalloc.h>
42 #include <linux/delay.h>
43 #include <linux/interrupt.h>
44 #include <linux/io.h>
45 #include <linux/fb.h>
46 #include <linux/init.h>
47 #include <linux/arcfb.h>
48 #include <linux/platform_device.h>
49 
50 #include <linux/uaccess.h>
51 
52 #define floor8(a) (a&(~0x07))
53 #define floorXres(a,xres) (a&(~(xres - 1)))
54 #define iceil8(a) (((int)((a+7)/8))*8)
55 #define ceil64(a) (a|0x3F)
56 #define ceilXres(a,xres) (a|(xres - 1))
57 
58 /* ks108 chipset specific defines and code */
59 
60 #define KS_SET_DPY_START_LINE 	0xC0
61 #define KS_SET_PAGE_NUM 	0xB8
62 #define KS_SET_X 		0x40
63 #define KS_CEHI 		0x01
64 #define KS_CELO 		0x00
65 #define KS_SEL_CMD 		0x08
66 #define KS_SEL_DATA 		0x00
67 #define KS_DPY_ON 		0x3F
68 #define KS_DPY_OFF 		0x3E
69 #define KS_INTACK 		0x40
70 #define KS_CLRINT		0x02
71 
72 struct arcfb_par {
73 	unsigned long dio_addr;
74 	unsigned long cio_addr;
75 	unsigned long c2io_addr;
76 	atomic_t ref_count;
77 	unsigned char cslut[9];
78 	struct fb_info *info;
79 	unsigned int irq;
80 	spinlock_t lock;
81 };
82 
83 static const struct fb_fix_screeninfo arcfb_fix = {
84 	.id =		"arcfb",
85 	.type =		FB_TYPE_PACKED_PIXELS,
86 	.visual =	FB_VISUAL_MONO01,
87 	.xpanstep =	0,
88 	.ypanstep =	1,
89 	.ywrapstep =	0,
90 	.accel =	FB_ACCEL_NONE,
91 };
92 
93 static const struct fb_var_screeninfo arcfb_var = {
94 	.xres		= 128,
95 	.yres		= 64,
96 	.xres_virtual	= 128,
97 	.yres_virtual	= 64,
98 	.bits_per_pixel	= 1,
99 	.nonstd		= 1,
100 };
101 
102 static unsigned long num_cols;
103 static unsigned long num_rows;
104 static unsigned long dio_addr;
105 static unsigned long cio_addr;
106 static unsigned long c2io_addr;
107 static unsigned long splashval;
108 static unsigned long tuhold;
109 static unsigned int nosplash;
110 static unsigned int arcfb_enable;
111 static unsigned int irq;
112 
113 static DECLARE_WAIT_QUEUE_HEAD(arcfb_waitq);
114 
115 static void ks108_writeb_ctl(struct arcfb_par *par,
116 				unsigned int chipindex, unsigned char value)
117 {
118 	unsigned char chipselval = par->cslut[chipindex];
119 
120 	outb(chipselval|KS_CEHI|KS_SEL_CMD, par->cio_addr);
121 	outb(value, par->dio_addr);
122 	udelay(tuhold);
123 	outb(chipselval|KS_CELO|KS_SEL_CMD, par->cio_addr);
124 }
125 
126 static void ks108_writeb_mainctl(struct arcfb_par *par, unsigned char value)
127 {
128 
129 	outb(value, par->cio_addr);
130 	udelay(tuhold);
131 }
132 
133 static unsigned char ks108_readb_ctl2(struct arcfb_par *par)
134 {
135 	return inb(par->c2io_addr);
136 }
137 
138 static void ks108_writeb_data(struct arcfb_par *par,
139 				unsigned int chipindex, unsigned char value)
140 {
141 	unsigned char chipselval = par->cslut[chipindex];
142 
143 	outb(chipselval|KS_CEHI|KS_SEL_DATA, par->cio_addr);
144 	outb(value, par->dio_addr);
145 	udelay(tuhold);
146 	outb(chipselval|KS_CELO|KS_SEL_DATA, par->cio_addr);
147 }
148 
149 static void ks108_set_start_line(struct arcfb_par *par,
150 				unsigned int chipindex, unsigned char y)
151 {
152 	ks108_writeb_ctl(par, chipindex, KS_SET_DPY_START_LINE|y);
153 }
154 
155 static void ks108_set_yaddr(struct arcfb_par *par,
156 				unsigned int chipindex, unsigned char y)
157 {
158 	ks108_writeb_ctl(par, chipindex, KS_SET_PAGE_NUM|y);
159 }
160 
161 static void ks108_set_xaddr(struct arcfb_par *par,
162 				unsigned int chipindex, unsigned char x)
163 {
164 	ks108_writeb_ctl(par, chipindex, KS_SET_X|x);
165 }
166 
167 static void ks108_clear_lcd(struct arcfb_par *par, unsigned int chipindex)
168 {
169 	int i,j;
170 
171 	for (i = 0; i <= 8; i++) {
172 		ks108_set_yaddr(par, chipindex, i);
173 		ks108_set_xaddr(par, chipindex, 0);
174 		for (j = 0; j < 64; j++) {
175 			ks108_writeb_data(par, chipindex,
176 				(unsigned char) splashval);
177 		}
178 	}
179 }
180 
181 /* main arcfb functions */
182 
183 static int arcfb_open(struct fb_info *info, int user)
184 {
185 	struct arcfb_par *par = info->par;
186 
187 	atomic_inc(&par->ref_count);
188 	return 0;
189 }
190 
191 static int arcfb_release(struct fb_info *info, int user)
192 {
193 	struct arcfb_par *par = info->par;
194 	int count = atomic_read(&par->ref_count);
195 
196 	if (!count)
197 		return -EINVAL;
198 	atomic_dec(&par->ref_count);
199 	return 0;
200 }
201 
202 static int arcfb_pan_display(struct fb_var_screeninfo *var,
203 				struct fb_info *info)
204 {
205 	int i;
206 	struct arcfb_par *par = info->par;
207 
208 	if ((var->vmode & FB_VMODE_YWRAP) && (var->yoffset < 64)
209 		&& (info->var.yres <= 64)) {
210 		for (i = 0; i < num_cols; i++) {
211 			ks108_set_start_line(par, i, var->yoffset);
212 		}
213 		info->var.yoffset = var->yoffset;
214 		return 0;
215 	}
216 
217 	return -EINVAL;
218 }
219 
220 static irqreturn_t arcfb_interrupt(int vec, void *dev_instance)
221 {
222 	struct fb_info *info = dev_instance;
223 	unsigned char ctl2status;
224 	struct arcfb_par *par = info->par;
225 
226 	ctl2status = ks108_readb_ctl2(par);
227 
228 	if (!(ctl2status & KS_INTACK)) /* not arc generated interrupt */
229 		return IRQ_NONE;
230 
231 	ks108_writeb_mainctl(par, KS_CLRINT);
232 
233 	spin_lock(&par->lock);
234         if (waitqueue_active(&arcfb_waitq)) {
235                 wake_up(&arcfb_waitq);
236         }
237 	spin_unlock(&par->lock);
238 
239 	return IRQ_HANDLED;
240 }
241 
242 /*
243  * here we handle a specific page on the lcd. the complexity comes from
244  * the fact that the fb is laidout in 8xX vertical columns. we extract
245  * each write of 8 vertical pixels. then we shift out as we move along
246  * X. That's what rightshift does. bitmask selects the desired input bit.
247  */
248 static void arcfb_lcd_update_page(struct arcfb_par *par, unsigned int upper,
249 		unsigned int left, unsigned int right, unsigned int distance)
250 {
251 	unsigned char *src;
252 	unsigned int xindex, yindex, chipindex, linesize;
253 	int i;
254 	unsigned char val;
255 	unsigned char bitmask, rightshift;
256 
257 	xindex = left >> 6;
258 	yindex = upper >> 6;
259 	chipindex = (xindex + (yindex*num_cols));
260 
261 	ks108_set_yaddr(par, chipindex, upper/8);
262 
263 	linesize = par->info->var.xres/8;
264 	src = (unsigned char *)par->info->screen_buffer + (left/8) +
265 		(upper * linesize);
266 	ks108_set_xaddr(par, chipindex, left);
267 
268 	bitmask=1;
269 	rightshift=0;
270 	while (left <= right) {
271 		val = 0;
272 		for (i = 0; i < 8; i++) {
273 			if ( i > rightshift) {
274 				val |= (*(src + (i*linesize)) & bitmask)
275 						<< (i - rightshift);
276 			} else {
277 				val |= (*(src + (i*linesize)) & bitmask)
278 						 >> (rightshift - i);
279 			}
280 		}
281 		ks108_writeb_data(par, chipindex, val);
282 		left++;
283 		if (bitmask == 0x80) {
284 			bitmask = 1;
285 			src++;
286 			rightshift=0;
287 		} else {
288 			bitmask <<= 1;
289 			rightshift++;
290 		}
291 	}
292 }
293 
294 /*
295  * here we handle the entire vertical page of the update. we write across
296  * lcd chips. update_page uses the upper/left values to decide which
297  * chip to select for the right. upper is needed for setting the page
298  * desired for the write.
299  */
300 static void arcfb_lcd_update_vert(struct arcfb_par *par, unsigned int top,
301 		unsigned int bottom, unsigned int left, unsigned int right)
302 {
303 	unsigned int distance, upper, lower;
304 
305 	distance = (bottom - top) + 1;
306 	upper = top;
307 	lower = top + 7;
308 
309 	while (distance > 0) {
310 		distance -= 8;
311 		arcfb_lcd_update_page(par, upper, left, right, 8);
312 		upper = lower + 1;
313 		lower = upper + 7;
314 	}
315 }
316 
317 /*
318  * here we handle horizontal blocks for the update. update_vert will
319  * handle spaning multiple pages. we break out each horizontal
320  * block in to individual blocks no taller than 64 pixels.
321  */
322 static void arcfb_lcd_update_horiz(struct arcfb_par *par, unsigned int left,
323 			unsigned int right, unsigned int top, unsigned int h)
324 {
325 	unsigned int distance, upper, lower;
326 
327 	distance = h;
328 	upper = floor8(top);
329 	lower = min(upper + distance - 1, ceil64(upper));
330 
331 	while (distance > 0) {
332 		distance -= ((lower - upper) + 1 );
333 		arcfb_lcd_update_vert(par, upper, lower, left, right);
334 		upper = lower + 1;
335 		lower = min(upper + distance - 1, ceil64(upper));
336 	}
337 }
338 
339 /*
340  * here we start the process of splitting out the fb update into
341  * individual blocks of pixels. we end up splitting into 64x64 blocks
342  * and finally down to 64x8 pages.
343  */
344 static void arcfb_lcd_update(struct arcfb_par *par, unsigned int dx,
345 			unsigned int dy, unsigned int w, unsigned int h)
346 {
347 	unsigned int left, right, distance, y;
348 
349 	/* align the request first */
350 	y = floor8(dy);
351 	h += dy - y;
352 	h = iceil8(h);
353 
354 	distance = w;
355 	left = dx;
356 	right = min(left + w - 1, ceil64(left));
357 
358 	while (distance > 0) {
359 		arcfb_lcd_update_horiz(par, left, right, y, h);
360 		distance -= ((right - left) + 1);
361 		left = right + 1;
362 		right = min(left + distance - 1, ceil64(left));
363 	}
364 }
365 
366 static void arcfb_fillrect(struct fb_info *info,
367 			   const struct fb_fillrect *rect)
368 {
369 	struct arcfb_par *par = info->par;
370 
371 	sys_fillrect(info, rect);
372 
373 	/* update the physical lcd */
374 	arcfb_lcd_update(par, rect->dx, rect->dy, rect->width, rect->height);
375 }
376 
377 static void arcfb_copyarea(struct fb_info *info,
378 			   const struct fb_copyarea *area)
379 {
380 	struct arcfb_par *par = info->par;
381 
382 	sys_copyarea(info, area);
383 
384 	/* update the physical lcd */
385 	arcfb_lcd_update(par, area->dx, area->dy, area->width, area->height);
386 }
387 
388 static void arcfb_imageblit(struct fb_info *info, const struct fb_image *image)
389 {
390 	struct arcfb_par *par = info->par;
391 
392 	sys_imageblit(info, image);
393 
394 	/* update the physical lcd */
395 	arcfb_lcd_update(par, image->dx, image->dy, image->width,
396 				image->height);
397 }
398 
399 static int arcfb_ioctl(struct fb_info *info,
400 			  unsigned int cmd, unsigned long arg)
401 {
402 	void __user *argp = (void __user *)arg;
403 	struct arcfb_par *par = info->par;
404 	unsigned long flags;
405 
406 	switch (cmd) {
407 		case FBIO_WAITEVENT:
408 		{
409 			DEFINE_WAIT(wait);
410 			/* illegal to wait on arc if no irq will occur */
411 			if (!par->irq)
412 				return -EINVAL;
413 
414 			/* wait until the Arc has generated an interrupt
415 			 * which will wake us up */
416 			spin_lock_irqsave(&par->lock, flags);
417 			prepare_to_wait(&arcfb_waitq, &wait,
418 					TASK_INTERRUPTIBLE);
419 			spin_unlock_irqrestore(&par->lock, flags);
420 			schedule();
421 			finish_wait(&arcfb_waitq, &wait);
422 		}
423 		fallthrough;
424 
425 		case FBIO_GETCONTROL2:
426 		{
427 			unsigned char ctl2;
428 
429 			ctl2 = ks108_readb_ctl2(info->par);
430 			if (copy_to_user(argp, &ctl2, sizeof(ctl2)))
431 				return -EFAULT;
432 			return 0;
433 		}
434 		default:
435 			return -EINVAL;
436 	}
437 }
438 
439 /*
440  * this is the access path from userspace. they can seek and write to
441  * the fb. it's inefficient for them to do anything less than 64*8
442  * writes since we update the lcd in each write() anyway.
443  */
444 static ssize_t arcfb_write(struct fb_info *info, const char __user *buf,
445 			   size_t count, loff_t *ppos)
446 {
447 	/* modded from epson 1355 */
448 
449 	unsigned long p;
450 	int err;
451 	unsigned int fbmemlength,x,y,w,h, bitppos, startpos, endpos, bitcount;
452 	struct arcfb_par *par;
453 	unsigned int xres;
454 
455 	if (!info->screen_buffer)
456 		return -ENODEV;
457 
458 	p = *ppos;
459 	par = info->par;
460 	xres = info->var.xres;
461 	fbmemlength = (xres * info->var.yres)/8;
462 
463 	if (p > fbmemlength)
464 		return -ENOSPC;
465 
466 	err = 0;
467 	if ((count + p) > fbmemlength) {
468 		count = fbmemlength - p;
469 		err = -ENOSPC;
470 	}
471 
472 	if (count) {
473 		char *base_addr;
474 
475 		base_addr = info->screen_buffer;
476 		count -= copy_from_user(base_addr + p, buf, count);
477 		*ppos += count;
478 		err = -EFAULT;
479 	}
480 
481 
482 	bitppos = p*8;
483 	startpos = floorXres(bitppos, xres);
484 	endpos = ceilXres((bitppos + (count*8)), xres);
485 	bitcount = endpos - startpos;
486 
487 	x = startpos % xres;
488 	y = startpos / xres;
489 	w = xres;
490 	h = bitcount / xres;
491 	arcfb_lcd_update(par, x, y, w, h);
492 
493 	if (count)
494 		return count;
495 	return err;
496 }
497 
498 static const struct fb_ops arcfb_ops = {
499 	.owner		= THIS_MODULE,
500 	.fb_open	= arcfb_open,
501 	.fb_read        = fb_sys_read,
502 	.fb_write	= arcfb_write,
503 	.fb_release	= arcfb_release,
504 	.fb_pan_display	= arcfb_pan_display,
505 	.fb_fillrect	= arcfb_fillrect,
506 	.fb_copyarea	= arcfb_copyarea,
507 	.fb_imageblit	= arcfb_imageblit,
508 	.fb_ioctl 	= arcfb_ioctl,
509 };
510 
511 static int arcfb_probe(struct platform_device *dev)
512 {
513 	struct fb_info *info;
514 	int retval = -ENOMEM;
515 	int videomemorysize;
516 	unsigned char *videomemory;
517 	struct arcfb_par *par;
518 	int i;
519 
520 	videomemorysize = (((64*64)*num_cols)*num_rows)/8;
521 
522 	/* We need a flat backing store for the Arc's
523 	   less-flat actual paged framebuffer */
524 	videomemory = vzalloc(videomemorysize);
525 	if (!videomemory)
526 		return retval;
527 
528 	info = framebuffer_alloc(sizeof(struct arcfb_par), &dev->dev);
529 	if (!info)
530 		goto err_fb_alloc;
531 
532 	info->screen_buffer = videomemory;
533 	info->fbops = &arcfb_ops;
534 
535 	info->var = arcfb_var;
536 	info->fix = arcfb_fix;
537 	par = info->par;
538 	par->info = info;
539 
540 	if (!dio_addr || !cio_addr || !c2io_addr) {
541 		printk(KERN_WARNING "no IO addresses supplied\n");
542 		goto err_addr;
543 	}
544 	par->dio_addr = dio_addr;
545 	par->cio_addr = cio_addr;
546 	par->c2io_addr = c2io_addr;
547 	par->cslut[0] = 0x00;
548 	par->cslut[1] = 0x06;
549 	spin_lock_init(&par->lock);
550 	if (irq) {
551 		par->irq = irq;
552 		if (request_irq(par->irq, &arcfb_interrupt, IRQF_SHARED,
553 				"arcfb", info)) {
554 			printk(KERN_INFO
555 				"arcfb: Failed req IRQ %d\n", par->irq);
556 			retval = -EBUSY;
557 			goto err_addr;
558 		}
559 	}
560 	retval = register_framebuffer(info);
561 	if (retval < 0)
562 		goto err_register_fb;
563 	platform_set_drvdata(dev, info);
564 	fb_info(info, "Arc frame buffer device, using %dK of video memory\n",
565 		videomemorysize >> 10);
566 
567 	/* this inits the lcd but doesn't clear dirty pixels */
568 	for (i = 0; i < num_cols * num_rows; i++) {
569 		ks108_writeb_ctl(par, i, KS_DPY_OFF);
570 		ks108_set_start_line(par, i, 0);
571 		ks108_set_yaddr(par, i, 0);
572 		ks108_set_xaddr(par, i, 0);
573 		ks108_writeb_ctl(par, i, KS_DPY_ON);
574 	}
575 
576 	/* if we were told to splash the screen, we just clear it */
577 	if (!nosplash) {
578 		for (i = 0; i < num_cols * num_rows; i++) {
579 			fb_info(info, "splashing lcd %d\n", i);
580 			ks108_set_start_line(par, i, 0);
581 			ks108_clear_lcd(par, i);
582 		}
583 	}
584 
585 	return 0;
586 
587 err_register_fb:
588 	free_irq(par->irq, info);
589 err_addr:
590 	framebuffer_release(info);
591 err_fb_alloc:
592 	vfree(videomemory);
593 	return retval;
594 }
595 
596 static void arcfb_remove(struct platform_device *dev)
597 {
598 	struct fb_info *info = platform_get_drvdata(dev);
599 
600 	if (info) {
601 		unregister_framebuffer(info);
602 		if (irq)
603 			free_irq(((struct arcfb_par *)(info->par))->irq, info);
604 		vfree(info->screen_buffer);
605 		framebuffer_release(info);
606 	}
607 }
608 
609 static struct platform_driver arcfb_driver = {
610 	.probe	= arcfb_probe,
611 	.remove_new = arcfb_remove,
612 	.driver	= {
613 		.name	= "arcfb",
614 	},
615 };
616 
617 static struct platform_device *arcfb_device;
618 
619 static int __init arcfb_init(void)
620 {
621 	int ret;
622 
623 	if (!arcfb_enable)
624 		return -ENXIO;
625 
626 	ret = platform_driver_register(&arcfb_driver);
627 	if (!ret) {
628 		arcfb_device = platform_device_alloc("arcfb", 0);
629 		if (arcfb_device) {
630 			ret = platform_device_add(arcfb_device);
631 		} else {
632 			ret = -ENOMEM;
633 		}
634 		if (ret) {
635 			platform_device_put(arcfb_device);
636 			platform_driver_unregister(&arcfb_driver);
637 		}
638 	}
639 	return ret;
640 
641 }
642 
643 static void __exit arcfb_exit(void)
644 {
645 	platform_device_unregister(arcfb_device);
646 	platform_driver_unregister(&arcfb_driver);
647 }
648 
649 module_param(num_cols, ulong, 0);
650 MODULE_PARM_DESC(num_cols, "Num horiz panels, eg: 2 = 128 bit wide");
651 module_param(num_rows, ulong, 0);
652 MODULE_PARM_DESC(num_rows, "Num vert panels, eg: 1 = 64 bit high");
653 module_param(nosplash, uint, 0);
654 MODULE_PARM_DESC(nosplash, "Disable doing the splash screen");
655 module_param(arcfb_enable, uint, 0);
656 MODULE_PARM_DESC(arcfb_enable, "Enable communication with Arc board");
657 module_param_hw(dio_addr, ulong, ioport, 0);
658 MODULE_PARM_DESC(dio_addr, "IO address for data, eg: 0x480");
659 module_param_hw(cio_addr, ulong, ioport, 0);
660 MODULE_PARM_DESC(cio_addr, "IO address for control, eg: 0x400");
661 module_param_hw(c2io_addr, ulong, ioport, 0);
662 MODULE_PARM_DESC(c2io_addr, "IO address for secondary control, eg: 0x408");
663 module_param(splashval, ulong, 0);
664 MODULE_PARM_DESC(splashval, "Splash pattern: 0xFF is black, 0x00 is green");
665 module_param(tuhold, ulong, 0);
666 MODULE_PARM_DESC(tuhold, "Time to hold between strobing data to Arc board");
667 module_param_hw(irq, uint, irq, 0);
668 MODULE_PARM_DESC(irq, "IRQ for the Arc board");
669 
670 module_init(arcfb_init);
671 module_exit(arcfb_exit);
672 
673 MODULE_DESCRIPTION("fbdev driver for Arc monochrome LCD board");
674 MODULE_AUTHOR("Jaya Kumar");
675 MODULE_LICENSE("GPL");
676 
677