^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * linux/drivers/video/hitfb.c -- Hitachi LCD frame buffer device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * (C) 1999 Mihai Spatar
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * (C) 2000 YAEGASHI Takeshi
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * (C) 2003, 2004 Paul Mundt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * (C) 2003, 2004, 2006 Andriy Skulysh
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * This file is subject to the terms and conditions of the GNU General Public
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * License. See the file COPYING in the main directory of this archive for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) * more details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/string.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/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/init.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/fb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <asm/machvec.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include <asm/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #include <asm/hd64461.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include <cpu/dac.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define WIDTH 640
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) static struct fb_var_screeninfo hitfb_var = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) .activate = FB_ACTIVATE_NOW,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) .height = -1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) .width = -1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) .vmode = FB_VMODE_NONINTERLACED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) static struct fb_fix_screeninfo hitfb_fix = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) .id = "Hitachi HD64461",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) .type = FB_TYPE_PACKED_PIXELS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) .accel = FB_ACCEL_NONE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) static inline void hitfb_accel_wait(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) while (fb_readw(HD64461_GRCFGR) & HD64461_GRCFGR_ACCSTATUS) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) static inline void hitfb_accel_start(int truecolor)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) if (truecolor) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) fb_writew(6, HD64461_GRCFGR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) fb_writew(7, HD64461_GRCFGR);
^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)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) static inline void hitfb_accel_set_dest(int truecolor, u16 dx, u16 dy,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) u16 width, u16 height)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) u32 saddr = WIDTH * dy + dx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) if (truecolor)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) saddr <<= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) fb_writew(width-1, HD64461_BBTDWR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) fb_writew(height-1, HD64461_BBTDHR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) fb_writew(saddr & 0xffff, HD64461_BBTDSARL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) fb_writew(saddr >> 16, HD64461_BBTDSARH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) static inline void hitfb_accel_bitblt(int truecolor, u16 sx, u16 sy, u16 dx,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) u16 dy, u16 width, u16 height, u16 rop,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) u32 mask_addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) u32 saddr, daddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) u32 maddr = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) height--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) width--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) fb_writew(rop, HD64461_BBTROPR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) if ((sy < dy) || ((sy == dy) && (sx <= dx))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) saddr = WIDTH * (sy + height) + sx + width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) daddr = WIDTH * (dy + height) + dx + width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) if (mask_addr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) if (truecolor)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) maddr = ((width >> 3) + 1) * (height + 1) - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) maddr =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) (((width >> 4) + 1) * (height + 1) - 1) * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) fb_writew((1 << 5) | 1, HD64461_BBTMDR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) fb_writew(1, HD64461_BBTMDR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) saddr = WIDTH * sy + sx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) daddr = WIDTH * dy + dx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) if (mask_addr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) fb_writew((1 << 5), HD64461_BBTMDR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) fb_writew(0, HD64461_BBTMDR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) if (truecolor) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) saddr <<= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) daddr <<= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) fb_writew(width, HD64461_BBTDWR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) fb_writew(height, HD64461_BBTDHR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) fb_writew(saddr & 0xffff, HD64461_BBTSSARL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) fb_writew(saddr >> 16, HD64461_BBTSSARH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) fb_writew(daddr & 0xffff, HD64461_BBTDSARL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) fb_writew(daddr >> 16, HD64461_BBTDSARH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) if (mask_addr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) maddr += mask_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) fb_writew(maddr & 0xffff, HD64461_BBTMARL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) fb_writew(maddr >> 16, HD64461_BBTMARH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) hitfb_accel_start(truecolor);
^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) static void hitfb_fillrect(struct fb_info *p, const struct fb_fillrect *rect)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) if (rect->rop != ROP_COPY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) cfb_fillrect(p, rect);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) hitfb_accel_wait();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) fb_writew(0x00f0, HD64461_BBTROPR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) fb_writew(16, HD64461_BBTMDR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) if (p->var.bits_per_pixel == 16) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) fb_writew(((u32 *) (p->pseudo_palette))[rect->color],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) HD64461_GRSCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) hitfb_accel_set_dest(1, rect->dx, rect->dy, rect->width,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) rect->height);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) hitfb_accel_start(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) fb_writew(rect->color, HD64461_GRSCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) hitfb_accel_set_dest(0, rect->dx, rect->dy, rect->width,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) rect->height);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) hitfb_accel_start(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) static void hitfb_copyarea(struct fb_info *p, const struct fb_copyarea *area)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) hitfb_accel_wait();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) hitfb_accel_bitblt(p->var.bits_per_pixel == 16, area->sx, area->sy,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) area->dx, area->dy, area->width, area->height,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 0x00cc, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) static int hitfb_pan_display(struct fb_var_screeninfo *var,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) int xoffset = var->xoffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) int yoffset = var->yoffset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) if (xoffset != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) fb_writew((yoffset*info->fix.line_length)>>10, HD64461_LCDCBAR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) int hitfb_blank(int blank_mode, struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) unsigned short v;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) if (blank_mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) v = fb_readw(HD64461_LDR1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) v &= ~HD64461_LDR1_DON;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) fb_writew(v, HD64461_LDR1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) v = fb_readw(HD64461_LCDCCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) v |= HD64461_LCDCCR_MOFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) fb_writew(v, HD64461_LCDCCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) v = fb_readw(HD64461_STBCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) v |= HD64461_STBCR_SLCDST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) fb_writew(v, HD64461_STBCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) v = fb_readw(HD64461_STBCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) v &= ~HD64461_STBCR_SLCDST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) fb_writew(v, HD64461_STBCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) v = fb_readw(HD64461_LCDCCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) v &= ~(HD64461_LCDCCR_MOFF | HD64461_LCDCCR_STREQ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) fb_writew(v, HD64461_LCDCCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) v = fb_readw(HD64461_LCDCCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) } while(v&HD64461_LCDCCR_STBACK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) v = fb_readw(HD64461_LDR1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) v |= HD64461_LDR1_DON;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) fb_writew(v, HD64461_LDR1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) static int hitfb_setcolreg(unsigned regno, unsigned red, unsigned green,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) unsigned blue, unsigned transp, struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) if (regno >= 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) switch (info->var.bits_per_pixel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) fb_writew(regno << 8, HD64461_CPTWAR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) fb_writew(red >> 10, HD64461_CPTWDR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) fb_writew(green >> 10, HD64461_CPTWDR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) fb_writew(blue >> 10, HD64461_CPTWDR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) case 16:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) if (regno >= 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) ((u32 *) (info->pseudo_palette))[regno] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) ((red & 0xf800)) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) ((green & 0xfc00) >> 5) | ((blue & 0xf800) >> 11);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) break;
^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 hitfb_sync(struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) hitfb_accel_wait();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) static int hitfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) int maxy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) var->xres = info->var.xres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) var->xres_virtual = info->var.xres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) var->yres = info->var.yres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) if ((var->bits_per_pixel != 8) && (var->bits_per_pixel != 16))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) var->bits_per_pixel = info->var.bits_per_pixel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) if (var->yres_virtual < var->yres)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) var->yres_virtual = var->yres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) maxy = info->fix.smem_len / var->xres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) if (var->bits_per_pixel == 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) maxy /= 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) if (var->yres_virtual > maxy)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) var->yres_virtual = maxy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) var->xoffset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) var->yoffset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) switch (var->bits_per_pixel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) var->red.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) var->red.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) var->green.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) var->green.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) var->blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) var->blue.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) var->transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) var->transp.length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) case 16: /* RGB 565 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) var->red.offset = 11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) var->red.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) var->green.offset = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) var->green.length = 6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) var->blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) var->blue.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) var->transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) var->transp.length = 0;
^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 int hitfb_set_par(struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) unsigned short ldr3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) switch (info->var.bits_per_pixel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) info->fix.line_length = info->var.xres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) info->fix.ypanstep = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) case 16:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) info->fix.line_length = info->var.xres*2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) info->fix.visual = FB_VISUAL_TRUECOLOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) info->fix.ypanstep = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) fb_writew(info->fix.line_length, HD64461_LCDCLOR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) ldr3 = fb_readw(HD64461_LDR3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) ldr3 &= ~15;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) ldr3 |= (info->var.bits_per_pixel == 8) ? 4 : 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) fb_writew(ldr3, HD64461_LDR3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) static const struct fb_ops hitfb_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) .fb_check_var = hitfb_check_var,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) .fb_set_par = hitfb_set_par,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) .fb_setcolreg = hitfb_setcolreg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) .fb_blank = hitfb_blank,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) .fb_sync = hitfb_sync,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) .fb_pan_display = hitfb_pan_display,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) .fb_fillrect = hitfb_fillrect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) .fb_copyarea = hitfb_copyarea,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) .fb_imageblit = cfb_imageblit,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) static int hitfb_probe(struct platform_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) unsigned short lcdclor, ldr3, ldvndr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) struct fb_info *info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) if (fb_get_options("hitfb", NULL))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) hitfb_fix.mmio_start = HD64461_IO_OFFSET(0x1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) hitfb_fix.mmio_len = 0x1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) hitfb_fix.smem_start = HD64461_IO_OFFSET(0x02000000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) hitfb_fix.smem_len = 512 * 1024;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) lcdclor = fb_readw(HD64461_LCDCLOR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) ldvndr = fb_readw(HD64461_LDVNDR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) ldr3 = fb_readw(HD64461_LDR3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) switch (ldr3 & 15) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) case 4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) hitfb_var.bits_per_pixel = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) hitfb_var.xres = lcdclor;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) hitfb_var.bits_per_pixel = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) hitfb_var.xres = lcdclor / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) hitfb_fix.line_length = lcdclor;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) hitfb_fix.visual = (hitfb_var.bits_per_pixel == 8) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) hitfb_var.yres = ldvndr + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) hitfb_var.xres_virtual = hitfb_var.xres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) hitfb_var.yres_virtual = hitfb_fix.smem_len / lcdclor;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) switch (hitfb_var.bits_per_pixel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) hitfb_var.red.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) hitfb_var.red.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) hitfb_var.green.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) hitfb_var.green.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) hitfb_var.blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) hitfb_var.blue.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) hitfb_var.transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) hitfb_var.transp.length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) case 16: /* RGB 565 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) hitfb_var.red.offset = 11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) hitfb_var.red.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) hitfb_var.green.offset = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) hitfb_var.green.length = 6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) hitfb_var.blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) hitfb_var.blue.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) hitfb_var.transp.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) hitfb_var.transp.length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) info = framebuffer_alloc(sizeof(u32) * 16, &dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) if (unlikely(!info))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) info->fbops = &hitfb_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) info->var = hitfb_var;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) info->fix = hitfb_fix;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) info->pseudo_palette = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) FBINFO_HWACCEL_FILLRECT | FBINFO_HWACCEL_COPYAREA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) info->screen_base = (void *)hitfb_fix.smem_start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) ret = fb_alloc_cmap(&info->cmap, 256, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) if (unlikely(ret < 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) goto err_fb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) ret = register_framebuffer(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) if (unlikely(ret < 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) platform_set_drvdata(dev, info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) fb_info(info, "%s frame buffer device\n", info->fix.id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) fb_dealloc_cmap(&info->cmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) err_fb:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) framebuffer_release(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) static int hitfb_remove(struct platform_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) struct fb_info *info = platform_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) unregister_framebuffer(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) fb_dealloc_cmap(&info->cmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) framebuffer_release(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) static int hitfb_suspend(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) u16 v;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) hitfb_blank(1,0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) v = fb_readw(HD64461_STBCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) v |= HD64461_STBCR_SLCKE_IST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) fb_writew(v, HD64461_STBCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) static int hitfb_resume(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) u16 v;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) v = fb_readw(HD64461_STBCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) v &= ~HD64461_STBCR_SLCKE_OST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) msleep(100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) v = fb_readw(HD64461_STBCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) v &= ~HD64461_STBCR_SLCKE_IST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) fb_writew(v, HD64461_STBCR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) hitfb_blank(0,0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) static const struct dev_pm_ops hitfb_dev_pm_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) .suspend = hitfb_suspend,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) .resume = hitfb_resume,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) static struct platform_driver hitfb_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) .probe = hitfb_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) .remove = hitfb_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) .name = "hitfb",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) .pm = &hitfb_dev_pm_ops,
^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)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) static struct platform_device hitfb_device = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) .name = "hitfb",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) .id = -1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) static int __init hitfb_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) ret = platform_driver_register(&hitfb_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) if (!ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) ret = platform_device_register(&hitfb_device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) platform_driver_unregister(&hitfb_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) static void __exit hitfb_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) platform_device_unregister(&hitfb_device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) platform_driver_unregister(&hitfb_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) module_init(hitfb_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) module_exit(hitfb_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) MODULE_LICENSE("GPL");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags