[PATCH] DEC PMAG BA frame buffer update (af690a94) · Commits · e / devices / android_kernel_oneplus_sm7250

drivers/video/pmag-ba-fb.c

+183 −102

Original line number	Original line	Diff line number	Diff line
	/*		/*
	* linux/drivers/video/pmag-ba-fb.c		* linux/drivers/video/pmag-ba-fb.c
	*		*
	* PMAG-BA TurboChannel framebuffer card support ... derived from:		* PMAG-BA TURBOchannel Color Frame Buffer (CFB) card support,
			* derived from:
	* "HP300 Topcat framebuffer support (derived from macfb of all things)		* "HP300 Topcat framebuffer support (derived from macfb of all things)
	* Phil Blundell <philb@gnu.org> 1998", the original code can be		* Phil Blundell <philb@gnu.org> 1998", the original code can be
	* found in the file hpfb.c in the same directory.		* found in the file hpfb.c in the same directory.
	@@ -14,44 +15,41 @@
	* Michael Engel <engel@unix-ag.org>,		* Michael Engel <engel@unix-ag.org>,
	* Karsten Merker <merker@linuxtag.org> and		* Karsten Merker <merker@linuxtag.org> and
	* Harald Koerfgen.		* Harald Koerfgen.
			* Copyright (c) 2005 Maciej W. Rozycki
			*
	* This file is subject to the terms and conditions of the GNU General		* This file is subject to the terms and conditions of the GNU General
	* Public License. See the file COPYING in the main directory of this		* Public License. See the file COPYING in the main directory of this
	* archive for more details.		* archive for more details.
	*
	*/		*/
	#include <linux/module.h>
	#include <linux/kernel.h>		#include <linux/compiler.h>
	#include <linux/sched.h>
	#include <linux/errno.h>		#include <linux/errno.h>
	#include <linux/string.h>
	#include <linux/timer.h>
	#include <linux/mm.h>
	#include <linux/tty.h>
	#include <linux/slab.h>
	#include <linux/delay.h>
	#include <linux/init.h>
	#include <linux/fb.h>		#include <linux/fb.h>
	#include <asm/bootinfo.h>		#include <linux/init.h>
	#include <asm/dec/machtype.h>		#include <linux/kernel.h>
			#include <linux/module.h>
			#include <linux/types.h>

			#include <asm/bug.h>
			#include <asm/io.h>
			#include <asm/system.h>

	#include <asm/dec/tc.h>		#include <asm/dec/tc.h>

	#include <video/pmag-ba-fb.h>		#include <video/pmag-ba-fb.h>

	struct pmag_ba_ramdac_regs {
	unsigned char addr_low;		struct pmagbafb_par {
	unsigned char pad0[3];		struct fb_info *next;
	unsigned char addr_hi;		volatile void __iomem *mmio;
	unsigned char pad1[3];		volatile u32 __iomem *dac;
	unsigned char data;		int slot;
	unsigned char pad2[3];
	unsigned char cmap;
	};		};

	/*
	* Max 3 TURBOchannel slots -> max 3 PMAG-BA :)
	*/
	static struct fb_info pmagba_fb_info[3];

	static struct fb_var_screeninfo pmagbafb_defined = {		static struct fb_info *root_pmagbafb_dev;

			static struct fb_var_screeninfo pmagbafb_defined __initdata = {
	.xres = 1024,		.xres = 1024,
	.yres = 864,		.yres = 864,
	.xres_virtual = 1024,		.xres_virtual = 1024,
	@@ -61,58 +59,71 @@ static struct fb_var_screeninfo pmagbafb_defined = {
	.green.length = 8,		.green.length = 8,
	.blue.length = 8,		.blue.length = 8,
	.activate = FB_ACTIVATE_NOW,		.activate = FB_ACTIVATE_NOW,
	.height = 274,		.height = -1,
	.width = 195,		.width = -1,
	.accel = FB_ACCEL_NONE,		.accel_flags = FB_ACCEL_NONE,
			.pixclock = 14452,
			.left_margin = 116,
			.right_margin = 12,
			.upper_margin = 34,
			.lower_margin = 12,
			.hsync_len = 128,
			.vsync_len = 3,
			.sync = FB_SYNC_ON_GREEN,
	.vmode = FB_VMODE_NONINTERLACED,		.vmode = FB_VMODE_NONINTERLACED,
	};		};

	static struct fb_fix_screeninfo pmagbafb_fix = {		static struct fb_fix_screeninfo pmagbafb_fix __initdata = {
	.id = "PMAG-BA",		.id = "PMAG-BA",
	.smem_len = (1024 * 864),		.smem_len = (1024 * 1024),
	.type = FB_TYPE_PACKED_PIXELS,		.type = FB_TYPE_PACKED_PIXELS,
	.visual = FB_VISUAL_PSEUDOCOLOR,		.visual = FB_VISUAL_PSEUDOCOLOR,
	.line_length = 1024,		.line_length = 1024,
			.mmio_len = PMAG_BA_SIZE - PMAG_BA_BT459,
	};		};

	/*
	* Turn hardware cursor off		static inline void dac_write(struct pmagbafb_par *par, unsigned int reg, u8 v)
	*/
	void pmagbafb_erase_cursor(struct pmag_ba_ramdac_regs *bt459_regs)
	{		{
	bt459_regs->addr_low = 0;		writeb(v, par->dac + reg / 4);
	bt459_regs->addr_hi = 3;
	bt459_regs->data = 0;
	}		}

			static inline u8 dac_read(struct pmagbafb_par *par, unsigned int reg)
			{
			return readb(par->dac + reg / 4);
			}


	/*		/*
	* Set the palette.		* Set the palette.
	*/		*/
	static int pmagbafb_setcolreg(unsigned regno, unsigned red, unsigned green,		static int pmagbafb_setcolreg(unsigned int regno, unsigned int red,
	unsigned blue, unsigned transp,		unsigned int green, unsigned int blue,
	struct fb_info *info)		unsigned int transp, struct fb_info *info)
	{		{
	struct pmag_ba_ramdac_regs bt459_regs = (struct pmag_ba_ramdac_regs ) info->par;		struct pmagbafb_par *par = info->par;

	if (regno >= info->cmap.len)		BUG_ON(regno >= info->cmap.len);
	return 1;

	red >>= 8; /* The cmap fields are 16 bits */		red >>= 8; /* The cmap fields are 16 bits */
	green >>= 8; /* wide, but the harware colormap */		green >>= 8; /* wide, but the hardware colormap */
	blue >>= 8; /* registers are only 8 bits wide */		blue >>= 8; /* registers are only 8 bits wide */

	bt459_regs->addr_low = (__u8) regno;		mb();
	bt459_regs->addr_hi = 0;		dac_write(par, BT459_ADDR_LO, regno);
	bt459_regs->cmap = red;		dac_write(par, BT459_ADDR_HI, 0x00);
	bt459_regs->cmap = green;		wmb();
	bt459_regs->cmap = blue;		dac_write(par, BT459_CMAP, red);
			wmb();
			dac_write(par, BT459_CMAP, green);
			wmb();
			dac_write(par, BT459_CMAP, blue);

	return 0;		return 0;
	}		}

	static struct fb_ops pmagbafb_ops = {		static struct fb_ops pmagbafb_ops = {
	.owner = THIS_MODULE,		.owner = THIS_MODULE,
	.fb_get_fix = gen_get_fix,
	.fb_get_var = gen_get_var,
	.fb_setcolreg = pmagbafb_setcolreg,		.fb_setcolreg = pmagbafb_setcolreg,
	.fb_fillrect = cfb_fillrect,		.fb_fillrect = cfb_fillrect,
	.fb_copyarea = cfb_copyarea,		.fb_copyarea = cfb_copyarea,
	@@ -120,63 +131,133 @@ static struct fb_ops pmagbafb_ops = {
	.fb_cursor = soft_cursor,		.fb_cursor = soft_cursor,
	};		};

	int __init pmagbafb_init_one(int slot)
	{
	unsigned long base_addr = get_tc_base_addr(slot);
	struct fb_info *info = &pmagba_fb_info[slot];
	struct display *disp = &pmagba_disp[slot];

	printk("PMAG-BA framebuffer in slot %d\n", slot);
	/*		/*
	* Framebuffer display memory base address and friends		* Turn the hardware cursor off.
	*/		*/
	pmagbafb_fix.smem_start = base_addr + PMAG_BA_ONBOARD_FBMEM_OFFSET;		static void __init pmagbafb_erase_cursor(struct fb_info *info)
	info->par = (base_addr + PMAG_BA_BT459_OFFSET);		{
			struct pmagbafb_par *par = info->par;

	/*		mb();
	* Configure the Bt459 RAM DAC		dac_write(par, BT459_ADDR_LO, 0x00);
	*/		dac_write(par, BT459_ADDR_HI, 0x03);
	pmagbafb_erase_cursor((struct pmag_ba_ramdac_regs *) info->par);		wmb();
			dac_write(par, BT459_DATA, 0x00);
			}


			static int __init pmagbafb_init_one(int slot)
			{
			struct fb_info *info;
			struct pmagbafb_par *par;
			unsigned long base_addr;

			info = framebuffer_alloc(sizeof(struct pmagbafb_par), NULL);
			if (!info)
			return -ENOMEM;

			par = info->par;
			par->slot = slot;
			claim_tc_card(par->slot);

			base_addr = get_tc_base_addr(par->slot);

			par->next = root_pmagbafb_dev;
			root_pmagbafb_dev = info;

			if (fb_alloc_cmap(&info->cmap, 256, 0) < 0)
			goto err_alloc;

	/*
	* Let there be consoles..
	*/
	info->fbops = &pmagbafb_ops;		info->fbops = &pmagbafb_ops;
	info->var = pmagbafb_defined;
	info->fix = pmagbafb_fix;		info->fix = pmagbafb_fix;
	info->screen_base = pmagbafb_fix.smem_start;		info->var = pmagbafb_defined;
	info->flags = FBINFO_DEFAULT;		info->flags = FBINFO_DEFAULT;

	fb_alloc_cmap(&fb_info.cmap, 256, 0);		/* MMIO mapping setup. */
			info->fix.mmio_start = base_addr;
			par->mmio = ioremap_nocache(info->fix.mmio_start, info->fix.mmio_len);
			if (!par->mmio)
			goto err_cmap;
			par->dac = par->mmio + PMAG_BA_BT459;

			/* Frame buffer mapping setup. */
			info->fix.smem_start = base_addr + PMAG_BA_FBMEM;
			info->screen_base = ioremap_nocache(info->fix.smem_start,
			info->fix.smem_len);
			if (!info->screen_base)
			goto err_mmio_map;
			info->screen_size = info->fix.smem_len;

			pmagbafb_erase_cursor(info);

	if (register_framebuffer(info) < 0)		if (register_framebuffer(info) < 0)
	return 1;		goto err_smem_map;

			pr_info("fb%d: %s frame buffer device in slot %d\n",
			info->node, info->fix.id, par->slot);

	return 0;		return 0;


			err_smem_map:
			iounmap(info->screen_base);

			err_mmio_map:
			iounmap(par->mmio);

			err_cmap:
			fb_dealloc_cmap(&info->cmap);

			err_alloc:
			root_pmagbafb_dev = par->next;
			release_tc_card(par->slot);
			framebuffer_release(info);
			return -ENXIO;
	}		}

			static void __exit pmagbafb_exit_one(void)
			{
			struct fb_info *info = root_pmagbafb_dev;
			struct pmagbafb_par *par = info->par;

			unregister_framebuffer(info);
			iounmap(info->screen_base);
			iounmap(par->mmio);
			fb_dealloc_cmap(&info->cmap);
			root_pmagbafb_dev = par->next;
			release_tc_card(par->slot);
			framebuffer_release(info);
			}


	/*		/*
	* Initialise the framebuffer		* Initialise the framebuffer.
	*/		*/
			static int __init pmagbafb_init(void)
	int __init pmagbafb_init(void)
	{		{
	int sid;		int count = 0;
	int found = 0;		int slot;

	if (fb_get_options("pmagbafb", NULL))		if (fb_get_options("pmagbafb", NULL))
	return -ENODEV;		return -ENXIO;

	if (TURBOCHANNEL) {		while ((slot = search_tc_card("PMAG-BA")) >= 0) {
	while ((sid = search_tc_card("PMAG-BA")) >= 0) {		if (pmagbafb_init_one(slot) < 0)
	found = 1;		break;
	claim_tc_card(sid);		count++;
	pmagbafb_init_one(sid);
	}		}
	return found ? 0 : -ENODEV;		return (count > 0) ? 0 : -ENXIO;
	} else {
	return -ENODEV;
	}		}

			static void __exit pmagbafb_exit(void)
			{
			while (root_pmagbafb_dev)
			pmagbafb_exit_one();
	}		}


	module_init(pmagbafb_init);		module_init(pmagbafb_init);
			module_exit(pmagbafb_exit);

	MODULE_LICENSE("GPL");		MODULE_LICENSE("GPL");

include/video/pmag-ba-fb.h

+22 −19

Original line number	Original line	Diff line number	Diff line
	/*		/*
	* linux/drivers/video/pmag-ba-fb.h		* linux/include/video/pmag-ba-fb.h
	*		*
	* TurboChannel PMAG-BA framebuffer card support,		* TURBOchannel PMAG-BA Color Frame Buffer (CFB) card support,
	* Copyright (C) 1999, 2000, 2001 by		* Copyright (C) 1999, 2000, 2001 by
	* Michael Engel <engel@unix-ag.org>,		* Michael Engel <engel@unix-ag.org>,
	* Karsten Merker <merker@linuxtag.org>		* Karsten Merker <merker@linuxtag.org>
			* Copyright (c) 2005 Maciej W. Rozycki
			*
	* This file is subject to the terms and conditions of the GNU General		* This file is subject to the terms and conditions of the GNU General
	* Public License. See the file COPYING in the main directory of this		* Public License. See the file COPYING in the main directory of this
	* archive for more details.		* archive for more details.
	*/		*/

	/*		/* IOmem resource offsets. */
	* Bt459 RAM DAC register base offset (rel. to TC slot base address)		#define PMAG_BA_FBMEM 0x000000 /* frame buffer */
	*/		#define PMAG_BA_BT459 0x200000 /* Bt459 RAMDAC */
			#define PMAG_BA_IRQ 0x300000 /* IRQ acknowledge */
	#define PMAG_BA_BT459_OFFSET 0x00200000		#define PMAG_BA_ROM 0x380000 /* REX option ROM */
			#define PMAG_BA_BT438 0x380000 /* Bt438 clock chip reset */
	/*		#define PMAG_BA_SIZE 0x400000 /* address space size */
	* Begin of PMAG-BA framebuffer memory relative to TC slot address,
	* resolution is 1024x864x8
	*/

	#define PMAG_BA_ONBOARD_FBMEM_OFFSET 0x00000000		/* Bt459 register offsets, byte-wide registers. */
			#define BT459_ADDR_LO 0x0 /* address low */
			#define BT459_ADDR_HI 0x4 /* address high */
			#define BT459_DATA 0x8 /* data window register */
			#define BT459_CMAP 0xc /* color map window register */