^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * OpenCores VGA/LCD 2.0 core frame buffer driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (C) 2013 Stefan Kristiansson, stefan.kristiansson@saunalahti.fi
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * This file is licensed under the terms of the GNU General Public License
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * version 2. This program is licensed "as is" without any warranty of any
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * kind, whether express or implied.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/dma-mapping.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/fb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/init.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/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/platform_device.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/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) /* OCFB register defines */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define OCFB_CTRL 0x000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #define OCFB_STAT 0x004
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define OCFB_HTIM 0x008
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define OCFB_VTIM 0x00c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define OCFB_HVLEN 0x010
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define OCFB_VBARA 0x014
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define OCFB_PALETTE 0x800
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define OCFB_CTRL_VEN 0x00000001 /* Video Enable */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define OCFB_CTRL_HIE 0x00000002 /* HSync Interrupt Enable */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define OCFB_CTRL_PC 0x00000800 /* 8-bit Pseudo Color Enable*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define OCFB_CTRL_CD8 0x00000000 /* Color Depth 8 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define OCFB_CTRL_CD16 0x00000200 /* Color Depth 16 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define OCFB_CTRL_CD24 0x00000400 /* Color Depth 24 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define OCFB_CTRL_CD32 0x00000600 /* Color Depth 32 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define OCFB_CTRL_VBL1 0x00000000 /* Burst Length 1 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define OCFB_CTRL_VBL2 0x00000080 /* Burst Length 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define OCFB_CTRL_VBL4 0x00000100 /* Burst Length 4 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define OCFB_CTRL_VBL8 0x00000180 /* Burst Length 8 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #define PALETTE_SIZE 256
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) #define OCFB_NAME "OC VGA/LCD"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) static char *mode_option;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) static const struct fb_videomode default_mode = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) /* 640x480 @ 60 Hz, 31.5 kHz hsync */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) NULL, 60, 640, 480, 39721, 40, 24, 32, 11, 96, 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 0, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) struct ocfb_dev {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) struct fb_info info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) void __iomem *regs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) /* flag indicating whether the regs are little endian accessed */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) int little_endian;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) /* Physical and virtual addresses of framebuffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) dma_addr_t fb_phys;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) void __iomem *fb_virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) u32 pseudo_palette[PALETTE_SIZE];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) #ifndef MODULE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) static int __init ocfb_setup(char *options)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) char *curr_opt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) if (!options || !*options)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) while ((curr_opt = strsep(&options, ",")) != NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) if (!*curr_opt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) mode_option = curr_opt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) static inline u32 ocfb_readreg(struct ocfb_dev *fbdev, loff_t offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) if (fbdev->little_endian)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) return ioread32(fbdev->regs + offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) return ioread32be(fbdev->regs + offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) static void ocfb_writereg(struct ocfb_dev *fbdev, loff_t offset, u32 data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) if (fbdev->little_endian)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) iowrite32(data, fbdev->regs + offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) iowrite32be(data, fbdev->regs + offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) static int ocfb_setupfb(struct ocfb_dev *fbdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) unsigned long bpp_config;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) struct fb_var_screeninfo *var = &fbdev->info.var;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) struct device *dev = fbdev->info.device;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) u32 hlen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) u32 vlen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) /* Disable display */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) ocfb_writereg(fbdev, OCFB_CTRL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) /* Register framebuffer address */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) fbdev->little_endian = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) ocfb_writereg(fbdev, OCFB_VBARA, fbdev->fb_phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) /* Detect endianess */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) if (ocfb_readreg(fbdev, OCFB_VBARA) != fbdev->fb_phys) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) fbdev->little_endian = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) ocfb_writereg(fbdev, OCFB_VBARA, fbdev->fb_phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) /* Horizontal timings */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) ocfb_writereg(fbdev, OCFB_HTIM, (var->hsync_len - 1) << 24 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) (var->left_margin - 1) << 16 | (var->xres - 1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) /* Vertical timings */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) ocfb_writereg(fbdev, OCFB_VTIM, (var->vsync_len - 1) << 24 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) (var->upper_margin - 1) << 16 | (var->yres - 1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) /* Total length of frame */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) hlen = var->left_margin + var->right_margin + var->hsync_len +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) var->xres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) vlen = var->upper_margin + var->lower_margin + var->vsync_len +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) var->yres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) ocfb_writereg(fbdev, OCFB_HVLEN, (hlen - 1) << 16 | (vlen - 1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) bpp_config = OCFB_CTRL_CD8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) switch (var->bits_per_pixel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) if (!var->grayscale)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) bpp_config |= OCFB_CTRL_PC; /* enable palette */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) case 16:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) bpp_config |= OCFB_CTRL_CD16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) case 24:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) bpp_config |= OCFB_CTRL_CD24;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) case 32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) bpp_config |= OCFB_CTRL_CD32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) dev_err(dev, "no bpp specified\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) /* maximum (8) VBL (video memory burst length) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) bpp_config |= OCFB_CTRL_VBL8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) /* Enable output */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) ocfb_writereg(fbdev, OCFB_CTRL, (OCFB_CTRL_VEN | bpp_config));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) static int ocfb_setcolreg(unsigned regno, unsigned red, unsigned green,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) unsigned blue, unsigned transp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) struct ocfb_dev *fbdev = (struct ocfb_dev *)info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) u32 color;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) if (regno >= info->cmap.len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) dev_err(info->device, "regno >= cmap.len\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) if (info->var.grayscale) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) /* grayscale = 0.30*R + 0.59*G + 0.11*B */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) red = green = blue = (red * 77 + green * 151 + blue * 28) >> 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) red >>= (16 - info->var.red.length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) green >>= (16 - info->var.green.length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) blue >>= (16 - info->var.blue.length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) transp >>= (16 - info->var.transp.length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) if (info->var.bits_per_pixel == 8 && !info->var.grayscale) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) regno <<= 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) color = (red << 16) | (green << 8) | blue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) ocfb_writereg(fbdev, OCFB_PALETTE + regno, color);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) ((u32 *)(info->pseudo_palette))[regno] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) (red << info->var.red.offset) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) (green << info->var.green.offset) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) (blue << info->var.blue.offset) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) (transp << info->var.transp.offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) static int ocfb_init_fix(struct ocfb_dev *fbdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) struct fb_var_screeninfo *var = &fbdev->info.var;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) struct fb_fix_screeninfo *fix = &fbdev->info.fix;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) strcpy(fix->id, OCFB_NAME);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) fix->line_length = var->xres * var->bits_per_pixel/8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) fix->smem_len = fix->line_length * var->yres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) fix->type = FB_TYPE_PACKED_PIXELS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) if (var->bits_per_pixel == 8 && !var->grayscale)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) fix->visual = FB_VISUAL_PSEUDOCOLOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) fix->visual = FB_VISUAL_TRUECOLOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) static int ocfb_init_var(struct ocfb_dev *fbdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) struct fb_var_screeninfo *var = &fbdev->info.var;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) var->accel_flags = FB_ACCEL_NONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) var->activate = FB_ACTIVATE_NOW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) var->xres_virtual = var->xres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) var->yres_virtual = var->yres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) switch (var->bits_per_pixel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) var->transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) var->transp.length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) var->red.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) var->red.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) var->green.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) var->green.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) var->blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) var->blue.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) case 16:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) var->transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) var->transp.length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) var->red.offset = 11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) var->red.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) var->green.offset = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) var->green.length = 6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) var->blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) var->blue.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) case 24:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) var->transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) var->transp.length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) var->red.offset = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) var->red.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) var->green.offset = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) var->green.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) var->blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) var->blue.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) case 32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) var->transp.offset = 24;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) var->transp.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) var->red.offset = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) var->red.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) var->green.offset = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) var->green.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) var->blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) var->blue.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) static const struct fb_ops ocfb_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) .fb_setcolreg = ocfb_setcolreg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) .fb_fillrect = cfb_fillrect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) .fb_copyarea = cfb_copyarea,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) .fb_imageblit = cfb_imageblit,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) static int ocfb_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) struct ocfb_dev *fbdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) int fbsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) fbdev = devm_kzalloc(&pdev->dev, sizeof(*fbdev), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) if (!fbdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) platform_set_drvdata(pdev, fbdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) fbdev->info.fbops = &ocfb_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) fbdev->info.device = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) fbdev->info.par = fbdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) /* Video mode setup */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) if (!fb_find_mode(&fbdev->info.var, &fbdev->info, mode_option,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) NULL, 0, &default_mode, 16)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) dev_err(&pdev->dev, "No valid video modes found\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) ocfb_init_var(fbdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) ocfb_init_fix(fbdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) fbdev->regs = devm_platform_ioremap_resource(pdev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) if (IS_ERR(fbdev->regs))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) return PTR_ERR(fbdev->regs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) /* Allocate framebuffer memory */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) fbsize = fbdev->info.fix.smem_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) fbdev->fb_virt = dma_alloc_coherent(&pdev->dev, PAGE_ALIGN(fbsize),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) &fbdev->fb_phys, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) if (!fbdev->fb_virt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) dev_err(&pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) "Frame buffer memory allocation failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) fbdev->info.fix.smem_start = fbdev->fb_phys;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) fbdev->info.screen_base = fbdev->fb_virt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) fbdev->info.pseudo_palette = fbdev->pseudo_palette;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) /* Clear framebuffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) memset_io(fbdev->fb_virt, 0, fbsize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) /* Setup and enable the framebuffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) ocfb_setupfb(fbdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) if (fbdev->little_endian)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) fbdev->info.flags |= FBINFO_FOREIGN_ENDIAN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) /* Allocate color map */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) ret = fb_alloc_cmap(&fbdev->info.cmap, PALETTE_SIZE, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) dev_err(&pdev->dev, "Color map allocation failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) goto err_dma_free;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) /* Register framebuffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) ret = register_framebuffer(&fbdev->info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) dev_err(&pdev->dev, "Framebuffer registration failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) goto err_dealloc_cmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) err_dealloc_cmap:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) fb_dealloc_cmap(&fbdev->info.cmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) err_dma_free:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) dma_free_coherent(&pdev->dev, PAGE_ALIGN(fbsize), fbdev->fb_virt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) fbdev->fb_phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) static int ocfb_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) struct ocfb_dev *fbdev = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) unregister_framebuffer(&fbdev->info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) fb_dealloc_cmap(&fbdev->info.cmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) dma_free_coherent(&pdev->dev, PAGE_ALIGN(fbdev->info.fix.smem_len),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) fbdev->fb_virt, fbdev->fb_phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) /* Disable display */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) ocfb_writereg(fbdev, OCFB_CTRL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) platform_set_drvdata(pdev, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) static struct of_device_id ocfb_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) { .compatible = "opencores,ocfb", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) {},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) MODULE_DEVICE_TABLE(of, ocfb_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) static struct platform_driver ocfb_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) .probe = ocfb_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) .remove = ocfb_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) .name = "ocfb_fb",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) .of_match_table = ocfb_match,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) * Init and exit routines
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) static int __init ocfb_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) #ifndef MODULE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) char *option = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) if (fb_get_options("ocfb", &option))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) ocfb_setup(option);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) return platform_driver_register(&ocfb_driver);
^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) static void __exit ocfb_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) platform_driver_unregister(&ocfb_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) module_init(ocfb_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) module_exit(ocfb_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) MODULE_AUTHOR("Stefan Kristiansson <stefan.kristiansson@saunalahti.fi>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) MODULE_DESCRIPTION("OpenCores VGA/LCD 2.0 frame buffer driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) MODULE_LICENSE("GPL v2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) module_param(mode_option, charp, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) MODULE_PARM_DESC(mode_option, "Video mode ('<xres>x<yres>[-<bpp>][@refresh]')");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags