PageRenderTime 41ms CodeModel.GetById 20ms app.highlight 18ms RepoModel.GetById 0ms app.codeStats 0ms

/drivers/video/pmag-aa-fb.c

https://bitbucket.org/cyanogenmod/android_kernel_asus_tf300t
C | 510 lines | 364 code | 88 blank | 58 comment | 44 complexity | f353b9b6b8f50489f8655bf163b98ee2 MD5 | raw file
Possible License(s): LGPL-2.0, AGPL-1.0, GPL-2.0
  1/*
  2 *	linux/drivers/video/pmag-aa-fb.c
  3 *	Copyright 2002 Karsten Merker <merker@debian.org>
  4 *
  5 *	PMAG-AA TurboChannel framebuffer card support ... derived from
  6 *	pmag-ba-fb.c, which is Copyright (C) 1999, 2000, 2001 by
  7 *	Michael Engel <engel@unix-ag.org>, Karsten Merker <merker@debian.org>
  8 *	and Harald Koerfgen <hkoerfg@web.de>, which itself is derived from
  9 *	"HP300 Topcat framebuffer support (derived from macfb of all things)
 10 *	Phil Blundell <philb@gnu.org> 1998"
 11 *
 12 *	This file is subject to the terms and conditions of the GNU General
 13 *	Public License.  See the file COPYING in the main directory of this
 14 *	archive for more details.
 15 *
 16 *	2002-09-28  Karsten Merker <merker@linuxtag.org>
 17 *		Version 0.01: First try to get a PMAG-AA running.
 18 *
 19 *	2003-02-24  Thiemo Seufer  <seufer@csv.ica.uni-stuttgart.de>
 20 *		Version 0.02: Major code cleanup.
 21 *
 22 *	2003-09-21  Thiemo Seufer  <seufer@csv.ica.uni-stuttgart.de>
 23 *		Hardware cursor support.
 24 */
 25#include <linux/module.h>
 26#include <linux/kernel.h>
 27#include <linux/errno.h>
 28#include <linux/string.h>
 29#include <linux/timer.h>
 30#include <linux/mm.h>
 31#include <linux/delay.h>
 32#include <linux/init.h>
 33#include <linux/fb.h>
 34#include <linux/console.h>
 35
 36#include <asm/bootinfo.h>
 37#include <asm/dec/machtype.h>
 38#include <asm/dec/tc.h>
 39
 40#include <video/fbcon.h>
 41#include <video/fbcon-cfb8.h>
 42
 43#include "bt455.h"
 44#include "bt431.h"
 45
 46/* Version information */
 47#define DRIVER_VERSION "0.02"
 48#define DRIVER_AUTHOR "Karsten Merker <merker@linuxtag.org>"
 49#define DRIVER_DESCRIPTION "PMAG-AA Framebuffer Driver"
 50
 51/* Prototypes */
 52static int aafb_set_var(struct fb_var_screeninfo *var, int con,
 53			struct fb_info *info);
 54
 55/*
 56 * Bt455 RAM DAC register base offset (rel. to TC slot base address).
 57 */
 58#define PMAG_AA_BT455_OFFSET		0x100000
 59
 60/*
 61 * Bt431 cursor generator offset (rel. to TC slot base address).
 62 */
 63#define PMAG_AA_BT431_OFFSET		0x180000
 64
 65/*
 66 * Begin of PMAG-AA framebuffer memory relative to TC slot address,
 67 * resolution is 1280x1024x1 (8 bits deep, but only LSB is used).
 68 */
 69#define PMAG_AA_ONBOARD_FBMEM_OFFSET	0x200000
 70
 71struct aafb_cursor {
 72	struct timer_list timer;
 73	int enable;
 74	int on;
 75	int vbl_cnt;
 76	int blink_rate;
 77	u16 x, y, width, height;
 78};
 79
 80#define CURSOR_TIMER_FREQ	(HZ / 50)
 81#define CURSOR_BLINK_RATE	(20)
 82#define CURSOR_DRAW_DELAY	(2)
 83
 84struct aafb_info {
 85	struct fb_info info;
 86	struct display disp;
 87	struct aafb_cursor cursor;
 88	struct bt455_regs *bt455;
 89	struct bt431_regs *bt431;
 90	unsigned long fb_start;
 91	unsigned long fb_size;
 92	unsigned long fb_line_length;
 93};
 94
 95/*
 96 * Max 3 TURBOchannel slots -> max 3 PMAG-AA.
 97 */
 98static struct aafb_info my_fb_info[3];
 99
