18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci/* tcx.c: TCX frame buffer driver
38c2ecf20Sopenharmony_ci *
48c2ecf20Sopenharmony_ci * Copyright (C) 2003, 2006 David S. Miller (davem@davemloft.net)
58c2ecf20Sopenharmony_ci * Copyright (C) 1996,1998 Jakub Jelinek (jj@ultra.linux.cz)
68c2ecf20Sopenharmony_ci * Copyright (C) 1996 Miguel de Icaza (miguel@nuclecu.unam.mx)
78c2ecf20Sopenharmony_ci * Copyright (C) 1996 Eddie C. Dost (ecd@skynet.be)
88c2ecf20Sopenharmony_ci *
98c2ecf20Sopenharmony_ci * Driver layout based loosely on tgafb.c, see that file for credits.
108c2ecf20Sopenharmony_ci */
118c2ecf20Sopenharmony_ci
128c2ecf20Sopenharmony_ci#include <linux/module.h>
138c2ecf20Sopenharmony_ci#include <linux/kernel.h>
148c2ecf20Sopenharmony_ci#include <linux/errno.h>
158c2ecf20Sopenharmony_ci#include <linux/string.h>
168c2ecf20Sopenharmony_ci#include <linux/delay.h>
178c2ecf20Sopenharmony_ci#include <linux/init.h>
188c2ecf20Sopenharmony_ci#include <linux/fb.h>
198c2ecf20Sopenharmony_ci#include <linux/mm.h>
208c2ecf20Sopenharmony_ci#include <linux/of_device.h>
218c2ecf20Sopenharmony_ci
228c2ecf20Sopenharmony_ci#include <asm/io.h>
238c2ecf20Sopenharmony_ci#include <asm/fbio.h>
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_ci#include "sbuslib.h"
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_ci/*
288c2ecf20Sopenharmony_ci * Local functions.
298c2ecf20Sopenharmony_ci */
308c2ecf20Sopenharmony_ci
318c2ecf20Sopenharmony_cistatic int tcx_setcolreg(unsigned, unsigned, unsigned, unsigned,
328c2ecf20Sopenharmony_ci			 unsigned, struct fb_info *);
338c2ecf20Sopenharmony_cistatic int tcx_blank(int, struct fb_info *);
348c2ecf20Sopenharmony_ci
358c2ecf20Sopenharmony_cistatic int tcx_mmap(struct fb_info *, struct vm_area_struct *);
368c2ecf20Sopenharmony_cistatic int tcx_ioctl(struct fb_info *, unsigned int, unsigned long);
378c2ecf20Sopenharmony_cistatic int tcx_pan_display(struct fb_var_screeninfo *, struct fb_info *);
388c2ecf20Sopenharmony_ci
398c2ecf20Sopenharmony_ci/*
408c2ecf20Sopenharmony_ci *  Frame buffer operations
418c2ecf20Sopenharmony_ci */
428c2ecf20Sopenharmony_ci
438c2ecf20Sopenharmony_cistatic const struct fb_ops tcx_ops = {
448c2ecf20Sopenharmony_ci	.owner			= THIS_MODULE,
458c2ecf20Sopenharmony_ci	.fb_setcolreg		= tcx_setcolreg,
468c2ecf20Sopenharmony_ci	.fb_blank		= tcx_blank,
478c2ecf20Sopenharmony_ci	.fb_pan_display		= tcx_pan_display,
488c2ecf20Sopenharmony_ci	.fb_fillrect		= cfb_fillrect,
498c2ecf20Sopenharmony_ci	.fb_copyarea		= cfb_copyarea,
508c2ecf20Sopenharmony_ci	.fb_imageblit		= cfb_imageblit,
518c2ecf20Sopenharmony_ci	.fb_mmap		= tcx_mmap,
528c2ecf20Sopenharmony_ci	.fb_ioctl		= tcx_ioctl,
538c2ecf20Sopenharmony_ci#ifdef CONFIG_COMPAT
548c2ecf20Sopenharmony_ci	.fb_compat_ioctl	= sbusfb_compat_ioctl,
558c2ecf20Sopenharmony_ci#endif
568c2ecf20Sopenharmony_ci};
578c2ecf20Sopenharmony_ci
588c2ecf20Sopenharmony_ci/* THC definitions */
598c2ecf20Sopenharmony_ci#define TCX_THC_MISC_REV_SHIFT       16
608c2ecf20Sopenharmony_ci#define TCX_THC_MISC_REV_MASK        15
618c2ecf20Sopenharmony_ci#define TCX_THC_MISC_VSYNC_DIS       (1 << 25)
628c2ecf20Sopenharmony_ci#define TCX_THC_MISC_HSYNC_DIS       (1 << 24)
638c2ecf20Sopenharmony_ci#define TCX_THC_MISC_RESET           (1 << 12)
648c2ecf20Sopenharmony_ci#define TCX_THC_MISC_VIDEO           (1 << 10)
658c2ecf20Sopenharmony_ci#define TCX_THC_MISC_SYNC            (1 << 9)
668c2ecf20Sopenharmony_ci#define TCX_THC_MISC_VSYNC           (1 << 8)
678c2ecf20Sopenharmony_ci#define TCX_THC_MISC_SYNC_ENAB       (1 << 7)
688c2ecf20Sopenharmony_ci#define TCX_THC_MISC_CURS_RES        (1 << 6)
698c2ecf20Sopenharmony_ci#define TCX_THC_MISC_INT_ENAB        (1 << 5)
708c2ecf20Sopenharmony_ci#define TCX_THC_MISC_INT             (1 << 4)
718c2ecf20Sopenharmony_ci#define TCX_THC_MISC_INIT            0x9f
728c2ecf20Sopenharmony_ci#define TCX_THC_REV_REV_SHIFT        20
738c2ecf20Sopenharmony_ci#define TCX_THC_REV_REV_MASK         15
748c2ecf20Sopenharmony_ci#define TCX_THC_REV_MINREV_SHIFT     28
758c2ecf20Sopenharmony_ci#define TCX_THC_REV_MINREV_MASK      15
768c2ecf20Sopenharmony_ci
778c2ecf20Sopenharmony_ci/* The contents are unknown */
788c2ecf20Sopenharmony_cistruct tcx_tec {
798c2ecf20Sopenharmony_ci	u32 tec_matrix;
808c2ecf20Sopenharmony_ci	u32 tec_clip;
818c2ecf20Sopenharmony_ci	u32 tec_vdc;
828c2ecf20Sopenharmony_ci};
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_cistruct tcx_thc {
858c2ecf20Sopenharmony_ci	u32 thc_rev;
868c2ecf20Sopenharmony_ci	u32 thc_pad0[511];
878c2ecf20Sopenharmony_ci	u32 thc_hs;		/* hsync timing */
888c2ecf20Sopenharmony_ci	u32 thc_hsdvs;
898c2ecf20Sopenharmony_ci	u32 thc_hd;
908c2ecf20Sopenharmony_ci	u32 thc_vs;		/* vsync timing */
918c2ecf20Sopenharmony_ci	u32 thc_vd;
928c2ecf20Sopenharmony_ci	u32 thc_refresh;
938c2ecf20Sopenharmony_ci	u32 thc_misc;
948c2ecf20Sopenharmony_ci	u32 thc_pad1[56];
958c2ecf20Sopenharmony_ci	u32 thc_cursxy;	/* cursor x,y position (16 bits each) */
968c2ecf20Sopenharmony_ci	u32 thc_cursmask[32];	/* cursor mask bits */
978c2ecf20Sopenharmony_ci	u32 thc_cursbits[32];	/* what to show where mask enabled */
988c2ecf20Sopenharmony_ci};
998c2ecf20Sopenharmony_ci
1008c2ecf20Sopenharmony_cistruct bt_regs {
1018c2ecf20Sopenharmony_ci	u32 addr;
1028c2ecf20Sopenharmony_ci	u32 color_map;
1038c2ecf20Sopenharmony_ci	u32 control;
1048c2ecf20Sopenharmony_ci	u32 cursor;
1058c2ecf20Sopenharmony_ci};
1068c2ecf20Sopenharmony_ci
1078c2ecf20Sopenharmony_ci#define TCX_MMAP_ENTRIES 14
1088c2ecf20Sopenharmony_ci
1098c2ecf20Sopenharmony_cistruct tcx_par {
1108c2ecf20Sopenharmony_ci	spinlock_t		lock;
1118c2ecf20Sopenharmony_ci	struct bt_regs		__iomem *bt;
1128c2ecf20Sopenharmony_ci	struct tcx_thc		__iomem *thc;
1138c2ecf20Sopenharmony_ci	struct tcx_tec		__iomem *tec;
1148c2ecf20Sopenharmony_ci	u32			__iomem *cplane;
1158c2ecf20Sopenharmony_ci
1168c2ecf20Sopenharmony_ci	u32			flags;
1178c2ecf20Sopenharmony_ci#define TCX_FLAG_BLANKED	0x00000001
1188c2ecf20Sopenharmony_ci
1198c2ecf20Sopenharmony_ci	unsigned long		which_io;
1208c2ecf20Sopenharmony_ci
1218c2ecf20Sopenharmony_ci	struct sbus_mmap_map	mmap_map[TCX_MMAP_ENTRIES];
1228c2ecf20Sopenharmony_ci	int			lowdepth;
1238c2ecf20Sopenharmony_ci};
1248c2ecf20Sopenharmony_ci
1258c2ecf20Sopenharmony_ci/* Reset control plane so that WID is 8-bit plane. */
1268c2ecf20Sopenharmony_cistatic void __tcx_set_control_plane(struct fb_info *info)
1278c2ecf20Sopenharmony_ci{
1288c2ecf20Sopenharmony_ci	struct tcx_par *par = info->par;
1298c2ecf20Sopenharmony_ci	u32 __iomem *p, *pend;
1308c2ecf20Sopenharmony_ci
1318c2ecf20Sopenharmony_ci	if (par->lowdepth)
1328c2ecf20Sopenharmony_ci		return;
1338c2ecf20Sopenharmony_ci
1348c2ecf20Sopenharmony_ci	p = par->cplane;
1358c2ecf20Sopenharmony_ci	if (p == NULL)
1368c2ecf20Sopenharmony_ci		return;
1378c2ecf20Sopenharmony_ci	for (pend = p + info->fix.smem_len; p < pend; p++) {
1388c2ecf20Sopenharmony_ci		u32 tmp = sbus_readl(p);
1398c2ecf20Sopenharmony_ci
1408c2ecf20Sopenharmony_ci		tmp &= 0xffffff;
1418c2ecf20Sopenharmony_ci		sbus_writel(tmp, p);
1428c2ecf20Sopenharmony_ci	}
1438c2ecf20Sopenharmony_ci}
1448c2ecf20Sopenharmony_ci
1458c2ecf20Sopenharmony_cistatic void tcx_reset(struct fb_info *info)
1468c2ecf20Sopenharmony_ci{
1478c2ecf20Sopenharmony_ci	struct tcx_par *par = (struct tcx_par *) info->par;
1488c2ecf20Sopenharmony_ci	unsigned long flags;
1498c2ecf20Sopenharmony_ci
1508c2ecf20Sopenharmony_ci	spin_lock_irqsave(&par->lock, flags);
1518c2ecf20Sopenharmony_ci	__tcx_set_control_plane(info);
1528c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&par->lock, flags);
1538c2ecf20Sopenharmony_ci}
1548c2ecf20Sopenharmony_ci
1558c2ecf20Sopenharmony_cistatic int tcx_pan_display(struct fb_var_screeninfo *var, struct fb_info *info)
1568c2ecf20Sopenharmony_ci{
1578c2ecf20Sopenharmony_ci	tcx_reset(info);
1588c2ecf20Sopenharmony_ci	return 0;
1598c2ecf20Sopenharmony_ci}
1608c2ecf20Sopenharmony_ci
1618c2ecf20Sopenharmony_ci/**
1628c2ecf20Sopenharmony_ci *      tcx_setcolreg - Optional function. Sets a color register.
1638c2ecf20Sopenharmony_ci *      @regno: boolean, 0 copy local, 1 get_user() function
1648c2ecf20Sopenharmony_ci *      @red: frame buffer colormap structure
1658c2ecf20Sopenharmony_ci *      @green: The green value which can be up to 16 bits wide
1668c2ecf20Sopenharmony_ci *      @blue:  The blue value which can be up to 16 bits wide.
1678c2ecf20Sopenharmony_ci *      @transp: If supported the alpha value which can be up to 16 bits wide.
1688c2ecf20Sopenharmony_ci *      @info: frame buffer info structure
1698c2ecf20Sopenharmony_ci */
1708c2ecf20Sopenharmony_cistatic int tcx_setcolreg(unsigned regno,
1718c2ecf20Sopenharmony_ci			 unsigned red, unsigned green, unsigned blue,
1728c2ecf20Sopenharmony_ci			 unsigned transp, struct fb_info *info)
1738c2ecf20Sopenharmony_ci{
1748c2ecf20Sopenharmony_ci	struct tcx_par *par = (struct tcx_par *) info->par;
1758c2ecf20Sopenharmony_ci	struct bt_regs __iomem *bt = par->bt;
1768c2ecf20Sopenharmony_ci	unsigned long flags;
1778c2ecf20Sopenharmony_ci
1788c2ecf20Sopenharmony_ci	if (regno >= 256)
1798c2ecf20Sopenharmony_ci		return 1;
1808c2ecf20Sopenharmony_ci
1818c2ecf20Sopenharmony_ci	red >>= 8;
1828c2ecf20Sopenharmony_ci	green >>= 8;
1838c2ecf20Sopenharmony_ci	blue >>= 8;
1848c2ecf20Sopenharmony_ci
1858c2ecf20Sopenharmony_ci	spin_lock_irqsave(&par->lock, flags);
1868c2ecf20Sopenharmony_ci
1878c2ecf20Sopenharmony_ci	sbus_writel(regno << 24, &bt->addr);
1888c2ecf20Sopenharmony_ci	sbus_writel(red << 24, &bt->color_map);
1898c2ecf20Sopenharmony_ci	sbus_writel(green << 24, &bt->color_map);
1908c2ecf20Sopenharmony_ci	sbus_writel(blue << 24, &bt->color_map);
1918c2ecf20Sopenharmony_ci
1928c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&par->lock, flags);
1938c2ecf20Sopenharmony_ci
1948c2ecf20Sopenharmony_ci	return 0;
1958c2ecf20Sopenharmony_ci}
1968c2ecf20Sopenharmony_ci
1978c2ecf20Sopenharmony_ci/**
1988c2ecf20Sopenharmony_ci *      tcx_blank - Optional function.  Blanks the display.
1998c2ecf20Sopenharmony_ci *      @blank_mode: the blank mode we want.
2008c2ecf20Sopenharmony_ci *      @info: frame buffer structure that represents a single frame buffer
2018c2ecf20Sopenharmony_ci */
2028c2ecf20Sopenharmony_cistatic int
2038c2ecf20Sopenharmony_citcx_blank(int blank, struct fb_info *info)
2048c2ecf20Sopenharmony_ci{
2058c2ecf20Sopenharmony_ci	struct tcx_par *par = (struct tcx_par *) info->par;
2068c2ecf20Sopenharmony_ci	struct tcx_thc __iomem *thc = par->thc;
2078c2ecf20Sopenharmony_ci	unsigned long flags;
2088c2ecf20Sopenharmony_ci	u32 val;
2098c2ecf20Sopenharmony_ci
2108c2ecf20Sopenharmony_ci	spin_lock_irqsave(&par->lock, flags);
2118c2ecf20Sopenharmony_ci
2128c2ecf20Sopenharmony_ci	val = sbus_readl(&thc->thc_misc);
2138c2ecf20Sopenharmony_ci
2148c2ecf20Sopenharmony_ci	switch (blank) {
2158c2ecf20Sopenharmony_ci	case FB_BLANK_UNBLANK: /* Unblanking */
2168c2ecf20Sopenharmony_ci		val &= ~(TCX_THC_MISC_VSYNC_DIS |
2178c2ecf20Sopenharmony_ci			 TCX_THC_MISC_HSYNC_DIS);
2188c2ecf20Sopenharmony_ci		val |= TCX_THC_MISC_VIDEO;
2198c2ecf20Sopenharmony_ci		par->flags &= ~TCX_FLAG_BLANKED;
2208c2ecf20Sopenharmony_ci		break;
2218c2ecf20Sopenharmony_ci
2228c2ecf20Sopenharmony_ci	case FB_BLANK_NORMAL: /* Normal blanking */
2238c2ecf20Sopenharmony_ci		val &= ~TCX_THC_MISC_VIDEO;
2248c2ecf20Sopenharmony_ci		par->flags |= TCX_FLAG_BLANKED;
2258c2ecf20Sopenharmony_ci		break;
2268c2ecf20Sopenharmony_ci
2278c2ecf20Sopenharmony_ci	case FB_BLANK_VSYNC_SUSPEND: /* VESA blank (vsync off) */
2288c2ecf20Sopenharmony_ci		val |= TCX_THC_MISC_VSYNC_DIS;
2298c2ecf20Sopenharmony_ci		break;
2308c2ecf20Sopenharmony_ci	case FB_BLANK_HSYNC_SUSPEND: /* VESA blank (hsync off) */
2318c2ecf20Sopenharmony_ci		val |= TCX_THC_MISC_HSYNC_DIS;
2328c2ecf20Sopenharmony_ci		break;
2338c2ecf20Sopenharmony_ci
2348c2ecf20Sopenharmony_ci	case FB_BLANK_POWERDOWN: /* Poweroff */
2358c2ecf20Sopenharmony_ci		break;
2368c2ecf20Sopenharmony_ci	}
2378c2ecf20Sopenharmony_ci
2388c2ecf20Sopenharmony_ci	sbus_writel(val, &thc->thc_misc);
2398c2ecf20Sopenharmony_ci
2408c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&par->lock, flags);
2418c2ecf20Sopenharmony_ci
2428c2ecf20Sopenharmony_ci	return 0;
2438c2ecf20Sopenharmony_ci}
2448c2ecf20Sopenharmony_ci
2458c2ecf20Sopenharmony_cistatic struct sbus_mmap_map __tcx_mmap_map[TCX_MMAP_ENTRIES] = {
2468c2ecf20Sopenharmony_ci	{
2478c2ecf20Sopenharmony_ci		.voff	= TCX_RAM8BIT,
2488c2ecf20Sopenharmony_ci		.size	= SBUS_MMAP_FBSIZE(1)
2498c2ecf20Sopenharmony_ci	},
2508c2ecf20Sopenharmony_ci	{
2518c2ecf20Sopenharmony_ci		.voff	= TCX_RAM24BIT,
2528c2ecf20Sopenharmony_ci		.size	= SBUS_MMAP_FBSIZE(4)
2538c2ecf20Sopenharmony_ci	},
2548c2ecf20Sopenharmony_ci	{
2558c2ecf20Sopenharmony_ci		.voff	= TCX_UNK3,
2568c2ecf20Sopenharmony_ci		.size	= SBUS_MMAP_FBSIZE(8)
2578c2ecf20Sopenharmony_ci	},
2588c2ecf20Sopenharmony_ci	{
2598c2ecf20Sopenharmony_ci		.voff	= TCX_UNK4,
2608c2ecf20Sopenharmony_ci		.size	= SBUS_MMAP_FBSIZE(8)
2618c2ecf20Sopenharmony_ci	},
2628c2ecf20Sopenharmony_ci	{
2638c2ecf20Sopenharmony_ci		.voff	= TCX_CONTROLPLANE,
2648c2ecf20Sopenharmony_ci		.size	= SBUS_MMAP_FBSIZE(4)
2658c2ecf20Sopenharmony_ci	},
2668c2ecf20Sopenharmony_ci	{
2678c2ecf20Sopenharmony_ci		.voff	= TCX_UNK6,
2688c2ecf20Sopenharmony_ci		.size	= SBUS_MMAP_FBSIZE(8)
2698c2ecf20Sopenharmony_ci	},
2708c2ecf20Sopenharmony_ci	{
2718c2ecf20Sopenharmony_ci		.voff	= TCX_UNK7,
2728c2ecf20Sopenharmony_ci		.size	= SBUS_MMAP_FBSIZE(8)
2738c2ecf20Sopenharmony_ci	},
2748c2ecf20Sopenharmony_ci	{
2758c2ecf20Sopenharmony_ci		.voff	= TCX_TEC,
2768c2ecf20Sopenharmony_ci		.size	= PAGE_SIZE
2778c2ecf20Sopenharmony_ci	},
2788c2ecf20Sopenharmony_ci	{
2798c2ecf20Sopenharmony_ci		.voff	= TCX_BTREGS,
2808c2ecf20Sopenharmony_ci		.size	= PAGE_SIZE
2818c2ecf20Sopenharmony_ci	},
2828c2ecf20Sopenharmony_ci	{
2838c2ecf20Sopenharmony_ci		.voff	= TCX_THC,
2848c2ecf20Sopenharmony_ci		.size	= PAGE_SIZE
2858c2ecf20Sopenharmony_ci	},
2868c2ecf20Sopenharmony_ci	{
2878c2ecf20Sopenharmony_ci		.voff	= TCX_DHC,
2888c2ecf20Sopenharmony_ci		.size	= PAGE_SIZE
2898c2ecf20Sopenharmony_ci	},
2908c2ecf20Sopenharmony_ci	{
2918c2ecf20Sopenharmony_ci		.voff	= TCX_ALT,
2928c2ecf20Sopenharmony_ci		.size	= PAGE_SIZE
2938c2ecf20Sopenharmony_ci	},
2948c2ecf20Sopenharmony_ci	{
2958c2ecf20Sopenharmony_ci		.voff	= TCX_UNK2,
2968c2ecf20Sopenharmony_ci		.size	= 0x20000
2978c2ecf20Sopenharmony_ci	},
2988c2ecf20Sopenharmony_ci	{ .size = 0 }
2998c2ecf20Sopenharmony_ci};
3008c2ecf20Sopenharmony_ci
3018c2ecf20Sopenharmony_cistatic int tcx_mmap(struct fb_info *info, struct vm_area_struct *vma)
3028c2ecf20Sopenharmony_ci{
3038c2ecf20Sopenharmony_ci	struct tcx_par *par = (struct tcx_par *)info->par;
3048c2ecf20Sopenharmony_ci
3058c2ecf20Sopenharmony_ci	return sbusfb_mmap_helper(par->mmap_map,
3068c2ecf20Sopenharmony_ci				  info->fix.smem_start, info->fix.smem_len,
3078c2ecf20Sopenharmony_ci				  par->which_io, vma);
3088c2ecf20Sopenharmony_ci}
3098c2ecf20Sopenharmony_ci
3108c2ecf20Sopenharmony_cistatic int tcx_ioctl(struct fb_info *info, unsigned int cmd,
3118c2ecf20Sopenharmony_ci		     unsigned long arg)
3128c2ecf20Sopenharmony_ci{
3138c2ecf20Sopenharmony_ci	struct tcx_par *par = (struct tcx_par *) info->par;
3148c2ecf20Sopenharmony_ci
3158c2ecf20Sopenharmony_ci	return sbusfb_ioctl_helper(cmd, arg, info,
3168c2ecf20Sopenharmony_ci				   FBTYPE_TCXCOLOR,
3178c2ecf20Sopenharmony_ci				   (par->lowdepth ? 8 : 24),
3188c2ecf20Sopenharmony_ci				   info->fix.smem_len);
3198c2ecf20Sopenharmony_ci}
3208c2ecf20Sopenharmony_ci
3218c2ecf20Sopenharmony_ci/*
3228c2ecf20Sopenharmony_ci *  Initialisation
3238c2ecf20Sopenharmony_ci */
3248c2ecf20Sopenharmony_ci
3258c2ecf20Sopenharmony_cistatic void
3268c2ecf20Sopenharmony_citcx_init_fix(struct fb_info *info, int linebytes)
3278c2ecf20Sopenharmony_ci{
3288c2ecf20Sopenharmony_ci	struct tcx_par *par = (struct tcx_par *)info->par;
3298c2ecf20Sopenharmony_ci	const char *tcx_name;
3308c2ecf20Sopenharmony_ci
3318c2ecf20Sopenharmony_ci	if (par->lowdepth)
3328c2ecf20Sopenharmony_ci		tcx_name = "TCX8";
3338c2ecf20Sopenharmony_ci	else
3348c2ecf20Sopenharmony_ci		tcx_name = "TCX24";
3358c2ecf20Sopenharmony_ci
3368c2ecf20Sopenharmony_ci	strlcpy(info->fix.id, tcx_name, sizeof(info->fix.id));
3378c2ecf20Sopenharmony_ci
3388c2ecf20Sopenharmony_ci	info->fix.type = FB_TYPE_PACKED_PIXELS;
3398c2ecf20Sopenharmony_ci	info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
3408c2ecf20Sopenharmony_ci
3418c2ecf20Sopenharmony_ci	info->fix.line_length = linebytes;
3428c2ecf20Sopenharmony_ci
3438c2ecf20Sopenharmony_ci	info->fix.accel = FB_ACCEL_SUN_TCX;
3448c2ecf20Sopenharmony_ci}
3458c2ecf20Sopenharmony_ci
3468c2ecf20Sopenharmony_cistatic void tcx_unmap_regs(struct platform_device *op, struct fb_info *info,
3478c2ecf20Sopenharmony_ci			   struct tcx_par *par)
3488c2ecf20Sopenharmony_ci{
3498c2ecf20Sopenharmony_ci	if (par->tec)
3508c2ecf20Sopenharmony_ci		of_iounmap(&op->resource[7],
3518c2ecf20Sopenharmony_ci			   par->tec, sizeof(struct tcx_tec));
3528c2ecf20Sopenharmony_ci	if (par->thc)
3538c2ecf20Sopenharmony_ci		of_iounmap(&op->resource[9],
3548c2ecf20Sopenharmony_ci			   par->thc, sizeof(struct tcx_thc));
3558c2ecf20Sopenharmony_ci	if (par->bt)
3568c2ecf20Sopenharmony_ci		of_iounmap(&op->resource[8],
3578c2ecf20Sopenharmony_ci			   par->bt, sizeof(struct bt_regs));
3588c2ecf20Sopenharmony_ci	if (par->cplane)
3598c2ecf20Sopenharmony_ci		of_iounmap(&op->resource[4],
3608c2ecf20Sopenharmony_ci			   par->cplane, info->fix.smem_len * sizeof(u32));
3618c2ecf20Sopenharmony_ci	if (info->screen_base)
3628c2ecf20Sopenharmony_ci		of_iounmap(&op->resource[0],
3638c2ecf20Sopenharmony_ci			   info->screen_base, info->fix.smem_len);
3648c2ecf20Sopenharmony_ci}
3658c2ecf20Sopenharmony_ci
3668c2ecf20Sopenharmony_cistatic int tcx_probe(struct platform_device *op)
3678c2ecf20Sopenharmony_ci{
3688c2ecf20Sopenharmony_ci	struct device_node *dp = op->dev.of_node;
3698c2ecf20Sopenharmony_ci	struct fb_info *info;
3708c2ecf20Sopenharmony_ci	struct tcx_par *par;
3718c2ecf20Sopenharmony_ci	int linebytes, i, err;
3728c2ecf20Sopenharmony_ci
3738c2ecf20Sopenharmony_ci	info = framebuffer_alloc(sizeof(struct tcx_par), &op->dev);
3748c2ecf20Sopenharmony_ci
3758c2ecf20Sopenharmony_ci	err = -ENOMEM;
3768c2ecf20Sopenharmony_ci	if (!info)
3778c2ecf20Sopenharmony_ci		goto out_err;
3788c2ecf20Sopenharmony_ci	par = info->par;
3798c2ecf20Sopenharmony_ci
3808c2ecf20Sopenharmony_ci	spin_lock_init(&par->lock);
3818c2ecf20Sopenharmony_ci
3828c2ecf20Sopenharmony_ci	par->lowdepth =
3838c2ecf20Sopenharmony_ci		(of_find_property(dp, "tcx-8-bit", NULL) != NULL);
3848c2ecf20Sopenharmony_ci
3858c2ecf20Sopenharmony_ci	sbusfb_fill_var(&info->var, dp, 8);
3868c2ecf20Sopenharmony_ci	info->var.red.length = 8;
3878c2ecf20Sopenharmony_ci	info->var.green.length = 8;
3888c2ecf20Sopenharmony_ci	info->var.blue.length = 8;
3898c2ecf20Sopenharmony_ci
3908c2ecf20Sopenharmony_ci	linebytes = of_getintprop_default(dp, "linebytes",
3918c2ecf20Sopenharmony_ci					  info->var.xres);
3928c2ecf20Sopenharmony_ci	info->fix.smem_len = PAGE_ALIGN(linebytes * info->var.yres);
3938c2ecf20Sopenharmony_ci
3948c2ecf20Sopenharmony_ci	par->tec = of_ioremap(&op->resource[7], 0,
3958c2ecf20Sopenharmony_ci				  sizeof(struct tcx_tec), "tcx tec");
3968c2ecf20Sopenharmony_ci	par->thc = of_ioremap(&op->resource[9], 0,
3978c2ecf20Sopenharmony_ci				  sizeof(struct tcx_thc), "tcx thc");
3988c2ecf20Sopenharmony_ci	par->bt = of_ioremap(&op->resource[8], 0,
3998c2ecf20Sopenharmony_ci				 sizeof(struct bt_regs), "tcx dac");
4008c2ecf20Sopenharmony_ci	info->screen_base = of_ioremap(&op->resource[0], 0,
4018c2ecf20Sopenharmony_ci					   info->fix.smem_len, "tcx ram");
4028c2ecf20Sopenharmony_ci	if (!par->tec || !par->thc ||
4038c2ecf20Sopenharmony_ci	    !par->bt || !info->screen_base)
4048c2ecf20Sopenharmony_ci		goto out_unmap_regs;
4058c2ecf20Sopenharmony_ci
4068c2ecf20Sopenharmony_ci	memcpy(&par->mmap_map, &__tcx_mmap_map, sizeof(par->mmap_map));
4078c2ecf20Sopenharmony_ci	if (!par->lowdepth) {
4088c2ecf20Sopenharmony_ci		par->cplane = of_ioremap(&op->resource[4], 0,
4098c2ecf20Sopenharmony_ci					     info->fix.smem_len * sizeof(u32),
4108c2ecf20Sopenharmony_ci					     "tcx cplane");
4118c2ecf20Sopenharmony_ci		if (!par->cplane)
4128c2ecf20Sopenharmony_ci			goto out_unmap_regs;
4138c2ecf20Sopenharmony_ci	} else {
4148c2ecf20Sopenharmony_ci		par->mmap_map[1].size = SBUS_MMAP_EMPTY;
4158c2ecf20Sopenharmony_ci		par->mmap_map[4].size = SBUS_MMAP_EMPTY;
4168c2ecf20Sopenharmony_ci		par->mmap_map[5].size = SBUS_MMAP_EMPTY;
4178c2ecf20Sopenharmony_ci		par->mmap_map[6].size = SBUS_MMAP_EMPTY;
4188c2ecf20Sopenharmony_ci	}
4198c2ecf20Sopenharmony_ci
4208c2ecf20Sopenharmony_ci	info->fix.smem_start = op->resource[0].start;
4218c2ecf20Sopenharmony_ci	par->which_io = op->resource[0].flags & IORESOURCE_BITS;
4228c2ecf20Sopenharmony_ci
4238c2ecf20Sopenharmony_ci	for (i = 0; i < TCX_MMAP_ENTRIES; i++) {
4248c2ecf20Sopenharmony_ci		int j;
4258c2ecf20Sopenharmony_ci
4268c2ecf20Sopenharmony_ci		switch (i) {
4278c2ecf20Sopenharmony_ci		case 10:
4288c2ecf20Sopenharmony_ci			j = 12;
4298c2ecf20Sopenharmony_ci			break;
4308c2ecf20Sopenharmony_ci
4318c2ecf20Sopenharmony_ci		case 11: case 12:
4328c2ecf20Sopenharmony_ci			j = i - 1;
4338c2ecf20Sopenharmony_ci			break;
4348c2ecf20Sopenharmony_ci
4358c2ecf20Sopenharmony_ci		default:
4368c2ecf20Sopenharmony_ci			j = i;
4378c2ecf20Sopenharmony_ci			break;
4388c2ecf20Sopenharmony_ci		}
4398c2ecf20Sopenharmony_ci		par->mmap_map[i].poff = op->resource[j].start;
4408c2ecf20Sopenharmony_ci	}
4418c2ecf20Sopenharmony_ci
4428c2ecf20Sopenharmony_ci	info->flags = FBINFO_DEFAULT;
4438c2ecf20Sopenharmony_ci	info->fbops = &tcx_ops;
4448c2ecf20Sopenharmony_ci
4458c2ecf20Sopenharmony_ci	/* Initialize brooktree DAC. */
4468c2ecf20Sopenharmony_ci	sbus_writel(0x04 << 24, &par->bt->addr);         /* color planes */
4478c2ecf20Sopenharmony_ci	sbus_writel(0xff << 24, &par->bt->control);
4488c2ecf20Sopenharmony_ci	sbus_writel(0x05 << 24, &par->bt->addr);
4498c2ecf20Sopenharmony_ci	sbus_writel(0x00 << 24, &par->bt->control);
4508c2ecf20Sopenharmony_ci	sbus_writel(0x06 << 24, &par->bt->addr);         /* overlay plane */
4518c2ecf20Sopenharmony_ci	sbus_writel(0x73 << 24, &par->bt->control);
4528c2ecf20Sopenharmony_ci	sbus_writel(0x07 << 24, &par->bt->addr);
4538c2ecf20Sopenharmony_ci	sbus_writel(0x00 << 24, &par->bt->control);
4548c2ecf20Sopenharmony_ci
4558c2ecf20Sopenharmony_ci	tcx_reset(info);
4568c2ecf20Sopenharmony_ci
4578c2ecf20Sopenharmony_ci	tcx_blank(FB_BLANK_UNBLANK, info);
4588c2ecf20Sopenharmony_ci
4598c2ecf20Sopenharmony_ci	if (fb_alloc_cmap(&info->cmap, 256, 0))
4608c2ecf20Sopenharmony_ci		goto out_unmap_regs;
4618c2ecf20Sopenharmony_ci
4628c2ecf20Sopenharmony_ci	fb_set_cmap(&info->cmap, info);
4638c2ecf20Sopenharmony_ci	tcx_init_fix(info, linebytes);
4648c2ecf20Sopenharmony_ci
4658c2ecf20Sopenharmony_ci	err = register_framebuffer(info);
4668c2ecf20Sopenharmony_ci	if (err < 0)
4678c2ecf20Sopenharmony_ci		goto out_dealloc_cmap;
4688c2ecf20Sopenharmony_ci
4698c2ecf20Sopenharmony_ci	dev_set_drvdata(&op->dev, info);
4708c2ecf20Sopenharmony_ci
4718c2ecf20Sopenharmony_ci	printk(KERN_INFO "%pOF: TCX at %lx:%lx, %s\n",
4728c2ecf20Sopenharmony_ci	       dp,
4738c2ecf20Sopenharmony_ci	       par->which_io,
4748c2ecf20Sopenharmony_ci	       info->fix.smem_start,
4758c2ecf20Sopenharmony_ci	       par->lowdepth ? "8-bit only" : "24-bit depth");
4768c2ecf20Sopenharmony_ci
4778c2ecf20Sopenharmony_ci	return 0;
4788c2ecf20Sopenharmony_ci
4798c2ecf20Sopenharmony_ciout_dealloc_cmap:
4808c2ecf20Sopenharmony_ci	fb_dealloc_cmap(&info->cmap);
4818c2ecf20Sopenharmony_ci
4828c2ecf20Sopenharmony_ciout_unmap_regs:
4838c2ecf20Sopenharmony_ci	tcx_unmap_regs(op, info, par);
4848c2ecf20Sopenharmony_ci	framebuffer_release(info);
4858c2ecf20Sopenharmony_ci
4868c2ecf20Sopenharmony_ciout_err:
4878c2ecf20Sopenharmony_ci	return err;
4888c2ecf20Sopenharmony_ci}
4898c2ecf20Sopenharmony_ci
4908c2ecf20Sopenharmony_cistatic int tcx_remove(struct platform_device *op)
4918c2ecf20Sopenharmony_ci{
4928c2ecf20Sopenharmony_ci	struct fb_info *info = dev_get_drvdata(&op->dev);
4938c2ecf20Sopenharmony_ci	struct tcx_par *par = info->par;
4948c2ecf20Sopenharmony_ci
4958c2ecf20Sopenharmony_ci	unregister_framebuffer(info);
4968c2ecf20Sopenharmony_ci	fb_dealloc_cmap(&info->cmap);
4978c2ecf20Sopenharmony_ci
4988c2ecf20Sopenharmony_ci	tcx_unmap_regs(op, info, par);
4998c2ecf20Sopenharmony_ci
5008c2ecf20Sopenharmony_ci	framebuffer_release(info);
5018c2ecf20Sopenharmony_ci
5028c2ecf20Sopenharmony_ci	return 0;
5038c2ecf20Sopenharmony_ci}
5048c2ecf20Sopenharmony_ci
5058c2ecf20Sopenharmony_cistatic const struct of_device_id tcx_match[] = {
5068c2ecf20Sopenharmony_ci	{
5078c2ecf20Sopenharmony_ci		.name = "SUNW,tcx",
5088c2ecf20Sopenharmony_ci	},
5098c2ecf20Sopenharmony_ci	{},
5108c2ecf20Sopenharmony_ci};
5118c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(of, tcx_match);
5128c2ecf20Sopenharmony_ci
5138c2ecf20Sopenharmony_cistatic struct platform_driver tcx_driver = {
5148c2ecf20Sopenharmony_ci	.driver = {
5158c2ecf20Sopenharmony_ci		.name = "tcx",
5168c2ecf20Sopenharmony_ci		.of_match_table = tcx_match,
5178c2ecf20Sopenharmony_ci	},
5188c2ecf20Sopenharmony_ci	.probe		= tcx_probe,
5198c2ecf20Sopenharmony_ci	.remove		= tcx_remove,
5208c2ecf20Sopenharmony_ci};
5218c2ecf20Sopenharmony_ci
5228c2ecf20Sopenharmony_cistatic int __init tcx_init(void)
5238c2ecf20Sopenharmony_ci{
5248c2ecf20Sopenharmony_ci	if (fb_get_options("tcxfb", NULL))
5258c2ecf20Sopenharmony_ci		return -ENODEV;
5268c2ecf20Sopenharmony_ci
5278c2ecf20Sopenharmony_ci	return platform_driver_register(&tcx_driver);
5288c2ecf20Sopenharmony_ci}
5298c2ecf20Sopenharmony_ci
5308c2ecf20Sopenharmony_cistatic void __exit tcx_exit(void)
5318c2ecf20Sopenharmony_ci{
5328c2ecf20Sopenharmony_ci	platform_driver_unregister(&tcx_driver);
5338c2ecf20Sopenharmony_ci}
5348c2ecf20Sopenharmony_ci
5358c2ecf20Sopenharmony_cimodule_init(tcx_init);
5368c2ecf20Sopenharmony_cimodule_exit(tcx_exit);
5378c2ecf20Sopenharmony_ci
5388c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("framebuffer driver for TCX chipsets");
5398c2ecf20Sopenharmony_ciMODULE_AUTHOR("David S. Miller <davem@davemloft.net>");
5408c2ecf20Sopenharmony_ciMODULE_VERSION("2.0");
5418c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
542