[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / video / wm8505fb.c

/*
 *  WonderMedia WM8505 Frame Buffer device driver
 *
 *  Copyright (C) 2010 Ed Spiridonov <edo.rus@gmail.com>
 *    Based on vt8500lcdfb.c
 *
 * This software is licensed under the terms of the GNU General Public
 * License version 2, as published by the Free Software Foundation, and
 * may be copied, distributed, and modified under those terms.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#include <linux/delay.h>
#include <linux/dma-mapping.h>
#include <linux/fb.h>
#include <linux/errno.h>
#include <linux/err.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/kernel.h>
#include <linux/memblock.h>
#include <linux/mm.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_fdt.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/string.h>
#include <linux/wait.h>
#include <video/of_display_timing.h>

#include "wm8505fb_regs.h"
#include "wmt_ge_rops.h"

#define DRIVER_NAME "wm8505-fb"

#define to_wm8505fb_info(__info) container_of(__info, \
						struct wm8505fb_info, fb)
struct wm8505fb_info {
	struct fb_info		fb;
	void __iomem		*regbase;
	unsigned int		contrast;
};


static int wm8505fb_init_hw(struct fb_info *info)
{
	struct wm8505fb_info *fbi = to_wm8505fb_info(info);

	int i;

	/* I know the purpose only of few registers, so clear unknown */
	for (i = 0; i < 0x200; i += 4)
		writel(0, fbi->regbase + i);

	/* Set frame buffer address */
	writel(fbi->fb.fix.smem_start, fbi->regbase + WMT_GOVR_FBADDR);
	writel(fbi->fb.fix.smem_start, fbi->regbase + WMT_GOVR_FBADDR1);

	/*
	 * Set in-memory picture format to RGB
	 * 0x31C sets the correct color mode (RGB565) for WM8650
	 * Bit 8+9 (0x300) are ignored on WM8505 as reserved
	 */
	writel(0x31c,		       fbi->regbase + WMT_GOVR_COLORSPACE);
	writel(1,		       fbi->regbase + WMT_GOVR_COLORSPACE1);

	/* Virtual buffer size */
	writel(info->var.xres,	       fbi->regbase + WMT_GOVR_XRES);
	writel(info->var.xres_virtual, fbi->regbase + WMT_GOVR_XRES_VIRTUAL);

	/* black magic ;) */
	writel(0xf,		       fbi->regbase + WMT_GOVR_FHI);
	writel(4,		       fbi->regbase + WMT_GOVR_DVO_SET);
	writel(1,		       fbi->regbase + WMT_GOVR_MIF_ENABLE);
	writel(1,		       fbi->regbase + WMT_GOVR_REG_UPDATE);

	return 0;
}

static int wm8505fb_set_timing(struct fb_info *info)
{
	struct wm8505fb_info *fbi = to_wm8505fb_info(info);

	int h_start = info->var.left_margin;
	int h_end = h_start + info->var.xres;
	int h_all = h_end + info->var.right_margin;
	int h_sync = info->var.hsync_len;

	int v_start = info->var.upper_margin;
	int v_end = v_start + info->var.yres;
	int v_all = v_end + info->var.lower_margin;
	int v_sync = info->var.vsync_len;

	writel(0, fbi->regbase + WMT_GOVR_TG);

	writel(h_start, fbi->regbase + WMT_GOVR_TIMING_H_START);
	writel(h_end,   fbi->regbase + WMT_GOVR_TIMING_H_END);
	writel(h_all,   fbi->regbase + WMT_GOVR_TIMING_H_ALL);
	writel(h_sync,  fbi->regbase + WMT_GOVR_TIMING_H_SYNC);

	writel(v_start, fbi->regbase + WMT_GOVR_TIMING_V_START);
	writel(v_end,   fbi->regbase + WMT_GOVR_TIMING_V_END);
	writel(v_all,   fbi->regbase + WMT_GOVR_TIMING_V_ALL);
	writel(v_sync,  fbi->regbase + WMT_GOVR_TIMING_V_SYNC);

	writel(1, fbi->regbase + WMT_GOVR_TG);

	return 0;
}


static int wm8505fb_set_par(struct fb_info *info)
{
	struct wm8505fb_info *fbi = to_wm8505fb_info(info);

	if (!fbi)
		return -EINVAL;

	if (info->var.bits_per_pixel == 32) {
		info->var.red.offset = 16;
		info->var.red.length = 8;
		info->var.red.msb_right = 0;
		info->var.green.offset = 8;
		info->var.green.length = 8;
		info->var.green.msb_right = 0;
		info->var.blue.offset = 0;
		info->var.blue.length = 8;
		info->var.blue.msb_right = 0;
		info->fix.visual = FB_VISUAL_TRUECOLOR;
		info->fix.line_length = info->var.xres_virtual << 2;
	} else if (info->var.bits_per_pixel == 16) {
		info->var.red.offset = 11;
		info->var.red.length = 5;
		info->var.red.msb_right = 0;
		info->var.green.offset = 5;
		info->var.green.length = 6;
		info->var.green.msb_right = 0;
		info->var.blue.offset = 0;
		info->var.blue.length = 5;
		info->var.blue.msb_right = 0;
		info->fix.visual = FB_VISUAL_TRUECOLOR;
		info->fix.line_length = info->var.xres_virtual << 1;
	}

	wm8505fb_set_timing(info);

	writel(fbi->contrast<<16 | fbi->contrast<<8 | fbi->contrast,
		fbi->regbase + WMT_GOVR_CONTRAST);

	return 0;
}

static ssize_t contrast_show(struct device *dev,
			     struct device_attribute *attr, char *buf)
{
	struct fb_info *info = dev_get_drvdata(dev);
	struct wm8505fb_info *fbi = to_wm8505fb_info(info);

	return sprintf(buf, "%d\n", fbi->contrast);
}

static ssize_t contrast_store(struct device *dev,
			      struct device_attribute *attr,
			      const char *buf, size_t count)
{
	struct fb_info *info = dev_get_drvdata(dev);
	struct wm8505fb_info *fbi = to_wm8505fb_info(info);
	unsigned long tmp;

	if (strict_strtoul(buf, 10, &tmp) || (tmp > 0xff))
		return -EINVAL;
	fbi->contrast = tmp;

	wm8505fb_set_par(info);

	return count;
}

static DEVICE_ATTR(contrast, 0644, contrast_show, contrast_store);

static inline u_int chan_to_field(u_int chan, struct fb_bitfield *bf)
{
	chan &= 0xffff;
	chan >>= 16 - bf->length;
	return chan << bf->offset;
}

static int wm8505fb_setcolreg(unsigned regno, unsigned red, unsigned green,
			   unsigned blue, unsigned transp,
			   struct fb_info *info) {
	struct wm8505fb_info *fbi = to_wm8505fb_info(info);
	int ret = 1;
	unsigned int val;
	if (regno >= 256)
		return -EINVAL;

	if (info->var.grayscale)
		red = green = blue =
			(19595 * red + 38470 * green + 7471 * blue) >> 16;

	switch (fbi->fb.fix.visual) {
	case FB_VISUAL_TRUECOLOR:
		if (regno < 16) {
			u32 *pal = info->pseudo_palette;

			val  = chan_to_field(red, &fbi->fb.var.red);
			val |= chan_to_field(green, &fbi->fb.var.green);
			val |= chan_to_field(blue, &fbi->fb.var.blue);

			pal[regno] = val;
			ret = 0;
		}
		break;
	}

	return ret;
}

static int wm8505fb_pan_display(struct fb_var_screeninfo *var,
				struct fb_info *info)
{
	struct wm8505fb_info *fbi = to_wm8505fb_info(info);

	writel(var->xoffset, fbi->regbase + WMT_GOVR_XPAN);
	writel(var->yoffset, fbi->regbase + WMT_GOVR_YPAN);
	return 0;
}

static int wm8505fb_blank(int blank, struct fb_info *info)
{
	struct wm8505fb_info *fbi = to_wm8505fb_info(info);

	switch (blank) {
	case FB_BLANK_UNBLANK:
		wm8505fb_set_timing(info);
		break;
	default:
		writel(0,  fbi->regbase + WMT_GOVR_TIMING_V_SYNC);
		break;
	}

	return 0;
}