100static struct aafb_par {
101} current_par;
102
103static int currcon = -1;
104
105static void aafb_set_cursor(struct aafb_info *info, int on)
106{
107	struct aafb_cursor *c = &info->cursor;
108
109	if (on) {
110		bt431_position_cursor(info->bt431, c->x, c->y);
111		bt431_enable_cursor(info->bt431);
112	} else
113		bt431_erase_cursor(info->bt431);
114}
115
116static void aafbcon_cursor(struct display *disp, int mode, int x, int y)
117{
118	struct aafb_info *info = (struct aafb_info *)disp->fb_info;
119	struct aafb_cursor *c = &info->cursor;
120
121	x *= fontwidth(disp);
122	y *= fontheight(disp);
123
124	if (c->x == x && c->y == y && (mode == CM_ERASE) == !c->enable)
125		return;
126
127	c->enable = 0;
128	if (c->on)
129		aafb_set_cursor(info, 0);
130	c->x = x - disp->var.xoffset;
131	c->y = y - disp->var.yoffset;
132
133	switch (mode) {
134		case CM_ERASE:
135			c->on = 0;
136			break;
137		case CM_DRAW:
138		case CM_MOVE:
139			if (c->on)
140				aafb_set_cursor(info, c->on);
141			else
142				c->vbl_cnt = CURSOR_DRAW_DELAY;
143			c->enable = 1;
144			break;
145	}
146}
147
148static int aafbcon_set_font(struct display *disp, int width, int height)
149{
150	struct aafb_info *info = (struct aafb_info *)disp->fb_info;
151	struct aafb_cursor *c = &info->cursor;
152	u8 fgc = ~attr_bgcol_ec(disp, disp->conp, &info->info);
153
154	if (width > 64 || height > 64 || width < 0 || height < 0)
155		return -EINVAL;
156
157	c->height = height;
158	c->width = width;
159
160	bt431_set_font(info->bt431, fgc, width, height);
161
162	return 1;
163}
164
165static void aafb_cursor_timer_handler(unsigned long data)
166{
167	struct aafb_info *info = (struct aafb_info *)data;
168	struct aafb_cursor *c = &info->cursor;
169
170	if (!c->enable)
171		goto out;
172
173	if (c->vbl_cnt && --c->vbl_cnt == 0) {
174		c->on ^= 1;
175		aafb_set_cursor(info, c->on);
176		c->vbl_cnt = c->blink_rate;
177	}
178
179out:
180	c->timer.expires = jiffies + CURSOR_TIMER_FREQ;
181	add_timer(&c->timer);
182}
183
184static void __init aafb_cursor_init(struct aafb_info *info)
185{
186	struct aafb_cursor *c = &info->cursor;
187
188	c->enable = 1;
189	c->on = 1;
190	c->x = c->y = 0;
191	c->width = c->height = 0;
192	c->vbl_cnt = CURSOR_DRAW_DELAY;
193	c->blink_rate = CURSOR_BLINK_RATE;
194
195	init_timer(&c->timer);
196	c->timer.data = (unsigned long)info;
197	c->timer.function = aafb_cursor_timer_handler;
198	mod_timer(&c->timer, jiffies + CURSOR_TIMER_FREQ);
199}
200
201static void __exit aafb_cursor_exit(struct aafb_info *info)
202{
203	struct aafb_cursor *c = &info->cursor;
204
205	del_timer_sync(&c->timer);
206}
207
208static struct display_switch aafb_switch8 = {
209	.setup = fbcon_cfb8_setup,
210	.bmove = fbcon_cfb8_bmove,
211	.clear = fbcon_cfb8_clear,
212	.putc = fbcon_cfb8_putc,
213	.putcs = fbcon_cfb8_putcs,
214	.revc = fbcon_cfb8_revc,
215	.cursor = aafbcon_cursor,
216	.set_font = aafbcon_set_font,
217	.clear_margins = fbcon_cfb8_clear_margins,
218	.fontwidthmask = FONTWIDTH(4)|FONTWIDTH(8)|FONTWIDTH(12)|FONTWIDTH(16)
219};
220
221static void aafb_get_par(struct aafb_par *par)
222{
223	*par = current_par;
224}
225
226static int aafb_get_fix(struct fb_fix_screeninfo *fix, int con,
227			struct fb_info *info)
228{
229	struct aafb_info *ip = (struct aafb_info *)info;
230
231	memset(fix, 0, sizeof(struct fb_fix_screeninfo));
232	strcpy(fix->id, "PMAG-AA");
233	fix->smem_start = ip->fb_start;
234	fix->smem_len = ip->fb_size;
235	fix->type = FB_TYPE_PACKED_PIXELS;
236	fix->ypanstep = 1;
237	fix->ywrapstep = 1;
238	fix->visual = FB_VISUAL_MONO10;
239	fix->line_length = 1280;
240	fix->accel = FB_ACCEL_NONE;
241
242	return 0;
243}
244
245static void aafb_set_disp(struct display *disp, int con,
246			  struct aafb_info *info)
247{
248	struct fb_fix_screeninfo fix;
249
250	disp->fb_info = &info->info;
251	aafb_set_var(&disp->var, con, &info->info);
252	if (disp->conp && disp->conp->vc_sw && disp->conp->vc_sw->con_cursor)
253		disp->conp->vc_sw->con_cursor(disp->conp, CM_ERASE);
254	disp->dispsw = &aafb_switch8;
255	disp->dispsw_data = 0;
256
257	aafb_get_fix(&fix, con, &info->info);
258	disp->screen_base = (u8 *) fix.smem_start;
259	disp->visual = fix.visual;
260	disp->type = fix.type;
261	disp->type_aux = fix.type_aux;
262	disp->ypanstep = fix.ypanstep;
263	disp->ywrapstep = fix.ywrapstep;
264	disp->line_length = fix.line_length;
265	disp->next_line = 2048;
266	disp->can_soft_blank = 1;
267	disp->inverse = 0;
268	disp->scrollmode = SCROLL_YREDRAW;
269
270	aafbcon_set_font(disp, fontwidth(disp), fontheight(disp));
271}
272
273static int aafb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
274			 struct fb_info *info)
275{
276	static u16 color[2] = {0x0000, 0x000f};
277	static struct fb_cmap aafb_cmap = {0, 2, color, color, color, NULL};
278
279	fb_copy_cmap(&aafb_cmap, cmap, kspc ? 0 : 2);
280	return 0;
281}
282
283static int aafb_set_cmap(struct fb_cmap *cmap, int kspc, int con,
284			 struct fb_info *info)
285{
286	u16 color[2] = {0x0000, 0x000f};
287
288	if (cmap->start == 0
289	    && cmap->len == 2
290	    && memcmp(cmap->red, color, sizeof(color)) == 0
291	    && memcmp(cmap->green, color, sizeof(color)) == 0
292	    && memcmp(cmap->blue, color, sizeof(color)) == 0
293	    && cmap->transp == NULL)
294		return 0;
295	else
296		return -EINVAL;
297}
298
299static int aafb_ioctl(struct fb_info *info, u32 cmd, unsigned long arg)
300{
301	/* TODO: Not yet implemented */
302	return -ENOIOCTLCMD;
303}
304
305static int aafb_switch(int con, struct fb_info *info)
306{
307	struct aafb_info *ip = (struct aafb_info *)info;
308	struct display *old = (currcon < 0) ? &ip->disp : (fb_display + currcon);
309	struct display *new = (con < 0) ? &ip->disp : (fb_display + con);
310
311	if (old->conp && old->conp->vc_sw && old->conp->vc_sw->con_cursor)
312		old->conp->vc_sw->con_cursor(old->conp, CM_ERASE);
313
314	/* Set the current console. */
315	currcon = con;
316	aafb_set_disp(new, con, ip);
317
318	return 0;
319}
320
321static void aafb_encode_var(struct fb_var_screeninfo *var,
322			    struct aafb_par *par)
323{
324	var->xres = 1280;
325	var->yres = 1024;
326	var->xres_virtual = 2048;
327	var->yres_virtual = 1024;
328	var->xoffset = 0;
329	var->yoffset = 0;
330	var->bits_per_pixel = 8;
331	var->grayscale = 1;
332	var->red.offset = 0;
333	var->red.length = 0;
334	var->red.msb_right = 0;
335	var->green.offset = 0;
336	var->green.length = 1;
337	var->green.msb_right = 0;
338	var->blue.offset = 0;
339	var->blue.length = 0;
340	var->blue.msb_right = 0;
341	var->transp.offset = 0;
342	var->transp.length = 0;
343	var->transp.msb_right = 0;
344	var->nonstd = 0;
345	var->activate &= ~FB_ACTIVATE_MASK & FB_ACTIVATE_NOW;
346	var->accel_flags = 0;
347	var->sync = FB_SYNC_ON_GREEN;
348	var->vmode &= ~FB_VMODE_MASK & FB_VMODE_NONINTERLACED;
349}
350
351static int aafb_get_var(struct fb_var_screeninfo *var, int con,
352			struct fb_info *info)
353{
354	if (con < 0) {
355		struct aafb_par par;
356
357		memset(var, 0, sizeof(struct fb_var_screeninfo));
358		aafb_get_par(&par);
359		aafb_encode_var(var, &par);
360	} else
361		*var = info->var;
362
363	return 0;
364}
365
366static int aafb_set_var(struct fb_var_screeninfo *var, int con,
367			struct fb_info *info)
368{
369	struct aafb_par par;
370
371	aafb_get_par(&par);
372	aafb_encode_var(var, &par);
373	info->var = *var;
374
375	return 0;
376}
377
378static int aafb_update_var(int con, struct fb_info *info)
379{
380	struct aafb_info *ip = (struct aafb_info *)info;
381	struct display *disp = (con < 0) ? &ip->disp : (fb_display + con);
382
383	if (con == currcon)
384		aafbcon_cursor(disp, CM_ERASE, ip->cursor.x, ip->cursor.y);
385
386	return 0;
387}
388
389/* 0 unblanks, any other blanks. */
390
391static void aafb_blank(int blank, struct fb_info *info)
392{
393	struct aafb_info *ip = (struct aafb_info *)info;
394	u8 val = blank ? 0x00 : 0x0f;
395
396	bt455_write_cmap_entry(ip->bt455, 1, val, val, val);
397	aafbcon_cursor(&ip->disp, CM_ERASE, ip->cursor.x, ip->cursor.y);
398}
399
400static struct fb_ops aafb_ops = {
401	.owner = THIS_MODULE,
402	.fb_get_fix = aafb_get_fix,
403	.fb_get_var = aafb_get_var,
404	.fb_set_var = aafb_set_var,
405	.fb_get_cmap = aafb_get_cmap,
406	.fb_set_cmap = aafb_set_cmap,
407	.fb_ioctl = aafb_ioctl
408};
409
410static int __init init_one(int slot)
411{
412	unsigned long base_addr = CKSEG1ADDR(get_tc_base_addr(slot));
413	struct aafb_info *ip = &my_fb_info[slot];
414
415	memset(ip, 0, sizeof(struct aafb_info));
416
417	/*
418	 * Framebuffer display memory base address and friends.
419	 */
420	ip->bt455 = (struct bt455_regs *) (base_addr + PMAG_AA_BT455_OFFSET);
421	ip->bt431 = (struct bt431_regs *) (base_addr + PMAG_AA_BT431_OFFSET);
422	ip->fb_start = base_addr + PMAG_AA_ONBOARD_FBMEM_OFFSET;
423	ip->fb_size = 2048 * 1024; /* fb_fix_screeninfo.smem_length
424				      seems to be physical */
425	ip->fb_line_length = 2048;
426
427	/*
428	 * Let there be consoles..
429	 */
430	strcpy(ip->info.modename, "PMAG-AA");
431	ip->info.node = -1;
432	ip->info.flags = FBINFO_FLAG_DEFAULT;
433	ip->info.fbops = &aafb_ops;
434	ip->info.disp = &ip->disp;
435	ip->info.changevar = NULL;
436	ip->info.switch_con = &aafb_switch;
437	ip->info.updatevar = &aafb_update_var;
438	ip->info.blank = &aafb_blank;
439
440	aafb_set_disp(&ip->disp, currcon, ip);
441
442	/*
443	 * Configure the RAM DACs.
444	 */
445	bt455_erase_cursor(ip->bt455);
446
447	/* Init colormap. */
448	bt455_write_cmap_entry(ip->bt455, 0, 0x00, 0x00, 0x00);
449	bt455_write_cmap_entry(ip->bt455, 1, 0x0f, 0x0f, 0x0f);
450
451	/* Init hardware cursor. */
452	bt431_init_cursor(ip->bt431);
453	aafb_cursor_init(ip);
454
455	/* Clear the screen. */
456	memset ((void *)ip->fb_start, 0, ip->fb_size);
457
458	if (register_framebuffer(&ip->info) < 0)
459		return -EINVAL;
460
461	printk(KERN_INFO "fb%d: %s frame buffer in TC slot %d\n",
462	       GET_FB_IDX(ip->info.node), ip->info.modename, slot);
463
464	return 0;
465}
466
467static int __exit exit_one(int slot)
468{
469	struct aafb_info *ip = &my_fb_info[slot];
470
471	if (unregister_framebuffer(&ip->info) < 0)
472		return -EINVAL;
473
474	return 0;
475}
476
477/*
478 * Initialise the framebuffer.
479 */
480int __init pmagaafb_init(void)
481{
482	int sid;
483	int found = 0;
484
485	while ((sid = search_tc_card("PMAG-AA")) >= 0) {
486		found = 1;
487		claim_tc_card(sid);
488		init_one(sid);
489	}
490
491	return found ? 0 : -ENXIO;
492}
493
494static void __exit pmagaafb_exit(void)
495{
496	int sid;
497
498	while ((sid = search_tc_card("PMAG-AA")) >= 0) {
499		exit_one(sid);
500		release_tc_card(sid);
501	}
502}
503
504MODULE_AUTHOR(DRIVER_AUTHOR);
505MODULE_DESCRIPTION(DRIVER_DESCRIPTION);
506MODULE_LICENSE("GPL");
507#ifdef MODULE
508module_init(pmagaafb_init);
509module_exit(pmagaafb_exit);
510#endif