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