static struct fb_ops wm8505fb_ops = {
	.owner		= THIS_MODULE,
	.fb_set_par	= wm8505fb_set_par,
	.fb_setcolreg	= wm8505fb_setcolreg,
	.fb_fillrect	= wmt_ge_fillrect,
	.fb_copyarea	= wmt_ge_copyarea,
	.fb_imageblit	= sys_imageblit,
	.fb_sync	= wmt_ge_sync,
	.fb_pan_display	= wm8505fb_pan_display,
	.fb_blank	= wm8505fb_blank,
};

static int wm8505fb_probe(struct platform_device *pdev)
{
	struct wm8505fb_info	*fbi;
	struct resource	*res;
	struct display_timings *disp_timing;
	void			*addr;
	int ret;

	struct fb_videomode	mode;
	u32			bpp;
	dma_addr_t fb_mem_phys;
	unsigned long fb_mem_len;
	void *fb_mem_virt;

	fbi = devm_kzalloc(&pdev->dev, sizeof(struct wm8505fb_info) +
			sizeof(u32) * 16, GFP_KERNEL);
	if (!fbi) {
		dev_err(&pdev->dev, "Failed to initialize framebuffer device\n");
		return -ENOMEM;
	}

	strcpy(fbi->fb.fix.id, DRIVER_NAME);

	fbi->fb.fix.type	= FB_TYPE_PACKED_PIXELS;
	fbi->fb.fix.xpanstep	= 1;
	fbi->fb.fix.ypanstep	= 1;
	fbi->fb.fix.ywrapstep	= 0;
	fbi->fb.fix.accel	= FB_ACCEL_NONE;

	fbi->fb.fbops		= &wm8505fb_ops;
	fbi->fb.flags		= FBINFO_DEFAULT
				| FBINFO_HWACCEL_COPYAREA
				| FBINFO_HWACCEL_FILLRECT
				| FBINFO_HWACCEL_XPAN
				| FBINFO_HWACCEL_YPAN
				| FBINFO_VIRTFB
				| FBINFO_PARTIAL_PAN_OK;
	fbi->fb.node		= -1;

	addr = fbi;
	addr = addr + sizeof(struct wm8505fb_info);
	fbi->fb.pseudo_palette	= addr;

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	fbi->regbase = devm_ioremap_resource(&pdev->dev, res);
	if (IS_ERR(fbi->regbase))
		return PTR_ERR(fbi->regbase);

	disp_timing = of_get_display_timings(pdev->dev.of_node);
	if (!disp_timing)
		return -EINVAL;

	ret = of_get_fb_videomode(pdev->dev.of_node, &mode, OF_USE_NATIVE_MODE);
	if (ret)
		return ret;

	ret = of_property_read_u32(pdev->dev.of_node, "bits-per-pixel", &bpp);
	if (ret)
		return ret;

	fb_videomode_to_var(&fbi->fb.var, &mode);

	fbi->fb.var.nonstd		= 0;
	fbi->fb.var.activate		= FB_ACTIVATE_NOW;

	fbi->fb.var.height		= -1;
	fbi->fb.var.width		= -1;

	/* try allocating the framebuffer */
	fb_mem_len = mode.xres * mode.yres * 2 * (bpp / 8);
	fb_mem_virt = dmam_alloc_coherent(&pdev->dev, fb_mem_len, &fb_mem_phys,
				GFP_KERNEL);
	if (!fb_mem_virt) {
		pr_err("%s: Failed to allocate framebuffer\n", __func__);
		return -ENOMEM;
	}

	fbi->fb.var.xres_virtual	= mode.xres;
	fbi->fb.var.yres_virtual	= mode.yres * 2;
	fbi->fb.var.bits_per_pixel	= bpp;

	fbi->fb.fix.smem_start		= fb_mem_phys;
	fbi->fb.fix.smem_len		= fb_mem_len;
	fbi->fb.screen_base		= fb_mem_virt;
	fbi->fb.screen_size		= fb_mem_len;

	fbi->contrast = 0x10;
	ret = wm8505fb_set_par(&fbi->fb);
	if (ret) {
		dev_err(&pdev->dev, "Failed to set parameters\n");
		return ret;
	}

	if (fb_alloc_cmap(&fbi->fb.cmap, 256, 0) < 0) {
		dev_err(&pdev->dev, "Failed to allocate color map\n");
		return -ENOMEM;
	}

	wm8505fb_init_hw(&fbi->fb);

	platform_set_drvdata(pdev, fbi);

	ret = register_framebuffer(&fbi->fb);
	if (ret < 0) {
		dev_err(&pdev->dev,
			"Failed to register framebuffer device: %d\n", ret);
		if (fbi->fb.cmap.len)
			fb_dealloc_cmap(&fbi->fb.cmap);
		return ret;
	}

	ret = device_create_file(&pdev->dev, &dev_attr_contrast);
	if (ret < 0) {
		printk(KERN_WARNING "fb%d: failed to register attributes (%d)\n",
			fbi->fb.node, ret);
	}

	printk(KERN_INFO "fb%d: %s frame buffer at 0x%lx-0x%lx\n",
	       fbi->fb.node, fbi->fb.fix.id, fbi->fb.fix.smem_start,
	       fbi->fb.fix.smem_start + fbi->fb.fix.smem_len - 1);

	return 0;
}

static int wm8505fb_remove(struct platform_device *pdev)
{
	struct wm8505fb_info *fbi = platform_get_drvdata(pdev);

	device_remove_file(&pdev->dev, &dev_attr_contrast);

	unregister_framebuffer(&fbi->fb);

	writel(0, fbi->regbase);

	if (fbi->fb.cmap.len)
		fb_dealloc_cmap(&fbi->fb.cmap);

	return 0;
}

static const struct of_device_id wmt_dt_ids[] = {
	{ .compatible = "wm,wm8505-fb", },
	{}
};

static struct platform_driver wm8505fb_driver = {
	.probe		= wm8505fb_probe,
	.remove		= wm8505fb_remove,
	.driver		= {
		.owner	= THIS_MODULE,
		.name	= DRIVER_NAME,
		.of_match_table = of_match_ptr(wmt_dt_ids),
	},
};

module_platform_driver(wm8505fb_driver);

MODULE_AUTHOR("Ed Spiridonov <edo.rus@gmail.com>");
MODULE_DESCRIPTION("Framebuffer driver for WMT WM8505");
MODULE_LICENSE("GPL v2");
MODULE_DEVICE_TABLE(of, wmt_dt_ids);
Commit	Line	Data
d6ff7d0f AC	1	/*
	2	* WonderMedia WM8505 Frame Buffer device driver
	3	*
	4	* Copyright (C) 2010 Ed Spiridonov <edo.rus@gmail.com>
	5	* Based on vt8500lcdfb.c
	6	*
	7	* This software is licensed under the terms of the GNU General Public
	8	* License version 2, as published by the Free Software Foundation, and
	9	* may be copied, distributed, and modified under those terms.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*/
	16
d6ff7d0f	17	#include <linux/delay.h>
7ab0a484	18	#include <linux/dma-mapping.h>
d6ff7d0f	19	#include <linux/fb.h>
7ab0a484	20	#include <linux/errno.h>
8e524c95	21	#include <linux/err.h>
d6ff7d0f AC	22	#include <linux/init.h>
	23	#include <linux/interrupt.h>
	24	#include <linux/io.h>
7ab0a484 TP	25	#include <linux/kernel.h>
	26	#include <linux/memblock.h>
	27	#include <linux/mm.h>
	28	#include <linux/module.h>
e7b99537 TP	29	#include <linux/of.h>
e7b99537 TP	30	#include <linux/of_fdt.h>
7ab0a484 TP	31	#include <linux/platform_device.h>
	32	#include <linux/slab.h>
	33	#include <linux/string.h>
	34	#include <linux/wait.h>
	35	#include <video/of_display_timing.h>
d6ff7d0f	36
d6ff7d0f AC	37	#include "wm8505fb_regs.h"
	38	#include "wmt_ge_rops.h"
	39
	40	#define DRIVER_NAME "wm8505-fb"
	41
	42	#define to_wm8505fb_info(__info) container_of(__info, \
	43	struct wm8505fb_info, fb)
	44	struct wm8505fb_info {
	45	struct fb_info fb;
	46	void __iomem *regbase;
	47	unsigned int contrast;
	48	};
	49
	50
	51	static int wm8505fb_init_hw(struct fb_info *info)
	52	{
	53	struct wm8505fb_info *fbi = to_wm8505fb_info(info);
	54
	55	int i;
	56
	57	/* I know the purpose only of few registers, so clear unknown */
	58	for (i = 0; i < 0x200; i += 4)
	59	writel(0, fbi->regbase + i);
	60
	61	/* Set frame buffer address */
	62	writel(fbi->fb.fix.smem_start, fbi->regbase + WMT_GOVR_FBADDR);
	63	writel(fbi->fb.fix.smem_start, fbi->regbase + WMT_GOVR_FBADDR1);
	64
e7b99537 TP	65	/*
	66	* Set in-memory picture format to RGB
	67	* 0x31C sets the correct color mode (RGB565) for WM8650
	68	* Bit 8+9 (0x300) are ignored on WM8505 as reserved
	69	*/
	70	writel(0x31c, fbi->regbase + WMT_GOVR_COLORSPACE);
d6ff7d0f AC	71	writel(1, fbi->regbase + WMT_GOVR_COLORSPACE1);
	72
	73	/* Virtual buffer size */
	74	writel(info->var.xres, fbi->regbase + WMT_GOVR_XRES);
	75	writel(info->var.xres_virtual, fbi->regbase + WMT_GOVR_XRES_VIRTUAL);
	76
	77	/* black magic ;) */
	78	writel(0xf, fbi->regbase + WMT_GOVR_FHI);
	79	writel(4, fbi->regbase + WMT_GOVR_DVO_SET);
	80	writel(1, fbi->regbase + WMT_GOVR_MIF_ENABLE);
	81	writel(1, fbi->regbase + WMT_GOVR_REG_UPDATE);
	82
	83	return 0;
	84	}
	85
	86	static int wm8505fb_set_timing(struct fb_info *info)
	87	{
	88	struct wm8505fb_info *fbi = to_wm8505fb_info(info);
	89
	90	int h_start = info->var.left_margin;
	91	int h_end = h_start + info->var.xres;
	92	int h_all = h_end + info->var.right_margin;
	93	int h_sync = info->var.hsync_len;
	94
	95	int v_start = info->var.upper_margin;
	96	int v_end = v_start + info->var.yres;
	97	int v_all = v_end + info->var.lower_margin;
623eb156	98	int v_sync = info->var.vsync_len;
d6ff7d0f AC	99
	100	writel(0, fbi->regbase + WMT_GOVR_TG);
	101
	102	writel(h_start, fbi->regbase + WMT_GOVR_TIMING_H_START);
	103	writel(h_end, fbi->regbase + WMT_GOVR_TIMING_H_END);
	104	writel(h_all, fbi->regbase + WMT_GOVR_TIMING_H_ALL);
	105	writel(h_sync, fbi->regbase + WMT_GOVR_TIMING_H_SYNC);
	106
	107	writel(v_start, fbi->regbase + WMT_GOVR_TIMING_V_START);
	108	writel(v_end, fbi->regbase + WMT_GOVR_TIMING_V_END);
	109	writel(v_all, fbi->regbase + WMT_GOVR_TIMING_V_ALL);
	110	writel(v_sync, fbi->regbase + WMT_GOVR_TIMING_V_SYNC);
	111
	112	writel(1, fbi->regbase + WMT_GOVR_TG);
	113
	114	return 0;
	115	}
	116
	117
	118	static int wm8505fb_set_par(struct fb_info *info)
	119	{
	120	struct wm8505fb_info *fbi = to_wm8505fb_info(info);
	121
	122	if (!fbi)
	123	return -EINVAL;
	124
	125	if (info->var.bits_per_pixel == 32) {
	126	info->var.red.offset = 16;
	127	info->var.red.length = 8;
	128	info->var.red.msb_right = 0;
	129	info->var.green.offset = 8;
	130	info->var.green.length = 8;
	131	info->var.green.msb_right = 0;
	132	info->var.blue.offset = 0;
	133	info->var.blue.length = 8;
	134	info->var.blue.msb_right = 0;
	135	info->fix.visual = FB_VISUAL_TRUECOLOR;
	136	info->fix.line_length = info->var.xres_virtual << 2;
e7b99537 TP	137	} else if (info->var.bits_per_pixel == 16) {
	138	info->var.red.offset = 11;
	139	info->var.red.length = 5;
	140	info->var.red.msb_right = 0;
	141	info->var.green.offset = 5;
	142	info->var.green.length = 6;
	143	info->var.green.msb_right = 0;
	144	info->var.blue.offset = 0;
	145	info->var.blue.length = 5;
	146	info->var.blue.msb_right = 0;
	147	info->fix.visual = FB_VISUAL_TRUECOLOR;
	148	info->fix.line_length = info->var.xres_virtual << 1;
d6ff7d0f AC	149	}
	150
	151	wm8505fb_set_timing(info);
	152
	153	writel(fbi->contrast<<16 \| fbi->contrast<<8 \| fbi->contrast,
	154	fbi->regbase + WMT_GOVR_CONTRAST);
	155
	156	return 0;
	157	}
	158
	159	static ssize_t contrast_show(struct device *dev,
	160	struct device_attribute attr, char buf)
	161	{
	162	struct fb_info *info = dev_get_drvdata(dev);
	163	struct wm8505fb_info *fbi = to_wm8505fb_info(info);
	164
	165	return sprintf(buf, "%d\n", fbi->contrast);
	166	}
	167
	168	static ssize_t contrast_store(struct device *dev,
	169	struct device_attribute *attr,
	170	const char *buf, size_t count)
	171	{
	172	struct fb_info *info = dev_get_drvdata(dev);
	173	struct wm8505fb_info *fbi = to_wm8505fb_info(info);
	174	unsigned long tmp;
	175
	176	if (strict_strtoul(buf, 10, &tmp) \|\| (tmp > 0xff))
	177	return -EINVAL;
	178	fbi->contrast = tmp;
	179
	180	wm8505fb_set_par(info);
	181
	182	return count;
	183	}
	184
	185	static DEVICE_ATTR(contrast, 0644, contrast_show, contrast_store);
	186
	187	static inline u_int chan_to_field(u_int chan, struct fb_bitfield *bf)
	188	{
	189	chan &= 0xffff;
	190	chan >>= 16 - bf->length;
	191	return chan << bf->offset;
	192	}
	193
	194	static int wm8505fb_setcolreg(unsigned regno, unsigned red, unsigned green,
	195	unsigned blue, unsigned transp,
	196	struct fb_info *info) {
	197	struct wm8505fb_info *fbi = to_wm8505fb_info(info);
	198	int ret = 1;
	199	unsigned int val;
	200	if (regno >= 256)
	201	return -EINVAL;
	202
	203	if (info->var.grayscale)
	204	red = green = blue =
	205	(19595 * red + 38470 * green + 7471 * blue) >> 16;
	206
	207	switch (fbi->fb.fix.visual) {
	208	case FB_VISUAL_TRUECOLOR:
	209	if (regno < 16) {
	210	u32 *pal = info->pseudo_palette;
	211
	212	val = chan_to_field(red, &fbi->fb.var.red);
213	val \|= chan_to_field(green, &fbi->fb.var.green);
214	val \|= chan_to_field(blue, &fbi->fb.var.blue);
215
216	pal[regno] = val;
217	ret = 0;
218	}
219	break;
220	}
221
222	return ret;
223	}
224
225	static int wm8505fb_pan_display(struct fb_var_screeninfo *var,
226	struct fb_info *info)
227	{
228	struct wm8505fb_info *fbi = to_wm8505fb_info(info);
229
230	writel(var->xoffset, fbi->regbase + WMT_GOVR_XPAN);
231	writel(var->yoffset, fbi->regbase + WMT_GOVR_YPAN);
232	return 0;
233	}
234
235	static int wm8505fb_blank(int blank, struct fb_info *info)
236	{
237	struct wm8505fb_info *fbi = to_wm8505fb_info(info);
238
239	switch (blank) {
240	case FB_BLANK_UNBLANK:
241	wm8505fb_set_timing(info);
242	break;
243	default:
244	writel(0, fbi->regbase + WMT_GOVR_TIMING_V_SYNC);
245	break;
246	}
247
248	return 0;
249	}
250
251	static struct fb_ops wm8505fb_ops = {
252	.owner = THIS_MODULE,
253	.fb_set_par = wm8505fb_set_par,
254	.fb_setcolreg = wm8505fb_setcolreg,
255	.fb_fillrect = wmt_ge_fillrect,
256	.fb_copyarea = wmt_ge_copyarea,
257	.fb_imageblit = sys_imageblit,
258	.fb_sync = wmt_ge_sync,
259	.fb_pan_display = wm8505fb_pan_display,
260	.fb_blank = wm8505fb_blank,
261	};
262
48c68c4f	263	static int wm8505fb_probe(struct platform_device *pdev)
d6ff7d0f AC	264	{
d6ff7d0f AC	265	struct wm8505fb_info *fbi;
7ab0a484 TP	266	struct resource *res;
7ab0a484 TP	267	struct display_timings *disp_timing;
d6ff7d0f	268	void *addr;
d6ff7d0f AC	269	int ret;
d6ff7d0f AC	270
7ab0a484	271	struct fb_videomode mode;
e7b99537 TP	272	u32 bpp;
	273	dma_addr_t fb_mem_phys;
	274	unsigned long fb_mem_len;
	275	void *fb_mem_virt;
d6ff7d0f	276
e7b99537 TP	277	fbi = devm_kzalloc(&pdev->dev, sizeof(struct wm8505fb_info) +
e7b99537 TP	278	sizeof(u32) * 16, GFP_KERNEL);
d6ff7d0f AC	279	if (!fbi) {
d6ff7d0f AC	280	dev_err(&pdev->dev, "Failed to initialize framebuffer device\n");
9e340fdc	281	return -ENOMEM;
d6ff7d0f AC	282	}
	283
	284	strcpy(fbi->fb.fix.id, DRIVER_NAME);
	285
	286	fbi->fb.fix.type = FB_TYPE_PACKED_PIXELS;
	287	fbi->fb.fix.xpanstep = 1;
	288	fbi->fb.fix.ypanstep = 1;
	289	fbi->fb.fix.ywrapstep = 0;
	290	fbi->fb.fix.accel = FB_ACCEL_NONE;
	291
	292	fbi->fb.fbops = &wm8505fb_ops;
	293	fbi->fb.flags = FBINFO_DEFAULT
	294	\| FBINFO_HWACCEL_COPYAREA
	295	\| FBINFO_HWACCEL_FILLRECT
	296	\| FBINFO_HWACCEL_XPAN
	297	\| FBINFO_HWACCEL_YPAN
	298	\| FBINFO_VIRTFB
	299	\| FBINFO_PARTIAL_PAN_OK;
	300	fbi->fb.node = -1;
	301
	302	addr = fbi;
	303	addr = addr + sizeof(struct wm8505fb_info);
	304	fbi->fb.pseudo_palette = addr;
	305
	306	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
8e524c95 SK	307	fbi->regbase = devm_ioremap_resource(&pdev->dev, res);
	308	if (IS_ERR(fbi->regbase))
	309	return PTR_ERR(fbi->regbase);
d6ff7d0f	310
7ab0a484 TP	311	disp_timing = of_get_display_timings(pdev->dev.of_node);
7ab0a484 TP	312	if (!disp_timing)
9e340fdc	313	return -EINVAL;
e7b99537	314
7ab0a484 TP	315	ret = of_get_fb_videomode(pdev->dev.of_node, &mode, OF_USE_NATIVE_MODE);
	316	if (ret)
	317	return ret;
	318
	319	ret = of_property_read_u32(pdev->dev.of_node, "bits-per-pixel", &bpp);
	320	if (ret)
	321	return ret;
e7b99537	322
7ab0a484	323	fb_videomode_to_var(&fbi->fb.var, &mode);
d6ff7d0f AC	324
	325	fbi->fb.var.nonstd = 0;
	326	fbi->fb.var.activate = FB_ACTIVATE_NOW;
	327
	328	fbi->fb.var.height = -1;
	329	fbi->fb.var.width = -1;
d6ff7d0f	330
e7b99537	331	/* try allocating the framebuffer */
7ab0a484	332	fb_mem_len = mode.xres * mode.yres * 2 * (bpp / 8);
9e340fdc	333	fb_mem_virt = dmam_alloc_coherent(&pdev->dev, fb_mem_len, &fb_mem_phys,
e7b99537 TP	334	GFP_KERNEL);
	335	if (!fb_mem_virt) {
	336	pr_err("%s: Failed to allocate framebuffer\n", __func__);
	337	return -ENOMEM;
9e340fdc	338	}
e7b99537	339
7ab0a484 TP	340	fbi->fb.var.xres_virtual = mode.xres;
7ab0a484 TP	341	fbi->fb.var.yres_virtual = mode.yres * 2;
e7b99537 TP	342	fbi->fb.var.bits_per_pixel = bpp;
	343
	344	fbi->fb.fix.smem_start = fb_mem_phys;
	345	fbi->fb.fix.smem_len = fb_mem_len;
	346	fbi->fb.screen_base = fb_mem_virt;
	347	fbi->fb.screen_size = fb_mem_len;
d6ff7d0f	348
de68efce	349	fbi->contrast = 0x10;
d6ff7d0f AC	350	ret = wm8505fb_set_par(&fbi->fb);
	351	if (ret) {
	352	dev_err(&pdev->dev, "Failed to set parameters\n");
9e340fdc	353	return ret;
d6ff7d0f AC	354	}
d6ff7d0f AC	355
9e340fdc JL	356	if (fb_alloc_cmap(&fbi->fb.cmap, 256, 0) < 0) {
	357	dev_err(&pdev->dev, "Failed to allocate color map\n");
	358	return -ENOMEM;
	359	}
	360
	361	wm8505fb_init_hw(&fbi->fb);
	362
d6ff7d0f AC	363	platform_set_drvdata(pdev, fbi);
	364
	365	ret = register_framebuffer(&fbi->fb);
	366	if (ret < 0) {
	367	dev_err(&pdev->dev,
	368	"Failed to register framebuffer device: %d\n", ret);
9e340fdc JL	369	if (fbi->fb.cmap.len)
	370	fb_dealloc_cmap(&fbi->fb.cmap);
	371	return ret;
d6ff7d0f AC	372	}
	373
	374	ret = device_create_file(&pdev->dev, &dev_attr_contrast);
	375	if (ret < 0) {
	376	printk(KERN_WARNING "fb%d: failed to register attributes (%d)\n",
	377	fbi->fb.node, ret);
	378	}
	379
	380	printk(KERN_INFO "fb%d: %s frame buffer at 0x%lx-0x%lx\n",
	381	fbi->fb.node, fbi->fb.fix.id, fbi->fb.fix.smem_start,
	382	fbi->fb.fix.smem_start + fbi->fb.fix.smem_len - 1);
	383
	384	return 0;
d6ff7d0f AC	385	}
d6ff7d0f AC	386
48c68c4f	387	static int wm8505fb_remove(struct platform_device *pdev)
d6ff7d0f AC	388	{
d6ff7d0f AC	389	struct wm8505fb_info *fbi = platform_get_drvdata(pdev);
d6ff7d0f AC	390
	391	device_remove_file(&pdev->dev, &dev_attr_contrast);
	392
	393	unregister_framebuffer(&fbi->fb);
	394
	395	writel(0, fbi->regbase);
	396
	397	if (fbi->fb.cmap.len)
	398	fb_dealloc_cmap(&fbi->fb.cmap);
	399
d6ff7d0f AC	400	return 0;
	401	}
	402
e7b99537 TP	403	static const struct of_device_id wmt_dt_ids[] = {
	404	{ .compatible = "wm,wm8505-fb", },
	405	{}
	406	};
	407
d6ff7d0f AC	408	static struct platform_driver wm8505fb_driver = {
d6ff7d0f AC	409	.probe = wm8505fb_probe,
48c68c4f	410	.remove = wm8505fb_remove,
d6ff7d0f AC	411	.driver = {
	412	.owner = THIS_MODULE,
	413	.name = DRIVER_NAME,
e7b99537	414	.of_match_table = of_match_ptr(wmt_dt_ids),
d6ff7d0f AC	415	},
	416	};
	417
4277f2c4	418	module_platform_driver(wm8505fb_driver);
d6ff7d0f AC	419
	420	MODULE_AUTHOR("Ed Spiridonov <edo.rus@gmail.com>");
	421	MODULE_DESCRIPTION("Framebuffer driver for WMT WM8505");
e7b99537 TP	422	MODULE_LICENSE("GPL v2");
e7b99537 TP	423	MODULE_DEVICE_TABLE(of, wmt_dt_ids);