Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 1 | /* |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 2 | * Xilinx TFT frame buffer driver |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 3 | * |
| 4 | * Author: MontaVista Software, Inc. |
| 5 | * source@mvista.com |
| 6 | * |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 7 | * 2002-2007 (c) MontaVista Software, Inc. |
| 8 | * 2007 (c) Secret Lab Technologies, Ltd. |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 9 | * 2009 (c) Xilinx Inc. |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 10 | * |
| 11 | * This file is licensed under the terms of the GNU General Public License |
| 12 | * version 2. This program is licensed "as is" without any warranty of any |
| 13 | * kind, whether express or implied. |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 14 | */ |
| 15 | |
| 16 | /* |
| 17 | * This driver was based on au1100fb.c by MontaVista rewritten for 2.6 |
| 18 | * by Embedded Alley Solutions <source@embeddedalley.com>, which in turn |
| 19 | * was based on skeletonfb.c, Skeleton for a frame buffer device by |
| 20 | * Geert Uytterhoeven. |
| 21 | */ |
| 22 | |
Grant Likely | 3cb3ec2 | 2007-10-04 10:48:36 -0600 | [diff] [blame] | 23 | #include <linux/device.h> |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 24 | #include <linux/module.h> |
| 25 | #include <linux/kernel.h> |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 26 | #include <linux/version.h> |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 27 | #include <linux/errno.h> |
| 28 | #include <linux/string.h> |
| 29 | #include <linux/mm.h> |
| 30 | #include <linux/fb.h> |
| 31 | #include <linux/init.h> |
| 32 | #include <linux/dma-mapping.h> |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 33 | #include <linux/of_device.h> |
| 34 | #include <linux/of_platform.h> |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 35 | #include <linux/io.h> |
Grant Likely | dc8afdc | 2007-10-01 07:47:00 +1000 | [diff] [blame] | 36 | #include <linux/xilinxfb.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 37 | #include <linux/slab.h> |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 38 | #include <asm/dcr.h> |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 39 | |
| 40 | #define DRIVER_NAME "xilinxfb" |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 41 | |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 42 | |
| 43 | /* |
| 44 | * Xilinx calls it "PLB TFT LCD Controller" though it can also be used for |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 45 | * the VGA port on the Xilinx ML40x board. This is a hardware display |
| 46 | * controller for a 640x480 resolution TFT or VGA screen. |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 47 | * |
| 48 | * The interface to the framebuffer is nice and simple. There are two |
| 49 | * control registers. The first tells the LCD interface where in memory |
| 50 | * the frame buffer is (only the 11 most significant bits are used, so |
| 51 | * don't start thinking about scrolling). The second allows the LCD to |
| 52 | * be turned on or off as well as rotated 180 degrees. |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 53 | * |
| 54 | * In case of direct PLB access the second control register will be at |
| 55 | * an offset of 4 as compared to the DCR access where the offset is 1 |
| 56 | * i.e. REG_CTRL. So this is taken care in the function |
| 57 | * xilinx_fb_out_be32 where it left shifts the offset 2 times in case of |
| 58 | * direct PLB access. |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 59 | */ |
| 60 | #define NUM_REGS 2 |
| 61 | #define REG_FB_ADDR 0 |
| 62 | #define REG_CTRL 1 |
| 63 | #define REG_CTRL_ENABLE 0x0001 |
| 64 | #define REG_CTRL_ROTATE 0x0002 |
| 65 | |
| 66 | /* |
| 67 | * The hardware only handles a single mode: 640x480 24 bit true |
| 68 | * color. Each pixel gets a word (32 bits) of memory. Within each word, |
| 69 | * the 8 most significant bits are ignored, the next 8 bits are the red |
| 70 | * level, the next 8 bits are the green level and the 8 least |
| 71 | * significant bits are the blue level. Each row of the LCD uses 1024 |
| 72 | * words, but only the first 640 pixels are displayed with the other 384 |
| 73 | * words being ignored. There are 480 rows. |
| 74 | */ |
| 75 | #define BYTES_PER_PIXEL 4 |
| 76 | #define BITS_PER_PIXEL (BYTES_PER_PIXEL * 8) |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 77 | |
| 78 | #define RED_SHIFT 16 |
| 79 | #define GREEN_SHIFT 8 |
| 80 | #define BLUE_SHIFT 0 |
| 81 | |
| 82 | #define PALETTE_ENTRIES_NO 16 /* passed to fb_alloc_cmap() */ |
| 83 | |
| 84 | /* |
Grant Likely | 01ba1e9 | 2007-10-11 04:31:46 +1000 | [diff] [blame] | 85 | * Default xilinxfb configuration |
| 86 | */ |
| 87 | static struct xilinxfb_platform_data xilinx_fb_default_pdata = { |
Grant Likely | b4d6a72 | 2007-10-11 04:31:51 +1000 | [diff] [blame] | 88 | .xres = 640, |
| 89 | .yres = 480, |
| 90 | .xvirt = 1024, |
Grant Likely | 86a2249 | 2007-10-13 22:13:32 -0600 | [diff] [blame] | 91 | .yvirt = 480, |
Grant Likely | 01ba1e9 | 2007-10-11 04:31:46 +1000 | [diff] [blame] | 92 | }; |
| 93 | |
| 94 | /* |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 95 | * Here are the default fb_fix_screeninfo and fb_var_screeninfo structures |
| 96 | */ |
Grant Likely | 3f5b85d | 2007-07-31 00:37:38 -0700 | [diff] [blame] | 97 | static struct fb_fix_screeninfo xilinx_fb_fix = { |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 98 | .id = "Xilinx", |
| 99 | .type = FB_TYPE_PACKED_PIXELS, |
| 100 | .visual = FB_VISUAL_TRUECOLOR, |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 101 | .accel = FB_ACCEL_NONE |
| 102 | }; |
| 103 | |
Grant Likely | 3f5b85d | 2007-07-31 00:37:38 -0700 | [diff] [blame] | 104 | static struct fb_var_screeninfo xilinx_fb_var = { |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 105 | .bits_per_pixel = BITS_PER_PIXEL, |
| 106 | |
| 107 | .red = { RED_SHIFT, 8, 0 }, |
| 108 | .green = { GREEN_SHIFT, 8, 0 }, |
| 109 | .blue = { BLUE_SHIFT, 8, 0 }, |
| 110 | .transp = { 0, 0, 0 }, |
| 111 | |
| 112 | .activate = FB_ACTIVATE_NOW |
| 113 | }; |
| 114 | |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 115 | |
| 116 | #define PLB_ACCESS_FLAG 0x1 /* 1 = PLB, 0 = DCR */ |
| 117 | |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 118 | struct xilinxfb_drvdata { |
| 119 | |
| 120 | struct fb_info info; /* FB driver info record */ |
| 121 | |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 122 | phys_addr_t regs_phys; /* phys. address of the control |
| 123 | registers */ |
| 124 | void __iomem *regs; /* virt. address of the control |
| 125 | registers */ |
| 126 | |
| 127 | dcr_host_t dcr_host; |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 128 | unsigned int dcr_len; |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 129 | |
Grant Likely | b9a2279 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 130 | void *fb_virt; /* virt. address of the frame buffer */ |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 131 | dma_addr_t fb_phys; /* phys. address of the frame buffer */ |
Grant Likely | 287e5d6 | 2007-10-11 04:31:56 +1000 | [diff] [blame] | 132 | int fb_alloced; /* Flag, was the fb memory alloced? */ |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 133 | |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 134 | u8 flags; /* features of the driver */ |
| 135 | |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 136 | u32 reg_ctrl_default; |
| 137 | |
| 138 | u32 pseudo_palette[PALETTE_ENTRIES_NO]; |
| 139 | /* Fake palette of 16 colors */ |
| 140 | }; |
| 141 | |
| 142 | #define to_xilinxfb_drvdata(_info) \ |
| 143 | container_of(_info, struct xilinxfb_drvdata, info) |
| 144 | |
| 145 | /* |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 146 | * The XPS TFT Controller can be accessed through PLB or DCR interface. |
| 147 | * To perform the read/write on the registers we need to check on |
| 148 | * which bus its connected and call the appropriate write API. |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 149 | */ |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 150 | static void xilinx_fb_out_be32(struct xilinxfb_drvdata *drvdata, u32 offset, |
| 151 | u32 val) |
| 152 | { |
| 153 | if (drvdata->flags & PLB_ACCESS_FLAG) |
| 154 | out_be32(drvdata->regs + (offset << 2), val); |
| 155 | else |
| 156 | dcr_write(drvdata->dcr_host, offset, val); |
| 157 | |
| 158 | } |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 159 | |
| 160 | static int |
| 161 | xilinx_fb_setcolreg(unsigned regno, unsigned red, unsigned green, unsigned blue, |
| 162 | unsigned transp, struct fb_info *fbi) |
| 163 | { |
| 164 | u32 *palette = fbi->pseudo_palette; |
| 165 | |
| 166 | if (regno >= PALETTE_ENTRIES_NO) |
| 167 | return -EINVAL; |
| 168 | |
| 169 | if (fbi->var.grayscale) { |
| 170 | /* Convert color to grayscale. |
| 171 | * grayscale = 0.30*R + 0.59*G + 0.11*B */ |
| 172 | red = green = blue = |
| 173 | (red * 77 + green * 151 + blue * 28 + 127) >> 8; |
| 174 | } |
| 175 | |
| 176 | /* fbi->fix.visual is always FB_VISUAL_TRUECOLOR */ |
| 177 | |
| 178 | /* We only handle 8 bits of each color. */ |
| 179 | red >>= 8; |
| 180 | green >>= 8; |
| 181 | blue >>= 8; |
| 182 | palette[regno] = (red << RED_SHIFT) | (green << GREEN_SHIFT) | |
| 183 | (blue << BLUE_SHIFT); |
| 184 | |
| 185 | return 0; |
| 186 | } |
| 187 | |
| 188 | static int |
| 189 | xilinx_fb_blank(int blank_mode, struct fb_info *fbi) |
| 190 | { |
| 191 | struct xilinxfb_drvdata *drvdata = to_xilinxfb_drvdata(fbi); |
| 192 | |
| 193 | switch (blank_mode) { |
| 194 | case FB_BLANK_UNBLANK: |
| 195 | /* turn on panel */ |
| 196 | xilinx_fb_out_be32(drvdata, REG_CTRL, drvdata->reg_ctrl_default); |
| 197 | break; |
| 198 | |
| 199 | case FB_BLANK_NORMAL: |
| 200 | case FB_BLANK_VSYNC_SUSPEND: |
| 201 | case FB_BLANK_HSYNC_SUSPEND: |
| 202 | case FB_BLANK_POWERDOWN: |
| 203 | /* turn off panel */ |
| 204 | xilinx_fb_out_be32(drvdata, REG_CTRL, 0); |
| 205 | default: |
| 206 | break; |
| 207 | |
| 208 | } |
| 209 | return 0; /* success */ |
| 210 | } |
| 211 | |
| 212 | static struct fb_ops xilinxfb_ops = |
| 213 | { |
| 214 | .owner = THIS_MODULE, |
| 215 | .fb_setcolreg = xilinx_fb_setcolreg, |
| 216 | .fb_blank = xilinx_fb_blank, |
| 217 | .fb_fillrect = cfb_fillrect, |
| 218 | .fb_copyarea = cfb_copyarea, |
| 219 | .fb_imageblit = cfb_imageblit, |
| 220 | }; |
| 221 | |
Grant Likely | 2647762 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 222 | /* --------------------------------------------------------------------- |
| 223 | * Bus independent setup/teardown |
| 224 | */ |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 225 | |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 226 | static int xilinxfb_assign(struct device *dev, |
| 227 | struct xilinxfb_drvdata *drvdata, |
| 228 | unsigned long physaddr, |
Grant Likely | 01ba1e9 | 2007-10-11 04:31:46 +1000 | [diff] [blame] | 229 | struct xilinxfb_platform_data *pdata) |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 230 | { |
Grant Likely | 2647762 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 231 | int rc; |
Grant Likely | b4d6a72 | 2007-10-11 04:31:51 +1000 | [diff] [blame] | 232 | int fbsize = pdata->xvirt * pdata->yvirt * BYTES_PER_PIXEL; |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 233 | |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 234 | if (drvdata->flags & PLB_ACCESS_FLAG) { |
| 235 | /* |
| 236 | * Map the control registers in if the controller |
| 237 | * is on direct PLB interface. |
| 238 | */ |
| 239 | if (!request_mem_region(physaddr, 8, DRIVER_NAME)) { |
| 240 | dev_err(dev, "Couldn't lock memory region at 0x%08lX\n", |
| 241 | physaddr); |
| 242 | rc = -ENODEV; |
| 243 | goto err_region; |
| 244 | } |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 245 | |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 246 | drvdata->regs_phys = physaddr; |
| 247 | drvdata->regs = ioremap(physaddr, 8); |
| 248 | if (!drvdata->regs) { |
| 249 | dev_err(dev, "Couldn't lock memory region at 0x%08lX\n", |
| 250 | physaddr); |
| 251 | rc = -ENODEV; |
| 252 | goto err_map; |
| 253 | } |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 254 | } |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 255 | |
| 256 | /* Allocate the framebuffer memory */ |
Grant Likely | 287e5d6 | 2007-10-11 04:31:56 +1000 | [diff] [blame] | 257 | if (pdata->fb_phys) { |
| 258 | drvdata->fb_phys = pdata->fb_phys; |
| 259 | drvdata->fb_virt = ioremap(pdata->fb_phys, fbsize); |
| 260 | } else { |
| 261 | drvdata->fb_alloced = 1; |
| 262 | drvdata->fb_virt = dma_alloc_coherent(dev, PAGE_ALIGN(fbsize), |
| 263 | &drvdata->fb_phys, GFP_KERNEL); |
| 264 | } |
| 265 | |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 266 | if (!drvdata->fb_virt) { |
Grant Likely | 3cb3ec2 | 2007-10-04 10:48:36 -0600 | [diff] [blame] | 267 | dev_err(dev, "Could not allocate frame buffer memory\n"); |
Grant Likely | 2647762 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 268 | rc = -ENOMEM; |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 269 | if (drvdata->flags & PLB_ACCESS_FLAG) |
| 270 | goto err_fbmem; |
| 271 | else |
| 272 | goto err_region; |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 273 | } |
| 274 | |
| 275 | /* Clear (turn to black) the framebuffer */ |
Grant Likely | b4d6a72 | 2007-10-11 04:31:51 +1000 | [diff] [blame] | 276 | memset_io((void __iomem *)drvdata->fb_virt, 0, fbsize); |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 277 | |
| 278 | /* Tell the hardware where the frame buffer is */ |
| 279 | xilinx_fb_out_be32(drvdata, REG_FB_ADDR, drvdata->fb_phys); |
| 280 | |
| 281 | /* Turn on the display */ |
Grant Likely | f53161d | 2007-07-31 00:37:39 -0700 | [diff] [blame] | 282 | drvdata->reg_ctrl_default = REG_CTRL_ENABLE; |
Grant Likely | 01ba1e9 | 2007-10-11 04:31:46 +1000 | [diff] [blame] | 283 | if (pdata->rotate_screen) |
Grant Likely | f53161d | 2007-07-31 00:37:39 -0700 | [diff] [blame] | 284 | drvdata->reg_ctrl_default |= REG_CTRL_ROTATE; |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 285 | xilinx_fb_out_be32(drvdata, REG_CTRL, |
| 286 | drvdata->reg_ctrl_default); |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 287 | |
| 288 | /* Fill struct fb_info */ |
| 289 | drvdata->info.device = dev; |
Grant Likely | b9a2279 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 290 | drvdata->info.screen_base = (void __iomem *)drvdata->fb_virt; |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 291 | drvdata->info.fbops = &xilinxfb_ops; |
| 292 | drvdata->info.fix = xilinx_fb_fix; |
| 293 | drvdata->info.fix.smem_start = drvdata->fb_phys; |
Grant Likely | b4d6a72 | 2007-10-11 04:31:51 +1000 | [diff] [blame] | 294 | drvdata->info.fix.smem_len = fbsize; |
| 295 | drvdata->info.fix.line_length = pdata->xvirt * BYTES_PER_PIXEL; |
| 296 | |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 297 | drvdata->info.pseudo_palette = drvdata->pseudo_palette; |
Grant Likely | 2647762 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 298 | drvdata->info.flags = FBINFO_DEFAULT; |
| 299 | drvdata->info.var = xilinx_fb_var; |
Grant Likely | b4d6a72 | 2007-10-11 04:31:51 +1000 | [diff] [blame] | 300 | drvdata->info.var.height = pdata->screen_height_mm; |
| 301 | drvdata->info.var.width = pdata->screen_width_mm; |
| 302 | drvdata->info.var.xres = pdata->xres; |
| 303 | drvdata->info.var.yres = pdata->yres; |
| 304 | drvdata->info.var.xres_virtual = pdata->xvirt; |
| 305 | drvdata->info.var.yres_virtual = pdata->yvirt; |
Grant Likely | 2647762 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 306 | |
| 307 | /* Allocate a colour map */ |
| 308 | rc = fb_alloc_cmap(&drvdata->info.cmap, PALETTE_ENTRIES_NO, 0); |
| 309 | if (rc) { |
Grant Likely | 3cb3ec2 | 2007-10-04 10:48:36 -0600 | [diff] [blame] | 310 | dev_err(dev, "Fail to allocate colormap (%d entries)\n", |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 311 | PALETTE_ENTRIES_NO); |
Grant Likely | 3fb99ce | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 312 | goto err_cmap; |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 313 | } |
| 314 | |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 315 | /* Register new frame buffer */ |
Grant Likely | 2647762 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 316 | rc = register_framebuffer(&drvdata->info); |
| 317 | if (rc) { |
Grant Likely | 3cb3ec2 | 2007-10-04 10:48:36 -0600 | [diff] [blame] | 318 | dev_err(dev, "Could not register frame buffer\n"); |
Grant Likely | 3fb99ce | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 319 | goto err_regfb; |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 320 | } |
| 321 | |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 322 | if (drvdata->flags & PLB_ACCESS_FLAG) { |
| 323 | /* Put a banner in the log (for DEBUG) */ |
| 324 | dev_dbg(dev, "regs: phys=%lx, virt=%p\n", physaddr, |
| 325 | drvdata->regs); |
| 326 | } |
Grant Likely | 258de4b | 2007-10-04 10:48:36 -0600 | [diff] [blame] | 327 | /* Put a banner in the log (for DEBUG) */ |
Grant Likely | aa296a8 | 2009-06-17 00:30:02 -0600 | [diff] [blame] | 328 | dev_dbg(dev, "fb: phys=%llx, virt=%p, size=%x\n", |
| 329 | (unsigned long long)drvdata->fb_phys, drvdata->fb_virt, fbsize); |
Grant Likely | b4d6a72 | 2007-10-11 04:31:51 +1000 | [diff] [blame] | 330 | |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 331 | return 0; /* success */ |
| 332 | |
Grant Likely | 3fb99ce | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 333 | err_regfb: |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 334 | fb_dealloc_cmap(&drvdata->info.cmap); |
| 335 | |
Grant Likely | 3fb99ce | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 336 | err_cmap: |
Grant Likely | 287e5d6 | 2007-10-11 04:31:56 +1000 | [diff] [blame] | 337 | if (drvdata->fb_alloced) |
| 338 | dma_free_coherent(dev, PAGE_ALIGN(fbsize), drvdata->fb_virt, |
| 339 | drvdata->fb_phys); |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 340 | else |
| 341 | iounmap(drvdata->fb_virt); |
| 342 | |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 343 | /* Turn off the display */ |
| 344 | xilinx_fb_out_be32(drvdata, REG_CTRL, 0); |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 345 | |
Grant Likely | 3fb99ce | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 346 | err_fbmem: |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 347 | if (drvdata->flags & PLB_ACCESS_FLAG) |
| 348 | iounmap(drvdata->regs); |
Grant Likely | 2647762 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 349 | |
| 350 | err_map: |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 351 | if (drvdata->flags & PLB_ACCESS_FLAG) |
| 352 | release_mem_region(physaddr, 8); |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 353 | |
Grant Likely | 3fb99ce | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 354 | err_region: |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 355 | kfree(drvdata); |
| 356 | dev_set_drvdata(dev, NULL); |
| 357 | |
Grant Likely | 2647762 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 358 | return rc; |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 359 | } |
| 360 | |
Grant Likely | 2647762 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 361 | static int xilinxfb_release(struct device *dev) |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 362 | { |
Grant Likely | 2647762 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 363 | struct xilinxfb_drvdata *drvdata = dev_get_drvdata(dev); |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 364 | |
| 365 | #if !defined(CONFIG_FRAMEBUFFER_CONSOLE) && defined(CONFIG_LOGO) |
| 366 | xilinx_fb_blank(VESA_POWERDOWN, &drvdata->info); |
| 367 | #endif |
| 368 | |
| 369 | unregister_framebuffer(&drvdata->info); |
| 370 | |
| 371 | fb_dealloc_cmap(&drvdata->info.cmap); |
| 372 | |
Grant Likely | 287e5d6 | 2007-10-11 04:31:56 +1000 | [diff] [blame] | 373 | if (drvdata->fb_alloced) |
| 374 | dma_free_coherent(dev, PAGE_ALIGN(drvdata->info.fix.smem_len), |
| 375 | drvdata->fb_virt, drvdata->fb_phys); |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 376 | else |
| 377 | iounmap(drvdata->fb_virt); |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 378 | |
| 379 | /* Turn off the display */ |
| 380 | xilinx_fb_out_be32(drvdata, REG_CTRL, 0); |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 381 | |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 382 | /* Release the resources, as allocated based on interface */ |
| 383 | if (drvdata->flags & PLB_ACCESS_FLAG) { |
| 384 | iounmap(drvdata->regs); |
| 385 | release_mem_region(drvdata->regs_phys, 8); |
| 386 | } else |
| 387 | dcr_unmap(drvdata->dcr_host, drvdata->dcr_len); |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 388 | |
| 389 | kfree(drvdata); |
| 390 | dev_set_drvdata(dev, NULL); |
| 391 | |
| 392 | return 0; |
| 393 | } |
| 394 | |
Grant Likely | 2647762 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 395 | /* --------------------------------------------------------------------- |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 396 | * OF bus binding |
| 397 | */ |
| 398 | |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 399 | static int __devinit |
Grant Likely | 2dc1158 | 2010-08-06 09:25:50 -0600 | [diff] [blame] | 400 | xilinxfb_of_probe(struct platform_device *op, const struct of_device_id *match) |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 401 | { |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 402 | const u32 *prop; |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 403 | u32 *p; |
| 404 | u32 tft_access; |
Grant Likely | 01ba1e9 | 2007-10-11 04:31:46 +1000 | [diff] [blame] | 405 | struct xilinxfb_platform_data pdata; |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 406 | struct resource res; |
Grant Likely | aa296a8 | 2009-06-17 00:30:02 -0600 | [diff] [blame] | 407 | int size, rc, start; |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 408 | struct xilinxfb_drvdata *drvdata; |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 409 | |
Grant Likely | 01ba1e9 | 2007-10-11 04:31:46 +1000 | [diff] [blame] | 410 | /* Copy with the default pdata (not a ptr reference!) */ |
| 411 | pdata = xilinx_fb_default_pdata; |
| 412 | |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 413 | dev_dbg(&op->dev, "xilinxfb_of_probe(%p, %p)\n", op, match); |
| 414 | |
Grant Likely | aa296a8 | 2009-06-17 00:30:02 -0600 | [diff] [blame] | 415 | /* Allocate the driver data region */ |
| 416 | drvdata = kzalloc(sizeof(*drvdata), GFP_KERNEL); |
| 417 | if (!drvdata) { |
| 418 | dev_err(&op->dev, "Couldn't allocate device private record\n"); |
| 419 | return -ENOMEM; |
| 420 | } |
| 421 | |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 422 | /* |
| 423 | * To check whether the core is connected directly to DCR or PLB |
| 424 | * interface and initialize the tft_access accordingly. |
| 425 | */ |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 426 | p = (u32 *)of_get_property(op->dev.of_node, "xlnx,dcr-splb-slave-if", NULL); |
Grant Likely | aa296a8 | 2009-06-17 00:30:02 -0600 | [diff] [blame] | 427 | tft_access = p ? *p : 0; |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 428 | |
| 429 | /* |
| 430 | * Fill the resource structure if its direct PLB interface |
| 431 | * otherwise fill the dcr_host structure. |
| 432 | */ |
| 433 | if (tft_access) { |
Grant Likely | aa296a8 | 2009-06-17 00:30:02 -0600 | [diff] [blame] | 434 | drvdata->flags |= PLB_ACCESS_FLAG; |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 435 | rc = of_address_to_resource(op->dev.of_node, 0, &res); |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 436 | if (rc) { |
| 437 | dev_err(&op->dev, "invalid address\n"); |
Grant Likely | aa296a8 | 2009-06-17 00:30:02 -0600 | [diff] [blame] | 438 | goto err; |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 439 | } |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 440 | } else { |
Grant Likely | aa296a8 | 2009-06-17 00:30:02 -0600 | [diff] [blame] | 441 | res.start = 0; |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 442 | start = dcr_resource_start(op->dev.of_node, 0); |
| 443 | drvdata->dcr_len = dcr_resource_len(op->dev.of_node, 0); |
| 444 | drvdata->dcr_host = dcr_map(op->dev.of_node, start, drvdata->dcr_len); |
Grant Likely | aa296a8 | 2009-06-17 00:30:02 -0600 | [diff] [blame] | 445 | if (!DCR_MAP_OK(drvdata->dcr_host)) { |
| 446 | dev_err(&op->dev, "invalid DCR address\n"); |
| 447 | goto err; |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 448 | } |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 449 | } |
| 450 | |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 451 | prop = of_get_property(op->dev.of_node, "phys-size", &size); |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 452 | if ((prop) && (size >= sizeof(u32)*2)) { |
Grant Likely | 01ba1e9 | 2007-10-11 04:31:46 +1000 | [diff] [blame] | 453 | pdata.screen_width_mm = prop[0]; |
| 454 | pdata.screen_height_mm = prop[1]; |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 455 | } |
| 456 | |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 457 | prop = of_get_property(op->dev.of_node, "resolution", &size); |
Grant Likely | b4d6a72 | 2007-10-11 04:31:51 +1000 | [diff] [blame] | 458 | if ((prop) && (size >= sizeof(u32)*2)) { |
| 459 | pdata.xres = prop[0]; |
| 460 | pdata.yres = prop[1]; |
| 461 | } |
| 462 | |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 463 | prop = of_get_property(op->dev.of_node, "virtual-resolution", &size); |
Grant Likely | b4d6a72 | 2007-10-11 04:31:51 +1000 | [diff] [blame] | 464 | if ((prop) && (size >= sizeof(u32)*2)) { |
| 465 | pdata.xvirt = prop[0]; |
| 466 | pdata.yvirt = prop[1]; |
| 467 | } |
| 468 | |
Grant Likely | 61c7a08 | 2010-04-13 16:12:29 -0700 | [diff] [blame] | 469 | if (of_find_property(op->dev.of_node, "rotate-display", NULL)) |
Grant Likely | 01ba1e9 | 2007-10-11 04:31:46 +1000 | [diff] [blame] | 470 | pdata.rotate_screen = 1; |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 471 | |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 472 | dev_set_drvdata(&op->dev, drvdata); |
Grant Likely | aa296a8 | 2009-06-17 00:30:02 -0600 | [diff] [blame] | 473 | return xilinxfb_assign(&op->dev, drvdata, res.start, &pdata); |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 474 | |
Grant Likely | aa296a8 | 2009-06-17 00:30:02 -0600 | [diff] [blame] | 475 | err: |
| 476 | kfree(drvdata); |
| 477 | return -ENODEV; |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 478 | } |
| 479 | |
Grant Likely | 2dc1158 | 2010-08-06 09:25:50 -0600 | [diff] [blame] | 480 | static int __devexit xilinxfb_of_remove(struct platform_device *op) |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 481 | { |
| 482 | return xilinxfb_release(&op->dev); |
| 483 | } |
| 484 | |
| 485 | /* Match table for of_platform binding */ |
Grant Likely | 911a317 | 2008-02-06 10:23:12 -0700 | [diff] [blame] | 486 | static struct of_device_id xilinxfb_of_match[] __devinitdata = { |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 487 | { .compatible = "xlnx,xps-tft-1.00.a", }, |
Adrian Alonso | 652078b | 2010-07-27 11:24:13 +0000 | [diff] [blame] | 488 | { .compatible = "xlnx,xps-tft-2.00.a", }, |
| 489 | { .compatible = "xlnx,xps-tft-2.01.a", }, |
Stephen Neuendorffer | 0e349b0 | 2008-01-09 06:35:05 +1100 | [diff] [blame] | 490 | { .compatible = "xlnx,plb-tft-cntlr-ref-1.00.a", }, |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 491 | { .compatible = "xlnx,plb-dvi-cntlr-ref-1.00.c", }, |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 492 | {}, |
| 493 | }; |
| 494 | MODULE_DEVICE_TABLE(of, xilinxfb_of_match); |
| 495 | |
| 496 | static struct of_platform_driver xilinxfb_of_driver = { |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 497 | .probe = xilinxfb_of_probe, |
| 498 | .remove = __devexit_p(xilinxfb_of_remove), |
| 499 | .driver = { |
| 500 | .name = DRIVER_NAME, |
Grant Likely | 4018294 | 2010-04-13 16:13:02 -0700 | [diff] [blame] | 501 | .owner = THIS_MODULE, |
| 502 | .of_match_table = xilinxfb_of_match, |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 503 | }, |
| 504 | }; |
| 505 | |
Grant Likely | 31e8d46 | 2007-10-04 10:48:37 -0600 | [diff] [blame] | 506 | |
| 507 | /* --------------------------------------------------------------------- |
| 508 | * Module setup and teardown |
| 509 | */ |
| 510 | |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 511 | static int __init |
| 512 | xilinxfb_init(void) |
| 513 | { |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 514 | return of_register_platform_driver(&xilinxfb_of_driver); |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 515 | } |
| 516 | |
| 517 | static void __exit |
| 518 | xilinxfb_cleanup(void) |
| 519 | { |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 520 | of_unregister_platform_driver(&xilinxfb_of_driver); |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 521 | } |
| 522 | |
| 523 | module_init(xilinxfb_init); |
| 524 | module_exit(xilinxfb_cleanup); |
| 525 | |
| 526 | MODULE_AUTHOR("MontaVista Software, Inc. <source@mvista.com>"); |
John Linn | dac4ccf | 2009-06-06 10:43:16 -0600 | [diff] [blame] | 527 | MODULE_DESCRIPTION("Xilinx TFT frame buffer driver"); |
Andrei Konovalov | 147394c | 2007-05-08 00:40:18 -0700 | [diff] [blame] | 528 | MODULE_LICENSE("GPL"); |