Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 1 | /* |
| 2 | * linux/drivers/video/omap2/dss/dpi.c |
| 3 | * |
| 4 | * Copyright (C) 2009 Nokia Corporation |
| 5 | * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com> |
| 6 | * |
| 7 | * Some code and ideas taken from drivers/video/omap/ driver |
| 8 | * by Imre Deak. |
| 9 | * |
| 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. |
| 13 | * |
| 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 |
| 17 | * more details. |
| 18 | * |
| 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/>. |
| 21 | */ |
| 22 | |
| 23 | #define DSS_SUBSYS_NAME "DPI" |
| 24 | |
| 25 | #include <linux/kernel.h> |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 26 | #include <linux/delay.h> |
Paul Gortmaker | a8a3593 | 2011-07-10 13:20:26 -0400 | [diff] [blame] | 27 | #include <linux/export.h> |
Tomi Valkeinen | 8a2cfea | 2010-02-04 17:03:41 +0200 | [diff] [blame] | 28 | #include <linux/err.h> |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 29 | #include <linux/errno.h> |
Tomi Valkeinen | 8a2cfea | 2010-02-04 17:03:41 +0200 | [diff] [blame] | 30 | #include <linux/platform_device.h> |
| 31 | #include <linux/regulator/consumer.h> |
Tomi Valkeinen | 13b1ba7 | 2012-09-28 10:03:03 +0300 | [diff] [blame] | 32 | #include <linux/string.h> |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 33 | #include <linux/of.h> |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 34 | #include <linux/clk.h> |
Tomi Valkeinen | 736e60d | 2015-06-04 15:22:23 +0300 | [diff] [blame] | 35 | #include <linux/component.h> |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 36 | |
Peter Ujfalusi | 32043da | 2016-05-27 14:40:49 +0300 | [diff] [blame] | 37 | #include "omapdss.h" |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 38 | #include "dss.h" |
Chandrabhanu Mahapatra | 195e672 | 2012-08-22 11:44:06 +0530 | [diff] [blame] | 39 | #include "dss_features.h" |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 40 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 41 | struct dpi_data { |
Tomi Valkeinen | 00df43b | 2013-03-19 11:33:52 +0200 | [diff] [blame] | 42 | struct platform_device *pdev; |
| 43 | |
Tomi Valkeinen | 8a2cfea | 2010-02-04 17:03:41 +0200 | [diff] [blame] | 44 | struct regulator *vdds_dsi_reg; |
Tomi Valkeinen | 331e607 | 2016-05-17 16:08:54 +0300 | [diff] [blame] | 45 | enum dss_clk_source clk_src; |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 46 | struct dss_pll *pll; |
Archit Taneja | 5cf9a26 | 2012-06-29 14:19:13 +0530 | [diff] [blame] | 47 | |
Archit Taneja | c8a5e4e | 2012-07-05 12:52:46 +0530 | [diff] [blame] | 48 | struct mutex lock; |
| 49 | |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 50 | struct videomode vm; |
Archit Taneja | 5cf9a26 | 2012-06-29 14:19:13 +0530 | [diff] [blame] | 51 | struct dss_lcd_mgr_config mgr_config; |
Archit Taneja | c6b393d | 2012-07-06 15:30:52 +0530 | [diff] [blame] | 52 | int data_lines; |
Archit Taneja | 81b87f5 | 2012-09-26 16:30:49 +0530 | [diff] [blame] | 53 | |
Tomi Valkeinen | 1f68d9c | 2013-04-19 15:09:34 +0300 | [diff] [blame] | 54 | struct omap_dss_device output; |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 55 | |
| 56 | bool port_initialized; |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 57 | }; |
| 58 | |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 59 | static struct dpi_data *dpi_get_data_from_dssdev(struct omap_dss_device *dssdev) |
| 60 | { |
| 61 | return container_of(dssdev, struct dpi_data, output); |
| 62 | } |
| 63 | |
Archit Taneja | 80eb675 | 2014-06-02 14:11:51 +0530 | [diff] [blame] | 64 | /* only used in non-DT mode */ |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 65 | static struct dpi_data *dpi_get_data_from_pdev(struct platform_device *pdev) |
| 66 | { |
| 67 | return dev_get_drvdata(&pdev->dev); |
| 68 | } |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 69 | |
Tomi Valkeinen | 7bbdef2 | 2016-08-10 11:04:29 +0300 | [diff] [blame^] | 70 | static enum dss_clk_source dpi_get_clk_src_dra7xx(enum omap_channel channel) |
| 71 | { |
| 72 | /* |
| 73 | * Possible clock sources: |
| 74 | * LCD1: FCK/PLL1_1/HDMI_PLL |
| 75 | * LCD2: FCK/PLL1_3/HDMI_PLL (DRA74x: PLL2_3) |
| 76 | * LCD3: FCK/PLL1_3/HDMI_PLL (DRA74x: PLL2_1) |
| 77 | */ |
| 78 | |
| 79 | switch (channel) { |
| 80 | case OMAP_DSS_CHANNEL_LCD: |
| 81 | { |
| 82 | if (dss_pll_find_by_src(DSS_CLK_SRC_PLL1_1)) |
| 83 | return DSS_CLK_SRC_PLL1_1; |
| 84 | break; |
| 85 | } |
| 86 | case OMAP_DSS_CHANNEL_LCD2: |
| 87 | { |
| 88 | if (dss_pll_find_by_src(DSS_CLK_SRC_PLL1_3)) |
| 89 | return DSS_CLK_SRC_PLL1_3; |
| 90 | if (dss_pll_find_by_src(DSS_CLK_SRC_PLL2_3)) |
| 91 | return DSS_CLK_SRC_PLL2_3; |
| 92 | break; |
| 93 | } |
| 94 | case OMAP_DSS_CHANNEL_LCD3: |
| 95 | { |
| 96 | if (dss_pll_find_by_src(DSS_CLK_SRC_PLL2_1)) |
| 97 | return DSS_CLK_SRC_PLL2_1; |
| 98 | if (dss_pll_find_by_src(DSS_CLK_SRC_PLL1_3)) |
| 99 | return DSS_CLK_SRC_PLL1_3; |
| 100 | break; |
| 101 | } |
| 102 | default: |
| 103 | break; |
| 104 | } |
| 105 | |
| 106 | return DSS_CLK_SRC_FCK; |
| 107 | } |
| 108 | |
Tomi Valkeinen | 331e607 | 2016-05-17 16:08:54 +0300 | [diff] [blame] | 109 | static enum dss_clk_source dpi_get_clk_src(enum omap_channel channel) |
Archit Taneja | a72b64b | 2011-05-12 17:26:26 +0530 | [diff] [blame] | 110 | { |
Tomi Valkeinen | bd0f5cc | 2012-12-13 14:21:30 +0200 | [diff] [blame] | 111 | /* |
| 112 | * XXX we can't currently use DSI PLL for DPI with OMAP3, as the DSI PLL |
| 113 | * would also be used for DISPC fclk. Meaning, when the DPI output is |
| 114 | * disabled, DISPC clock will be disabled, and TV out will stop. |
| 115 | */ |
| 116 | switch (omapdss_get_version()) { |
| 117 | case OMAPDSS_VER_OMAP24xx: |
| 118 | case OMAPDSS_VER_OMAP34xx_ES1: |
| 119 | case OMAPDSS_VER_OMAP34xx_ES3: |
| 120 | case OMAPDSS_VER_OMAP3630: |
| 121 | case OMAPDSS_VER_AM35xx: |
Sathya Prakash M R | d6279d4 | 2014-03-24 16:31:51 +0530 | [diff] [blame] | 122 | case OMAPDSS_VER_AM43xx: |
Tomi Valkeinen | 331e607 | 2016-05-17 16:08:54 +0300 | [diff] [blame] | 123 | return DSS_CLK_SRC_FCK; |
Tomi Valkeinen | bd0f5cc | 2012-12-13 14:21:30 +0200 | [diff] [blame] | 124 | |
Tomi Valkeinen | f8ad984 | 2013-03-11 13:57:38 +0200 | [diff] [blame] | 125 | case OMAPDSS_VER_OMAP4430_ES1: |
| 126 | case OMAPDSS_VER_OMAP4430_ES2: |
| 127 | case OMAPDSS_VER_OMAP4: |
| 128 | switch (channel) { |
| 129 | case OMAP_DSS_CHANNEL_LCD: |
Tomi Valkeinen | 331e607 | 2016-05-17 16:08:54 +0300 | [diff] [blame] | 130 | return DSS_CLK_SRC_PLL1_1; |
Tomi Valkeinen | f8ad984 | 2013-03-11 13:57:38 +0200 | [diff] [blame] | 131 | case OMAP_DSS_CHANNEL_LCD2: |
Tomi Valkeinen | 331e607 | 2016-05-17 16:08:54 +0300 | [diff] [blame] | 132 | return DSS_CLK_SRC_PLL2_1; |
Tomi Valkeinen | f8ad984 | 2013-03-11 13:57:38 +0200 | [diff] [blame] | 133 | default: |
Tomi Valkeinen | 331e607 | 2016-05-17 16:08:54 +0300 | [diff] [blame] | 134 | return DSS_CLK_SRC_FCK; |
Tomi Valkeinen | f8ad984 | 2013-03-11 13:57:38 +0200 | [diff] [blame] | 135 | } |
| 136 | |
| 137 | case OMAPDSS_VER_OMAP5: |
| 138 | switch (channel) { |
| 139 | case OMAP_DSS_CHANNEL_LCD: |
Tomi Valkeinen | 331e607 | 2016-05-17 16:08:54 +0300 | [diff] [blame] | 140 | return DSS_CLK_SRC_PLL1_1; |
Tomi Valkeinen | f8ad984 | 2013-03-11 13:57:38 +0200 | [diff] [blame] | 141 | case OMAP_DSS_CHANNEL_LCD3: |
Tomi Valkeinen | 331e607 | 2016-05-17 16:08:54 +0300 | [diff] [blame] | 142 | return DSS_CLK_SRC_PLL2_1; |
| 143 | case OMAP_DSS_CHANNEL_LCD2: |
Tomi Valkeinen | f8ad984 | 2013-03-11 13:57:38 +0200 | [diff] [blame] | 144 | default: |
Tomi Valkeinen | 331e607 | 2016-05-17 16:08:54 +0300 | [diff] [blame] | 145 | return DSS_CLK_SRC_FCK; |
Tomi Valkeinen | f8ad984 | 2013-03-11 13:57:38 +0200 | [diff] [blame] | 146 | } |
| 147 | |
Tomi Valkeinen | a240815 | 2014-12-31 11:26:06 +0200 | [diff] [blame] | 148 | case OMAPDSS_VER_DRA7xx: |
Tomi Valkeinen | 7bbdef2 | 2016-08-10 11:04:29 +0300 | [diff] [blame^] | 149 | return dpi_get_clk_src_dra7xx(channel); |
Tomi Valkeinen | a240815 | 2014-12-31 11:26:06 +0200 | [diff] [blame] | 150 | |
Tomi Valkeinen | 0e8276e | 2012-10-22 16:12:58 +0300 | [diff] [blame] | 151 | default: |
Tomi Valkeinen | 3b63ca7 | 2016-05-17 14:01:10 +0300 | [diff] [blame] | 152 | return DSS_CLK_SRC_FCK; |
Tomi Valkeinen | 0e8276e | 2012-10-22 16:12:58 +0300 | [diff] [blame] | 153 | } |
Archit Taneja | 7636b3b | 2011-04-12 13:52:26 +0530 | [diff] [blame] | 154 | } |
| 155 | |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 156 | struct dpi_clk_calc_ctx { |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 157 | struct dss_pll *pll; |
Tomi Valkeinen | 13ece4d | 2016-05-17 16:20:07 +0300 | [diff] [blame] | 158 | unsigned clkout_idx; |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 159 | |
| 160 | /* inputs */ |
| 161 | |
| 162 | unsigned long pck_min, pck_max; |
| 163 | |
| 164 | /* outputs */ |
| 165 | |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 166 | struct dss_pll_clock_info pll_cinfo; |
Tomi Valkeinen | c56812f | 2014-01-28 08:50:47 +0200 | [diff] [blame] | 167 | unsigned long fck; |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 168 | struct dispc_clock_info dispc_cinfo; |
| 169 | }; |
| 170 | |
| 171 | static bool dpi_calc_dispc_cb(int lckd, int pckd, unsigned long lck, |
| 172 | unsigned long pck, void *data) |
| 173 | { |
| 174 | struct dpi_clk_calc_ctx *ctx = data; |
| 175 | |
| 176 | /* |
| 177 | * Odd dividers give us uneven duty cycle, causing problem when level |
| 178 | * shifted. So skip all odd dividers when the pixel clock is on the |
| 179 | * higher side. |
| 180 | */ |
Tomi Valkeinen | 72e5512 | 2013-06-12 09:44:52 +0300 | [diff] [blame] | 181 | if (ctx->pck_min >= 100000000) { |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 182 | if (lckd > 1 && lckd % 2 != 0) |
| 183 | return false; |
| 184 | |
| 185 | if (pckd > 1 && pckd % 2 != 0) |
| 186 | return false; |
| 187 | } |
| 188 | |
| 189 | ctx->dispc_cinfo.lck_div = lckd; |
| 190 | ctx->dispc_cinfo.pck_div = pckd; |
| 191 | ctx->dispc_cinfo.lck = lck; |
| 192 | ctx->dispc_cinfo.pck = pck; |
| 193 | |
| 194 | return true; |
| 195 | } |
| 196 | |
| 197 | |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 198 | static bool dpi_calc_hsdiv_cb(int m_dispc, unsigned long dispc, |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 199 | void *data) |
| 200 | { |
| 201 | struct dpi_clk_calc_ctx *ctx = data; |
| 202 | |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 203 | ctx->pll_cinfo.mX[ctx->clkout_idx] = m_dispc; |
| 204 | ctx->pll_cinfo.clkout[ctx->clkout_idx] = dispc; |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 205 | |
| 206 | return dispc_div_calc(dispc, ctx->pck_min, ctx->pck_max, |
| 207 | dpi_calc_dispc_cb, ctx); |
| 208 | } |
| 209 | |
| 210 | |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 211 | static bool dpi_calc_pll_cb(int n, int m, unsigned long fint, |
| 212 | unsigned long clkdco, |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 213 | void *data) |
| 214 | { |
| 215 | struct dpi_clk_calc_ctx *ctx = data; |
| 216 | |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 217 | ctx->pll_cinfo.n = n; |
| 218 | ctx->pll_cinfo.m = m; |
| 219 | ctx->pll_cinfo.fint = fint; |
| 220 | ctx->pll_cinfo.clkdco = clkdco; |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 221 | |
Tomi Valkeinen | cd0715f | 2016-05-17 21:23:37 +0300 | [diff] [blame] | 222 | return dss_pll_hsdiv_calc_a(ctx->pll, clkdco, |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 223 | ctx->pck_min, dss_feat_get_param_max(FEAT_PARAM_DSS_FCK), |
| 224 | dpi_calc_hsdiv_cb, ctx); |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 225 | } |
| 226 | |
Tomi Valkeinen | d0f58bd | 2013-10-31 14:44:23 +0200 | [diff] [blame] | 227 | static bool dpi_calc_dss_cb(unsigned long fck, void *data) |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 228 | { |
| 229 | struct dpi_clk_calc_ctx *ctx = data; |
| 230 | |
Tomi Valkeinen | d0f58bd | 2013-10-31 14:44:23 +0200 | [diff] [blame] | 231 | ctx->fck = fck; |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 232 | |
| 233 | return dispc_div_calc(fck, ctx->pck_min, ctx->pck_max, |
| 234 | dpi_calc_dispc_cb, ctx); |
| 235 | } |
| 236 | |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 237 | static bool dpi_pll_clk_calc(struct dpi_data *dpi, unsigned long pck, |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 238 | struct dpi_clk_calc_ctx *ctx) |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 239 | { |
| 240 | unsigned long clkin; |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 241 | |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 242 | memset(ctx, 0, sizeof(*ctx)); |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 243 | ctx->pll = dpi->pll; |
Tomi Valkeinen | 13ece4d | 2016-05-17 16:20:07 +0300 | [diff] [blame] | 244 | ctx->clkout_idx = dss_pll_get_clkout_idx_for_src(dpi->clk_src); |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 245 | |
Tomi Valkeinen | 683cd86 | 2016-05-18 12:06:49 +0300 | [diff] [blame] | 246 | clkin = clk_get_rate(dpi->pll->clkin); |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 247 | |
Tomi Valkeinen | 683cd86 | 2016-05-18 12:06:49 +0300 | [diff] [blame] | 248 | if (dpi->pll->hw->type == DSS_PLL_TYPE_A) { |
| 249 | unsigned long pll_min, pll_max; |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 250 | |
Tomi Valkeinen | 683cd86 | 2016-05-18 12:06:49 +0300 | [diff] [blame] | 251 | ctx->pck_min = pck - 1000; |
| 252 | ctx->pck_max = pck + 1000; |
| 253 | |
| 254 | pll_min = 0; |
| 255 | pll_max = 0; |
| 256 | |
| 257 | return dss_pll_calc_a(ctx->pll, clkin, |
| 258 | pll_min, pll_max, |
| 259 | dpi_calc_pll_cb, ctx); |
| 260 | } else { /* DSS_PLL_TYPE_B */ |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 261 | dss_pll_calc_b(dpi->pll, clkin, pck, &ctx->pll_cinfo); |
Tomi Valkeinen | 683cd86 | 2016-05-18 12:06:49 +0300 | [diff] [blame] | 262 | |
| 263 | ctx->dispc_cinfo.lck_div = 1; |
| 264 | ctx->dispc_cinfo.pck_div = 1; |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 265 | ctx->dispc_cinfo.lck = ctx->pll_cinfo.clkout[0]; |
Tomi Valkeinen | 683cd86 | 2016-05-18 12:06:49 +0300 | [diff] [blame] | 266 | ctx->dispc_cinfo.pck = ctx->dispc_cinfo.lck; |
| 267 | |
| 268 | return true; |
| 269 | } |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 270 | } |
| 271 | |
| 272 | static bool dpi_dss_clk_calc(unsigned long pck, struct dpi_clk_calc_ctx *ctx) |
| 273 | { |
| 274 | int i; |
| 275 | |
| 276 | /* |
| 277 | * DSS fck gives us very few possibilities, so finding a good pixel |
| 278 | * clock may not be possible. We try multiple times to find the clock, |
| 279 | * each time widening the pixel clock range we look for, up to |
Tomi Valkeinen | 2c6360f | 2013-04-10 14:54:54 +0300 | [diff] [blame] | 280 | * +/- ~15MHz. |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 281 | */ |
| 282 | |
Tomi Valkeinen | 2c6360f | 2013-04-10 14:54:54 +0300 | [diff] [blame] | 283 | for (i = 0; i < 25; ++i) { |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 284 | bool ok; |
| 285 | |
| 286 | memset(ctx, 0, sizeof(*ctx)); |
| 287 | if (pck > 1000 * i * i * i) |
| 288 | ctx->pck_min = max(pck - 1000 * i * i * i, 0lu); |
| 289 | else |
| 290 | ctx->pck_min = 0; |
| 291 | ctx->pck_max = pck + 1000 * i * i * i; |
| 292 | |
Tomi Valkeinen | 688af02 | 2013-10-31 16:41:57 +0200 | [diff] [blame] | 293 | ok = dss_div_calc(pck, ctx->pck_min, dpi_calc_dss_cb, ctx); |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 294 | if (ok) |
| 295 | return ok; |
| 296 | } |
| 297 | |
| 298 | return false; |
| 299 | } |
| 300 | |
| 301 | |
| 302 | |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 303 | static int dpi_set_pll_clk(struct dpi_data *dpi, enum omap_channel channel, |
Sumit Semwal | ff1b2cde | 2010-12-02 11:27:11 +0000 | [diff] [blame] | 304 | unsigned long pck_req, unsigned long *fck, int *lck_div, |
| 305 | int *pck_div) |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 306 | { |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 307 | struct dpi_clk_calc_ctx ctx; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 308 | int r; |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 309 | bool ok; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 310 | |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 311 | ok = dpi_pll_clk_calc(dpi, pck_req, &ctx); |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 312 | if (!ok) |
| 313 | return -EINVAL; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 314 | |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 315 | r = dss_pll_set_config(dpi->pll, &ctx.pll_cinfo); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 316 | if (r) |
| 317 | return r; |
| 318 | |
Tomi Valkeinen | 331e607 | 2016-05-17 16:08:54 +0300 | [diff] [blame] | 319 | dss_select_lcd_clk_source(channel, dpi->clk_src); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 320 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 321 | dpi->mgr_config.clock_info = ctx.dispc_cinfo; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 322 | |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 323 | *fck = ctx.pll_cinfo.clkout[ctx.clkout_idx]; |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 324 | *lck_div = ctx.dispc_cinfo.lck_div; |
| 325 | *pck_div = ctx.dispc_cinfo.pck_div; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 326 | |
| 327 | return 0; |
| 328 | } |
Archit Taneja | 7636b3b | 2011-04-12 13:52:26 +0530 | [diff] [blame] | 329 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 330 | static int dpi_set_dispc_clk(struct dpi_data *dpi, unsigned long pck_req, |
| 331 | unsigned long *fck, int *lck_div, int *pck_div) |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 332 | { |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 333 | struct dpi_clk_calc_ctx ctx; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 334 | int r; |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 335 | bool ok; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 336 | |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 337 | ok = dpi_dss_clk_calc(pck_req, &ctx); |
| 338 | if (!ok) |
| 339 | return -EINVAL; |
| 340 | |
Tomi Valkeinen | d0f58bd | 2013-10-31 14:44:23 +0200 | [diff] [blame] | 341 | r = dss_set_fck_rate(ctx.fck); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 342 | if (r) |
| 343 | return r; |
| 344 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 345 | dpi->mgr_config.clock_info = ctx.dispc_cinfo; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 346 | |
Tomi Valkeinen | d0f58bd | 2013-10-31 14:44:23 +0200 | [diff] [blame] | 347 | *fck = ctx.fck; |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 348 | *lck_div = ctx.dispc_cinfo.lck_div; |
| 349 | *pck_div = ctx.dispc_cinfo.pck_div; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 350 | |
| 351 | return 0; |
| 352 | } |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 353 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 354 | static int dpi_set_mode(struct dpi_data *dpi) |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 355 | { |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 356 | struct omap_dss_device *out = &dpi->output; |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 357 | enum omap_channel channel = out->dispc_channel; |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 358 | struct videomode *vm = &dpi->vm; |
Archit Taneja | 7636b3b | 2011-04-12 13:52:26 +0530 | [diff] [blame] | 359 | int lck_div = 0, pck_div = 0; |
| 360 | unsigned long fck = 0; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 361 | unsigned long pck; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 362 | int r = 0; |
| 363 | |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 364 | if (dpi->pll) |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 365 | r = dpi_set_pll_clk(dpi, channel, vm->pixelclock, &fck, |
Archit Taneja | 6d523e7 | 2012-06-21 09:33:55 +0530 | [diff] [blame] | 366 | &lck_div, &pck_div); |
Archit Taneja | 7636b3b | 2011-04-12 13:52:26 +0530 | [diff] [blame] | 367 | else |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 368 | r = dpi_set_dispc_clk(dpi, vm->pixelclock, &fck, |
Archit Taneja | 6d523e7 | 2012-06-21 09:33:55 +0530 | [diff] [blame] | 369 | &lck_div, &pck_div); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 370 | if (r) |
Tomi Valkeinen | 4fbafaf | 2011-05-27 10:52:19 +0300 | [diff] [blame] | 371 | return r; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 372 | |
Tomi Valkeinen | d8d78941 | 2013-04-10 14:12:14 +0300 | [diff] [blame] | 373 | pck = fck / lck_div / pck_div; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 374 | |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 375 | if (pck != vm->pixelclock) { |
Peter Ujfalusi | 7aa91e7 | 2016-09-22 14:07:02 +0300 | [diff] [blame] | 376 | DSSWARN("Could not find exact pixel clock. Requested %lu Hz, got %lu Hz\n", |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 377 | vm->pixelclock, pck); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 378 | |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 379 | vm->pixelclock = pck; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 380 | } |
| 381 | |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 382 | dss_mgr_set_timings(channel, vm); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 383 | |
Tomi Valkeinen | 4fbafaf | 2011-05-27 10:52:19 +0300 | [diff] [blame] | 384 | return 0; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 385 | } |
| 386 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 387 | static void dpi_config_lcd_manager(struct dpi_data *dpi) |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 388 | { |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 389 | struct omap_dss_device *out = &dpi->output; |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 390 | enum omap_channel channel = out->dispc_channel; |
Archit Taneja | 569969d | 2011-08-22 17:41:57 +0530 | [diff] [blame] | 391 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 392 | dpi->mgr_config.io_pad_mode = DSS_IO_PAD_MODE_BYPASS; |
Archit Taneja | 5cf9a26 | 2012-06-29 14:19:13 +0530 | [diff] [blame] | 393 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 394 | dpi->mgr_config.stallmode = false; |
| 395 | dpi->mgr_config.fifohandcheck = false; |
Archit Taneja | 5cf9a26 | 2012-06-29 14:19:13 +0530 | [diff] [blame] | 396 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 397 | dpi->mgr_config.video_port_width = dpi->data_lines; |
Archit Taneja | 5cf9a26 | 2012-06-29 14:19:13 +0530 | [diff] [blame] | 398 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 399 | dpi->mgr_config.lcden_sig_polarity = 0; |
| 400 | |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 401 | dss_mgr_set_lcd_config(channel, &dpi->mgr_config); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 402 | } |
| 403 | |
Tomi Valkeinen | 86a3efe | 2013-05-15 10:40:15 +0300 | [diff] [blame] | 404 | static int dpi_display_enable(struct omap_dss_device *dssdev) |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 405 | { |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 406 | struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev); |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 407 | struct omap_dss_device *out = &dpi->output; |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 408 | enum omap_channel channel = out->dispc_channel; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 409 | int r; |
| 410 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 411 | mutex_lock(&dpi->lock); |
Archit Taneja | c8a5e4e | 2012-07-05 12:52:46 +0530 | [diff] [blame] | 412 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 413 | if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI) && !dpi->vdds_dsi_reg) { |
Russell King | 4041071 | 2012-02-07 09:44:55 +0000 | [diff] [blame] | 414 | DSSERR("no VDSS_DSI regulator\n"); |
Archit Taneja | c8a5e4e | 2012-07-05 12:52:46 +0530 | [diff] [blame] | 415 | r = -ENODEV; |
| 416 | goto err_no_reg; |
Russell King | 4041071 | 2012-02-07 09:44:55 +0000 | [diff] [blame] | 417 | } |
| 418 | |
Tomi Valkeinen | f1504ad | 2015-11-05 09:34:51 +0200 | [diff] [blame] | 419 | if (!out->dispc_channel_connected) { |
Archit Taneja | 5d512fc | 2012-09-07 17:53:38 +0530 | [diff] [blame] | 420 | DSSERR("failed to enable display: no output/manager\n"); |
Archit Taneja | c8a5e4e | 2012-07-05 12:52:46 +0530 | [diff] [blame] | 421 | r = -ENODEV; |
Archit Taneja | 5d512fc | 2012-09-07 17:53:38 +0530 | [diff] [blame] | 422 | goto err_no_out_mgr; |
Tomi Valkeinen | 05e1d60 | 2011-06-23 16:38:21 +0300 | [diff] [blame] | 423 | } |
| 424 | |
Chandrabhanu Mahapatra | 195e672 | 2012-08-22 11:44:06 +0530 | [diff] [blame] | 425 | if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI)) { |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 426 | r = regulator_enable(dpi->vdds_dsi_reg); |
Tomi Valkeinen | 8a2cfea | 2010-02-04 17:03:41 +0200 | [diff] [blame] | 427 | if (r) |
Tomi Valkeinen | 4fbafaf | 2011-05-27 10:52:19 +0300 | [diff] [blame] | 428 | goto err_reg_enable; |
Tomi Valkeinen | 8a2cfea | 2010-02-04 17:03:41 +0200 | [diff] [blame] | 429 | } |
| 430 | |
Tomi Valkeinen | 4fbafaf | 2011-05-27 10:52:19 +0300 | [diff] [blame] | 431 | r = dispc_runtime_get(); |
| 432 | if (r) |
| 433 | goto err_get_dispc; |
| 434 | |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 435 | r = dss_dpi_select_source(out->port_num, channel); |
Tomi Valkeinen | de09e45 | 2012-09-21 12:09:54 +0300 | [diff] [blame] | 436 | if (r) |
| 437 | goto err_src_sel; |
| 438 | |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 439 | if (dpi->pll) { |
| 440 | r = dss_pll_enable(dpi->pll); |
Archit Taneja | 7636b3b | 2011-04-12 13:52:26 +0530 | [diff] [blame] | 441 | if (r) |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 442 | goto err_pll_init; |
Archit Taneja | 7636b3b | 2011-04-12 13:52:26 +0530 | [diff] [blame] | 443 | } |
| 444 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 445 | r = dpi_set_mode(dpi); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 446 | if (r) |
Tomi Valkeinen | 4fbafaf | 2011-05-27 10:52:19 +0300 | [diff] [blame] | 447 | goto err_set_mode; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 448 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 449 | dpi_config_lcd_manager(dpi); |
Archit Taneja | 5cf9a26 | 2012-06-29 14:19:13 +0530 | [diff] [blame] | 450 | |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 451 | mdelay(2); |
| 452 | |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 453 | r = dss_mgr_enable(channel); |
Tomi Valkeinen | 33ca237 | 2011-11-21 13:42:58 +0200 | [diff] [blame] | 454 | if (r) |
| 455 | goto err_mgr_enable; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 456 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 457 | mutex_unlock(&dpi->lock); |
Archit Taneja | c8a5e4e | 2012-07-05 12:52:46 +0530 | [diff] [blame] | 458 | |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 459 | return 0; |
| 460 | |
Tomi Valkeinen | 33ca237 | 2011-11-21 13:42:58 +0200 | [diff] [blame] | 461 | err_mgr_enable: |
Tomi Valkeinen | 4fbafaf | 2011-05-27 10:52:19 +0300 | [diff] [blame] | 462 | err_set_mode: |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 463 | if (dpi->pll) |
| 464 | dss_pll_disable(dpi->pll); |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 465 | err_pll_init: |
Tomi Valkeinen | de09e45 | 2012-09-21 12:09:54 +0300 | [diff] [blame] | 466 | err_src_sel: |
Tomi Valkeinen | 4fbafaf | 2011-05-27 10:52:19 +0300 | [diff] [blame] | 467 | dispc_runtime_put(); |
| 468 | err_get_dispc: |
Chandrabhanu Mahapatra | 195e672 | 2012-08-22 11:44:06 +0530 | [diff] [blame] | 469 | if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI)) |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 470 | regulator_disable(dpi->vdds_dsi_reg); |
Tomi Valkeinen | 4fbafaf | 2011-05-27 10:52:19 +0300 | [diff] [blame] | 471 | err_reg_enable: |
Archit Taneja | 5d512fc | 2012-09-07 17:53:38 +0530 | [diff] [blame] | 472 | err_no_out_mgr: |
Archit Taneja | c8a5e4e | 2012-07-05 12:52:46 +0530 | [diff] [blame] | 473 | err_no_reg: |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 474 | mutex_unlock(&dpi->lock); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 475 | return r; |
| 476 | } |
| 477 | |
Tomi Valkeinen | 86a3efe | 2013-05-15 10:40:15 +0300 | [diff] [blame] | 478 | static void dpi_display_disable(struct omap_dss_device *dssdev) |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 479 | { |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 480 | struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev); |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 481 | enum omap_channel channel = dpi->output.dispc_channel; |
Archit Taneja | 5d512fc | 2012-09-07 17:53:38 +0530 | [diff] [blame] | 482 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 483 | mutex_lock(&dpi->lock); |
Archit Taneja | c8a5e4e | 2012-07-05 12:52:46 +0530 | [diff] [blame] | 484 | |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 485 | dss_mgr_disable(channel); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 486 | |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 487 | if (dpi->pll) { |
Tomi Valkeinen | 3b63ca7 | 2016-05-17 14:01:10 +0300 | [diff] [blame] | 488 | dss_select_lcd_clk_source(channel, DSS_CLK_SRC_FCK); |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 489 | dss_pll_disable(dpi->pll); |
Archit Taneja | 7636b3b | 2011-04-12 13:52:26 +0530 | [diff] [blame] | 490 | } |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 491 | |
Tomi Valkeinen | 4fbafaf | 2011-05-27 10:52:19 +0300 | [diff] [blame] | 492 | dispc_runtime_put(); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 493 | |
Chandrabhanu Mahapatra | 195e672 | 2012-08-22 11:44:06 +0530 | [diff] [blame] | 494 | if (dss_has_feature(FEAT_DPI_USES_VDDS_DSI)) |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 495 | regulator_disable(dpi->vdds_dsi_reg); |
Tomi Valkeinen | 8a2cfea | 2010-02-04 17:03:41 +0200 | [diff] [blame] | 496 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 497 | mutex_unlock(&dpi->lock); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 498 | } |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 499 | |
Tomi Valkeinen | 86a3efe | 2013-05-15 10:40:15 +0300 | [diff] [blame] | 500 | static void dpi_set_timings(struct omap_dss_device *dssdev, |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 501 | struct videomode *vm) |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 502 | { |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 503 | struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev); |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 504 | |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 505 | DSSDBG("dpi_set_timings\n"); |
Archit Taneja | c8a5e4e | 2012-07-05 12:52:46 +0530 | [diff] [blame] | 506 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 507 | mutex_lock(&dpi->lock); |
Archit Taneja | c8a5e4e | 2012-07-05 12:52:46 +0530 | [diff] [blame] | 508 | |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 509 | dpi->vm = *vm; |
Archit Taneja | c499144 | 2012-08-08 14:28:54 +0530 | [diff] [blame] | 510 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 511 | mutex_unlock(&dpi->lock); |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 512 | } |
| 513 | |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 514 | static void dpi_get_timings(struct omap_dss_device *dssdev, |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 515 | struct videomode *vm) |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 516 | { |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 517 | struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev); |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 518 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 519 | mutex_lock(&dpi->lock); |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 520 | |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 521 | *vm = dpi->vm; |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 522 | |
| 523 | mutex_unlock(&dpi->lock); |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 524 | } |
| 525 | |
Tomi Valkeinen | 86a3efe | 2013-05-15 10:40:15 +0300 | [diff] [blame] | 526 | static int dpi_check_timings(struct omap_dss_device *dssdev, |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 527 | struct videomode *vm) |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 528 | { |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 529 | struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev); |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 530 | enum omap_channel channel = dpi->output.dispc_channel; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 531 | int lck_div, pck_div; |
| 532 | unsigned long fck; |
| 533 | unsigned long pck; |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 534 | struct dpi_clk_calc_ctx ctx; |
| 535 | bool ok; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 536 | |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 537 | if (vm->hactive % 8 != 0) |
Tomi Valkeinen | 2158f2c | 2016-01-05 11:43:18 +0200 | [diff] [blame] | 538 | return -EINVAL; |
| 539 | |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 540 | if (!dispc_mgr_timings_ok(channel, vm)) |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 541 | return -EINVAL; |
| 542 | |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 543 | if (vm->pixelclock == 0) |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 544 | return -EINVAL; |
| 545 | |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 546 | if (dpi->pll) { |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 547 | ok = dpi_pll_clk_calc(dpi, vm->pixelclock, &ctx); |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 548 | if (!ok) |
| 549 | return -EINVAL; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 550 | |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 551 | fck = ctx.pll_cinfo.clkout[ctx.clkout_idx]; |
Archit Taneja | 7636b3b | 2011-04-12 13:52:26 +0530 | [diff] [blame] | 552 | } else { |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 553 | ok = dpi_dss_clk_calc(vm->pixelclock, &ctx); |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 554 | if (!ok) |
| 555 | return -EINVAL; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 556 | |
Tomi Valkeinen | d0f58bd | 2013-10-31 14:44:23 +0200 | [diff] [blame] | 557 | fck = ctx.fck; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 558 | } |
Archit Taneja | 7636b3b | 2011-04-12 13:52:26 +0530 | [diff] [blame] | 559 | |
Tomi Valkeinen | 100c826 | 2013-03-05 17:07:16 +0200 | [diff] [blame] | 560 | lck_div = ctx.dispc_cinfo.lck_div; |
| 561 | pck_div = ctx.dispc_cinfo.pck_div; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 562 | |
Tomi Valkeinen | d8d78941 | 2013-04-10 14:12:14 +0300 | [diff] [blame] | 563 | pck = fck / lck_div / pck_div; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 564 | |
Peter Ujfalusi | da11bbbb | 2016-09-22 14:07:04 +0300 | [diff] [blame] | 565 | vm->pixelclock = pck; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 566 | |
| 567 | return 0; |
| 568 | } |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 569 | |
Tomi Valkeinen | 86a3efe | 2013-05-15 10:40:15 +0300 | [diff] [blame] | 570 | static void dpi_set_data_lines(struct omap_dss_device *dssdev, int data_lines) |
Archit Taneja | c6b393d | 2012-07-06 15:30:52 +0530 | [diff] [blame] | 571 | { |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 572 | struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev); |
Archit Taneja | c6b393d | 2012-07-06 15:30:52 +0530 | [diff] [blame] | 573 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 574 | mutex_lock(&dpi->lock); |
Archit Taneja | c6b393d | 2012-07-06 15:30:52 +0530 | [diff] [blame] | 575 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 576 | dpi->data_lines = data_lines; |
| 577 | |
| 578 | mutex_unlock(&dpi->lock); |
Archit Taneja | c6b393d | 2012-07-06 15:30:52 +0530 | [diff] [blame] | 579 | } |
Archit Taneja | c6b393d | 2012-07-06 15:30:52 +0530 | [diff] [blame] | 580 | |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 581 | static int dpi_verify_pll(struct dss_pll *pll) |
Tomi Valkeinen | 6061675 | 2012-10-30 12:57:43 +0200 | [diff] [blame] | 582 | { |
| 583 | int r; |
| 584 | |
| 585 | /* do initial setup with the PLL to see if it is operational */ |
| 586 | |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 587 | r = dss_pll_enable(pll); |
Tomi Valkeinen | 6061675 | 2012-10-30 12:57:43 +0200 | [diff] [blame] | 588 | if (r) |
| 589 | return r; |
| 590 | |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 591 | dss_pll_disable(pll); |
Tomi Valkeinen | 6061675 | 2012-10-30 12:57:43 +0200 | [diff] [blame] | 592 | |
| 593 | return 0; |
| 594 | } |
| 595 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 596 | static int dpi_init_regulator(struct dpi_data *dpi) |
Tomi Valkeinen | 2795f64 | 2013-04-19 16:52:27 +0300 | [diff] [blame] | 597 | { |
| 598 | struct regulator *vdds_dsi; |
| 599 | |
| 600 | if (!dss_has_feature(FEAT_DPI_USES_VDDS_DSI)) |
| 601 | return 0; |
| 602 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 603 | if (dpi->vdds_dsi_reg) |
Tomi Valkeinen | 2795f64 | 2013-04-19 16:52:27 +0300 | [diff] [blame] | 604 | return 0; |
| 605 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 606 | vdds_dsi = devm_regulator_get(&dpi->pdev->dev, "vdds_dsi"); |
Tomi Valkeinen | 2795f64 | 2013-04-19 16:52:27 +0300 | [diff] [blame] | 607 | if (IS_ERR(vdds_dsi)) { |
Tomi Valkeinen | 40359a9 | 2013-12-19 16:15:34 +0200 | [diff] [blame] | 608 | if (PTR_ERR(vdds_dsi) != -EPROBE_DEFER) |
| 609 | DSSERR("can't get VDDS_DSI regulator\n"); |
Tomi Valkeinen | 4123de2 | 2013-08-29 10:06:55 +0300 | [diff] [blame] | 610 | return PTR_ERR(vdds_dsi); |
Tomi Valkeinen | 2795f64 | 2013-04-19 16:52:27 +0300 | [diff] [blame] | 611 | } |
| 612 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 613 | dpi->vdds_dsi_reg = vdds_dsi; |
Tomi Valkeinen | 2795f64 | 2013-04-19 16:52:27 +0300 | [diff] [blame] | 614 | |
| 615 | return 0; |
| 616 | } |
| 617 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 618 | static void dpi_init_pll(struct dpi_data *dpi) |
Tomi Valkeinen | 2795f64 | 2013-04-19 16:52:27 +0300 | [diff] [blame] | 619 | { |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 620 | struct dss_pll *pll; |
Tomi Valkeinen | 2795f64 | 2013-04-19 16:52:27 +0300 | [diff] [blame] | 621 | |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 622 | if (dpi->pll) |
Tomi Valkeinen | 2795f64 | 2013-04-19 16:52:27 +0300 | [diff] [blame] | 623 | return; |
| 624 | |
Tomi Valkeinen | 331e607 | 2016-05-17 16:08:54 +0300 | [diff] [blame] | 625 | dpi->clk_src = dpi_get_clk_src(dpi->output.dispc_channel); |
| 626 | |
| 627 | pll = dss_pll_find_by_src(dpi->clk_src); |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 628 | if (!pll) |
Tomi Valkeinen | 2795f64 | 2013-04-19 16:52:27 +0300 | [diff] [blame] | 629 | return; |
| 630 | |
Tomi Valkeinen | 31dca07 | 2016-05-18 12:22:32 +0300 | [diff] [blame] | 631 | if (dpi_verify_pll(pll)) { |
| 632 | DSSWARN("PLL not operational\n"); |
Tomi Valkeinen | 2795f64 | 2013-04-19 16:52:27 +0300 | [diff] [blame] | 633 | return; |
| 634 | } |
| 635 | |
Tomi Valkeinen | 2daea7a | 2014-10-22 14:49:14 +0300 | [diff] [blame] | 636 | dpi->pll = pll; |
Tomi Valkeinen | 2795f64 | 2013-04-19 16:52:27 +0300 | [diff] [blame] | 637 | } |
| 638 | |
Tomi Valkeinen | 2eea5ae | 2013-02-13 11:23:54 +0200 | [diff] [blame] | 639 | /* |
| 640 | * Return a hardcoded channel for the DPI output. This should work for |
| 641 | * current use cases, but this can be later expanded to either resolve |
| 642 | * the channel in some more dynamic manner, or get the channel as a user |
| 643 | * parameter. |
| 644 | */ |
Archit Taneja | f7e38fe | 2014-05-06 17:07:39 +0530 | [diff] [blame] | 645 | static enum omap_channel dpi_get_channel(int port_num) |
Tomi Valkeinen | 2eea5ae | 2013-02-13 11:23:54 +0200 | [diff] [blame] | 646 | { |
| 647 | switch (omapdss_get_version()) { |
| 648 | case OMAPDSS_VER_OMAP24xx: |
| 649 | case OMAPDSS_VER_OMAP34xx_ES1: |
| 650 | case OMAPDSS_VER_OMAP34xx_ES3: |
| 651 | case OMAPDSS_VER_OMAP3630: |
| 652 | case OMAPDSS_VER_AM35xx: |
Sathya Prakash M R | d6279d4 | 2014-03-24 16:31:51 +0530 | [diff] [blame] | 653 | case OMAPDSS_VER_AM43xx: |
Tomi Valkeinen | 2eea5ae | 2013-02-13 11:23:54 +0200 | [diff] [blame] | 654 | return OMAP_DSS_CHANNEL_LCD; |
| 655 | |
Tomi Valkeinen | a240815 | 2014-12-31 11:26:06 +0200 | [diff] [blame] | 656 | case OMAPDSS_VER_DRA7xx: |
| 657 | switch (port_num) { |
| 658 | case 2: |
| 659 | return OMAP_DSS_CHANNEL_LCD3; |
| 660 | case 1: |
| 661 | return OMAP_DSS_CHANNEL_LCD2; |
| 662 | case 0: |
| 663 | default: |
| 664 | return OMAP_DSS_CHANNEL_LCD; |
| 665 | } |
| 666 | |
Tomi Valkeinen | 2eea5ae | 2013-02-13 11:23:54 +0200 | [diff] [blame] | 667 | case OMAPDSS_VER_OMAP4430_ES1: |
| 668 | case OMAPDSS_VER_OMAP4430_ES2: |
| 669 | case OMAPDSS_VER_OMAP4: |
| 670 | return OMAP_DSS_CHANNEL_LCD2; |
| 671 | |
| 672 | case OMAPDSS_VER_OMAP5: |
| 673 | return OMAP_DSS_CHANNEL_LCD3; |
| 674 | |
| 675 | default: |
| 676 | DSSWARN("unsupported DSS version\n"); |
| 677 | return OMAP_DSS_CHANNEL_LCD; |
| 678 | } |
| 679 | } |
| 680 | |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 681 | static int dpi_connect(struct omap_dss_device *dssdev, |
| 682 | struct omap_dss_device *dst) |
| 683 | { |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 684 | struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev); |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 685 | enum omap_channel channel = dpi->output.dispc_channel; |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 686 | int r; |
| 687 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 688 | r = dpi_init_regulator(dpi); |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 689 | if (r) |
| 690 | return r; |
| 691 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 692 | dpi_init_pll(dpi); |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 693 | |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 694 | r = dss_mgr_connect(channel, dssdev); |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 695 | if (r) |
| 696 | return r; |
| 697 | |
| 698 | r = omapdss_output_set_device(dssdev, dst); |
| 699 | if (r) { |
| 700 | DSSERR("failed to connect output to new device: %s\n", |
| 701 | dst->name); |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 702 | dss_mgr_disconnect(channel, dssdev); |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 703 | return r; |
| 704 | } |
| 705 | |
| 706 | return 0; |
| 707 | } |
| 708 | |
| 709 | static void dpi_disconnect(struct omap_dss_device *dssdev, |
| 710 | struct omap_dss_device *dst) |
| 711 | { |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 712 | struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev); |
| 713 | enum omap_channel channel = dpi->output.dispc_channel; |
| 714 | |
Tomi Valkeinen | 9560dc10 | 2013-07-24 13:06:54 +0300 | [diff] [blame] | 715 | WARN_ON(dst != dssdev->dst); |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 716 | |
Tomi Valkeinen | 9560dc10 | 2013-07-24 13:06:54 +0300 | [diff] [blame] | 717 | if (dst != dssdev->dst) |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 718 | return; |
| 719 | |
| 720 | omapdss_output_unset_device(dssdev); |
| 721 | |
Tomi Valkeinen | a070ba6 | 2015-11-05 09:52:00 +0200 | [diff] [blame] | 722 | dss_mgr_disconnect(channel, dssdev); |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 723 | } |
| 724 | |
| 725 | static const struct omapdss_dpi_ops dpi_ops = { |
| 726 | .connect = dpi_connect, |
| 727 | .disconnect = dpi_disconnect, |
| 728 | |
Tomi Valkeinen | 86a3efe | 2013-05-15 10:40:15 +0300 | [diff] [blame] | 729 | .enable = dpi_display_enable, |
| 730 | .disable = dpi_display_disable, |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 731 | |
| 732 | .check_timings = dpi_check_timings, |
Tomi Valkeinen | 86a3efe | 2013-05-15 10:40:15 +0300 | [diff] [blame] | 733 | .set_timings = dpi_set_timings, |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 734 | .get_timings = dpi_get_timings, |
| 735 | |
Tomi Valkeinen | 86a3efe | 2013-05-15 10:40:15 +0300 | [diff] [blame] | 736 | .set_data_lines = dpi_set_data_lines, |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 737 | }; |
| 738 | |
Tomi Valkeinen | 94cf394 | 2013-04-26 14:27:44 +0300 | [diff] [blame] | 739 | static void dpi_init_output(struct platform_device *pdev) |
Archit Taneja | 81b87f5 | 2012-09-26 16:30:49 +0530 | [diff] [blame] | 740 | { |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 741 | struct dpi_data *dpi = dpi_get_data_from_pdev(pdev); |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 742 | struct omap_dss_device *out = &dpi->output; |
Archit Taneja | 81b87f5 | 2012-09-26 16:30:49 +0530 | [diff] [blame] | 743 | |
Tomi Valkeinen | 1f68d9c | 2013-04-19 15:09:34 +0300 | [diff] [blame] | 744 | out->dev = &pdev->dev; |
Archit Taneja | 81b87f5 | 2012-09-26 16:30:49 +0530 | [diff] [blame] | 745 | out->id = OMAP_DSS_OUTPUT_DPI; |
Tomi Valkeinen | 1f68d9c | 2013-04-19 15:09:34 +0300 | [diff] [blame] | 746 | out->output_type = OMAP_DISPLAY_TYPE_DPI; |
Tomi Valkeinen | 7286a08 | 2013-02-18 13:06:01 +0200 | [diff] [blame] | 747 | out->name = "dpi.0"; |
Archit Taneja | f7e38fe | 2014-05-06 17:07:39 +0530 | [diff] [blame] | 748 | out->dispc_channel = dpi_get_channel(0); |
Tomi Valkeinen | 0b24edb | 2013-05-24 13:18:52 +0300 | [diff] [blame] | 749 | out->ops.dpi = &dpi_ops; |
Tomi Valkeinen | b7328e1 | 2013-05-03 11:42:18 +0300 | [diff] [blame] | 750 | out->owner = THIS_MODULE; |
Archit Taneja | 81b87f5 | 2012-09-26 16:30:49 +0530 | [diff] [blame] | 751 | |
Tomi Valkeinen | 5d47dbc | 2013-04-24 13:32:51 +0300 | [diff] [blame] | 752 | omapdss_register_output(out); |
Archit Taneja | 81b87f5 | 2012-09-26 16:30:49 +0530 | [diff] [blame] | 753 | } |
| 754 | |
Tomi Valkeinen | ede9269 | 2015-06-04 14:12:16 +0300 | [diff] [blame] | 755 | static void dpi_uninit_output(struct platform_device *pdev) |
Archit Taneja | 81b87f5 | 2012-09-26 16:30:49 +0530 | [diff] [blame] | 756 | { |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 757 | struct dpi_data *dpi = dpi_get_data_from_pdev(pdev); |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 758 | struct omap_dss_device *out = &dpi->output; |
Archit Taneja | 81b87f5 | 2012-09-26 16:30:49 +0530 | [diff] [blame] | 759 | |
Tomi Valkeinen | 5d47dbc | 2013-04-24 13:32:51 +0300 | [diff] [blame] | 760 | omapdss_unregister_output(out); |
Archit Taneja | 81b87f5 | 2012-09-26 16:30:49 +0530 | [diff] [blame] | 761 | } |
| 762 | |
Archit Taneja | 80eb675 | 2014-06-02 14:11:51 +0530 | [diff] [blame] | 763 | static void dpi_init_output_port(struct platform_device *pdev, |
| 764 | struct device_node *port) |
| 765 | { |
| 766 | struct dpi_data *dpi = port->data; |
| 767 | struct omap_dss_device *out = &dpi->output; |
Archit Taneja | f7e38fe | 2014-05-06 17:07:39 +0530 | [diff] [blame] | 768 | int r; |
| 769 | u32 port_num; |
| 770 | |
| 771 | r = of_property_read_u32(port, "reg", &port_num); |
| 772 | if (r) |
| 773 | port_num = 0; |
| 774 | |
| 775 | switch (port_num) { |
| 776 | case 2: |
| 777 | out->name = "dpi.2"; |
| 778 | break; |
| 779 | case 1: |
| 780 | out->name = "dpi.1"; |
| 781 | break; |
| 782 | case 0: |
| 783 | default: |
| 784 | out->name = "dpi.0"; |
| 785 | break; |
| 786 | } |
Archit Taneja | 80eb675 | 2014-06-02 14:11:51 +0530 | [diff] [blame] | 787 | |
| 788 | out->dev = &pdev->dev; |
| 789 | out->id = OMAP_DSS_OUTPUT_DPI; |
| 790 | out->output_type = OMAP_DISPLAY_TYPE_DPI; |
Archit Taneja | f7e38fe | 2014-05-06 17:07:39 +0530 | [diff] [blame] | 791 | out->dispc_channel = dpi_get_channel(port_num); |
| 792 | out->port_num = port_num; |
Archit Taneja | 80eb675 | 2014-06-02 14:11:51 +0530 | [diff] [blame] | 793 | out->ops.dpi = &dpi_ops; |
| 794 | out->owner = THIS_MODULE; |
| 795 | |
| 796 | omapdss_register_output(out); |
| 797 | } |
| 798 | |
Tomi Valkeinen | ede9269 | 2015-06-04 14:12:16 +0300 | [diff] [blame] | 799 | static void dpi_uninit_output_port(struct device_node *port) |
Archit Taneja | 80eb675 | 2014-06-02 14:11:51 +0530 | [diff] [blame] | 800 | { |
| 801 | struct dpi_data *dpi = port->data; |
| 802 | struct omap_dss_device *out = &dpi->output; |
| 803 | |
| 804 | omapdss_unregister_output(out); |
| 805 | } |
| 806 | |
Tomi Valkeinen | 736e60d | 2015-06-04 15:22:23 +0300 | [diff] [blame] | 807 | static int dpi_bind(struct device *dev, struct device *master, void *data) |
Tomi Valkeinen | 38f3daf | 2012-05-02 14:55:12 +0300 | [diff] [blame] | 808 | { |
Tomi Valkeinen | 736e60d | 2015-06-04 15:22:23 +0300 | [diff] [blame] | 809 | struct platform_device *pdev = to_platform_device(dev); |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 810 | struct dpi_data *dpi; |
| 811 | |
| 812 | dpi = devm_kzalloc(&pdev->dev, sizeof(*dpi), GFP_KERNEL); |
| 813 | if (!dpi) |
| 814 | return -ENOMEM; |
Tomi Valkeinen | 00df43b | 2013-03-19 11:33:52 +0200 | [diff] [blame] | 815 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 816 | dpi->pdev = pdev; |
| 817 | |
| 818 | dev_set_drvdata(&pdev->dev, dpi); |
| 819 | |
| 820 | mutex_init(&dpi->lock); |
Archit Taneja | c8a5e4e | 2012-07-05 12:52:46 +0530 | [diff] [blame] | 821 | |
Archit Taneja | 81b87f5 | 2012-09-26 16:30:49 +0530 | [diff] [blame] | 822 | dpi_init_output(pdev); |
| 823 | |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 824 | return 0; |
| 825 | } |
| 826 | |
Tomi Valkeinen | 736e60d | 2015-06-04 15:22:23 +0300 | [diff] [blame] | 827 | static void dpi_unbind(struct device *dev, struct device *master, void *data) |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 828 | { |
Tomi Valkeinen | 736e60d | 2015-06-04 15:22:23 +0300 | [diff] [blame] | 829 | struct platform_device *pdev = to_platform_device(dev); |
Archit Taneja | 81b87f5 | 2012-09-26 16:30:49 +0530 | [diff] [blame] | 830 | |
Tomi Valkeinen | 736e60d | 2015-06-04 15:22:23 +0300 | [diff] [blame] | 831 | dpi_uninit_output(pdev); |
| 832 | } |
| 833 | |
| 834 | static const struct component_ops dpi_component_ops = { |
| 835 | .bind = dpi_bind, |
| 836 | .unbind = dpi_unbind, |
| 837 | }; |
| 838 | |
| 839 | static int dpi_probe(struct platform_device *pdev) |
| 840 | { |
| 841 | return component_add(&pdev->dev, &dpi_component_ops); |
| 842 | } |
| 843 | |
| 844 | static int dpi_remove(struct platform_device *pdev) |
| 845 | { |
| 846 | component_del(&pdev->dev, &dpi_component_ops); |
Tomi Valkeinen | a57dd4f | 2012-02-20 16:57:37 +0200 | [diff] [blame] | 847 | return 0; |
Tomi Valkeinen | 553c48c | 2009-08-07 13:15:50 +0300 | [diff] [blame] | 848 | } |
| 849 | |
Tomi Valkeinen | a57dd4f | 2012-02-20 16:57:37 +0200 | [diff] [blame] | 850 | static struct platform_driver omap_dpi_driver = { |
Tomi Valkeinen | 736e60d | 2015-06-04 15:22:23 +0300 | [diff] [blame] | 851 | .probe = dpi_probe, |
| 852 | .remove = dpi_remove, |
Tomi Valkeinen | a57dd4f | 2012-02-20 16:57:37 +0200 | [diff] [blame] | 853 | .driver = { |
| 854 | .name = "omapdss_dpi", |
Tomi Valkeinen | 422ccbd | 2014-10-16 09:54:25 +0300 | [diff] [blame] | 855 | .suppress_bind_attrs = true, |
Tomi Valkeinen | a57dd4f | 2012-02-20 16:57:37 +0200 | [diff] [blame] | 856 | }, |
| 857 | }; |
| 858 | |
Tomi Valkeinen | 6e7e8f0 | 2012-02-17 17:41:13 +0200 | [diff] [blame] | 859 | int __init dpi_init_platform_driver(void) |
Tomi Valkeinen | a57dd4f | 2012-02-20 16:57:37 +0200 | [diff] [blame] | 860 | { |
Tomi Valkeinen | 94cf394 | 2013-04-26 14:27:44 +0300 | [diff] [blame] | 861 | return platform_driver_register(&omap_dpi_driver); |
Tomi Valkeinen | a57dd4f | 2012-02-20 16:57:37 +0200 | [diff] [blame] | 862 | } |
| 863 | |
Tomi Valkeinen | ede9269 | 2015-06-04 14:12:16 +0300 | [diff] [blame] | 864 | void dpi_uninit_platform_driver(void) |
Tomi Valkeinen | a57dd4f | 2012-02-20 16:57:37 +0200 | [diff] [blame] | 865 | { |
| 866 | platform_driver_unregister(&omap_dpi_driver); |
| 867 | } |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 868 | |
Tomi Valkeinen | ede9269 | 2015-06-04 14:12:16 +0300 | [diff] [blame] | 869 | int dpi_init_port(struct platform_device *pdev, struct device_node *port) |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 870 | { |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 871 | struct dpi_data *dpi; |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 872 | struct device_node *ep; |
| 873 | u32 datalines; |
| 874 | int r; |
| 875 | |
Archit Taneja | 2ac6a1a | 2014-06-01 12:47:44 +0530 | [diff] [blame] | 876 | dpi = devm_kzalloc(&pdev->dev, sizeof(*dpi), GFP_KERNEL); |
| 877 | if (!dpi) |
| 878 | return -ENOMEM; |
| 879 | |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 880 | ep = omapdss_of_get_next_endpoint(port, NULL); |
| 881 | if (!ep) |
| 882 | return 0; |
| 883 | |
| 884 | r = of_property_read_u32(ep, "data-lines", &datalines); |
| 885 | if (r) { |
| 886 | DSSERR("failed to parse datalines\n"); |
| 887 | goto err_datalines; |
| 888 | } |
| 889 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 890 | dpi->data_lines = datalines; |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 891 | |
| 892 | of_node_put(ep); |
| 893 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 894 | dpi->pdev = pdev; |
Archit Taneja | 80eb675 | 2014-06-02 14:11:51 +0530 | [diff] [blame] | 895 | port->data = dpi; |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 896 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 897 | mutex_init(&dpi->lock); |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 898 | |
Archit Taneja | 80eb675 | 2014-06-02 14:11:51 +0530 | [diff] [blame] | 899 | dpi_init_output_port(pdev, port); |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 900 | |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 901 | dpi->port_initialized = true; |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 902 | |
| 903 | return 0; |
| 904 | |
| 905 | err_datalines: |
| 906 | of_node_put(ep); |
| 907 | |
| 908 | return r; |
| 909 | } |
| 910 | |
Tomi Valkeinen | ede9269 | 2015-06-04 14:12:16 +0300 | [diff] [blame] | 911 | void dpi_uninit_port(struct device_node *port) |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 912 | { |
Archit Taneja | 80eb675 | 2014-06-02 14:11:51 +0530 | [diff] [blame] | 913 | struct dpi_data *dpi = port->data; |
Archit Taneja | 630d2d0 | 2014-05-30 16:26:22 +0530 | [diff] [blame] | 914 | |
| 915 | if (!dpi->port_initialized) |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 916 | return; |
| 917 | |
Archit Taneja | 80eb675 | 2014-06-02 14:11:51 +0530 | [diff] [blame] | 918 | dpi_uninit_output_port(port); |
Tomi Valkeinen | 2ecef24 | 2013-12-16 15:13:24 +0200 | [diff] [blame] | 919 | } |