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