2 * linux/drivers/video/omap2/dss/dss.c
4 * Copyright (C) 2009 Nokia Corporation
5 * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
7 * Some code and ideas taken from drivers/video/omap/ driver
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License version 2 as published by
12 * the Free Software Foundation.
14 * This program is distributed in the hope that it will be useful, but WITHOUT
15 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
16 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
19 * You should have received a copy of the GNU General Public License along with
20 * this program. If not, see <http://www.gnu.org/licenses/>.
23 #define DSS_SUBSYS_NAME "DSS"
25 #include <linux/kernel.h>
27 #include <linux/export.h>
28 #include <linux/err.h>
29 #include <linux/delay.h>
30 #include <linux/seq_file.h>
31 #include <linux/clk.h>
32 #include <linux/platform_device.h>
33 #include <linux/pm_runtime.h>
34 #include <linux/gfp.h>
36 #include <video/omapdss.h>
41 #include "dss_features.h"
43 #define DSS_SZ_REGS SZ_512
49 #define DSS_REG(idx) ((const struct dss_reg) { idx })
51 #define DSS_REVISION DSS_REG(0x0000)
52 #define DSS_SYSCONFIG DSS_REG(0x0010)
53 #define DSS_SYSSTATUS DSS_REG(0x0014)
54 #define DSS_CONTROL DSS_REG(0x0040)
55 #define DSS_SDI_CONTROL DSS_REG(0x0044)
56 #define DSS_PLL_CONTROL DSS_REG(0x0048)
57 #define DSS_SDI_STATUS DSS_REG(0x005C)
59 #define REG_GET(idx, start, end) \
60 FLD_GET(dss_read_reg(idx), start, end)
62 #define REG_FLD_MOD(idx, val, start, end) \
63 dss_write_reg(idx, FLD_MOD(dss_read_reg(idx), val, start, end))
65 static int dss_runtime_get(void);
66 static void dss_runtime_put(void);
70 u8 dss_fck_multiplier
;
72 int (*dpi_select_source
)(enum omap_channel channel
);
76 struct platform_device
*pdev
;
79 struct clk
*dpll4_m4_ck
;
82 unsigned long cache_req_pck
;
83 unsigned long cache_prate
;
84 struct dss_clock_info cache_dss_cinfo
;
85 struct dispc_clock_info cache_dispc_cinfo
;
87 enum omap_dss_clk_source dsi_clk_source
[MAX_NUM_DSI
];
88 enum omap_dss_clk_source dispc_clk_source
;
89 enum omap_dss_clk_source lcd_clk_source
[MAX_DSS_LCD_MANAGERS
];
92 u32 ctx
[DSS_SZ_REGS
/ sizeof(u32
)];
94 const struct dss_features
*feat
;
97 static const char * const dss_generic_clk_source_names
[] = {
98 [OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC
] = "DSI_PLL_HSDIV_DISPC",
99 [OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DSI
] = "DSI_PLL_HSDIV_DSI",
100 [OMAP_DSS_CLK_SRC_FCK
] = "DSS_FCK",
103 static inline void dss_write_reg(const struct dss_reg idx
, u32 val
)
105 __raw_writel(val
, dss
.base
+ idx
.idx
);
108 static inline u32
dss_read_reg(const struct dss_reg idx
)
110 return __raw_readl(dss
.base
+ idx
.idx
);
114 dss.ctx[(DSS_##reg).idx / sizeof(u32)] = dss_read_reg(DSS_##reg)
116 dss_write_reg(DSS_##reg, dss.ctx[(DSS_##reg).idx / sizeof(u32)])
118 static void dss_save_context(void)
120 DSSDBG("dss_save_context\n");
124 if (dss_feat_get_supported_displays(OMAP_DSS_CHANNEL_LCD
) &
125 OMAP_DISPLAY_TYPE_SDI
) {
130 dss
.ctx_valid
= true;
132 DSSDBG("context saved\n");
135 static void dss_restore_context(void)
137 DSSDBG("dss_restore_context\n");
144 if (dss_feat_get_supported_displays(OMAP_DSS_CHANNEL_LCD
) &
145 OMAP_DISPLAY_TYPE_SDI
) {
150 DSSDBG("context restored\n");
156 void dss_sdi_init(int datapairs
)
160 BUG_ON(datapairs
> 3 || datapairs
< 1);
162 l
= dss_read_reg(DSS_SDI_CONTROL
);
163 l
= FLD_MOD(l
, 0xf, 19, 15); /* SDI_PDIV */
164 l
= FLD_MOD(l
, datapairs
-1, 3, 2); /* SDI_PRSEL */
165 l
= FLD_MOD(l
, 2, 1, 0); /* SDI_BWSEL */
166 dss_write_reg(DSS_SDI_CONTROL
, l
);
168 l
= dss_read_reg(DSS_PLL_CONTROL
);
169 l
= FLD_MOD(l
, 0x7, 25, 22); /* SDI_PLL_FREQSEL */
170 l
= FLD_MOD(l
, 0xb, 16, 11); /* SDI_PLL_REGN */
171 l
= FLD_MOD(l
, 0xb4, 10, 1); /* SDI_PLL_REGM */
172 dss_write_reg(DSS_PLL_CONTROL
, l
);
175 int dss_sdi_enable(void)
177 unsigned long timeout
;
179 dispc_pck_free_enable(1);
182 REG_FLD_MOD(DSS_PLL_CONTROL
, 1, 18, 18); /* SDI_PLL_SYSRESET */
183 udelay(1); /* wait 2x PCLK */
186 REG_FLD_MOD(DSS_PLL_CONTROL
, 1, 28, 28); /* SDI_PLL_GOBIT */
188 /* Waiting for PLL lock request to complete */
189 timeout
= jiffies
+ msecs_to_jiffies(500);
190 while (dss_read_reg(DSS_SDI_STATUS
) & (1 << 6)) {
191 if (time_after_eq(jiffies
, timeout
)) {
192 DSSERR("PLL lock request timed out\n");
197 /* Clearing PLL_GO bit */
198 REG_FLD_MOD(DSS_PLL_CONTROL
, 0, 28, 28);
200 /* Waiting for PLL to lock */
201 timeout
= jiffies
+ msecs_to_jiffies(500);
202 while (!(dss_read_reg(DSS_SDI_STATUS
) & (1 << 5))) {
203 if (time_after_eq(jiffies
, timeout
)) {
204 DSSERR("PLL lock timed out\n");
209 dispc_lcd_enable_signal(1);
211 /* Waiting for SDI reset to complete */
212 timeout
= jiffies
+ msecs_to_jiffies(500);
213 while (!(dss_read_reg(DSS_SDI_STATUS
) & (1 << 2))) {
214 if (time_after_eq(jiffies
, timeout
)) {
215 DSSERR("SDI reset timed out\n");
223 dispc_lcd_enable_signal(0);
226 REG_FLD_MOD(DSS_PLL_CONTROL
, 0, 18, 18); /* SDI_PLL_SYSRESET */
228 dispc_pck_free_enable(0);
233 void dss_sdi_disable(void)
235 dispc_lcd_enable_signal(0);
237 dispc_pck_free_enable(0);
240 REG_FLD_MOD(DSS_PLL_CONTROL
, 0, 18, 18); /* SDI_PLL_SYSRESET */
243 const char *dss_get_generic_clk_source_name(enum omap_dss_clk_source clk_src
)
245 return dss_generic_clk_source_names
[clk_src
];
248 void dss_dump_clocks(struct seq_file
*s
)
250 unsigned long dpll4_ck_rate
;
251 unsigned long dpll4_m4_ck_rate
;
252 const char *fclk_name
, *fclk_real_name
;
253 unsigned long fclk_rate
;
255 if (dss_runtime_get())
258 seq_printf(s
, "- DSS -\n");
260 fclk_name
= dss_get_generic_clk_source_name(OMAP_DSS_CLK_SRC_FCK
);
261 fclk_real_name
= dss_feat_get_clk_source_name(OMAP_DSS_CLK_SRC_FCK
);
262 fclk_rate
= clk_get_rate(dss
.dss_clk
);
264 if (dss
.dpll4_m4_ck
) {
265 dpll4_ck_rate
= clk_get_rate(clk_get_parent(dss
.dpll4_m4_ck
));
266 dpll4_m4_ck_rate
= clk_get_rate(dss
.dpll4_m4_ck
);
268 seq_printf(s
, "dpll4_ck %lu\n", dpll4_ck_rate
);
270 seq_printf(s
, "%s (%s) = %lu / %lu * %d = %lu\n",
271 fclk_name
, fclk_real_name
, dpll4_ck_rate
,
272 dpll4_ck_rate
/ dpll4_m4_ck_rate
,
273 dss
.feat
->dss_fck_multiplier
, fclk_rate
);
275 seq_printf(s
, "%s (%s) = %lu\n",
276 fclk_name
, fclk_real_name
,
283 static void dss_dump_regs(struct seq_file
*s
)
285 #define DUMPREG(r) seq_printf(s, "%-35s %08x\n", #r, dss_read_reg(r))
287 if (dss_runtime_get())
290 DUMPREG(DSS_REVISION
);
291 DUMPREG(DSS_SYSCONFIG
);
292 DUMPREG(DSS_SYSSTATUS
);
293 DUMPREG(DSS_CONTROL
);
295 if (dss_feat_get_supported_displays(OMAP_DSS_CHANNEL_LCD
) &
296 OMAP_DISPLAY_TYPE_SDI
) {
297 DUMPREG(DSS_SDI_CONTROL
);
298 DUMPREG(DSS_PLL_CONTROL
);
299 DUMPREG(DSS_SDI_STATUS
);
306 void dss_select_dispc_clk_source(enum omap_dss_clk_source clk_src
)
308 struct platform_device
*dsidev
;
313 case OMAP_DSS_CLK_SRC_FCK
:
316 case OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC
:
318 dsidev
= dsi_get_dsidev_from_id(0);
319 dsi_wait_pll_hsdiv_dispc_active(dsidev
);
321 case OMAP_DSS_CLK_SRC_DSI2_PLL_HSDIV_DISPC
:
323 dsidev
= dsi_get_dsidev_from_id(1);
324 dsi_wait_pll_hsdiv_dispc_active(dsidev
);
331 dss_feat_get_reg_field(FEAT_REG_DISPC_CLK_SWITCH
, &start
, &end
);
333 REG_FLD_MOD(DSS_CONTROL
, b
, start
, end
); /* DISPC_CLK_SWITCH */
335 dss
.dispc_clk_source
= clk_src
;
338 void dss_select_dsi_clk_source(int dsi_module
,
339 enum omap_dss_clk_source clk_src
)
341 struct platform_device
*dsidev
;
345 case OMAP_DSS_CLK_SRC_FCK
:
348 case OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DSI
:
349 BUG_ON(dsi_module
!= 0);
351 dsidev
= dsi_get_dsidev_from_id(0);
352 dsi_wait_pll_hsdiv_dsi_active(dsidev
);
354 case OMAP_DSS_CLK_SRC_DSI2_PLL_HSDIV_DSI
:
355 BUG_ON(dsi_module
!= 1);
357 dsidev
= dsi_get_dsidev_from_id(1);
358 dsi_wait_pll_hsdiv_dsi_active(dsidev
);
365 pos
= dsi_module
== 0 ? 1 : 10;
366 REG_FLD_MOD(DSS_CONTROL
, b
, pos
, pos
); /* DSIx_CLK_SWITCH */
368 dss
.dsi_clk_source
[dsi_module
] = clk_src
;
371 void dss_select_lcd_clk_source(enum omap_channel channel
,
372 enum omap_dss_clk_source clk_src
)
374 struct platform_device
*dsidev
;
377 if (!dss_has_feature(FEAT_LCD_CLK_SRC
))
381 case OMAP_DSS_CLK_SRC_FCK
:
384 case OMAP_DSS_CLK_SRC_DSI_PLL_HSDIV_DISPC
:
385 BUG_ON(channel
!= OMAP_DSS_CHANNEL_LCD
);
387 dsidev
= dsi_get_dsidev_from_id(0);
388 dsi_wait_pll_hsdiv_dispc_active(dsidev
);
390 case OMAP_DSS_CLK_SRC_DSI2_PLL_HSDIV_DISPC
:
391 BUG_ON(channel
!= OMAP_DSS_CHANNEL_LCD2
&&
392 channel
!= OMAP_DSS_CHANNEL_LCD3
);
394 dsidev
= dsi_get_dsidev_from_id(1);
395 dsi_wait_pll_hsdiv_dispc_active(dsidev
);
402 pos
= channel
== OMAP_DSS_CHANNEL_LCD
? 0 :
403 (channel
== OMAP_DSS_CHANNEL_LCD2
? 12 : 19);
404 REG_FLD_MOD(DSS_CONTROL
, b
, pos
, pos
); /* LCDx_CLK_SWITCH */
406 ix
= channel
== OMAP_DSS_CHANNEL_LCD
? 0 :
407 (channel
== OMAP_DSS_CHANNEL_LCD2
? 1 : 2);
408 dss
.lcd_clk_source
[ix
] = clk_src
;
411 enum omap_dss_clk_source
dss_get_dispc_clk_source(void)
413 return dss
.dispc_clk_source
;
416 enum omap_dss_clk_source
dss_get_dsi_clk_source(int dsi_module
)
418 return dss
.dsi_clk_source
[dsi_module
];
421 enum omap_dss_clk_source
dss_get_lcd_clk_source(enum omap_channel channel
)
423 if (dss_has_feature(FEAT_LCD_CLK_SRC
)) {
424 int ix
= channel
== OMAP_DSS_CHANNEL_LCD
? 0 :
425 (channel
== OMAP_DSS_CHANNEL_LCD2
? 1 : 2);
426 return dss
.lcd_clk_source
[ix
];
428 /* LCD_CLK source is the same as DISPC_FCLK source for
430 return dss
.dispc_clk_source
;
434 int dss_set_clock_div(struct dss_clock_info
*cinfo
)
436 if (dss
.dpll4_m4_ck
) {
440 prate
= clk_get_rate(clk_get_parent(dss
.dpll4_m4_ck
));
441 DSSDBG("dpll4_m4 = %ld\n", prate
);
443 r
= clk_set_rate(dss
.dpll4_m4_ck
, prate
/ cinfo
->fck_div
);
447 if (cinfo
->fck_div
!= 0)
451 DSSDBG("fck = %ld (%d)\n", cinfo
->fck
, cinfo
->fck_div
);
456 unsigned long dss_get_dpll4_rate(void)
459 return clk_get_rate(clk_get_parent(dss
.dpll4_m4_ck
));
464 int dss_calc_clock_div(unsigned long req_pck
, struct dss_clock_info
*dss_cinfo
,
465 struct dispc_clock_info
*dispc_cinfo
)
468 struct dss_clock_info best_dss
;
469 struct dispc_clock_info best_dispc
;
471 unsigned long fck
, max_dss_fck
;
478 prate
= dss_get_dpll4_rate();
480 max_dss_fck
= dss_feat_get_param_max(FEAT_PARAM_DSS_FCK
);
482 fck
= clk_get_rate(dss
.dss_clk
);
483 if (req_pck
== dss
.cache_req_pck
&& prate
== dss
.cache_prate
&&
484 dss
.cache_dss_cinfo
.fck
== fck
) {
485 DSSDBG("dispc clock info found from cache.\n");
486 *dss_cinfo
= dss
.cache_dss_cinfo
;
487 *dispc_cinfo
= dss
.cache_dispc_cinfo
;
491 min_fck_per_pck
= CONFIG_OMAP2_DSS_MIN_FCK_PER_PCK
;
493 if (min_fck_per_pck
&&
494 req_pck
* min_fck_per_pck
> max_dss_fck
) {
495 DSSERR("Requested pixel clock not possible with the current "
496 "OMAP2_DSS_MIN_FCK_PER_PCK setting. Turning "
497 "the constraint off.\n");
502 memset(&best_dss
, 0, sizeof(best_dss
));
503 memset(&best_dispc
, 0, sizeof(best_dispc
));
505 if (dss
.dpll4_m4_ck
== NULL
) {
506 struct dispc_clock_info cur_dispc
;
507 /* XXX can we change the clock on omap2? */
508 fck
= clk_get_rate(dss
.dss_clk
);
511 dispc_find_clk_divs(req_pck
, fck
, &cur_dispc
);
515 best_dss
.fck_div
= fck_div
;
517 best_dispc
= cur_dispc
;
521 for (fck_div
= dss
.feat
->fck_div_max
; fck_div
> 0; --fck_div
) {
522 struct dispc_clock_info cur_dispc
;
524 fck
= prate
/ fck_div
* dss
.feat
->dss_fck_multiplier
;
526 if (fck
> max_dss_fck
)
529 if (min_fck_per_pck
&&
530 fck
< req_pck
* min_fck_per_pck
)
535 dispc_find_clk_divs(req_pck
, fck
, &cur_dispc
);
537 if (abs(cur_dispc
.pck
- req_pck
) <
538 abs(best_dispc
.pck
- req_pck
)) {
541 best_dss
.fck_div
= fck_div
;
543 best_dispc
= cur_dispc
;
545 if (cur_dispc
.pck
== req_pck
)
553 if (min_fck_per_pck
) {
554 DSSERR("Could not find suitable clock settings.\n"
555 "Turning FCK/PCK constraint off and"
561 DSSERR("Could not find suitable clock settings.\n");
567 *dss_cinfo
= best_dss
;
569 *dispc_cinfo
= best_dispc
;
571 dss
.cache_req_pck
= req_pck
;
572 dss
.cache_prate
= prate
;
573 dss
.cache_dss_cinfo
= best_dss
;
574 dss
.cache_dispc_cinfo
= best_dispc
;
579 void dss_set_venc_output(enum omap_dss_venc_type type
)
583 if (type
== OMAP_DSS_VENC_TYPE_COMPOSITE
)
585 else if (type
== OMAP_DSS_VENC_TYPE_SVIDEO
)
590 /* venc out selection. 0 = comp, 1 = svideo */
591 REG_FLD_MOD(DSS_CONTROL
, l
, 6, 6);
594 void dss_set_dac_pwrdn_bgz(bool enable
)
596 REG_FLD_MOD(DSS_CONTROL
, enable
, 5, 5); /* DAC Power-Down Control */
599 void dss_select_hdmi_venc_clk_source(enum dss_hdmi_venc_clk_source_select src
)
601 enum omap_display_type dp
;
602 dp
= dss_feat_get_supported_displays(OMAP_DSS_CHANNEL_DIGIT
);
604 /* Complain about invalid selections */
605 WARN_ON((src
== DSS_VENC_TV_CLK
) && !(dp
& OMAP_DISPLAY_TYPE_VENC
));
606 WARN_ON((src
== DSS_HDMI_M_PCLK
) && !(dp
& OMAP_DISPLAY_TYPE_HDMI
));
608 /* Select only if we have options */
609 if ((dp
& OMAP_DISPLAY_TYPE_VENC
) && (dp
& OMAP_DISPLAY_TYPE_HDMI
))
610 REG_FLD_MOD(DSS_CONTROL
, src
, 15, 15); /* VENC_HDMI_SWITCH */
613 enum dss_hdmi_venc_clk_source_select
dss_get_hdmi_venc_clk_source(void)
615 enum omap_display_type displays
;
617 displays
= dss_feat_get_supported_displays(OMAP_DSS_CHANNEL_DIGIT
);
618 if ((displays
& OMAP_DISPLAY_TYPE_HDMI
) == 0)
619 return DSS_VENC_TV_CLK
;
621 if ((displays
& OMAP_DISPLAY_TYPE_VENC
) == 0)
622 return DSS_HDMI_M_PCLK
;
624 return REG_GET(DSS_CONTROL
, 15, 15);
627 static int dss_dpi_select_source_omap2_omap3(enum omap_channel channel
)
629 if (channel
!= OMAP_DSS_CHANNEL_LCD
)
635 static int dss_dpi_select_source_omap4(enum omap_channel channel
)
640 case OMAP_DSS_CHANNEL_LCD2
:
643 case OMAP_DSS_CHANNEL_DIGIT
:
650 REG_FLD_MOD(DSS_CONTROL
, val
, 17, 17);
655 static int dss_dpi_select_source_omap5(enum omap_channel channel
)
660 case OMAP_DSS_CHANNEL_LCD
:
663 case OMAP_DSS_CHANNEL_LCD2
:
666 case OMAP_DSS_CHANNEL_LCD3
:
669 case OMAP_DSS_CHANNEL_DIGIT
:
676 REG_FLD_MOD(DSS_CONTROL
, val
, 17, 16);
681 int dss_dpi_select_source(enum omap_channel channel
)
683 return dss
.feat
->dpi_select_source(channel
);
686 static int dss_get_clocks(void)
691 clk
= clk_get(&dss
.pdev
->dev
, "fck");
693 DSSERR("can't get clock fck\n");
700 if (dss
.feat
->clk_name
) {
701 clk
= clk_get(NULL
, dss
.feat
->clk_name
);
703 DSSERR("Failed to get %s\n", dss
.feat
->clk_name
);
711 dss
.dpll4_m4_ck
= clk
;
717 clk_put(dss
.dss_clk
);
719 clk_put(dss
.dpll4_m4_ck
);
724 static void dss_put_clocks(void)
727 clk_put(dss
.dpll4_m4_ck
);
728 clk_put(dss
.dss_clk
);
731 static int dss_runtime_get(void)
735 DSSDBG("dss_runtime_get\n");
737 r
= pm_runtime_get_sync(&dss
.pdev
->dev
);
739 return r
< 0 ? r
: 0;
742 static void dss_runtime_put(void)
746 DSSDBG("dss_runtime_put\n");
748 r
= pm_runtime_put_sync(&dss
.pdev
->dev
);
749 WARN_ON(r
< 0 && r
!= -ENOSYS
&& r
!= -EBUSY
);
753 #if defined(CONFIG_DEBUG_FS) && defined(CONFIG_OMAP2_DSS_DEBUG_SUPPORT)
754 void dss_debug_dump_clocks(struct seq_file
*s
)
757 dispc_dump_clocks(s
);
758 #ifdef CONFIG_OMAP2_DSS_DSI
764 static const struct dss_features omap24xx_dss_feats __initconst
= {
766 .dss_fck_multiplier
= 2,
768 .dpi_select_source
= &dss_dpi_select_source_omap2_omap3
,
771 static const struct dss_features omap34xx_dss_feats __initconst
= {
773 .dss_fck_multiplier
= 2,
774 .clk_name
= "dpll4_m4_ck",
775 .dpi_select_source
= &dss_dpi_select_source_omap2_omap3
,
778 static const struct dss_features omap3630_dss_feats __initconst
= {
780 .dss_fck_multiplier
= 1,
781 .clk_name
= "dpll4_m4_ck",
782 .dpi_select_source
= &dss_dpi_select_source_omap2_omap3
,
785 static const struct dss_features omap44xx_dss_feats __initconst
= {
787 .dss_fck_multiplier
= 1,
788 .clk_name
= "dpll_per_m5x2_ck",
789 .dpi_select_source
= &dss_dpi_select_source_omap4
,
792 static const struct dss_features omap54xx_dss_feats __initconst
= {
794 .dss_fck_multiplier
= 1,
795 .clk_name
= "dpll_per_h12x2_ck",
796 .dpi_select_source
= &dss_dpi_select_source_omap5
,
799 static int __init
dss_init_features(struct device
*dev
)
801 const struct dss_features
*src
;
802 struct dss_features
*dst
;
804 dst
= devm_kzalloc(dev
, sizeof(*dst
), GFP_KERNEL
);
806 dev_err(dev
, "Failed to allocate local DSS Features\n");
810 if (cpu_is_omap24xx())
811 src
= &omap24xx_dss_feats
;
812 else if (cpu_is_omap3630())
813 src
= &omap3630_dss_feats
;
814 else if (cpu_is_omap34xx())
815 src
= &omap34xx_dss_feats
;
816 else if (cpu_is_omap44xx())
817 src
= &omap44xx_dss_feats
;
818 else if (soc_is_omap54xx())
819 src
= &omap54xx_dss_feats
;
823 memcpy(dst
, src
, sizeof(*dst
));
829 /* DSS HW IP initialisation */
830 static int __init
omap_dsshw_probe(struct platform_device
*pdev
)
832 struct resource
*dss_mem
;
838 r
= dss_init_features(&dss
.pdev
->dev
);
842 dss_mem
= platform_get_resource(dss
.pdev
, IORESOURCE_MEM
, 0);
844 DSSERR("can't get IORESOURCE_MEM DSS\n");
848 dss
.base
= devm_ioremap(&pdev
->dev
, dss_mem
->start
,
849 resource_size(dss_mem
));
851 DSSERR("can't ioremap DSS\n");
855 r
= dss_get_clocks();
859 pm_runtime_enable(&pdev
->dev
);
861 r
= dss_runtime_get();
863 goto err_runtime_get
;
866 REG_FLD_MOD(DSS_CONTROL
, 0, 0, 0);
868 #ifdef CONFIG_OMAP2_DSS_VENC
869 REG_FLD_MOD(DSS_CONTROL
, 1, 4, 4); /* venc dac demen */
870 REG_FLD_MOD(DSS_CONTROL
, 1, 3, 3); /* venc clock 4x enable */
871 REG_FLD_MOD(DSS_CONTROL
, 0, 2, 2); /* venc clock mode = normal */
873 dss
.dsi_clk_source
[0] = OMAP_DSS_CLK_SRC_FCK
;
874 dss
.dsi_clk_source
[1] = OMAP_DSS_CLK_SRC_FCK
;
875 dss
.dispc_clk_source
= OMAP_DSS_CLK_SRC_FCK
;
876 dss
.lcd_clk_source
[0] = OMAP_DSS_CLK_SRC_FCK
;
877 dss
.lcd_clk_source
[1] = OMAP_DSS_CLK_SRC_FCK
;
879 rev
= dss_read_reg(DSS_REVISION
);
880 printk(KERN_INFO
"OMAP DSS rev %d.%d\n",
881 FLD_GET(rev
, 7, 4), FLD_GET(rev
, 3, 0));
885 dss_debugfs_create_file("dss", dss_dump_regs
);
890 pm_runtime_disable(&pdev
->dev
);
895 static int __exit
omap_dsshw_remove(struct platform_device
*pdev
)
897 pm_runtime_disable(&pdev
->dev
);
904 static int dss_runtime_suspend(struct device
*dev
)
907 dss_set_min_bus_tput(dev
, 0);
911 static int dss_runtime_resume(struct device
*dev
)
915 * Set an arbitrarily high tput request to ensure OPP100.
916 * What we should really do is to make a request to stay in OPP100,
917 * without any tput requirements, but that is not currently possible
921 r
= dss_set_min_bus_tput(dev
, 1000000000);
925 dss_restore_context();
929 static const struct dev_pm_ops dss_pm_ops
= {
930 .runtime_suspend
= dss_runtime_suspend
,
931 .runtime_resume
= dss_runtime_resume
,
934 static struct platform_driver omap_dsshw_driver
= {
935 .remove
= __exit_p(omap_dsshw_remove
),
937 .name
= "omapdss_dss",
938 .owner
= THIS_MODULE
,
943 int __init
dss_init_platform_driver(void)
945 return platform_driver_probe(&omap_dsshw_driver
, omap_dsshw_probe
);
948 void dss_uninit_platform_driver(void)
950 platform_driver_unregister(&omap_dsshw_driver
);