^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * linux/drivers/video/vt8500lcdfb.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2010 Alexey Charkov <alchark@gmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Based on skeletonfb.c and pxafb.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/dma-mapping.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/fb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/wait.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <video/of_display_timing.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include "vt8500lcdfb.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #include "wmt_ge_rops.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #ifdef CONFIG_OF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #include <linux/of_fdt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #include <linux/memblock.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define to_vt8500lcd_info(__info) container_of(__info, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) struct vt8500lcd_info, fb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) static int vt8500lcd_set_par(struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) struct vt8500lcd_info *fbi = to_vt8500lcd_info(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) int reg_bpp = 5; /* 16bpp */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) unsigned long control0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) if (!fbi)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) if (info->var.bits_per_pixel <= 8) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) /* palettized */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) info->var.red.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) info->var.red.length = info->var.bits_per_pixel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) info->var.red.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) info->var.green.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) info->var.green.length = info->var.bits_per_pixel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) info->var.green.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) info->var.blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) info->var.blue.length = info->var.bits_per_pixel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) info->var.blue.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) info->var.transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) info->var.transp.length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) info->var.transp.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) info->fix.line_length = info->var.xres_virtual /
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) (8/info->var.bits_per_pixel);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) /* non-palettized */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) info->var.transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) info->var.transp.length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) info->var.transp.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) if (info->var.bits_per_pixel == 16) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) /* RGB565 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) info->var.red.offset = 11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) info->var.red.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) info->var.red.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) info->var.green.offset = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) info->var.green.length = 6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) info->var.green.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) info->var.blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) info->var.blue.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) info->var.blue.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) /* Equal depths per channel */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) info->var.red.offset = info->var.bits_per_pixel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) * 2 / 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) info->var.red.length = info->var.bits_per_pixel / 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) info->var.red.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) info->var.green.offset = info->var.bits_per_pixel / 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) info->var.green.length = info->var.bits_per_pixel / 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) info->var.green.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) info->var.blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) info->var.blue.length = info->var.bits_per_pixel / 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) info->var.blue.msb_right = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) info->fix.visual = FB_VISUAL_TRUECOLOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) info->fix.line_length = info->var.bits_per_pixel > 16 ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) info->var.xres_virtual << 2 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) info->var.xres_virtual << 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) for (i = 0; i < 8; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) if (bpp_values[i] == info->var.bits_per_pixel)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) reg_bpp = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) control0 = readl(fbi->regbase) & ~0xf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) writel(0, fbi->regbase);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) while (readl(fbi->regbase + 0x38) & 0x10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) /* wait */;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) writel((((info->var.hsync_len - 1) & 0x3f) << 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) | ((info->var.left_margin & 0xff) << 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) | (((info->var.xres - 1) & 0x3ff) << 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) | (info->var.right_margin & 0xff), fbi->regbase + 0x4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) writel((((info->var.vsync_len - 1) & 0x3f) << 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) | ((info->var.upper_margin & 0xff) << 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) | (((info->var.yres - 1) & 0x3ff) << 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) | (info->var.lower_margin & 0xff), fbi->regbase + 0x8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) writel((((info->var.yres - 1) & 0x400) << 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) | ((info->var.xres - 1) & 0x400), fbi->regbase + 0x10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) writel(0x80000000, fbi->regbase + 0x20);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) writel(control0 | (reg_bpp << 1) | 0x100, fbi->regbase);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) static inline u_int chan_to_field(u_int chan, struct fb_bitfield *bf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) chan &= 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) chan >>= 16 - bf->length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) return chan << bf->offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) static int vt8500lcd_setcolreg(unsigned regno, unsigned red, unsigned green,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) unsigned blue, unsigned transp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) struct fb_info *info) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) struct vt8500lcd_info *fbi = to_vt8500lcd_info(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) int ret = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) unsigned int val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) if (regno >= 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) if (info->var.grayscale)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) red = green = blue =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) (19595 * red + 38470 * green + 7471 * blue) >> 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) switch (fbi->fb.fix.visual) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) case FB_VISUAL_TRUECOLOR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) if (regno < 16) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) u32 *pal = fbi->fb.pseudo_palette;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) val = chan_to_field(red, &fbi->fb.var.red);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) val |= chan_to_field(green, &fbi->fb.var.green);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) val |= chan_to_field(blue, &fbi->fb.var.blue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) pal[regno] = val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) case FB_VISUAL_STATIC_PSEUDOCOLOR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) case FB_VISUAL_PSEUDOCOLOR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) writew((red & 0xf800)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) | ((green >> 5) & 0x7e0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) | ((blue >> 11) & 0x1f),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) fbi->palette_cpu + sizeof(u16) * regno);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) static int vt8500lcd_ioctl(struct fb_info *info, unsigned int cmd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) struct vt8500lcd_info *fbi = to_vt8500lcd_info(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) if (cmd == FBIO_WAITFORVSYNC) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) /* Unmask End of Frame interrupt */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) writel(0xffffffff ^ (1 << 3), fbi->regbase + 0x3c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) ret = wait_event_interruptible_timeout(fbi->wait,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) readl(fbi->regbase + 0x38) & (1 << 3), HZ / 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) /* Mask back to reduce unwanted interrupt traffic */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) writel(0xffffffff, fbi->regbase + 0x3c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) if (ret == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) return -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) static int vt8500lcd_pan_display(struct fb_var_screeninfo *var,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) unsigned pixlen = info->fix.line_length / info->var.xres_virtual;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) unsigned off = pixlen * var->xoffset
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) + info->fix.line_length * var->yoffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) struct vt8500lcd_info *fbi = to_vt8500lcd_info(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) writel((1 << 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) | (((info->var.xres_virtual - info->var.xres) * pixlen / 4) << 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) | (off >> 2), fbi->regbase + 0x20);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) * vt8500lcd_blank():
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) * Blank the display by setting all palette values to zero. Note,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) * True Color modes do not really use the palette, so this will not
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) * blank the display in all modes.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) static int vt8500lcd_blank(int blank, struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) switch (blank) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) case FB_BLANK_POWERDOWN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) case FB_BLANK_VSYNC_SUSPEND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) case FB_BLANK_HSYNC_SUSPEND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) case FB_BLANK_NORMAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) if (info->fix.visual == FB_VISUAL_PSEUDOCOLOR ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) info->fix.visual == FB_VISUAL_STATIC_PSEUDOCOLOR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) for (i = 0; i < 256; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) vt8500lcd_setcolreg(i, 0, 0, 0, 0, info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) case FB_BLANK_UNBLANK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) if (info->fix.visual == FB_VISUAL_PSEUDOCOLOR ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) info->fix.visual == FB_VISUAL_STATIC_PSEUDOCOLOR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) fb_set_cmap(&info->cmap, info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) static const struct fb_ops vt8500lcd_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) .fb_set_par = vt8500lcd_set_par,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) .fb_setcolreg = vt8500lcd_setcolreg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) .fb_fillrect = wmt_ge_fillrect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) .fb_copyarea = wmt_ge_copyarea,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) .fb_imageblit = sys_imageblit,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) .fb_sync = wmt_ge_sync,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) .fb_ioctl = vt8500lcd_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) .fb_pan_display = vt8500lcd_pan_display,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) .fb_blank = vt8500lcd_blank,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) static irqreturn_t vt8500lcd_handle_irq(int irq, void *dev_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) struct vt8500lcd_info *fbi = dev_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) if (readl(fbi->regbase + 0x38) & (1 << 3))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) wake_up_interruptible(&fbi->wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) writel(0xffffffff, fbi->regbase + 0x38);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) static int vt8500lcd_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) struct vt8500lcd_info *fbi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) struct resource *res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) struct display_timings *disp_timing;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) void *addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) int irq, ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) struct fb_videomode of_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) u32 bpp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) dma_addr_t fb_mem_phys;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) unsigned long fb_mem_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) void *fb_mem_virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) fbi = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) fbi = devm_kzalloc(&pdev->dev, sizeof(struct vt8500lcd_info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) + sizeof(u32) * 16, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) if (!fbi)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) strcpy(fbi->fb.fix.id, "VT8500 LCD");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) fbi->fb.fix.type = FB_TYPE_PACKED_PIXELS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) fbi->fb.fix.xpanstep = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) fbi->fb.fix.ypanstep = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) fbi->fb.fix.ywrapstep = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) fbi->fb.fix.accel = FB_ACCEL_NONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) fbi->fb.var.nonstd = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) fbi->fb.var.activate = FB_ACTIVATE_NOW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) fbi->fb.var.height = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) fbi->fb.var.width = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) fbi->fb.var.vmode = FB_VMODE_NONINTERLACED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) fbi->fb.fbops = &vt8500lcd_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) fbi->fb.flags = FBINFO_DEFAULT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) | FBINFO_HWACCEL_COPYAREA
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) | FBINFO_HWACCEL_FILLRECT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) | FBINFO_HWACCEL_YPAN
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) | FBINFO_VIRTFB
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) | FBINFO_PARTIAL_PAN_OK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) fbi->fb.node = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) addr = fbi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) addr = addr + sizeof(struct vt8500lcd_info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) fbi->fb.pseudo_palette = addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) if (res == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) dev_err(&pdev->dev, "no I/O memory resource defined\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) res = request_mem_region(res->start, resource_size(res), "vt8500lcd");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) if (res == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) dev_err(&pdev->dev, "failed to request I/O memory\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) fbi->regbase = ioremap(res->start, resource_size(res));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) if (fbi->regbase == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) dev_err(&pdev->dev, "failed to map I/O memory\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) ret = -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) goto failed_free_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) disp_timing = of_get_display_timings(pdev->dev.of_node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) if (!disp_timing) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) goto failed_free_io;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) ret = of_get_fb_videomode(pdev->dev.of_node, &of_mode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) OF_USE_NATIVE_MODE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) goto failed_free_io;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) ret = of_property_read_u32(pdev->dev.of_node, "bits-per-pixel", &bpp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) goto failed_free_io;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) /* try allocating the framebuffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) fb_mem_len = of_mode.xres * of_mode.yres * 2 * (bpp / 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) fb_mem_virt = dma_alloc_coherent(&pdev->dev, fb_mem_len, &fb_mem_phys,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) if (!fb_mem_virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) pr_err("%s: Failed to allocate framebuffer\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) goto failed_free_io;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) fbi->fb.fix.smem_start = fb_mem_phys;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) fbi->fb.fix.smem_len = fb_mem_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) fbi->fb.screen_base = fb_mem_virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) fbi->palette_size = PAGE_ALIGN(512);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) fbi->palette_cpu = dma_alloc_coherent(&pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) fbi->palette_size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) &fbi->palette_phys,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) if (fbi->palette_cpu == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) dev_err(&pdev->dev, "Failed to allocate palette buffer\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) goto failed_free_io;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) irq = platform_get_irq(pdev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) if (irq < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) dev_err(&pdev->dev, "no IRQ defined\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) ret = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) goto failed_free_palette;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) ret = request_irq(irq, vt8500lcd_handle_irq, 0, "LCD", fbi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) dev_err(&pdev->dev, "request_irq failed: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) ret = -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) goto failed_free_palette;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) init_waitqueue_head(&fbi->wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) if (fb_alloc_cmap(&fbi->fb.cmap, 256, 0) < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) dev_err(&pdev->dev, "Failed to allocate color map\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) goto failed_free_irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) fb_videomode_to_var(&fbi->fb.var, &of_mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) fbi->fb.var.xres_virtual = of_mode.xres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) fbi->fb.var.yres_virtual = of_mode.yres * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) fbi->fb.var.bits_per_pixel = bpp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) ret = vt8500lcd_set_par(&fbi->fb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) dev_err(&pdev->dev, "Failed to set parameters\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) goto failed_free_cmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) writel(fbi->fb.fix.smem_start >> 22, fbi->regbase + 0x1c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) writel((fbi->palette_phys & 0xfffffe00) | 1, fbi->regbase + 0x18);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) platform_set_drvdata(pdev, fbi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) ret = register_framebuffer(&fbi->fb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) dev_err(&pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) "Failed to register framebuffer device: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) goto failed_free_cmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) * Ok, now enable the LCD controller
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) writel(readl(fbi->regbase) | 1, fbi->regbase);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) failed_free_cmap:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) if (fbi->fb.cmap.len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) fb_dealloc_cmap(&fbi->fb.cmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) failed_free_irq:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) free_irq(irq, fbi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) failed_free_palette:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) dma_free_coherent(&pdev->dev, fbi->palette_size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) fbi->palette_cpu, fbi->palette_phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) failed_free_io:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) iounmap(fbi->regbase);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) failed_free_res:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) release_mem_region(res->start, resource_size(res));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) static int vt8500lcd_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) struct vt8500lcd_info *fbi = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) struct resource *res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) int irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) unregister_framebuffer(&fbi->fb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) writel(0, fbi->regbase);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) if (fbi->fb.cmap.len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) fb_dealloc_cmap(&fbi->fb.cmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) irq = platform_get_irq(pdev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) free_irq(irq, fbi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) dma_free_coherent(&pdev->dev, fbi->palette_size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) fbi->palette_cpu, fbi->palette_phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) iounmap(fbi->regbase);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) release_mem_region(res->start, resource_size(res));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) static const struct of_device_id via_dt_ids[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) { .compatible = "via,vt8500-fb", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) {}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) static struct platform_driver vt8500lcd_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) .probe = vt8500lcd_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) .remove = vt8500lcd_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) .name = "vt8500-lcd",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) .of_match_table = of_match_ptr(via_dt_ids),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) module_platform_driver(vt8500lcd_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) MODULE_AUTHOR("Alexey Charkov <alchark@gmail.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) MODULE_DESCRIPTION("LCD controller driver for VIA VT8500");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) MODULE_LICENSE("GPL v2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) MODULE_DEVICE_TABLE(of, via_dt_ids);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags