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