1 /* 2 * OMAP2plus display device setup / initialization. 3 * 4 * Copyright (C) 2010 Texas Instruments Incorporated - http://www.ti.com/ 5 * Senthilvadivu Guruswamy 6 * Sumit Semwal 7 * 8 * This program is free software; you can redistribute it and/or modify 9 * it under the terms of the GNU General Public License version 2 as 10 * published by the Free Software Foundation. 11 * 12 * This program is distributed "as is" WITHOUT ANY WARRANTY of any 13 * kind, whether express or implied; without even the implied warranty 14 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15 * GNU General Public License for more details. 16 */ 17 18 #include <linux/string.h> 19 #include <linux/kernel.h> 20 #include <linux/init.h> 21 #include <linux/platform_device.h> 22 #include <linux/io.h> 23 #include <linux/clk.h> 24 #include <linux/err.h> 25 26 #include <video/omapdss.h> 27 #include <plat/omap_hwmod.h> 28 #include <plat/omap_device.h> 29 #include <plat/omap-pm.h> 30 31 #include "control.h" 32 33 static struct platform_device omap_display_device = { 34 .name = "omapdss", 35 .id = -1, 36 .dev = { 37 .platform_data = NULL, 38 }, 39 }; 40 41 struct omap_dss_hwmod_data { 42 const char *oh_name; 43 const char *dev_name; 44 const int id; 45 }; 46 47 static const struct omap_dss_hwmod_data omap2_dss_hwmod_data[] __initdata = { 48 { "dss_core", "omapdss_dss", -1 }, 49 { "dss_dispc", "omapdss_dispc", -1 }, 50 { "dss_rfbi", "omapdss_rfbi", -1 }, 51 { "dss_venc", "omapdss_venc", -1 }, 52 }; 53 54 static const struct omap_dss_hwmod_data omap3_dss_hwmod_data[] __initdata = { 55 { "dss_core", "omapdss_dss", -1 }, 56 { "dss_dispc", "omapdss_dispc", -1 }, 57 { "dss_rfbi", "omapdss_rfbi", -1 }, 58 { "dss_venc", "omapdss_venc", -1 }, 59 { "dss_dsi1", "omapdss_dsi", 0 }, 60 }; 61 62 static const struct omap_dss_hwmod_data omap4_dss_hwmod_data[] __initdata = { 63 { "dss_core", "omapdss_dss", -1 }, 64 { "dss_dispc", "omapdss_dispc", -1 }, 65 { "dss_rfbi", "omapdss_rfbi", -1 }, 66 { "dss_venc", "omapdss_venc", -1 }, 67 { "dss_dsi1", "omapdss_dsi", 0 }, 68 { "dss_dsi2", "omapdss_dsi", 1 }, 69 { "dss_hdmi", "omapdss_hdmi", -1 }, 70 }; 71 72 static int omap4_dsi_mux_pads(int dsi_id, unsigned lanes) 73 { 74 u32 enable_mask, enable_shift; 75 u32 pipd_mask, pipd_shift; 76 u32 reg; 77 78 if (dsi_id == 0) { 79 enable_mask = OMAP4_DSI1_LANEENABLE_MASK; 80 enable_shift = OMAP4_DSI1_LANEENABLE_SHIFT; 81 pipd_mask = OMAP4_DSI1_PIPD_MASK; 82 pipd_shift = OMAP4_DSI1_PIPD_SHIFT; 83 } else if (dsi_id == 1) { 84 enable_mask = OMAP4_DSI2_LANEENABLE_MASK; 85 enable_shift = OMAP4_DSI2_LANEENABLE_SHIFT; 86 pipd_mask = OMAP4_DSI2_PIPD_MASK; 87 pipd_shift = OMAP4_DSI2_PIPD_SHIFT; 88 } else { 89 return -ENODEV; 90 } 91 92 reg = omap4_ctrl_pad_readl(OMAP4_CTRL_MODULE_PAD_CORE_CONTROL_DSIPHY); 93 94 reg &= ~enable_mask; 95 reg &= ~pipd_mask; 96 97 reg |= (lanes << enable_shift) & enable_mask; 98 reg |= (lanes << pipd_shift) & pipd_mask; 99 100 omap4_ctrl_pad_writel(reg, OMAP4_CTRL_MODULE_PAD_CORE_CONTROL_DSIPHY); 101 102 return 0; 103 } 104 105 static int omap_dsi_enable_pads(int dsi_id, unsigned lane_mask) 106 { 107 if (cpu_is_omap44xx()) 108 return omap4_dsi_mux_pads(dsi_id, lane_mask); 109 110 return 0; 111 } 112 113 static void omap_dsi_disable_pads(int dsi_id, unsigned lane_mask) 114 { 115 if (cpu_is_omap44xx()) 116 omap4_dsi_mux_pads(dsi_id, 0); 117 } 118 119 int __init omap_display_init(struct omap_dss_board_info *board_data) 120 { 121 int r = 0; 122 struct omap_hwmod *oh; 123 struct platform_device *pdev; 124 int i, oh_count; 125 struct omap_display_platform_data pdata; 126 const struct omap_dss_hwmod_data *curr_dss_hwmod; 127 128 memset(&pdata, 0, sizeof(pdata)); 129 130 if (cpu_is_omap24xx()) { 131 curr_dss_hwmod = omap2_dss_hwmod_data; 132 oh_count = ARRAY_SIZE(omap2_dss_hwmod_data); 133 } else if (cpu_is_omap34xx()) { 134 curr_dss_hwmod = omap3_dss_hwmod_data; 135 oh_count = ARRAY_SIZE(omap3_dss_hwmod_data); 136 } else { 137 curr_dss_hwmod = omap4_dss_hwmod_data; 138 oh_count = ARRAY_SIZE(omap4_dss_hwmod_data); 139 } 140 141 if (board_data->dsi_enable_pads == NULL) 142 board_data->dsi_enable_pads = omap_dsi_enable_pads; 143 if (board_data->dsi_disable_pads == NULL) 144 board_data->dsi_disable_pads = omap_dsi_disable_pads; 145 146 pdata.board_data = board_data; 147 pdata.board_data->get_context_loss_count = 148 omap_pm_get_dev_context_loss_count; 149 150 for (i = 0; i < oh_count; i++) { 151 oh = omap_hwmod_lookup(curr_dss_hwmod[i].oh_name); 152 if (!oh) { 153 pr_err("Could not look up %s\n", 154 curr_dss_hwmod[i].oh_name); 155 return -ENODEV; 156 } 157 158 pdev = omap_device_build(curr_dss_hwmod[i].dev_name, 159 curr_dss_hwmod[i].id, oh, &pdata, 160 sizeof(struct omap_display_platform_data), 161 NULL, 0, 0); 162 163 if (WARN((IS_ERR(pdev)), "Could not build omap_device for %s\n", 164 curr_dss_hwmod[i].oh_name)) 165 return -ENODEV; 166 } 167 omap_display_device.dev.platform_data = board_data; 168 169 r = platform_device_register(&omap_display_device); 170 if (r < 0) 171 printk(KERN_ERR "Unable to register OMAP-Display device\n"); 172 173 return r; 174 } 175