Merge with 2.3.19.

1 files changed, 178 insertions, 0 deletions

diff --git a/drivers/video/p9100fb.c b/drivers/video/p9100fb.c
new file mode 100644
index 000000000..cbecb5e4f
--- /dev/null
+++ b/drivers/video/p9100fb.c
@@ -0,0 +1,178 @@
+/* $id: p9100fb.c,v 1.4 1999/08/18 10:55:01 shadow Exp $
+ * p9100fb.c: P9100 frame buffer driver
+ *
+ * Copyright 1999 Derrick J Brashear (shadow@dementia.org)
+ */
+
+#include <linux/module.h>
+#include <linux/sched.h>
+#include <linux/kernel.h>
+#include <linux/errno.h>
+#include <linux/string.h>
+#include <linux/mm.h>
+#include <linux/tty.h>
+#include <linux/malloc.h>
+#include <linux/vmalloc.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/fb.h>
+#include <linux/init.h>
+#include <linux/selection.h>
+
+#include <video/sbusfb.h>
+#include <asm/io.h>
+
+#include <video/fbcon-cfb8.h>
+
+#include "p9100.h"
+
+static struct sbus_mmap_map p9100_mmap_map[] = {
+#if 0 /* For now, play we're a dumb color fb */
+  { P9100_CTL_OFF, 0x38000000, 0x2000 },
+  { P9100_CMD_OFF, 0x38002000, 0x2000 },
+  { P9100_FB_OFF, 0x38800000, 0x200000 },
+  { CG3_MMAP_OFFSET, 0x38800000, SBUS_MMAP_FBSIZE(1) },
+#else
+  { CG3_MMAP_OFFSET, 0x0, SBUS_MMAP_FBSIZE(1) },
+#endif
+  { 0, 0, 0 }
+};
+
+#define _READCTL(member, out) \
+{ \
+  struct p9100_ctrl *actual; \
+  actual = (struct p9100_ctrl *)fb->s.p9100.ctrl; \
+  out = actual-> ## member ; \
+}
+
+#define READCTL(member, out) \
+{ \
+  struct p9100_ctrl *enab, *actual; \
+  actual = (struct p9100_ctrl *)fb->s.p9100.ctrl; \
+  enab = (struct p9100_ctrl *)fb->s.p9100.fbmem; \
+  out = enab-> ## member ; \
+  out = actual-> ## member ; \
+}
+
+#define WRITECTL(member, val) \
+{ \
+  u32 __writetmp; \
+  struct p9100_ctrl *enab, *actual; \
+  actual = (struct p9100_ctrl *)fb->s.p9100.ctrl; \
+  enab = (struct p9100_ctrl *)fb->s.p9100.fbmem; \
+  __writetmp = enab-> ## member ; \
+  actual-> ## member = val; \
+}
+
+static void p9100_loadcmap (struct fb_info_sbusfb *fb, struct display *p, int index, int count)
+{
+	int i;
+	u32 tmp;
+
+	_READCTL(pwrup_cfg, tmp);
+	WRITECTL(ramdac_cmap_wridx, (index << 16));
+
+	for (i = index; count--; i++){
+		_READCTL(pwrup_cfg, tmp);
+		WRITECTL(ramdac_palette_data, (fb->color_map CM(i,0) << 16));
+		_READCTL(pwrup_cfg, tmp);
+		WRITECTL(ramdac_palette_data, (fb->color_map CM(i,1) << 16));
+		_READCTL(pwrup_cfg, tmp);
+		WRITECTL(ramdac_palette_data, (fb->color_map CM(i,2) << 16));
+	}
+}
+
+static void p9100_blank (struct fb_info_sbusfb *fb)
+{
+  u32 val;
+  READCTL(vid_screenpaint_timectl1, val);
+  val &= ~ SCREENPAINT_TIMECTL1_ENABLE_VIDEO;
+  WRITECTL(vid_screenpaint_timectl1, val);
+}
+
+static void p9100_unblank (struct fb_info_sbusfb *fb)
+{
+  u32 val;
+  READCTL(vid_screenpaint_timectl1, val);
+  val |= SCREENPAINT_TIMECTL1_ENABLE_VIDEO;
+  WRITECTL(vid_screenpaint_timectl1, val);
+}
+
+static void p9100_margins (struct fb_info_sbusfb *fb, struct display *p, int x_margin, int y_margin)
+{
+  p->screen_base += (y_margin - fb->y_margin) * p->line_length + 
+    (x_margin - fb->x_margin);
+}
+
+static char idstring[60] __initdata = { 0 };
+
+char * __init p9100fb_init(struct fb_info_sbusfb *fb)
+{
+	struct fb_fix_screeninfo *fix = &fb->fix;
+	struct display *disp = &fb->disp;
+	struct fbtype *type = &fb->type;
+	unsigned long phys = fb->sbdp->reg_addrs[2].phys_addr;
+	int tmp;
+
+#ifndef FBCON_HAS_CFB8
+	return NULL;
+#endif
+
+	/* Control regs: fb->sbdp->reg_addrs[0].phys_addr 
+	 * Command regs: fb->sbdp->reg_addrs[1].phys_addr 
+	 * Frame buffer: fb->sbdp->reg_addrs[2].phys_addr 
+         */
+
+	if (!fb->s.p9100.ctrl) {
+	  fb->s.p9100.ctrl = (struct p9100_ctrl *)
+	    sparc_alloc_io(fb->sbdp->reg_addrs[0].phys_addr, 0, 
+			   fb->sbdp->reg_addrs[1].reg_size, "p9100_ctrl", fb->iospace, 0);
+	}
+
+	strcpy(fb->info.modename, "p9100");
+	strcpy(fix->id, "p9100");
+	fix->accel = FB_ACCEL_SUN_CGTHREE;
+	fix->line_length = fb->var.xres_virtual;
+
+	disp->scrollmode = SCROLL_YREDRAW;
+	if (!disp->screen_base)
+		disp->screen_base = 
+		  (char *)sparc_alloc_io(phys, 0, type->fb_size, "p9100_ram", 
+					 fb->iospace, 0);
+	fb->s.p9100.fbmem = disp->screen_base;
+	disp->screen_base += fix->line_length * fb->y_margin + fb->x_margin;
+
+	READCTL(sys_config, tmp);
+        switch ((tmp >> SYS_CONFIG_PIXELSIZE_SHIFT) & 7) {
+	case 7: 
+	  type->fb_depth = 24; 
+	  break;
+	case 5: 
+	  type->fb_depth = 32;
+	  break;
+	case 3: 
+	  type->fb_depth = 16; 
+	  break;
+	case 2: 
+	  type->fb_depth = 8; 
+	  break;
+	default: 
+	  printk("p9100: screen depth unknown: 0x%x", tmp);
+	  return NULL;
+        }
+
+	fb->dispsw = fbcon_cfb8;
+
+	fb->margins = p9100_margins;
+	fb->loadcmap = p9100_loadcmap;
+	fb->blank = p9100_blank;
+	fb->unblank = p9100_unblank;
+	
+	fb->physbase = phys;
+	fb->mmap_map = p9100_mmap_map;
+	
+	sprintf(idstring, "%s at 0x%x", "p9100", disp->screen_base);
+
+	return idstring;
+}
+