1f7018c21STomi Valkeinen /*
2f7018c21STomi Valkeinen * Freescale i.MX Frame Buffer device driver
3f7018c21STomi Valkeinen *
4f7018c21STomi Valkeinen * Copyright (C) 2004 Sascha Hauer, Pengutronix
5f7018c21STomi Valkeinen * Based on acornfb.c Copyright (C) Russell King.
6f7018c21STomi Valkeinen *
7f7018c21STomi Valkeinen * This file is subject to the terms and conditions of the GNU General Public
8f7018c21STomi Valkeinen * License. See the file COPYING in the main directory of this archive for
9f7018c21STomi Valkeinen * more details.
10f7018c21STomi Valkeinen *
11f7018c21STomi Valkeinen * Please direct your questions and comments on this driver to the following
12f7018c21STomi Valkeinen * email address:
13f7018c21STomi Valkeinen *
14f7018c21STomi Valkeinen * linux-arm-kernel@lists.arm.linux.org.uk
15f7018c21STomi Valkeinen */
16f7018c21STomi Valkeinen
17f7018c21STomi Valkeinen #include <linux/module.h>
18f7018c21STomi Valkeinen #include <linux/kernel.h>
19f7018c21STomi Valkeinen #include <linux/errno.h>
20f7018c21STomi Valkeinen #include <linux/string.h>
21f7018c21STomi Valkeinen #include <linux/interrupt.h>
22f7018c21STomi Valkeinen #include <linux/slab.h>
23f7018c21STomi Valkeinen #include <linux/mm.h>
24f7018c21STomi Valkeinen #include <linux/fb.h>
25f7018c21STomi Valkeinen #include <linux/delay.h>
26f7018c21STomi Valkeinen #include <linux/init.h>
27f7018c21STomi Valkeinen #include <linux/ioport.h>
28f7018c21STomi Valkeinen #include <linux/cpufreq.h>
29f7018c21STomi Valkeinen #include <linux/clk.h>
30f7018c21STomi Valkeinen #include <linux/platform_device.h>
31f7018c21STomi Valkeinen #include <linux/dma-mapping.h>
32f7018c21STomi Valkeinen #include <linux/io.h>
33f7018c21STomi Valkeinen #include <linux/lcd.h>
34f7018c21STomi Valkeinen #include <linux/math64.h>
35f7018c21STomi Valkeinen #include <linux/of.h>
36f7018c21STomi Valkeinen #include <linux/of_device.h>
37f7018c21STomi Valkeinen
38f7018c21STomi Valkeinen #include <linux/regulator/consumer.h>
39f7018c21STomi Valkeinen
40f7018c21STomi Valkeinen #include <video/of_display_timing.h>
41f7018c21STomi Valkeinen #include <video/of_videomode.h>
42f7018c21STomi Valkeinen #include <video/videomode.h>
43f7018c21STomi Valkeinen
44ded77a74SUwe Kleine-König #define PCR_TFT (1 << 31)
45*71ec48abSDario Binacchi #define PCR_COLOR (1 << 30)
46ded77a74SUwe Kleine-König #define PCR_BPIX_8 (3 << 25)
47ded77a74SUwe Kleine-König #define PCR_BPIX_12 (4 << 25)
48ded77a74SUwe Kleine-König #define PCR_BPIX_16 (5 << 25)
49ded77a74SUwe Kleine-König #define PCR_BPIX_18 (6 << 25)
50ded77a74SUwe Kleine-König
51ded77a74SUwe Kleine-König struct imx_fb_videomode {
52ded77a74SUwe Kleine-König struct fb_videomode mode;
53ded77a74SUwe Kleine-König u32 pcr;
54ded77a74SUwe Kleine-König bool aus_mode;
55ded77a74SUwe Kleine-König unsigned char bpp;
56ded77a74SUwe Kleine-König };
57f7018c21STomi Valkeinen
58f7018c21STomi Valkeinen /*
59f7018c21STomi Valkeinen * Complain if VAR is out of range.
60f7018c21STomi Valkeinen */
61f7018c21STomi Valkeinen #define DEBUG_VAR 1
62f7018c21STomi Valkeinen
63f7018c21STomi Valkeinen #define DRIVER_NAME "imx-fb"
64f7018c21STomi Valkeinen
65f7018c21STomi Valkeinen #define LCDC_SSA 0x00
66f7018c21STomi Valkeinen
67f7018c21STomi Valkeinen #define LCDC_SIZE 0x04
68f7018c21STomi Valkeinen #define SIZE_XMAX(x) ((((x) >> 4) & 0x3f) << 20)
69f7018c21STomi Valkeinen
70f7018c21STomi Valkeinen #define YMAX_MASK_IMX1 0x1ff
71f7018c21STomi Valkeinen #define YMAX_MASK_IMX21 0x3ff
72f7018c21STomi Valkeinen
73f7018c21STomi Valkeinen #define LCDC_VPW 0x08
74f7018c21STomi Valkeinen #define VPW_VPW(x) ((x) & 0x3ff)
75f7018c21STomi Valkeinen
76f7018c21STomi Valkeinen #define LCDC_CPOS 0x0C
77f7018c21STomi Valkeinen #define CPOS_CC1 (1<<31)
78f7018c21STomi Valkeinen #define CPOS_CC0 (1<<30)
79f7018c21STomi Valkeinen #define CPOS_OP (1<<28)
80f7018c21STomi Valkeinen #define CPOS_CXP(x) (((x) & 3ff) << 16)
81f7018c21STomi Valkeinen
82f7018c21STomi Valkeinen #define LCDC_LCWHB 0x10
83f7018c21STomi Valkeinen #define LCWHB_BK_EN (1<<31)
84f7018c21STomi Valkeinen #define LCWHB_CW(w) (((w) & 0x1f) << 24)
85f7018c21STomi Valkeinen #define LCWHB_CH(h) (((h) & 0x1f) << 16)
86f7018c21STomi Valkeinen #define LCWHB_BD(x) ((x) & 0xff)
87f7018c21STomi Valkeinen
88f7018c21STomi Valkeinen #define LCDC_LCHCC 0x14
89f7018c21STomi Valkeinen
90f7018c21STomi Valkeinen #define LCDC_PCR 0x18
91f7018c21STomi Valkeinen
92f7018c21STomi Valkeinen #define LCDC_HCR 0x1C
93f7018c21STomi Valkeinen #define HCR_H_WIDTH(x) (((x) & 0x3f) << 26)
94f7018c21STomi Valkeinen #define HCR_H_WAIT_1(x) (((x) & 0xff) << 8)
95f7018c21STomi Valkeinen #define HCR_H_WAIT_2(x) ((x) & 0xff)
96f7018c21STomi Valkeinen
97f7018c21STomi Valkeinen #define LCDC_VCR 0x20
98f7018c21STomi Valkeinen #define VCR_V_WIDTH(x) (((x) & 0x3f) << 26)
99f7018c21STomi Valkeinen #define VCR_V_WAIT_1(x) (((x) & 0xff) << 8)
100f7018c21STomi Valkeinen #define VCR_V_WAIT_2(x) ((x) & 0xff)
101f7018c21STomi Valkeinen
102f7018c21STomi Valkeinen #define LCDC_POS 0x24
103f7018c21STomi Valkeinen #define POS_POS(x) ((x) & 1f)
104f7018c21STomi Valkeinen
105f7018c21STomi Valkeinen #define LCDC_LSCR1 0x28
106f7018c21STomi Valkeinen /* bit fields in imxfb.h */
107f7018c21STomi Valkeinen
108f7018c21STomi Valkeinen #define LCDC_PWMR 0x2C
109f7018c21STomi Valkeinen /* bit fields in imxfb.h */
110f7018c21STomi Valkeinen
111f7018c21STomi Valkeinen #define LCDC_DMACR 0x30
112f7018c21STomi Valkeinen /* bit fields in imxfb.h */
113f7018c21STomi Valkeinen
114f7018c21STomi Valkeinen #define LCDC_RMCR 0x34
115f7018c21STomi Valkeinen
116f7018c21STomi Valkeinen #define RMCR_LCDC_EN_MX1 (1<<1)
117f7018c21STomi Valkeinen
118f7018c21STomi Valkeinen #define RMCR_SELF_REF (1<<0)
119f7018c21STomi Valkeinen
120f7018c21STomi Valkeinen #define LCDC_LCDICR 0x38
121f7018c21STomi Valkeinen #define LCDICR_INT_SYN (1<<2)
122f7018c21STomi Valkeinen #define LCDICR_INT_CON (1)
123f7018c21STomi Valkeinen
124f7018c21STomi Valkeinen #define LCDC_LCDISR 0x40
125f7018c21STomi Valkeinen #define LCDISR_UDR_ERR (1<<3)
126f7018c21STomi Valkeinen #define LCDISR_ERR_RES (1<<2)
127f7018c21STomi Valkeinen #define LCDISR_EOF (1<<1)
128f7018c21STomi Valkeinen #define LCDISR_BOF (1<<0)
129f7018c21STomi Valkeinen
130f7018c21STomi Valkeinen #define IMXFB_LSCR1_DEFAULT 0x00120300
131f7018c21STomi Valkeinen
132b62ea411SMartin Kaiser #define LCDC_LAUSCR 0x80
133b62ea411SMartin Kaiser #define LAUSCR_AUS_MODE (1<<31)
134b62ea411SMartin Kaiser
135f7018c21STomi Valkeinen /* Used fb-mode. Can be set on kernel command line, therefore file-static. */
136f7018c21STomi Valkeinen static const char *fb_mode;
137f7018c21STomi Valkeinen
138f7018c21STomi Valkeinen /*
139f7018c21STomi Valkeinen * These are the bitfields for each
140f7018c21STomi Valkeinen * display depth that we support.
141f7018c21STomi Valkeinen */
142f7018c21STomi Valkeinen struct imxfb_rgb {
143f7018c21STomi Valkeinen struct fb_bitfield red;
144f7018c21STomi Valkeinen struct fb_bitfield green;
145f7018c21STomi Valkeinen struct fb_bitfield blue;
146f7018c21STomi Valkeinen struct fb_bitfield transp;
147f7018c21STomi Valkeinen };
148f7018c21STomi Valkeinen
149f7018c21STomi Valkeinen enum imxfb_type {
150f7018c21STomi Valkeinen IMX1_FB,
151f7018c21STomi Valkeinen IMX21_FB,
152f7018c21STomi Valkeinen };
153f7018c21STomi Valkeinen
154*71ec48abSDario Binacchi enum imxfb_panel_type {
155*71ec48abSDario Binacchi PANEL_TYPE_MONOCHROME,
156*71ec48abSDario Binacchi PANEL_TYPE_CSTN,
157*71ec48abSDario Binacchi PANEL_TYPE_TFT,
158*71ec48abSDario Binacchi };
159*71ec48abSDario Binacchi
160f7018c21STomi Valkeinen struct imxfb_info {
161f7018c21STomi Valkeinen struct platform_device *pdev;
162f7018c21STomi Valkeinen void __iomem *regs;
163f7018c21STomi Valkeinen struct clk *clk_ipg;
164f7018c21STomi Valkeinen struct clk *clk_ahb;
165f7018c21STomi Valkeinen struct clk *clk_per;
166f7018c21STomi Valkeinen enum imxfb_type devtype;
167*71ec48abSDario Binacchi enum imxfb_panel_type panel_type;
168f7018c21STomi Valkeinen bool enabled;
169f7018c21STomi Valkeinen
170f7018c21STomi Valkeinen /*
171f7018c21STomi Valkeinen * These are the addresses we mapped
172f7018c21STomi Valkeinen * the framebuffer memory region to.
173f7018c21STomi Valkeinen */
174f7018c21STomi Valkeinen dma_addr_t map_dma;
175f7018c21STomi Valkeinen u_int map_size;
176f7018c21STomi Valkeinen
177f7018c21STomi Valkeinen u_int palette_size;
178f7018c21STomi Valkeinen
179f7018c21STomi Valkeinen dma_addr_t dbar1;
180f7018c21STomi Valkeinen dma_addr_t dbar2;
181f7018c21STomi Valkeinen
182f7018c21STomi Valkeinen u_int pcr;
183b62ea411SMartin Kaiser u_int lauscr;
184f7018c21STomi Valkeinen u_int pwmr;
185f7018c21STomi Valkeinen u_int lscr1;
186f7018c21STomi Valkeinen u_int dmacr;
187f7018c21STomi Valkeinen bool cmap_inverse;
188f7018c21STomi Valkeinen bool cmap_static;
189f7018c21STomi Valkeinen
190f7018c21STomi Valkeinen struct imx_fb_videomode *mode;
191f7018c21STomi Valkeinen int num_modes;
192f7018c21STomi Valkeinen
193f7018c21STomi Valkeinen struct regulator *lcd_pwr;
1945c694f80SUwe Kleine-König int lcd_pwr_enabled;
195f7018c21STomi Valkeinen };
196f7018c21STomi Valkeinen
197bd388a2cSKrzysztof Kozlowski static const struct platform_device_id imxfb_devtype[] = {
198f7018c21STomi Valkeinen {
199f7018c21STomi Valkeinen .name = "imx1-fb",
200f7018c21STomi Valkeinen .driver_data = IMX1_FB,
201f7018c21STomi Valkeinen }, {
202f7018c21STomi Valkeinen .name = "imx21-fb",
203f7018c21STomi Valkeinen .driver_data = IMX21_FB,
204f7018c21STomi Valkeinen }, {
205f7018c21STomi Valkeinen /* sentinel */
206f7018c21STomi Valkeinen }
207f7018c21STomi Valkeinen };
208f7018c21STomi Valkeinen MODULE_DEVICE_TABLE(platform, imxfb_devtype);
209f7018c21STomi Valkeinen
2105d802441SSanjeev Sharma static const struct of_device_id imxfb_of_dev_id[] = {
211f7018c21STomi Valkeinen {
212f7018c21STomi Valkeinen .compatible = "fsl,imx1-fb",
213f7018c21STomi Valkeinen .data = &imxfb_devtype[IMX1_FB],
214f7018c21STomi Valkeinen }, {
215f7018c21STomi Valkeinen .compatible = "fsl,imx21-fb",
216f7018c21STomi Valkeinen .data = &imxfb_devtype[IMX21_FB],
217f7018c21STomi Valkeinen }, {
218f7018c21STomi Valkeinen /* sentinel */
219f7018c21STomi Valkeinen }
220f7018c21STomi Valkeinen };
221f7018c21STomi Valkeinen MODULE_DEVICE_TABLE(of, imxfb_of_dev_id);
222f7018c21STomi Valkeinen
is_imx1_fb(struct imxfb_info * fbi)223f7018c21STomi Valkeinen static inline int is_imx1_fb(struct imxfb_info *fbi)
224f7018c21STomi Valkeinen {
225f7018c21STomi Valkeinen return fbi->devtype == IMX1_FB;
226f7018c21STomi Valkeinen }
227f7018c21STomi Valkeinen
228f7018c21STomi Valkeinen #define IMX_NAME "IMX"
229f7018c21STomi Valkeinen
230f7018c21STomi Valkeinen /*
231f7018c21STomi Valkeinen * Minimum X and Y resolutions
232f7018c21STomi Valkeinen */
233f7018c21STomi Valkeinen #define MIN_XRES 64
234f7018c21STomi Valkeinen #define MIN_YRES 64
235f7018c21STomi Valkeinen
236f7018c21STomi Valkeinen /* Actually this really is 18bit support, the lowest 2 bits of each colour
237f7018c21STomi Valkeinen * are unused in hardware. We claim to have 24bit support to make software
238f7018c21STomi Valkeinen * like X work, which does not support 18bit.
239f7018c21STomi Valkeinen */
240f7018c21STomi Valkeinen static struct imxfb_rgb def_rgb_18 = {
241f7018c21STomi Valkeinen .red = {.offset = 16, .length = 8,},
242f7018c21STomi Valkeinen .green = {.offset = 8, .length = 8,},
243f7018c21STomi Valkeinen .blue = {.offset = 0, .length = 8,},
244f7018c21STomi Valkeinen .transp = {.offset = 0, .length = 0,},
245f7018c21STomi Valkeinen };
246f7018c21STomi Valkeinen
247f7018c21STomi Valkeinen static struct imxfb_rgb def_rgb_16_tft = {
248f7018c21STomi Valkeinen .red = {.offset = 11, .length = 5,},
249f7018c21STomi Valkeinen .green = {.offset = 5, .length = 6,},
250f7018c21STomi Valkeinen .blue = {.offset = 0, .length = 5,},
251f7018c21STomi Valkeinen .transp = {.offset = 0, .length = 0,},
252f7018c21STomi Valkeinen };
253f7018c21STomi Valkeinen
254f7018c21STomi Valkeinen static struct imxfb_rgb def_rgb_16_stn = {
255f7018c21STomi Valkeinen .red = {.offset = 8, .length = 4,},
256f7018c21STomi Valkeinen .green = {.offset = 4, .length = 4,},
257f7018c21STomi Valkeinen .blue = {.offset = 0, .length = 4,},
258f7018c21STomi Valkeinen .transp = {.offset = 0, .length = 0,},
259f7018c21STomi Valkeinen };
260f7018c21STomi Valkeinen
261f7018c21STomi Valkeinen static struct imxfb_rgb def_rgb_8 = {
262f7018c21STomi Valkeinen .red = {.offset = 0, .length = 8,},
263f7018c21STomi Valkeinen .green = {.offset = 0, .length = 8,},
264f7018c21STomi Valkeinen .blue = {.offset = 0, .length = 8,},
265f7018c21STomi Valkeinen .transp = {.offset = 0, .length = 0,},
266f7018c21STomi Valkeinen };
267f7018c21STomi Valkeinen
268f7018c21STomi Valkeinen static int imxfb_activate_var(struct fb_var_screeninfo *var,
269f7018c21STomi Valkeinen struct fb_info *info);
270f7018c21STomi Valkeinen
chan_to_field(u_int chan,struct fb_bitfield * bf)271f7018c21STomi Valkeinen static inline u_int chan_to_field(u_int chan, struct fb_bitfield *bf)
272f7018c21STomi Valkeinen {
273f7018c21STomi Valkeinen chan &= 0xffff;
274f7018c21STomi Valkeinen chan >>= 16 - bf->length;
275f7018c21STomi Valkeinen return chan << bf->offset;
276f7018c21STomi Valkeinen }
277f7018c21STomi Valkeinen
imxfb_setpalettereg(u_int regno,u_int red,u_int green,u_int blue,u_int trans,struct fb_info * info)278f7018c21STomi Valkeinen static int imxfb_setpalettereg(u_int regno, u_int red, u_int green, u_int blue,
279f7018c21STomi Valkeinen u_int trans, struct fb_info *info)
280f7018c21STomi Valkeinen {
281f7018c21STomi Valkeinen struct imxfb_info *fbi = info->par;
282f7018c21STomi Valkeinen u_int val, ret = 1;
283f7018c21STomi Valkeinen
284f7018c21STomi Valkeinen #define CNVT_TOHW(val,width) ((((val)<<(width))+0x7FFF-(val))>>16)
285f7018c21STomi Valkeinen if (regno < fbi->palette_size) {
286f7018c21STomi Valkeinen val = (CNVT_TOHW(red, 4) << 8) |
287f7018c21STomi Valkeinen (CNVT_TOHW(green,4) << 4) |
288f7018c21STomi Valkeinen CNVT_TOHW(blue, 4);
289f7018c21STomi Valkeinen
290f7018c21STomi Valkeinen writel(val, fbi->regs + 0x800 + (regno << 2));
291f7018c21STomi Valkeinen ret = 0;
292f7018c21STomi Valkeinen }
293f7018c21STomi Valkeinen return ret;
294f7018c21STomi Valkeinen }
295f7018c21STomi Valkeinen
imxfb_setcolreg(u_int regno,u_int red,u_int green,u_int blue,u_int trans,struct fb_info * info)296f7018c21STomi Valkeinen static int imxfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
297f7018c21STomi Valkeinen u_int trans, struct fb_info *info)
298f7018c21STomi Valkeinen {
299f7018c21STomi Valkeinen struct imxfb_info *fbi = info->par;
300f7018c21STomi Valkeinen unsigned int val;
301f7018c21STomi Valkeinen int ret = 1;
302f7018c21STomi Valkeinen
303f7018c21STomi Valkeinen /*
304f7018c21STomi Valkeinen * If inverse mode was selected, invert all the colours
305f7018c21STomi Valkeinen * rather than the register number. The register number
306f7018c21STomi Valkeinen * is what you poke into the framebuffer to produce the
307f7018c21STomi Valkeinen * colour you requested.
308f7018c21STomi Valkeinen */
309f7018c21STomi Valkeinen if (fbi->cmap_inverse) {
310f7018c21STomi Valkeinen red = 0xffff - red;
311f7018c21STomi Valkeinen green = 0xffff - green;
312f7018c21STomi Valkeinen blue = 0xffff - blue;
313f7018c21STomi Valkeinen }
314f7018c21STomi Valkeinen
315f7018c21STomi Valkeinen /*
316f7018c21STomi Valkeinen * If greyscale is true, then we convert the RGB value
317f7018c21STomi Valkeinen * to greyscale no mater what visual we are using.
318f7018c21STomi Valkeinen */
319f7018c21STomi Valkeinen if (info->var.grayscale)
320f7018c21STomi Valkeinen red = green = blue = (19595 * red + 38470 * green +
321f7018c21STomi Valkeinen 7471 * blue) >> 16;
322f7018c21STomi Valkeinen
323f7018c21STomi Valkeinen switch (info->fix.visual) {
324f7018c21STomi Valkeinen case FB_VISUAL_TRUECOLOR:
325f7018c21STomi Valkeinen /*
326f7018c21STomi Valkeinen * 12 or 16-bit True Colour. We encode the RGB value
327f7018c21STomi Valkeinen * according to the RGB bitfield information.
328f7018c21STomi Valkeinen */
329f7018c21STomi Valkeinen if (regno < 16) {
330f7018c21STomi Valkeinen u32 *pal = info->pseudo_palette;
331f7018c21STomi Valkeinen
332f7018c21STomi Valkeinen val = chan_to_field(red, &info->var.red);
333f7018c21STomi Valkeinen val |= chan_to_field(green, &info->var.green);
334f7018c21STomi Valkeinen val |= chan_to_field(blue, &info->var.blue);
335f7018c21STomi Valkeinen
336f7018c21STomi Valkeinen pal[regno] = val;
337f7018c21STomi Valkeinen ret = 0;
338f7018c21STomi Valkeinen }
339f7018c21STomi Valkeinen break;
340f7018c21STomi Valkeinen
341f7018c21STomi Valkeinen case FB_VISUAL_STATIC_PSEUDOCOLOR:
342f7018c21STomi Valkeinen case FB_VISUAL_PSEUDOCOLOR:
343f7018c21STomi Valkeinen ret = imxfb_setpalettereg(regno, red, green, blue, trans, info);
344f7018c21STomi Valkeinen break;
345f7018c21STomi Valkeinen }
346f7018c21STomi Valkeinen
347f7018c21STomi Valkeinen return ret;
348f7018c21STomi Valkeinen }
349f7018c21STomi Valkeinen
imxfb_find_mode(struct imxfb_info * fbi)350f7018c21STomi Valkeinen static const struct imx_fb_videomode *imxfb_find_mode(struct imxfb_info *fbi)
351f7018c21STomi Valkeinen {
352f7018c21STomi Valkeinen struct imx_fb_videomode *m;
353f7018c21STomi Valkeinen int i;
354f7018c21STomi Valkeinen
355f7018c21STomi Valkeinen if (!fb_mode)
356f7018c21STomi Valkeinen return &fbi->mode[0];
357f7018c21STomi Valkeinen
358f7018c21STomi Valkeinen for (i = 0, m = &fbi->mode[0]; i < fbi->num_modes; i++, m++) {
359f7018c21STomi Valkeinen if (!strcmp(m->mode.name, fb_mode))
360f7018c21STomi Valkeinen return m;
361f7018c21STomi Valkeinen }
362f7018c21STomi Valkeinen return NULL;
363f7018c21STomi Valkeinen }
364f7018c21STomi Valkeinen
365f7018c21STomi Valkeinen /*
366f7018c21STomi Valkeinen * imxfb_check_var():
367f7018c21STomi Valkeinen * Round up in the following order: bits_per_pixel, xres,
368f7018c21STomi Valkeinen * yres, xres_virtual, yres_virtual, xoffset, yoffset, grayscale,
369f7018c21STomi Valkeinen * bitfields, horizontal timing, vertical timing.
370f7018c21STomi Valkeinen */
imxfb_check_var(struct fb_var_screeninfo * var,struct fb_info * info)371f7018c21STomi Valkeinen static int imxfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
372f7018c21STomi Valkeinen {
373f7018c21STomi Valkeinen struct imxfb_info *fbi = info->par;
374f7018c21STomi Valkeinen struct imxfb_rgb *rgb;
375f7018c21STomi Valkeinen const struct imx_fb_videomode *imxfb_mode;
376f7018c21STomi Valkeinen unsigned long lcd_clk;
377f7018c21STomi Valkeinen unsigned long long tmp;
378f7018c21STomi Valkeinen u32 pcr = 0;
379f7018c21STomi Valkeinen
380f7018c21STomi Valkeinen if (var->xres < MIN_XRES)
381f7018c21STomi Valkeinen var->xres = MIN_XRES;
382f7018c21STomi Valkeinen if (var->yres < MIN_YRES)
383f7018c21STomi Valkeinen var->yres = MIN_YRES;
384f7018c21STomi Valkeinen
385f7018c21STomi Valkeinen imxfb_mode = imxfb_find_mode(fbi);
386f7018c21STomi Valkeinen if (!imxfb_mode)
387f7018c21STomi Valkeinen return -EINVAL;
388f7018c21STomi Valkeinen
389f7018c21STomi Valkeinen var->xres = imxfb_mode->mode.xres;
390f7018c21STomi Valkeinen var->yres = imxfb_mode->mode.yres;
391f7018c21STomi Valkeinen var->bits_per_pixel = imxfb_mode->bpp;
392f7018c21STomi Valkeinen var->pixclock = imxfb_mode->mode.pixclock;
393f7018c21STomi Valkeinen var->hsync_len = imxfb_mode->mode.hsync_len;
394f7018c21STomi Valkeinen var->left_margin = imxfb_mode->mode.left_margin;
395f7018c21STomi Valkeinen var->right_margin = imxfb_mode->mode.right_margin;
396f7018c21STomi Valkeinen var->vsync_len = imxfb_mode->mode.vsync_len;
397f7018c21STomi Valkeinen var->upper_margin = imxfb_mode->mode.upper_margin;
398f7018c21STomi Valkeinen var->lower_margin = imxfb_mode->mode.lower_margin;
399f7018c21STomi Valkeinen var->sync = imxfb_mode->mode.sync;
400f7018c21STomi Valkeinen var->xres_virtual = max(var->xres_virtual, var->xres);
401f7018c21STomi Valkeinen var->yres_virtual = max(var->yres_virtual, var->yres);
402f7018c21STomi Valkeinen
403f7018c21STomi Valkeinen pr_debug("var->bits_per_pixel=%d\n", var->bits_per_pixel);
404f7018c21STomi Valkeinen
405f7018c21STomi Valkeinen lcd_clk = clk_get_rate(fbi->clk_per);
406f7018c21STomi Valkeinen
407f7018c21STomi Valkeinen tmp = var->pixclock * (unsigned long long)lcd_clk;
408f7018c21STomi Valkeinen
409f7018c21STomi Valkeinen do_div(tmp, 1000000);
410f7018c21STomi Valkeinen
411f7018c21STomi Valkeinen if (do_div(tmp, 1000000) > 500000)
412f7018c21STomi Valkeinen tmp++;
413f7018c21STomi Valkeinen
414f7018c21STomi Valkeinen pcr = (unsigned int)tmp;
415f7018c21STomi Valkeinen
416f7018c21STomi Valkeinen if (--pcr > 0x3F) {
417f7018c21STomi Valkeinen pcr = 0x3F;
418f7018c21STomi Valkeinen printk(KERN_WARNING "Must limit pixel clock to %luHz\n",
419f7018c21STomi Valkeinen lcd_clk / pcr);
420f7018c21STomi Valkeinen }
421f7018c21STomi Valkeinen
422f7018c21STomi Valkeinen switch (var->bits_per_pixel) {
423f7018c21STomi Valkeinen case 32:
424f7018c21STomi Valkeinen pcr |= PCR_BPIX_18;
425f7018c21STomi Valkeinen rgb = &def_rgb_18;
426f7018c21STomi Valkeinen break;
427f7018c21STomi Valkeinen case 16:
428f7018c21STomi Valkeinen default:
429f7018c21STomi Valkeinen if (is_imx1_fb(fbi))
430f7018c21STomi Valkeinen pcr |= PCR_BPIX_12;
431f7018c21STomi Valkeinen else
432f7018c21STomi Valkeinen pcr |= PCR_BPIX_16;
433f7018c21STomi Valkeinen
434f7018c21STomi Valkeinen if (imxfb_mode->pcr & PCR_TFT)
435f7018c21STomi Valkeinen rgb = &def_rgb_16_tft;
436f7018c21STomi Valkeinen else
437f7018c21STomi Valkeinen rgb = &def_rgb_16_stn;
438f7018c21STomi Valkeinen break;
439f7018c21STomi Valkeinen case 8:
440f7018c21STomi Valkeinen pcr |= PCR_BPIX_8;
441f7018c21STomi Valkeinen rgb = &def_rgb_8;
442f7018c21STomi Valkeinen break;
443f7018c21STomi Valkeinen }
444f7018c21STomi Valkeinen
445f7018c21STomi Valkeinen /* add sync polarities */
446f7018c21STomi Valkeinen pcr |= imxfb_mode->pcr & ~(0x3f | (7 << 25));
447f7018c21STomi Valkeinen
448f7018c21STomi Valkeinen fbi->pcr = pcr;
449b62ea411SMartin Kaiser /*
450b62ea411SMartin Kaiser * The LCDC AUS Mode Control Register does not exist on imx1.
451b62ea411SMartin Kaiser */
452b62ea411SMartin Kaiser if (!is_imx1_fb(fbi) && imxfb_mode->aus_mode)
453b62ea411SMartin Kaiser fbi->lauscr = LAUSCR_AUS_MODE;
454f7018c21STomi Valkeinen
455*71ec48abSDario Binacchi if (imxfb_mode->pcr & PCR_TFT)
456*71ec48abSDario Binacchi fbi->panel_type = PANEL_TYPE_TFT;
457*71ec48abSDario Binacchi else if (imxfb_mode->pcr & PCR_COLOR)
458*71ec48abSDario Binacchi fbi->panel_type = PANEL_TYPE_CSTN;
459*71ec48abSDario Binacchi else
460*71ec48abSDario Binacchi fbi->panel_type = PANEL_TYPE_MONOCHROME;
461*71ec48abSDario Binacchi
462f7018c21STomi Valkeinen /*
463f7018c21STomi Valkeinen * Copy the RGB parameters for this display
464f7018c21STomi Valkeinen * from the machine specific parameters.
465f7018c21STomi Valkeinen */
466f7018c21STomi Valkeinen var->red = rgb->red;
467f7018c21STomi Valkeinen var->green = rgb->green;
468f7018c21STomi Valkeinen var->blue = rgb->blue;
469f7018c21STomi Valkeinen var->transp = rgb->transp;
470f7018c21STomi Valkeinen
471f7018c21STomi Valkeinen pr_debug("RGBT length = %d:%d:%d:%d\n",
472f7018c21STomi Valkeinen var->red.length, var->green.length, var->blue.length,
473f7018c21STomi Valkeinen var->transp.length);
474f7018c21STomi Valkeinen
475f7018c21STomi Valkeinen pr_debug("RGBT offset = %d:%d:%d:%d\n",
476f7018c21STomi Valkeinen var->red.offset, var->green.offset, var->blue.offset,
477f7018c21STomi Valkeinen var->transp.offset);
478f7018c21STomi Valkeinen
479f7018c21STomi Valkeinen return 0;
480f7018c21STomi Valkeinen }
481f7018c21STomi Valkeinen
482f7018c21STomi Valkeinen /*
483f7018c21STomi Valkeinen * imxfb_set_par():
484f7018c21STomi Valkeinen * Set the user defined part of the display for the specified console
485f7018c21STomi Valkeinen */
imxfb_set_par(struct fb_info * info)486f7018c21STomi Valkeinen static int imxfb_set_par(struct fb_info *info)
487f7018c21STomi Valkeinen {
488f7018c21STomi Valkeinen struct imxfb_info *fbi = info->par;
489f7018c21STomi Valkeinen struct fb_var_screeninfo *var = &info->var;
490f7018c21STomi Valkeinen
491f7018c21STomi Valkeinen if (var->bits_per_pixel == 16 || var->bits_per_pixel == 32)
492f7018c21STomi Valkeinen info->fix.visual = FB_VISUAL_TRUECOLOR;
493f7018c21STomi Valkeinen else if (!fbi->cmap_static)
494f7018c21STomi Valkeinen info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
495f7018c21STomi Valkeinen else {
496f7018c21STomi Valkeinen /*
497f7018c21STomi Valkeinen * Some people have weird ideas about wanting static
498f7018c21STomi Valkeinen * pseudocolor maps. I suspect their user space
499f7018c21STomi Valkeinen * applications are broken.
500f7018c21STomi Valkeinen */
501f7018c21STomi Valkeinen info->fix.visual = FB_VISUAL_STATIC_PSEUDOCOLOR;
502f7018c21STomi Valkeinen }
503f7018c21STomi Valkeinen
504f7018c21STomi Valkeinen info->fix.line_length = var->xres_virtual * var->bits_per_pixel / 8;
505f7018c21STomi Valkeinen fbi->palette_size = var->bits_per_pixel == 8 ? 256 : 16;
506f7018c21STomi Valkeinen
507f7018c21STomi Valkeinen imxfb_activate_var(var, info);
508f7018c21STomi Valkeinen
509f7018c21STomi Valkeinen return 0;
510f7018c21STomi Valkeinen }
511f7018c21STomi Valkeinen
imxfb_enable_controller(struct imxfb_info * fbi)512cc6df3a2SUwe Kleine-König static int imxfb_enable_controller(struct imxfb_info *fbi)
513f7018c21STomi Valkeinen {
514cc6df3a2SUwe Kleine-König int ret;
515f7018c21STomi Valkeinen
516f7018c21STomi Valkeinen if (fbi->enabled)
517cc6df3a2SUwe Kleine-König return 0;
518f7018c21STomi Valkeinen
519f7018c21STomi Valkeinen pr_debug("Enabling LCD controller\n");
520f7018c21STomi Valkeinen
521f7018c21STomi Valkeinen writel(fbi->map_dma, fbi->regs + LCDC_SSA);
522f7018c21STomi Valkeinen
523f7018c21STomi Valkeinen /* panning offset 0 (0 pixel offset) */
524f7018c21STomi Valkeinen writel(0x00000000, fbi->regs + LCDC_POS);
525f7018c21STomi Valkeinen
526f7018c21STomi Valkeinen /* disable hardware cursor */
527f7018c21STomi Valkeinen writel(readl(fbi->regs + LCDC_CPOS) & ~(CPOS_CC0 | CPOS_CC1),
528f7018c21STomi Valkeinen fbi->regs + LCDC_CPOS);
529f7018c21STomi Valkeinen
530f7018c21STomi Valkeinen /*
531f7018c21STomi Valkeinen * RMCR_LCDC_EN_MX1 is present on i.MX1 only, but doesn't hurt
532f7018c21STomi Valkeinen * on other SoCs
533f7018c21STomi Valkeinen */
534f7018c21STomi Valkeinen writel(RMCR_LCDC_EN_MX1, fbi->regs + LCDC_RMCR);
535f7018c21STomi Valkeinen
536cc6df3a2SUwe Kleine-König ret = clk_prepare_enable(fbi->clk_ipg);
537cc6df3a2SUwe Kleine-König if (ret)
538cc6df3a2SUwe Kleine-König goto err_enable_ipg;
539cc6df3a2SUwe Kleine-König
540cc6df3a2SUwe Kleine-König ret = clk_prepare_enable(fbi->clk_ahb);
541cc6df3a2SUwe Kleine-König if (ret)
542cc6df3a2SUwe Kleine-König goto err_enable_ahb;
543cc6df3a2SUwe Kleine-König
544cc6df3a2SUwe Kleine-König ret = clk_prepare_enable(fbi->clk_per);
545cc6df3a2SUwe Kleine-König if (ret)
546cc6df3a2SUwe Kleine-König goto err_enable_per;
547cc6df3a2SUwe Kleine-König
548f7018c21STomi Valkeinen fbi->enabled = true;
549cc6df3a2SUwe Kleine-König return 0;
550cc6df3a2SUwe Kleine-König
551cc6df3a2SUwe Kleine-König err_enable_per:
552cc6df3a2SUwe Kleine-König clk_disable_unprepare(fbi->clk_ahb);
553cc6df3a2SUwe Kleine-König err_enable_ahb:
554cc6df3a2SUwe Kleine-König clk_disable_unprepare(fbi->clk_ipg);
555cc6df3a2SUwe Kleine-König err_enable_ipg:
556cc6df3a2SUwe Kleine-König writel(0, fbi->regs + LCDC_RMCR);
557cc6df3a2SUwe Kleine-König
558cc6df3a2SUwe Kleine-König return ret;
559f7018c21STomi Valkeinen }
560f7018c21STomi Valkeinen
imxfb_disable_controller(struct imxfb_info * fbi)561f7018c21STomi Valkeinen static void imxfb_disable_controller(struct imxfb_info *fbi)
562f7018c21STomi Valkeinen {
563f7018c21STomi Valkeinen if (!fbi->enabled)
564f7018c21STomi Valkeinen return;
565f7018c21STomi Valkeinen
566f7018c21STomi Valkeinen pr_debug("Disabling LCD controller\n");
567f7018c21STomi Valkeinen
568f7018c21STomi Valkeinen clk_disable_unprepare(fbi->clk_per);
569f7018c21STomi Valkeinen clk_disable_unprepare(fbi->clk_ahb);
570cc6df3a2SUwe Kleine-König clk_disable_unprepare(fbi->clk_ipg);
571f7018c21STomi Valkeinen fbi->enabled = false;
572f7018c21STomi Valkeinen
573f7018c21STomi Valkeinen writel(0, fbi->regs + LCDC_RMCR);
574f7018c21STomi Valkeinen }
575f7018c21STomi Valkeinen
imxfb_blank(int blank,struct fb_info * info)576f7018c21STomi Valkeinen static int imxfb_blank(int blank, struct fb_info *info)
577f7018c21STomi Valkeinen {
578f7018c21STomi Valkeinen struct imxfb_info *fbi = info->par;
579f7018c21STomi Valkeinen
580f7018c21STomi Valkeinen pr_debug("imxfb_blank: blank=%d\n", blank);
581f7018c21STomi Valkeinen
582f7018c21STomi Valkeinen switch (blank) {
583f7018c21STomi Valkeinen case FB_BLANK_POWERDOWN:
584f7018c21STomi Valkeinen case FB_BLANK_VSYNC_SUSPEND:
585f7018c21STomi Valkeinen case FB_BLANK_HSYNC_SUSPEND:
586f7018c21STomi Valkeinen case FB_BLANK_NORMAL:
587f7018c21STomi Valkeinen imxfb_disable_controller(fbi);
588f7018c21STomi Valkeinen break;
589f7018c21STomi Valkeinen
590f7018c21STomi Valkeinen case FB_BLANK_UNBLANK:
591cc6df3a2SUwe Kleine-König return imxfb_enable_controller(fbi);
592f7018c21STomi Valkeinen }
593f7018c21STomi Valkeinen return 0;
594f7018c21STomi Valkeinen }
595f7018c21STomi Valkeinen
5968a48ac33SJani Nikula static const struct fb_ops imxfb_ops = {
597f7018c21STomi Valkeinen .owner = THIS_MODULE,
5984df6457cSThomas Zimmermann FB_DEFAULT_IOMEM_OPS,
599f7018c21STomi Valkeinen .fb_check_var = imxfb_check_var,
600f7018c21STomi Valkeinen .fb_set_par = imxfb_set_par,
601f7018c21STomi Valkeinen .fb_setcolreg = imxfb_setcolreg,
602f7018c21STomi Valkeinen .fb_blank = imxfb_blank,
603f7018c21STomi Valkeinen };
604f7018c21STomi Valkeinen
605f7018c21STomi Valkeinen /*
606f7018c21STomi Valkeinen * imxfb_activate_var():
607f7018c21STomi Valkeinen * Configures LCD Controller based on entries in var parameter. Settings are
608f7018c21STomi Valkeinen * only written to the controller if changes were made.
609f7018c21STomi Valkeinen */
imxfb_activate_var(struct fb_var_screeninfo * var,struct fb_info * info)610f7018c21STomi Valkeinen static int imxfb_activate_var(struct fb_var_screeninfo *var, struct fb_info *info)
611f7018c21STomi Valkeinen {
612f7018c21STomi Valkeinen struct imxfb_info *fbi = info->par;
613f7018c21STomi Valkeinen u32 ymax_mask = is_imx1_fb(fbi) ? YMAX_MASK_IMX1 : YMAX_MASK_IMX21;
614*71ec48abSDario Binacchi u8 left_margin_low;
615f7018c21STomi Valkeinen
616f7018c21STomi Valkeinen pr_debug("var: xres=%d hslen=%d lm=%d rm=%d\n",
617f7018c21STomi Valkeinen var->xres, var->hsync_len,
618f7018c21STomi Valkeinen var->left_margin, var->right_margin);
619f7018c21STomi Valkeinen pr_debug("var: yres=%d vslen=%d um=%d bm=%d\n",
620f7018c21STomi Valkeinen var->yres, var->vsync_len,
621f7018c21STomi Valkeinen var->upper_margin, var->lower_margin);
622f7018c21STomi Valkeinen
623*71ec48abSDario Binacchi if (fbi->panel_type == PANEL_TYPE_TFT)
624*71ec48abSDario Binacchi left_margin_low = 3;
625*71ec48abSDario Binacchi else if (fbi->panel_type == PANEL_TYPE_CSTN)
626*71ec48abSDario Binacchi left_margin_low = 2;
627*71ec48abSDario Binacchi else
628*71ec48abSDario Binacchi left_margin_low = 0;
629*71ec48abSDario Binacchi
630f7018c21STomi Valkeinen #if DEBUG_VAR
631f7018c21STomi Valkeinen if (var->xres < 16 || var->xres > 1024)
632f7018c21STomi Valkeinen printk(KERN_ERR "%s: invalid xres %d\n",
633f7018c21STomi Valkeinen info->fix.id, var->xres);
634f7018c21STomi Valkeinen if (var->hsync_len < 1 || var->hsync_len > 64)
635f7018c21STomi Valkeinen printk(KERN_ERR "%s: invalid hsync_len %d\n",
636f7018c21STomi Valkeinen info->fix.id, var->hsync_len);
637*71ec48abSDario Binacchi if (var->left_margin < left_margin_low || var->left_margin > 255)
638f7018c21STomi Valkeinen printk(KERN_ERR "%s: invalid left_margin %d\n",
639f7018c21STomi Valkeinen info->fix.id, var->left_margin);
6404e47382fSMartin Kaiser if (var->right_margin < 1 || var->right_margin > 255)
641f7018c21STomi Valkeinen printk(KERN_ERR "%s: invalid right_margin %d\n",
642f7018c21STomi Valkeinen info->fix.id, var->right_margin);
643f7018c21STomi Valkeinen if (var->yres < 1 || var->yres > ymax_mask)
644f7018c21STomi Valkeinen printk(KERN_ERR "%s: invalid yres %d\n",
645f7018c21STomi Valkeinen info->fix.id, var->yres);
646f7018c21STomi Valkeinen if (var->vsync_len > 100)
647f7018c21STomi Valkeinen printk(KERN_ERR "%s: invalid vsync_len %d\n",
648f7018c21STomi Valkeinen info->fix.id, var->vsync_len);
649f7018c21STomi Valkeinen if (var->upper_margin > 63)
650f7018c21STomi Valkeinen printk(KERN_ERR "%s: invalid upper_margin %d\n",
651f7018c21STomi Valkeinen info->fix.id, var->upper_margin);
652f7018c21STomi Valkeinen if (var->lower_margin > 255)
653f7018c21STomi Valkeinen printk(KERN_ERR "%s: invalid lower_margin %d\n",
654f7018c21STomi Valkeinen info->fix.id, var->lower_margin);
655f7018c21STomi Valkeinen #endif
656f7018c21STomi Valkeinen
657f7018c21STomi Valkeinen /* physical screen start address */
658f7018c21STomi Valkeinen writel(VPW_VPW(var->xres * var->bits_per_pixel / 8 / 4),
659f7018c21STomi Valkeinen fbi->regs + LCDC_VPW);
660f7018c21STomi Valkeinen
661f7018c21STomi Valkeinen writel(HCR_H_WIDTH(var->hsync_len - 1) |
662f7018c21STomi Valkeinen HCR_H_WAIT_1(var->right_margin - 1) |
663*71ec48abSDario Binacchi HCR_H_WAIT_2(var->left_margin - left_margin_low),
664f7018c21STomi Valkeinen fbi->regs + LCDC_HCR);
665f7018c21STomi Valkeinen
666f7018c21STomi Valkeinen writel(VCR_V_WIDTH(var->vsync_len) |
667f7018c21STomi Valkeinen VCR_V_WAIT_1(var->lower_margin) |
668f7018c21STomi Valkeinen VCR_V_WAIT_2(var->upper_margin),
669f7018c21STomi Valkeinen fbi->regs + LCDC_VCR);
670f7018c21STomi Valkeinen
671f7018c21STomi Valkeinen writel(SIZE_XMAX(var->xres) | (var->yres & ymax_mask),
672f7018c21STomi Valkeinen fbi->regs + LCDC_SIZE);
673f7018c21STomi Valkeinen
674f7018c21STomi Valkeinen writel(fbi->pcr, fbi->regs + LCDC_PCR);
675f7018c21STomi Valkeinen if (fbi->pwmr)
676f7018c21STomi Valkeinen writel(fbi->pwmr, fbi->regs + LCDC_PWMR);
677f7018c21STomi Valkeinen writel(fbi->lscr1, fbi->regs + LCDC_LSCR1);
678f7018c21STomi Valkeinen
679f7018c21STomi Valkeinen /* dmacr = 0 is no valid value, as we need DMA control marks. */
680f7018c21STomi Valkeinen if (fbi->dmacr)
681f7018c21STomi Valkeinen writel(fbi->dmacr, fbi->regs + LCDC_DMACR);
682f7018c21STomi Valkeinen
683b62ea411SMartin Kaiser if (fbi->lauscr)
684b62ea411SMartin Kaiser writel(fbi->lauscr, fbi->regs + LCDC_LAUSCR);
685b62ea411SMartin Kaiser
686f7018c21STomi Valkeinen return 0;
687f7018c21STomi Valkeinen }
688f7018c21STomi Valkeinen
imxfb_init_fbinfo(struct platform_device * pdev)689f7018c21STomi Valkeinen static int imxfb_init_fbinfo(struct platform_device *pdev)
690f7018c21STomi Valkeinen {
6910b5e0f45SJulia Lawall struct fb_info *info = platform_get_drvdata(pdev);
692f7018c21STomi Valkeinen struct imxfb_info *fbi = info->par;
693f7018c21STomi Valkeinen struct device_node *np;
694f7018c21STomi Valkeinen
695f7018c21STomi Valkeinen pr_debug("%s\n",__func__);
696f7018c21STomi Valkeinen
69755dd7378SYangtao Li info->pseudo_palette = devm_kmalloc_array(&pdev->dev, 16,
69855dd7378SYangtao Li sizeof(u32), GFP_KERNEL);
699f7018c21STomi Valkeinen if (!info->pseudo_palette)
700f7018c21STomi Valkeinen return -ENOMEM;
701f7018c21STomi Valkeinen
702f7018c21STomi Valkeinen memset(fbi, 0, sizeof(struct imxfb_info));
703f7018c21STomi Valkeinen
704f7018c21STomi Valkeinen fbi->devtype = pdev->id_entry->driver_data;
705f7018c21STomi Valkeinen
7068d026858SWolfram Sang strscpy(info->fix.id, IMX_NAME, sizeof(info->fix.id));
707f7018c21STomi Valkeinen
708f7018c21STomi Valkeinen info->fix.type = FB_TYPE_PACKED_PIXELS;
709f7018c21STomi Valkeinen info->fix.type_aux = 0;
710f7018c21STomi Valkeinen info->fix.xpanstep = 0;
711f7018c21STomi Valkeinen info->fix.ypanstep = 0;
712f7018c21STomi Valkeinen info->fix.ywrapstep = 0;
713f7018c21STomi Valkeinen info->fix.accel = FB_ACCEL_NONE;
714f7018c21STomi Valkeinen
715f7018c21STomi Valkeinen info->var.nonstd = 0;
716f7018c21STomi Valkeinen info->var.activate = FB_ACTIVATE_NOW;
717f7018c21STomi Valkeinen info->var.height = -1;
718f7018c21STomi Valkeinen info->var.width = -1;
719f7018c21STomi Valkeinen info->var.accel_flags = 0;
720f7018c21STomi Valkeinen info->var.vmode = FB_VMODE_NONINTERLACED;
721f7018c21STomi Valkeinen
722f7018c21STomi Valkeinen info->fbops = &imxfb_ops;
7238a4675ebSThomas Zimmermann info->flags = FBINFO_READS_FAST;
724e948d32cSUwe Kleine-König
725f7018c21STomi Valkeinen np = pdev->dev.of_node;
726f7018c21STomi Valkeinen info->var.grayscale = of_property_read_bool(np,
727f7018c21STomi Valkeinen "cmap-greyscale");
728f7018c21STomi Valkeinen fbi->cmap_inverse = of_property_read_bool(np, "cmap-inverse");
729f7018c21STomi Valkeinen fbi->cmap_static = of_property_read_bool(np, "cmap-static");
730f7018c21STomi Valkeinen
731f7018c21STomi Valkeinen fbi->lscr1 = IMXFB_LSCR1_DEFAULT;
732f7018c21STomi Valkeinen
733f7018c21STomi Valkeinen of_property_read_u32(np, "fsl,lpccr", &fbi->pwmr);
734f7018c21STomi Valkeinen
735f7018c21STomi Valkeinen of_property_read_u32(np, "fsl,lscr1", &fbi->lscr1);
736f7018c21STomi Valkeinen
737f7018c21STomi Valkeinen of_property_read_u32(np, "fsl,dmacr", &fbi->dmacr);
738f7018c21STomi Valkeinen
739f7018c21STomi Valkeinen return 0;
740f7018c21STomi Valkeinen }
741f7018c21STomi Valkeinen
imxfb_of_read_mode(struct device * dev,struct device_node * np,struct imx_fb_videomode * imxfb_mode)742f7018c21STomi Valkeinen static int imxfb_of_read_mode(struct device *dev, struct device_node *np,
743f7018c21STomi Valkeinen struct imx_fb_videomode *imxfb_mode)
744f7018c21STomi Valkeinen {
745f7018c21STomi Valkeinen int ret;
746f7018c21STomi Valkeinen struct fb_videomode *of_mode = &imxfb_mode->mode;
747f7018c21STomi Valkeinen u32 bpp;
748f7018c21STomi Valkeinen u32 pcr;
749f7018c21STomi Valkeinen
750f7018c21STomi Valkeinen ret = of_property_read_string(np, "model", &of_mode->name);
751f7018c21STomi Valkeinen if (ret)
752f7018c21STomi Valkeinen of_mode->name = NULL;
753f7018c21STomi Valkeinen
754f7018c21STomi Valkeinen ret = of_get_fb_videomode(np, of_mode, OF_USE_NATIVE_MODE);
755f7018c21STomi Valkeinen if (ret) {
756f7018c21STomi Valkeinen dev_err(dev, "Failed to get videomode from DT\n");
757f7018c21STomi Valkeinen return ret;
758f7018c21STomi Valkeinen }
759f7018c21STomi Valkeinen
760f7018c21STomi Valkeinen ret = of_property_read_u32(np, "bits-per-pixel", &bpp);
761f7018c21STomi Valkeinen ret |= of_property_read_u32(np, "fsl,pcr", &pcr);
762f7018c21STomi Valkeinen
763f7018c21STomi Valkeinen if (ret) {
764f7018c21STomi Valkeinen dev_err(dev, "Failed to read bpp and pcr from DT\n");
765f7018c21STomi Valkeinen return -EINVAL;
766f7018c21STomi Valkeinen }
767f7018c21STomi Valkeinen
768f7018c21STomi Valkeinen if (bpp < 1 || bpp > 255) {
769f7018c21STomi Valkeinen dev_err(dev, "Bits per pixel have to be between 1 and 255\n");
770f7018c21STomi Valkeinen return -EINVAL;
771f7018c21STomi Valkeinen }
772f7018c21STomi Valkeinen
773f7018c21STomi Valkeinen imxfb_mode->bpp = bpp;
774f7018c21STomi Valkeinen imxfb_mode->pcr = pcr;
775f7018c21STomi Valkeinen
776b62ea411SMartin Kaiser /*
777b62ea411SMartin Kaiser * fsl,aus-mode is optional
778b62ea411SMartin Kaiser */
779b62ea411SMartin Kaiser imxfb_mode->aus_mode = of_property_read_bool(np, "fsl,aus-mode");
780b62ea411SMartin Kaiser
781f7018c21STomi Valkeinen return 0;
782f7018c21STomi Valkeinen }
783f7018c21STomi Valkeinen
imxfb_lcd_check_fb(struct lcd_device * lcddev,struct fb_info * fi)784f7018c21STomi Valkeinen static int imxfb_lcd_check_fb(struct lcd_device *lcddev, struct fb_info *fi)
785f7018c21STomi Valkeinen {
786f7018c21STomi Valkeinen struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);
787f7018c21STomi Valkeinen
788f7018c21STomi Valkeinen if (!fi || fi->par == fbi)
789f7018c21STomi Valkeinen return 1;
790f7018c21STomi Valkeinen
791f7018c21STomi Valkeinen return 0;
792f7018c21STomi Valkeinen }
793f7018c21STomi Valkeinen
imxfb_lcd_get_contrast(struct lcd_device * lcddev)794f7018c21STomi Valkeinen static int imxfb_lcd_get_contrast(struct lcd_device *lcddev)
795f7018c21STomi Valkeinen {
796f7018c21STomi Valkeinen struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);
797f7018c21STomi Valkeinen
798f7018c21STomi Valkeinen return fbi->pwmr & 0xff;
799f7018c21STomi Valkeinen }
800f7018c21STomi Valkeinen
imxfb_lcd_set_contrast(struct lcd_device * lcddev,int contrast)801f7018c21STomi Valkeinen static int imxfb_lcd_set_contrast(struct lcd_device *lcddev, int contrast)
802f7018c21STomi Valkeinen {
803f7018c21STomi Valkeinen struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);
804f7018c21STomi Valkeinen
805f7018c21STomi Valkeinen if (fbi->pwmr && fbi->enabled) {
806f7018c21STomi Valkeinen if (contrast > 255)
807f7018c21STomi Valkeinen contrast = 255;
808f7018c21STomi Valkeinen else if (contrast < 0)
809f7018c21STomi Valkeinen contrast = 0;
810f7018c21STomi Valkeinen
811f7018c21STomi Valkeinen fbi->pwmr &= ~0xff;
812f7018c21STomi Valkeinen fbi->pwmr |= contrast;
813f7018c21STomi Valkeinen
814f7018c21STomi Valkeinen writel(fbi->pwmr, fbi->regs + LCDC_PWMR);
815f7018c21STomi Valkeinen }
816f7018c21STomi Valkeinen
817f7018c21STomi Valkeinen return 0;
818f7018c21STomi Valkeinen }
819f7018c21STomi Valkeinen
imxfb_lcd_get_power(struct lcd_device * lcddev)820f7018c21STomi Valkeinen static int imxfb_lcd_get_power(struct lcd_device *lcddev)
821f7018c21STomi Valkeinen {
822f7018c21STomi Valkeinen struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);
823f7018c21STomi Valkeinen
82446ffe109SUwe Kleine-König if (!IS_ERR(fbi->lcd_pwr) &&
82546ffe109SUwe Kleine-König !regulator_is_enabled(fbi->lcd_pwr))
82646ffe109SUwe Kleine-König return FB_BLANK_POWERDOWN;
827f7018c21STomi Valkeinen
82846ffe109SUwe Kleine-König return FB_BLANK_UNBLANK;
829f7018c21STomi Valkeinen }
830f7018c21STomi Valkeinen
imxfb_regulator_set(struct imxfb_info * fbi,int enable)8315c694f80SUwe Kleine-König static int imxfb_regulator_set(struct imxfb_info *fbi, int enable)
8325c694f80SUwe Kleine-König {
8335c694f80SUwe Kleine-König int ret;
8345c694f80SUwe Kleine-König
8355c694f80SUwe Kleine-König if (enable == fbi->lcd_pwr_enabled)
8365c694f80SUwe Kleine-König return 0;
8375c694f80SUwe Kleine-König
8385c694f80SUwe Kleine-König if (enable)
8395c694f80SUwe Kleine-König ret = regulator_enable(fbi->lcd_pwr);
8405c694f80SUwe Kleine-König else
8415c694f80SUwe Kleine-König ret = regulator_disable(fbi->lcd_pwr);
8425c694f80SUwe Kleine-König
8435c694f80SUwe Kleine-König if (ret == 0)
8445c694f80SUwe Kleine-König fbi->lcd_pwr_enabled = enable;
8455c694f80SUwe Kleine-König
8465c694f80SUwe Kleine-König return ret;
8475c694f80SUwe Kleine-König }
8485c694f80SUwe Kleine-König
imxfb_lcd_set_power(struct lcd_device * lcddev,int power)849f7018c21STomi Valkeinen static int imxfb_lcd_set_power(struct lcd_device *lcddev, int power)
850f7018c21STomi Valkeinen {
851f7018c21STomi Valkeinen struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);
852f7018c21STomi Valkeinen
8535c694f80SUwe Kleine-König if (!IS_ERR(fbi->lcd_pwr))
8545c694f80SUwe Kleine-König return imxfb_regulator_set(fbi, power == FB_BLANK_UNBLANK);
855f7018c21STomi Valkeinen
856f7018c21STomi Valkeinen return 0;
857f7018c21STomi Valkeinen }
858f7018c21STomi Valkeinen
859f7018c21STomi Valkeinen static struct lcd_ops imxfb_lcd_ops = {
860f7018c21STomi Valkeinen .check_fb = imxfb_lcd_check_fb,
861f7018c21STomi Valkeinen .get_contrast = imxfb_lcd_get_contrast,
862f7018c21STomi Valkeinen .set_contrast = imxfb_lcd_set_contrast,
863f7018c21STomi Valkeinen .get_power = imxfb_lcd_get_power,
864f7018c21STomi Valkeinen .set_power = imxfb_lcd_set_power,
865f7018c21STomi Valkeinen };
866f7018c21STomi Valkeinen
imxfb_setup(void)867f7018c21STomi Valkeinen static int imxfb_setup(void)
868f7018c21STomi Valkeinen {
869f7018c21STomi Valkeinen char *opt, *options = NULL;
870f7018c21STomi Valkeinen
871f7018c21STomi Valkeinen if (fb_get_options("imxfb", &options))
872f7018c21STomi Valkeinen return -ENODEV;
873f7018c21STomi Valkeinen
874f7018c21STomi Valkeinen if (!options || !*options)
875f7018c21STomi Valkeinen return 0;
876f7018c21STomi Valkeinen
877f7018c21STomi Valkeinen while ((opt = strsep(&options, ",")) != NULL) {
878f7018c21STomi Valkeinen if (!*opt)
879f7018c21STomi Valkeinen continue;
880f7018c21STomi Valkeinen else
881f7018c21STomi Valkeinen fb_mode = opt;
882f7018c21STomi Valkeinen }
883f7018c21STomi Valkeinen
884f7018c21STomi Valkeinen return 0;
885f7018c21STomi Valkeinen }
886f7018c21STomi Valkeinen
imxfb_probe(struct platform_device * pdev)887f7018c21STomi Valkeinen static int imxfb_probe(struct platform_device *pdev)
888f7018c21STomi Valkeinen {
889f7018c21STomi Valkeinen struct imxfb_info *fbi;
890f7018c21STomi Valkeinen struct lcd_device *lcd;
891f7018c21STomi Valkeinen struct fb_info *info;
892f7018c21STomi Valkeinen struct imx_fb_videomode *m;
893f7018c21STomi Valkeinen const struct of_device_id *of_id;
894e948d32cSUwe Kleine-König struct device_node *display_np;
895f7018c21STomi Valkeinen int ret, i;
896f7018c21STomi Valkeinen int bytes_per_pixel;
897f7018c21STomi Valkeinen
898f7018c21STomi Valkeinen dev_info(&pdev->dev, "i.MX Framebuffer driver\n");
899f7018c21STomi Valkeinen
900f7018c21STomi Valkeinen ret = imxfb_setup();
901f7018c21STomi Valkeinen if (ret < 0)
902f7018c21STomi Valkeinen return ret;
903f7018c21STomi Valkeinen
904f7018c21STomi Valkeinen of_id = of_match_device(imxfb_of_dev_id, &pdev->dev);
905f7018c21STomi Valkeinen if (of_id)
906f7018c21STomi Valkeinen pdev->id_entry = of_id->data;
907f7018c21STomi Valkeinen
908f7018c21STomi Valkeinen info = framebuffer_alloc(sizeof(struct imxfb_info), &pdev->dev);
909f7018c21STomi Valkeinen if (!info)
910f7018c21STomi Valkeinen return -ENOMEM;
911f7018c21STomi Valkeinen
912f7018c21STomi Valkeinen fbi = info->par;
913f7018c21STomi Valkeinen
914f7018c21STomi Valkeinen platform_set_drvdata(pdev, info);
915f7018c21STomi Valkeinen
916f7018c21STomi Valkeinen ret = imxfb_init_fbinfo(pdev);
917f7018c21STomi Valkeinen if (ret < 0)
918f7018c21STomi Valkeinen goto failed_init;
919f7018c21STomi Valkeinen
920f7018c21STomi Valkeinen fb_mode = NULL;
921f7018c21STomi Valkeinen
922f7018c21STomi Valkeinen display_np = of_parse_phandle(pdev->dev.of_node, "display", 0);
923f7018c21STomi Valkeinen if (!display_np) {
924f7018c21STomi Valkeinen dev_err(&pdev->dev, "No display defined in devicetree\n");
925f7018c21STomi Valkeinen ret = -EINVAL;
92653a90ae8SYangtao Li goto failed_init;
927f7018c21STomi Valkeinen }
928f7018c21STomi Valkeinen
929f7018c21STomi Valkeinen /*
930f7018c21STomi Valkeinen * imxfb does not support more modes, we choose only the native
931f7018c21STomi Valkeinen * mode.
932f7018c21STomi Valkeinen */
933f7018c21STomi Valkeinen fbi->num_modes = 1;
934f7018c21STomi Valkeinen
935f7018c21STomi Valkeinen fbi->mode = devm_kzalloc(&pdev->dev,
936f7018c21STomi Valkeinen sizeof(struct imx_fb_videomode), GFP_KERNEL);
937f7018c21STomi Valkeinen if (!fbi->mode) {
938f7018c21STomi Valkeinen ret = -ENOMEM;
939836ffc47SLv Ruyi of_node_put(display_np);
94053a90ae8SYangtao Li goto failed_init;
941f7018c21STomi Valkeinen }
942f7018c21STomi Valkeinen
943f7018c21STomi Valkeinen ret = imxfb_of_read_mode(&pdev->dev, display_np, fbi->mode);
944836ffc47SLv Ruyi of_node_put(display_np);
945f7018c21STomi Valkeinen if (ret)
94653a90ae8SYangtao Li goto failed_init;
947f7018c21STomi Valkeinen
948f7018c21STomi Valkeinen /* Calculate maximum bytes used per pixel. In most cases this should
949f7018c21STomi Valkeinen * be the same as m->bpp/8 */
950f7018c21STomi Valkeinen m = &fbi->mode[0];
951f7018c21STomi Valkeinen bytes_per_pixel = (m->bpp + 7) / 8;
952f7018c21STomi Valkeinen for (i = 0; i < fbi->num_modes; i++, m++)
953f7018c21STomi Valkeinen info->fix.smem_len = max_t(size_t, info->fix.smem_len,
954f7018c21STomi Valkeinen m->mode.xres * m->mode.yres * bytes_per_pixel);
955f7018c21STomi Valkeinen
956f7018c21STomi Valkeinen fbi->clk_ipg = devm_clk_get(&pdev->dev, "ipg");
957f7018c21STomi Valkeinen if (IS_ERR(fbi->clk_ipg)) {
958f7018c21STomi Valkeinen ret = PTR_ERR(fbi->clk_ipg);
95953a90ae8SYangtao Li goto failed_init;
960f7018c21STomi Valkeinen }
961f7018c21STomi Valkeinen
962b82fe6ddSFabio Estevam /*
963b82fe6ddSFabio Estevam * The LCDC controller does not have an enable bit. The
964b82fe6ddSFabio Estevam * controller starts directly when the clocks are enabled.
965b82fe6ddSFabio Estevam * If the clocks are enabled when the controller is not yet
966b82fe6ddSFabio Estevam * programmed with proper register values (enabled at the
967b82fe6ddSFabio Estevam * bootloader, for example) then it just goes into some undefined
968b82fe6ddSFabio Estevam * state.
969b82fe6ddSFabio Estevam * To avoid this issue, let's enable and disable LCDC IPG clock
970b82fe6ddSFabio Estevam * so that we force some kind of 'reset' to the LCDC block.
971b82fe6ddSFabio Estevam */
972b82fe6ddSFabio Estevam ret = clk_prepare_enable(fbi->clk_ipg);
973b82fe6ddSFabio Estevam if (ret)
97453a90ae8SYangtao Li goto failed_init;
975b82fe6ddSFabio Estevam clk_disable_unprepare(fbi->clk_ipg);
976b82fe6ddSFabio Estevam
977f7018c21STomi Valkeinen fbi->clk_ahb = devm_clk_get(&pdev->dev, "ahb");
978f7018c21STomi Valkeinen if (IS_ERR(fbi->clk_ahb)) {
979f7018c21STomi Valkeinen ret = PTR_ERR(fbi->clk_ahb);
98053a90ae8SYangtao Li goto failed_init;
981f7018c21STomi Valkeinen }
982f7018c21STomi Valkeinen
983f7018c21STomi Valkeinen fbi->clk_per = devm_clk_get(&pdev->dev, "per");
984f7018c21STomi Valkeinen if (IS_ERR(fbi->clk_per)) {
985f7018c21STomi Valkeinen ret = PTR_ERR(fbi->clk_per);
98653a90ae8SYangtao Li goto failed_init;
987f7018c21STomi Valkeinen }
988f7018c21STomi Valkeinen
98978dd4f41SYangtao Li fbi->regs = devm_platform_ioremap_resource(pdev, 0);
990c5c7502eSYang Yingliang if (IS_ERR(fbi->regs)) {
991c5c7502eSYang Yingliang ret = PTR_ERR(fbi->regs);
99253a90ae8SYangtao Li goto failed_init;
993f7018c21STomi Valkeinen }
994f7018c21STomi Valkeinen
995f7018c21STomi Valkeinen fbi->map_size = PAGE_ALIGN(info->fix.smem_len);
996739a6439SBartlomiej Zolnierkiewicz info->screen_buffer = dma_alloc_wc(&pdev->dev, fbi->map_size,
997f7018c21STomi Valkeinen &fbi->map_dma, GFP_KERNEL);
998732146a3SWei Yongjun if (!info->screen_buffer) {
999767d724aSChristophe JAILLET dev_err(&pdev->dev, "Failed to allocate video RAM\n");
1000f7018c21STomi Valkeinen ret = -ENOMEM;
100153a90ae8SYangtao Li goto failed_init;
1002f7018c21STomi Valkeinen }
1003f7018c21STomi Valkeinen
1004f7018c21STomi Valkeinen info->fix.smem_start = fbi->map_dma;
1005f7018c21STomi Valkeinen
1006f7018c21STomi Valkeinen INIT_LIST_HEAD(&info->modelist);
1007f7018c21STomi Valkeinen for (i = 0; i < fbi->num_modes; i++)
1008f7018c21STomi Valkeinen fb_add_videomode(&fbi->mode[i].mode, &info->modelist);
1009f7018c21STomi Valkeinen
1010f7018c21STomi Valkeinen /*
1011f7018c21STomi Valkeinen * This makes sure that our colour bitfield
1012f7018c21STomi Valkeinen * descriptors are correctly initialised.
1013f7018c21STomi Valkeinen */
1014f7018c21STomi Valkeinen imxfb_check_var(&info->var, info);
1015f7018c21STomi Valkeinen
1016dc312120SMartin Kaiser /*
1017dc312120SMartin Kaiser * For modes > 8bpp, the color map is bypassed.
1018dc312120SMartin Kaiser * Therefore, 256 entries are enough.
1019dc312120SMartin Kaiser */
1020dc312120SMartin Kaiser ret = fb_alloc_cmap(&info->cmap, 256, 0);
1021f7018c21STomi Valkeinen if (ret < 0)
1022f7018c21STomi Valkeinen goto failed_cmap;
1023f7018c21STomi Valkeinen
1024f7018c21STomi Valkeinen imxfb_set_par(info);
1025f7018c21STomi Valkeinen ret = register_framebuffer(info);
1026f7018c21STomi Valkeinen if (ret < 0) {
1027f7018c21STomi Valkeinen dev_err(&pdev->dev, "failed to register framebuffer\n");
1028f7018c21STomi Valkeinen goto failed_register;
1029f7018c21STomi Valkeinen }
1030f7018c21STomi Valkeinen
1031f7018c21STomi Valkeinen fbi->lcd_pwr = devm_regulator_get(&pdev->dev, "lcd");
103245586c70SMasahiro Yamada if (PTR_ERR(fbi->lcd_pwr) == -EPROBE_DEFER) {
1033f7018c21STomi Valkeinen ret = -EPROBE_DEFER;
1034f7018c21STomi Valkeinen goto failed_lcd;
1035f7018c21STomi Valkeinen }
1036f7018c21STomi Valkeinen
1037f7018c21STomi Valkeinen lcd = devm_lcd_device_register(&pdev->dev, "imxfb-lcd", &pdev->dev, fbi,
1038f7018c21STomi Valkeinen &imxfb_lcd_ops);
1039f7018c21STomi Valkeinen if (IS_ERR(lcd)) {
1040f7018c21STomi Valkeinen ret = PTR_ERR(lcd);
1041f7018c21STomi Valkeinen goto failed_lcd;
1042f7018c21STomi Valkeinen }
1043f7018c21STomi Valkeinen
1044f7018c21STomi Valkeinen lcd->props.max_contrast = 0xff;
1045f7018c21STomi Valkeinen
1046f7018c21STomi Valkeinen imxfb_enable_controller(fbi);
1047f7018c21STomi Valkeinen fbi->pdev = pdev;
1048f7018c21STomi Valkeinen
1049f7018c21STomi Valkeinen return 0;
1050f7018c21STomi Valkeinen
1051f7018c21STomi Valkeinen failed_lcd:
1052f7018c21STomi Valkeinen unregister_framebuffer(info);
1053f7018c21STomi Valkeinen failed_register:
1054f7018c21STomi Valkeinen fb_dealloc_cmap(&info->cmap);
1055f7018c21STomi Valkeinen failed_cmap:
1056739a6439SBartlomiej Zolnierkiewicz dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer,
1057f7018c21STomi Valkeinen fbi->map_dma);
1058f7018c21STomi Valkeinen failed_init:
1059f7018c21STomi Valkeinen framebuffer_release(info);
1060f7018c21STomi Valkeinen return ret;
1061f7018c21STomi Valkeinen }
1062f7018c21STomi Valkeinen
imxfb_remove(struct platform_device * pdev)1063909b7a3eSUwe Kleine-König static void imxfb_remove(struct platform_device *pdev)
1064f7018c21STomi Valkeinen {
1065f7018c21STomi Valkeinen struct fb_info *info = platform_get_drvdata(pdev);
1066f7018c21STomi Valkeinen struct imxfb_info *fbi = info->par;
1067f7018c21STomi Valkeinen
1068f7018c21STomi Valkeinen imxfb_disable_controller(fbi);
1069f7018c21STomi Valkeinen
1070f7018c21STomi Valkeinen unregister_framebuffer(info);
10715ae29649SDan Carpenter fb_dealloc_cmap(&info->cmap);
1072739a6439SBartlomiej Zolnierkiewicz dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer,
1073f7018c21STomi Valkeinen fbi->map_dma);
10745ae29649SDan Carpenter framebuffer_release(info);
1075f7018c21STomi Valkeinen }
1076f7018c21STomi Valkeinen
imxfb_suspend(struct device * dev)107786a10102SMartin Kaiser static int imxfb_suspend(struct device *dev)
1078f7018c21STomi Valkeinen {
1079f7018c21STomi Valkeinen struct fb_info *info = dev_get_drvdata(dev);
1080f7018c21STomi Valkeinen struct imxfb_info *fbi = info->par;
1081f7018c21STomi Valkeinen
1082f7018c21STomi Valkeinen imxfb_disable_controller(fbi);
1083f7018c21STomi Valkeinen
1084f7018c21STomi Valkeinen return 0;
1085f7018c21STomi Valkeinen }
1086f7018c21STomi Valkeinen
imxfb_resume(struct device * dev)108786a10102SMartin Kaiser static int imxfb_resume(struct device *dev)
1088f7018c21STomi Valkeinen {
1089f7018c21STomi Valkeinen struct fb_info *info = dev_get_drvdata(dev);
1090f7018c21STomi Valkeinen struct imxfb_info *fbi = info->par;
1091f7018c21STomi Valkeinen
1092f7018c21STomi Valkeinen imxfb_enable_controller(fbi);
1093f7018c21STomi Valkeinen
1094f7018c21STomi Valkeinen return 0;
1095f7018c21STomi Valkeinen }
1096f7018c21STomi Valkeinen
109786a10102SMartin Kaiser static DEFINE_SIMPLE_DEV_PM_OPS(imxfb_pm_ops, imxfb_suspend, imxfb_resume);
1098f7018c21STomi Valkeinen
1099f7018c21STomi Valkeinen static struct platform_driver imxfb_driver = {
1100f7018c21STomi Valkeinen .driver = {
1101f7018c21STomi Valkeinen .name = DRIVER_NAME,
1102f7018c21STomi Valkeinen .of_match_table = imxfb_of_dev_id,
110386a10102SMartin Kaiser .pm = pm_sleep_ptr(&imxfb_pm_ops),
1104f7018c21STomi Valkeinen },
1105f7018c21STomi Valkeinen .probe = imxfb_probe,
1106909b7a3eSUwe Kleine-König .remove_new = imxfb_remove,
1107f7018c21STomi Valkeinen .id_table = imxfb_devtype,
1108f7018c21STomi Valkeinen };
1109f7018c21STomi Valkeinen module_platform_driver(imxfb_driver);
1110f7018c21STomi Valkeinen
1111f7018c21STomi Valkeinen MODULE_DESCRIPTION("Freescale i.MX framebuffer driver");
1112f7018c21STomi Valkeinen MODULE_AUTHOR("Sascha Hauer, Pengutronix");
1113f7018c21STomi Valkeinen MODULE_LICENSE("GPL");
1114