51 static enum dss_clk_source dpi_get_clk_src_dra7xx(struct dpi_data *dpi,  in dpi_get_clk_src_dra7xx()  argument
64 		if (dss_pll_find_by_src(dpi->dss, DSS_CLK_SRC_PLL1_1))  in dpi_get_clk_src_dra7xx()
70 		if (dss_pll_find_by_src(dpi->dss, DSS_CLK_SRC_PLL1_3))  in dpi_get_clk_src_dra7xx()
72 		if (dss_pll_find_by_src(dpi->dss, DSS_CLK_SRC_PLL2_3))  in dpi_get_clk_src_dra7xx()
78 		if (dss_pll_find_by_src(dpi->dss, DSS_CLK_SRC_PLL2_1))  in dpi_get_clk_src_dra7xx()
80 		if (dss_pll_find_by_src(dpi->dss, DSS_CLK_SRC_PLL1_3))  in dpi_get_clk_src_dra7xx()
91 static enum dss_clk_source dpi_get_clk_src(struct dpi_data *dpi)  in dpi_get_clk_src()  argument
93 	enum omap_channel channel = dpi->output.dispc_channel;  in dpi_get_clk_src()
100 	switch (dpi->dss_model) {  in dpi_get_clk_src()
127 		return dpi_get_clk_src_dra7xx(dpi, channel);  in dpi_get_clk_src()
135 	struct dpi_data *dpi;  member
184 	return dispc_div_calc(ctx->dpi->dss->dispc, dispc,  in dpi_calc_hsdiv_cb()
201 	return dss_pll_hsdiv_calc_a(ctx->dpi->pll, clkdco,  in dpi_calc_pll_cb()
202 		ctx->pck_min, dss_get_max_fck_rate(ctx->dpi->dss),  in dpi_calc_pll_cb()
212 	return dispc_div_calc(ctx->dpi->dss->dispc, fck,  in dpi_calc_dss_cb()
217 static bool dpi_pll_clk_calc(struct dpi_data *dpi, unsigned long pck,  in dpi_pll_clk_calc()  argument
223 	ctx->dpi = dpi;  in dpi_pll_clk_calc()
224 	ctx->clkout_idx = dss_pll_get_clkout_idx_for_src(dpi->clk_src);  in dpi_pll_clk_calc()
226 	clkin = clk_get_rate(dpi->pll->clkin);  in dpi_pll_clk_calc()
228 	if (dpi->pll->hw->type == DSS_PLL_TYPE_A) {  in dpi_pll_clk_calc()
237 		return dss_pll_calc_a(ctx->dpi->pll, clkin,  in dpi_pll_clk_calc()
241 		dss_pll_calc_b(dpi->pll, clkin, pck, &ctx->pll_cinfo);  in dpi_pll_clk_calc()
252 static bool dpi_dss_clk_calc(struct dpi_data *dpi, unsigned long pck,  in dpi_dss_clk_calc()  argument
268 		ctx->dpi = dpi;  in dpi_dss_clk_calc()
275 		ok = dss_div_calc(dpi->dss, pck, ctx->pck_min,  in dpi_dss_clk_calc()
286 static int dpi_set_pll_clk(struct dpi_data *dpi, enum omap_channel channel,  in dpi_set_pll_clk()  argument
294 	ok = dpi_pll_clk_calc(dpi, pck_req, &ctx);  in dpi_set_pll_clk()
298 	r = dss_pll_set_config(dpi->pll, &ctx.pll_cinfo);  in dpi_set_pll_clk()
302 	dss_select_lcd_clk_source(dpi->dss, channel, dpi->clk_src);  in dpi_set_pll_clk()
304 	dpi->mgr_config.clock_info = ctx.dispc_cinfo;  in dpi_set_pll_clk()
313 static int dpi_set_dispc_clk(struct dpi_data *dpi, unsigned long pck_req,  in dpi_set_dispc_clk()  argument
320 	ok = dpi_dss_clk_calc(dpi, pck_req, &ctx);  in dpi_set_dispc_clk()
324 	r = dss_set_fck_rate(dpi->dss, ctx.fck);  in dpi_set_dispc_clk()
328 	dpi->mgr_config.clock_info = ctx.dispc_cinfo;  in dpi_set_dispc_clk()
337 static int dpi_set_mode(struct dpi_data *dpi)  in dpi_set_mode()  argument
343 	if (dpi->pll)  in dpi_set_mode()
344 		r = dpi_set_pll_clk(dpi, dpi->output.dispc_channel,  in dpi_set_mode()
345 				    dpi->pixelclock, &fck, &lck_div, &pck_div);  in dpi_set_mode()
347 		r = dpi_set_dispc_clk(dpi, dpi->pixelclock, &fck,  in dpi_set_mode()
355 static void dpi_config_lcd_manager(struct dpi_data *dpi)  in dpi_config_lcd_manager()  argument
357 	dpi->mgr_config.io_pad_mode = DSS_IO_PAD_MODE_BYPASS;  in dpi_config_lcd_manager()
359 	dpi->mgr_config.stallmode = false;  in dpi_config_lcd_manager()
360 	dpi->mgr_config.fifohandcheck = false;  in dpi_config_lcd_manager()
362 	dpi->mgr_config.video_port_width = dpi->data_lines;  in dpi_config_lcd_manager()
364 	dpi->mgr_config.lcden_sig_polarity = 0;  in dpi_config_lcd_manager()
366 	dss_mgr_set_lcd_config(&dpi->output, &dpi->mgr_config);  in dpi_config_lcd_manager()
371 	struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);  in dpi_display_enable()  local
372 	struct omap_dss_device *out = &dpi->output;  in dpi_display_enable()
375 	mutex_lock(&dpi->lock);  in dpi_display_enable()
377 	if (dpi->vdds_dsi_reg) {  in dpi_display_enable()
378 		r = regulator_enable(dpi->vdds_dsi_reg);  in dpi_display_enable()
383 	r = dispc_runtime_get(dpi->dss->dispc);  in dpi_display_enable()
387 	r = dss_dpi_select_source(dpi->dss, dpi->id, out->dispc_channel);  in dpi_display_enable()
391 	if (dpi->pll) {  in dpi_display_enable()
392 		r = dss_pll_enable(dpi->pll);  in dpi_display_enable()
397 	r = dpi_set_mode(dpi);  in dpi_display_enable()
401 	dpi_config_lcd_manager(dpi);  in dpi_display_enable()
405 	r = dss_mgr_enable(&dpi->output);  in dpi_display_enable()
409 	mutex_unlock(&dpi->lock);  in dpi_display_enable()
415 	if (dpi->pll)  in dpi_display_enable()
416 		dss_pll_disable(dpi->pll);  in dpi_display_enable()
419 	dispc_runtime_put(dpi->dss->dispc);  in dpi_display_enable()
421 	if (dpi->vdds_dsi_reg)  in dpi_display_enable()
422 		regulator_disable(dpi->vdds_dsi_reg);  in dpi_display_enable()
424 	mutex_unlock(&dpi->lock);  in dpi_display_enable()
429 	struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);  in dpi_display_disable()  local
431 	mutex_lock(&dpi->lock);  in dpi_display_disable()
433 	dss_mgr_disable(&dpi->output);  in dpi_display_disable()
435 	if (dpi->pll) {  in dpi_display_disable()
436 		dss_select_lcd_clk_source(dpi->dss, dpi->output.dispc_channel,  in dpi_display_disable()
438 		dss_pll_disable(dpi->pll);  in dpi_display_disable()
441 	dispc_runtime_put(dpi->dss->dispc);  in dpi_display_disable()
443 	if (dpi->vdds_dsi_reg)  in dpi_display_disable()
444 		regulator_disable(dpi->vdds_dsi_reg);  in dpi_display_disable()
446 	mutex_unlock(&dpi->lock);  in dpi_display_disable()
452 	struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);  in dpi_set_timings()  local
456 	mutex_lock(&dpi->lock);  in dpi_set_timings()
458 	dpi->pixelclock = mode->clock * 1000;  in dpi_set_timings()
460 	mutex_unlock(&dpi->lock);  in dpi_set_timings()
466 	struct dpi_data *dpi = dpi_get_data_from_dssdev(dssdev);  in dpi_check_timings()  local
479 	if (dpi->pll) {  in dpi_check_timings()
480 		ok = dpi_pll_clk_calc(dpi, mode->clock * 1000, &ctx);  in dpi_check_timings()
486 		ok = dpi_dss_clk_calc(dpi, mode->clock * 1000, &ctx);  in dpi_check_timings()
518 static void dpi_init_pll(struct dpi_data *dpi)  in dpi_init_pll()  argument
522 	if (dpi->pll)  in dpi_init_pll()
525 	dpi->clk_src = dpi_get_clk_src(dpi);  in dpi_init_pll()
527 	pll = dss_pll_find_by_src(dpi->dss, dpi->clk_src);  in dpi_init_pll()
536 	dpi->pll = pll;  in dpi_init_pll()
545 static enum omap_channel dpi_get_channel(struct dpi_data *dpi)  in dpi_get_channel()  argument
547 	switch (dpi->dss_model) {  in dpi_get_channel()
553 		switch (dpi->id) {  in dpi_get_channel()
578 	struct dpi_data *dpi = dpi_get_data_from_dssdev(dst);  in dpi_connect()  local
580 	dpi_init_pll(dpi);  in dpi_connect()
602 static int dpi_init_output_port(struct dpi_data *dpi, struct device_node *port)  in dpi_init_output_port()  argument
604 	struct omap_dss_device *out = &dpi->output;  in dpi_init_output_port()
609 	dpi->id = port_num <= 2 ? port_num : 0;  in dpi_init_output_port()
624 	out->dev = &dpi->pdev->dev;  in dpi_init_output_port()
627 	out->dispc_channel = dpi_get_channel(dpi);  in dpi_init_output_port()
643 	struct dpi_data *dpi = port->data;  in dpi_uninit_output_port()  local
644 	struct omap_dss_device *out = &dpi->output;  in dpi_uninit_output_port()
656 static int dpi_init_regulator(struct dpi_data *dpi)  in dpi_init_regulator()  argument
667 	vdds_dsi = devm_regulator_get(&dpi->pdev->dev, "vdds_dsi");  in dpi_init_regulator()
674 	dpi->vdds_dsi_reg = vdds_dsi;  in dpi_init_regulator()
682 	struct dpi_data *dpi;  in dpi_init_port()  local
687 	dpi = devm_kzalloc(&pdev->dev, sizeof(*dpi), GFP_KERNEL);  in dpi_init_port()
688 	if (!dpi)  in dpi_init_port()
702 	dpi->data_lines = datalines;  in dpi_init_port()
704 	dpi->pdev = pdev;  in dpi_init_port()
705 	dpi->dss_model = dss_model;  in dpi_init_port()
706 	dpi->dss = dss;  in dpi_init_port()
707 	port->data = dpi;  in dpi_init_port()
709 	mutex_init(&dpi->lock);  in dpi_init_port()
711 	r = dpi_init_regulator(dpi);  in dpi_init_port()
715 	return dpi_init_output_port(dpi, port);  in dpi_init_port()
720 	struct dpi_data *dpi = port->data;  in dpi_uninit_port()  local
722 	if (!dpi)  in dpi_uninit_port()