On Fri, Aug 13, 2021 at 10:53:02PM +0800, Kevin Tang wrote:
Adds dsi host controller support for the Unisoc's display subsystem. Adds dsi phy support for the Unisoc's display subsystem. Only MIPI DSI Displays supported, DP/TV/HMDI will be support in the feature.
v1:
- Remove dphy and dsi graph binding, merge the dphy driver into the dsi.
v2:
- Use drm_xxx to replace all DRM_XXX.
- Use kzalloc to replace devm_kzalloc for sprd_dsi structure init.
v4:
- Use drmm_helpers to allocate encoder.
- Move allocate encoder and connector to bind function.
v5:
- Drop the dsi ip file prefix.
- Fix the checkpatch warnings.
- Add Signed-off-by for dsi&dphy patch.
- Use the mode_flags of mipi_dsi_device to setup crtc DPI and EDPI mode.
v6:
- Redesign the way to access the dsi register.
- Reduce the dsi_context member variables.
drivers/gpu/drm/sprd/Kconfig | 1 + drivers/gpu/drm/sprd/Makefile | 4 +- drivers/gpu/drm/sprd/megacores_pll.c | 317 +++++++ drivers/gpu/drm/sprd/megacores_pll.h | 146 +++ drivers/gpu/drm/sprd/sprd_dpu.c | 17 + drivers/gpu/drm/sprd/sprd_drm.c | 1 + drivers/gpu/drm/sprd/sprd_drm.h | 1 + drivers/gpu/drm/sprd/sprd_dsi.c | 1260 ++++++++++++++++++++++++++ drivers/gpu/drm/sprd/sprd_dsi.h | 94 ++ 9 files changed, 1840 insertions(+), 1 deletion(-) create mode 100644 drivers/gpu/drm/sprd/megacores_pll.c create mode 100644 drivers/gpu/drm/sprd/megacores_pll.h create mode 100644 drivers/gpu/drm/sprd/sprd_dsi.c create mode 100644 drivers/gpu/drm/sprd/sprd_dsi.h
diff --git a/drivers/gpu/drm/sprd/Kconfig b/drivers/gpu/drm/sprd/Kconfig index 37762c333..3edeaeca0 100644 --- a/drivers/gpu/drm/sprd/Kconfig +++ b/drivers/gpu/drm/sprd/Kconfig @@ -5,6 +5,7 @@ config DRM_SPRD select DRM_GEM_CMA_HELPER select DRM_KMS_CMA_HELPER select DRM_KMS_HELPER
- select DRM_MIPI_DSI select VIDEOMODE_HELPERS help Choose this option if you have a Unisoc chipset.
diff --git a/drivers/gpu/drm/sprd/Makefile b/drivers/gpu/drm/sprd/Makefile index ab12b95e6..73f96c459 100644 --- a/drivers/gpu/drm/sprd/Makefile +++ b/drivers/gpu/drm/sprd/Makefile @@ -1,4 +1,6 @@ # SPDX-License-Identifier: GPL-2.0
obj-y := sprd_drm.o \
- sprd_dpu.o
- sprd_dpu.o \
- sprd_dsi.o \
- megacores_pll.o
diff --git a/drivers/gpu/drm/sprd/megacores_pll.c b/drivers/gpu/drm/sprd/megacores_pll.c new file mode 100644 index 000000000..0dfd3c372 --- /dev/null +++ b/drivers/gpu/drm/sprd/megacores_pll.c @@ -0,0 +1,317 @@ +// SPDX-License-Identifier: GPL-2.0 +/*
- Copyright (C) 2020 Unisoc Inc.
- */
+#include <asm/div64.h> +#include <linux/delay.h> +#include <linux/init.h> +#include <linux/kernel.h> +#include <linux/regmap.h> +#include <linux/string.h>
+#include "megacores_pll.h"
+#define L 0 +#define H 1 +#define CLK 0 +#define DATA 1 +#define INFINITY 0xffffffff +#define MIN_OUTPUT_FREQ (100)
+#define AVERAGE(a, b) (min(a, b) + abs((b) - (a)) / 2)
+/* sharkle */ +#define VCO_BAND_LOW 750 +#define VCO_BAND_MID 1100 +#define VCO_BAND_HIGH 1500 +#define PHY_REF_CLK 26000
+static int dphy_calc_pll_param(struct dphy_pll *pll) +{
- const u32 khz = 1000;
- const u32 mhz = 1000000;
- const unsigned long long factor = 100;
- unsigned long long tmp;
- int i;
- pll->potential_fvco = pll->freq / khz;
- pll->ref_clk = PHY_REF_CLK / khz;
- for (i = 0; i < 4; ++i) {
if (pll->potential_fvco >= VCO_BAND_LOW &&
pll->potential_fvco <= VCO_BAND_HIGH) {
pll->fvco = pll->potential_fvco;
pll->out_sel = BIT(i);
break;
}
pll->potential_fvco <<= 1;
- }
- if (pll->fvco == 0)
return -EINVAL;
- if (pll->fvco >= VCO_BAND_LOW && pll->fvco <= VCO_BAND_MID) {
/* vco band control */
pll->vco_band = 0x0;
/* low pass filter control */
pll->lpf_sel = 1;
- } else if (pll->fvco > VCO_BAND_MID && pll->fvco <= VCO_BAND_HIGH) {
pll->vco_band = 0x1;
pll->lpf_sel = 0;
- } else
return -EINVAL;
This doesn't follow the kernel coding style, make sure all the issues with checkpatch.pl --strict are fixed.
- pll->nint = pll->fvco / pll->ref_clk;
- tmp = pll->fvco * factor * mhz;
- do_div(tmp, pll->ref_clk);
- tmp = tmp - pll->nint * factor * mhz;
- tmp *= BIT(20);
- do_div(tmp, 100000000);
- pll->kint = (u32)tmp;
- pll->refin = 3; /* pre-divider bypass */
- pll->sdm_en = true; /* use fraction N PLL */
- pll->fdk_s = 0x1; /* fraction */
- pll->cp_s = 0x0;
- pll->det_delay = 0x1;
- return 0;
+}
+static void dphy_set_pll_reg(struct dphy_pll *pll, struct regmap *regmap) +{
- struct pll_reg *reg = &pll->reg;
- u8 *val;
- int i;
- u8 reg_addr[] = {
0x03, 0x04, 0x06, 0x08, 0x09,
0x0a, 0x0b, 0x0e, 0x0f
- };
- reg->_03.bits.prbs_bist = 1;
- reg->_03.bits.en_lp_treot = true;
- reg->_03.bits.lpf_sel = pll->lpf_sel;
- reg->_03.bits.txfifo_bypass = 0;
- reg->_04.bits.div = pll->div;
- reg->_04.bits.masterof8lane = 1;
- reg->_04.bits.cp_s = pll->cp_s;
- reg->_04.bits.fdk_s = pll->fdk_s;
- reg->_06.bits.nint = pll->nint;
- reg->_08.bits.vco_band = pll->vco_band;
- reg->_08.bits.sdm_en = pll->sdm_en;
- reg->_08.bits.refin = pll->refin;
- reg->_09.bits.kint_h = pll->kint >> 12;
- reg->_0a.bits.kint_m = (pll->kint >> 4) & 0xff;
- reg->_0b.bits.out_sel = pll->out_sel;
- reg->_0b.bits.kint_l = pll->kint & 0xf;
- reg->_0e.bits.pll_pu_byp = 0;
- reg->_0e.bits.pll_pu = 0;
- reg->_0e.bits.stopstate_sel = 1;
- reg->_0f.bits.det_delay = pll->det_delay;
- val = (u8 *)®
- for (i = 0; i < sizeof(reg_addr); ++i) {
regmap_write(regmap, reg_addr[i], val[i]);
DRM_DEBUG("%02x: %02x\n", reg_addr[i], val[i]);
- }
+}
It would be great to also convert this part to a pattern without structures.
+int dphy_pll_config(struct dsi_context *ctx) +{
- struct sprd_dsi *dsi = container_of(ctx, struct sprd_dsi, ctx);
- struct regmap *regmap = ctx->regmap;
- struct dphy_pll *pll = ctx->pll;
- int ret;
- pll->freq = dsi->slave->hs_rate;
- /* FREQ = 26M * (NINT + KINT / 2^20) / out_sel */
- ret = dphy_calc_pll_param(pll);
- if (ret) {
drm_err(dsi->drm, "failed to calculate dphy pll parameters\n");
return ret;
- }
- dphy_set_pll_reg(pll, regmap);
- return 0;
+}
+static void dphy_set_timing_reg(struct regmap *regmap, int type, u8 val[]) +{
- switch (type) {
- case REQUEST_TIME:
regmap_write(regmap, 0x31, val[CLK]);
regmap_write(regmap, 0x41, val[DATA]);
regmap_write(regmap, 0x51, val[DATA]);
regmap_write(regmap, 0x61, val[DATA]);
regmap_write(regmap, 0x71, val[DATA]);
regmap_write(regmap, 0x90, val[CLK]);
regmap_write(regmap, 0xa0, val[DATA]);
regmap_write(regmap, 0xb0, val[DATA]);
regmap_write(regmap, 0xc0, val[DATA]);
regmap_write(regmap, 0xd0, val[DATA]);
break;
defines and macros would help the readability here
- case PREPARE_TIME:
regmap_write(regmap, 0x32, val[CLK]);
regmap_write(regmap, 0x42, val[DATA]);
regmap_write(regmap, 0x52, val[DATA]);
regmap_write(regmap, 0x62, val[DATA]);
regmap_write(regmap, 0x72, val[DATA]);
regmap_write(regmap, 0x91, val[CLK]);
regmap_write(regmap, 0xa1, val[DATA]);
regmap_write(regmap, 0xb1, val[DATA]);
regmap_write(regmap, 0xc1, val[DATA]);
regmap_write(regmap, 0xd1, val[DATA]);
break;
- case ZERO_TIME:
regmap_write(regmap, 0x33, val[CLK]);
regmap_write(regmap, 0x43, val[DATA]);
regmap_write(regmap, 0x53, val[DATA]);
regmap_write(regmap, 0x63, val[DATA]);
regmap_write(regmap, 0x73, val[DATA]);
regmap_write(regmap, 0x92, val[CLK]);
regmap_write(regmap, 0xa2, val[DATA]);
regmap_write(regmap, 0xb2, val[DATA]);
regmap_write(regmap, 0xc2, val[DATA]);
regmap_write(regmap, 0xd2, val[DATA]);
break;
- case TRAIL_TIME:
regmap_write(regmap, 0x34, val[CLK]);
regmap_write(regmap, 0x44, val[DATA]);
regmap_write(regmap, 0x54, val[DATA]);
regmap_write(regmap, 0x64, val[DATA]);
regmap_write(regmap, 0x74, val[DATA]);
regmap_write(regmap, 0x93, val[CLK]);
regmap_write(regmap, 0xa3, val[DATA]);
regmap_write(regmap, 0xb3, val[DATA]);
regmap_write(regmap, 0xc3, val[DATA]);
regmap_write(regmap, 0xd3, val[DATA]);
break;
- case EXIT_TIME:
regmap_write(regmap, 0x36, val[CLK]);
regmap_write(regmap, 0x46, val[DATA]);
regmap_write(regmap, 0x56, val[DATA]);
regmap_write(regmap, 0x66, val[DATA]);
regmap_write(regmap, 0x76, val[DATA]);
regmap_write(regmap, 0x95, val[CLK]);
regmap_write(regmap, 0xA5, val[DATA]);
regmap_write(regmap, 0xB5, val[DATA]);
regmap_write(regmap, 0xc5, val[DATA]);
regmap_write(regmap, 0xd5, val[DATA]);
break;
- case CLKPOST_TIME:
regmap_write(regmap, 0x35, val[CLK]);
regmap_write(regmap, 0x94, val[CLK]);
break;
- /* the following just use default value */
- case SETTLE_TIME:
- case TA_GET:
- case TA_GO:
- case TA_SURE:
break;
you need to use fallthrough; for all those cases
- default:
break;
- }
+}
+void dphy_timing_config(struct dsi_context *ctx) +{
- struct regmap *regmap = ctx->regmap;
- struct dphy_pll *pll = ctx->pll;
- const u32 factor = 2;
- const u32 scale = 100;
- u32 t_ui, t_byteck, t_half_byteck;
- u32 range[2], constant;
- u8 val[2];
- u32 tmp = 0;
- /* t_ui: 1 ui, byteck: 8 ui, half byteck: 4 ui */
- t_ui = 1000 * scale / (pll->freq / 1000);
- t_byteck = t_ui << 3;
- t_half_byteck = t_ui << 2;
- constant = t_ui << 1;
- /* REQUEST_TIME: HS T-LPX: LP-01
* For T-LPX, mipi spec defined min value is 50ns,
* but maybe it shouldn't be too small, because BTA,
* LP-10, LP-00, LP-01, all of this is related to T-LPX.
*/
- range[L] = 50 * scale;
- range[H] = INFINITY;
- val[CLK] = DIV_ROUND_UP(range[L] * (factor << 1), t_byteck) - 2;
- val[DATA] = val[CLK];
- dphy_set_timing_reg(regmap, REQUEST_TIME, val);
- /* PREPARE_TIME: HS sequence: LP-00 */
- range[L] = 38 * scale;
- range[H] = 95 * scale;
- tmp = AVERAGE(range[L], range[H]);
- val[CLK] = DIV_ROUND_UP(AVERAGE(range[L], range[H]),
t_half_byteck) - 1;
- range[L] = 40 * scale + 4 * t_ui;
- range[H] = 85 * scale + 6 * t_ui;
- tmp |= AVERAGE(range[L], range[H]) << 16;
- val[DATA] = DIV_ROUND_UP(AVERAGE(range[L], range[H]),
t_half_byteck) - 1;
- dphy_set_timing_reg(regmap, PREPARE_TIME, val);
- /* ZERO_TIME: HS-ZERO */
- range[L] = 300 * scale;
- range[H] = INFINITY;
- val[CLK] = DIV_ROUND_UP(range[L] * factor + (tmp & 0xffff)
- 525 * t_byteck / 100, t_byteck) - 2;
- range[L] = 145 * scale + 10 * t_ui;
- val[DATA] = DIV_ROUND_UP(range[L] * factor
+ ((tmp >> 16) & 0xffff) - 525 * t_byteck / 100,
t_byteck) - 2;
- dphy_set_timing_reg(regmap, ZERO_TIME, val);
- /* TRAIL_TIME: HS-TRAIL */
- range[L] = 60 * scale;
- range[H] = INFINITY;
- val[CLK] = DIV_ROUND_UP(range[L] * factor - constant, t_half_byteck);
- range[L] = max(8 * t_ui, 60 * scale + 4 * t_ui);
- val[DATA] = DIV_ROUND_UP(range[L] * 3 / 2 - constant, t_half_byteck) - 2;
- dphy_set_timing_reg(regmap, TRAIL_TIME, val);
- /* EXIT_TIME: */
- range[L] = 100 * scale;
- range[H] = INFINITY;
- val[CLK] = DIV_ROUND_UP(range[L] * factor, t_byteck) - 2;
- val[DATA] = val[CLK];
- dphy_set_timing_reg(regmap, EXIT_TIME, val);
- /* CLKPOST_TIME: */
- range[L] = 60 * scale + 52 * t_ui;
- range[H] = INFINITY;
- val[CLK] = DIV_ROUND_UP(range[L] * factor, t_byteck) - 2;
- val[DATA] = val[CLK];
- dphy_set_timing_reg(regmap, CLKPOST_TIME, val);
- /* SETTLE_TIME:
* This time is used for receiver. So for transmitter,
* it can be ignored.
*/
- /* TA_GO:
* transmitter drives bridge state(LP-00) before releasing control,
* reg 0x1f default value: 0x04, which is good.
*/
- /* TA_SURE:
* After LP-10 state and before bridge state(LP-00),
* reg 0x20 default value: 0x01, which is good.
*/
- /* TA_GET:
* receiver drives Bridge state(LP-00) before releasing control
* reg 0x21 default value: 0x03, which is good.
*/
+} diff --git a/drivers/gpu/drm/sprd/megacores_pll.h b/drivers/gpu/drm/sprd/megacores_pll.h new file mode 100644 index 000000000..bf20aae65 --- /dev/null +++ b/drivers/gpu/drm/sprd/megacores_pll.h @@ -0,0 +1,146 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/*
- Copyright (C) 2020 Unisoc Inc.
- */
+#ifndef _MEGACORES_PLL_H_ +#define _MEGACORES_PLL_H_
+#include "sprd_dsi.h"
+enum PLL_TIMING {
- NONE,
- REQUEST_TIME,
- PREPARE_TIME,
- SETTLE_TIME,
- ZERO_TIME,
- TRAIL_TIME,
- EXIT_TIME,
- CLKPOST_TIME,
- TA_GET,
- TA_GO,
- TA_SURE,
- TA_WAIT,
+};
+struct pll_reg {
- union __reg_03__ {
struct __03 {
u8 prbs_bist: 1;
u8 en_lp_treot: 1;
u8 lpf_sel: 4;
u8 txfifo_bypass: 1;
u8 freq_hopping: 1;
} bits;
u8 val;
- } _03;
- union __reg_04__ {
struct __04 {
u8 div: 3;
u8 masterof8lane: 1;
u8 hop_trig: 1;
u8 cp_s: 2;
u8 fdk_s: 1;
} bits;
u8 val;
- } _04;
- union __reg_06__ {
struct __06 {
u8 nint: 7;
u8 mod_en: 1;
} bits;
u8 val;
- } _06;
- union __reg_07__ {
struct __07 {
u8 kdelta_h: 8;
} bits;
u8 val;
- } _07;
- union __reg_08__ {
struct __08 {
u8 vco_band: 1;
u8 sdm_en: 1;
u8 refin: 2;
u8 kdelta_l: 4;
} bits;
u8 val;
- } _08;
- union __reg_09__ {
struct __09 {
u8 kint_h: 8;
} bits;
u8 val;
- } _09;
- union __reg_0a__ {
struct __0a {
u8 kint_m: 8;
} bits;
u8 val;
- } _0a;
- union __reg_0b__ {
struct __0b {
u8 out_sel: 4;
u8 kint_l: 4;
} bits;
u8 val;
- } _0b;
- union __reg_0c__ {
struct __0c {
u8 kstep_h: 8;
} bits;
u8 val;
- } _0c;
- union __reg_0d__ {
struct __0d {
u8 kstep_m: 8;
} bits;
u8 val;
- } _0d;
- union __reg_0e__ {
struct __0e {
u8 pll_pu_byp: 1;
u8 pll_pu: 1;
u8 hsbist_len: 2;
u8 stopstate_sel: 1;
u8 kstep_l: 3;
} bits;
u8 val;
- } _0e;
- union __reg_0f__ {
struct __0f {
u8 det_delay:2;
u8 kdelta: 4;
u8 ldo0p4:2;
} bits;
u8 val;
- } _0f;
+};
+struct dphy_pll {
- u8 refin; /* Pre-divider control signal */
- u8 cp_s; /* 00: SDM_EN=1, 10: SDM_EN=0 */
- u8 fdk_s; /* PLL mode control: integer or fraction */
- u8 sdm_en;
- u8 div;
- u8 int_n; /* integer N PLL */
- u32 ref_clk; /* dphy reference clock, unit: MHz */
- u32 freq; /* panel config, unit: KHz */
- u32 fvco;
- u32 potential_fvco;
- u32 nint; /* sigma delta modulator NINT control */
- u32 kint; /* sigma delta modulator KINT control */
- u8 lpf_sel; /* low pass filter control */
- u8 out_sel; /* post divider control */
- u8 vco_band; /* vco range */
- u8 det_delay;
- struct pll_reg reg;
+};
+struct dsi_context;
+int dphy_pll_config(struct dsi_context *ctx); +void dphy_timing_config(struct dsi_context *ctx);
+#endif /* _MEGACORES_PLL_H_ */ diff --git a/drivers/gpu/drm/sprd/sprd_dpu.c b/drivers/gpu/drm/sprd/sprd_dpu.c index 448dd4fb6..4e3b30abe 100644 --- a/drivers/gpu/drm/sprd/sprd_dpu.c +++ b/drivers/gpu/drm/sprd/sprd_dpu.c @@ -25,6 +25,7 @@
#include "sprd_drm.h" #include "sprd_dpu.h" +#include "sprd_dsi.h"
/* Global control registers */ #define REG_DPU_CTRL 0x04 @@ -686,9 +687,25 @@ static void sprd_crtc_mode_set_nofb(struct drm_crtc *crtc) { struct sprd_dpu *dpu = to_sprd_crtc(crtc); struct drm_display_mode *mode = &crtc->state->adjusted_mode;
struct drm_encoder *encoder;
struct mipi_dsi_device *slave;
struct sprd_dsi *dsi;
drm_display_mode_to_videomode(mode, &dpu->ctx.vm);
drm_for_each_encoder(encoder, crtc->dev) {
if (encoder->crtc != crtc)
continue;
dsi = encoder_to_dsi(encoder);
slave = dsi->slave;
if (slave->mode_flags & MIPI_DSI_MODE_VIDEO)
dpu->ctx.if_type = SPRD_DPU_IF_DPI;
else
dpu->ctx.if_type = SPRD_DPU_IF_EDPI;
}
You're not using if_type anywhere
sprd_dpi_init(dpu); }
diff --git a/drivers/gpu/drm/sprd/sprd_drm.c b/drivers/gpu/drm/sprd/sprd_drm.c index 549b71278..68cf0933c 100644 --- a/drivers/gpu/drm/sprd/sprd_drm.c +++ b/drivers/gpu/drm/sprd/sprd_drm.c @@ -183,6 +183,7 @@ static struct platform_driver sprd_drm_driver = { static struct platform_driver *sprd_drm_drivers[] = { &sprd_drm_driver, &sprd_dpu_driver,
- &sprd_dsi_driver,
};
static int __init sprd_drm_init(void) diff --git a/drivers/gpu/drm/sprd/sprd_drm.h b/drivers/gpu/drm/sprd/sprd_drm.h index 85d4a8b9f..95d1b972f 100644 --- a/drivers/gpu/drm/sprd/sprd_drm.h +++ b/drivers/gpu/drm/sprd/sprd_drm.h @@ -14,5 +14,6 @@ struct sprd_drm { };
extern struct platform_driver sprd_dpu_driver; +extern struct platform_driver sprd_dsi_driver;
#endif /* _SPRD_DRM_H_ */ diff --git a/drivers/gpu/drm/sprd/sprd_dsi.c b/drivers/gpu/drm/sprd/sprd_dsi.c new file mode 100644 index 000000000..5ce98fe90 --- /dev/null +++ b/drivers/gpu/drm/sprd/sprd_dsi.c @@ -0,0 +1,1260 @@ +// SPDX-License-Identifier: GPL-2.0 +/*
- Copyright (C) 2020 Unisoc Inc.
- */
+#include <linux/component.h> +#include <linux/module.h> +#include <linux/of_address.h> +#include <linux/of_device.h> +#include <linux/of_irq.h> +#include <linux/of_graph.h> +#include <video/mipi_display.h>
+#include <drm/drm_atomic_helper.h> +#include <drm/drm_crtc_helper.h> +#include <drm/drm_of.h> +#include <drm/drm_probe_helper.h>
+#include "sprd_drm.h" +#include "sprd_dpu.h" +#include "sprd_dsi.h"
+#define SOFT_RESET 0x04 +#define MASK_PROTOCOL_INT 0x0C +#define MASK_INTERNAL_INT 0x14 +#define DSI_MODE_CFG 0x18
+#define VIRTUAL_CHANNEL_ID 0x1C +#define GEN_RX_VCID GENMASK(1, 0) +#define VIDEO_PKT_VCID GENMASK(3, 2)
+#define DPI_VIDEO_FORMAT 0x20 +#define DPI_VIDEO_MODE_FORMAT GENMASK(5, 0) +#define LOOSELY18_EN BIT(6)
+#define VIDEO_PKT_CONFIG 0x24 +#define VIDEO_PKT_SIZE GENMASK(15, 0) +#define VIDEO_LINE_CHUNK_NUM GENMASK(31, 16)
+#define VIDEO_LINE_HBLK_TIME 0x28 +#define VIDEO_LINE_HBP_TIME GENMASK(15, 0) +#define VIDEO_LINE_HSA_TIME GENMASK(31, 16)
+#define VIDEO_LINE_TIME 0x2C
+#define VIDEO_VBLK_LINES 0x30 +#define VFP_LINES GENMASK(9, 0) +#define VBP_LINES GENMASK(19, 10) +#define VSA_LINES GENMASK(29, 20)
+#define VIDEO_VACTIVE_LINES 0x34
+#define VID_MODE_CFG 0x38 +#define VID_MODE_TYPE GENMASK(1, 0) +#define LP_VSA_EN BIT(8) +#define LP_VBP_EN BIT(9) +#define LP_VFP_EN BIT(10) +#define LP_VACT_EN BIT(11) +#define LP_HBP_EN BIT(12) +#define LP_HFP_EN BIT(13) +#define FRAME_BTA_ACK_EN BIT(14) +#define LP_CMD_EN BIT(15)
+#define TIMEOUT_CNT_CLK_CONFIG 0x40 +#define HTX_TO_CONFIG 0x44 +#define LRX_H_TO_CONFIG 0x48
+#define TX_ESC_CLK_CONFIG 0x5C
+#define CMD_MODE_CFG 0x68 +#define TEAR_FX_EN BIT(0) +#define ACK_RQST_EN BIT(1) +#define PPS_TX BIT(5) +#define EXQ_TX BIT(6) +#define CMC_TX BIT(7) +#define GEN_SW_0P_TX BIT(8) +#define GEN_SW_1P_TX BIT(9) +#define GEN_SW_2P_TX BIT(10) +#define GEN_SR_0P_TX BIT(11) +#define GEN_SR_1P_TX BIT(12) +#define GEN_SR_2P_TX BIT(13) +#define GEN_LW_TX BIT(14) +#define DCS_SW_0P_TX BIT(16) +#define DCS_SW_1P_TX BIT(17) +#define DCS_SR_0P_TX BIT(18) +#define DCS_LW_TX BIT(19) +#define MAX_RD_PKT_SIZE BIT(24)
+#define GEN_HDR 0x6C +#define GEN_DT GENMASK(5, 0) +#define GEN_VC GENMASK(7, 6) +#define GEN_WC_LSBYTE GENMASK(15, 8) +#define GEN_WC_MSBYTE GENMASK(23, 16)
+#define GEN_PLD_DATA 0x70 +#define GEN_PLD_B1 GENMASK(7, 0) +#define GEN_PLD_B2 GENMASK(15, 8) +#define GEN_PLD_B3 GENMASK(23, 16) +#define GEN_PLD_B4 GENMASK(31, 24)
+#define PHY_CLK_LANE_LP_CTRL 0x74 +#define PHY_CLKLANE_TX_REQ_HS BIT(0) +#define AUTO_CLKLANE_CTRL_EN BIT(1)
+#define PHY_INTERFACE_CTRL 0x78 +#define RF_PHY_SHUTDOWN BIT(0) +#define RF_PHY_RESET_N BIT(1) +#define RF_PHY_CLK_EN BIT(2)
+#define CMD_MODE_STATUS 0x98 +#define GEN_CMD_RDCMD_ONGOING BIT(0) +#define GEN_CMD_RDATA_FIFO_EMPTY BIT(1) +#define GEN_CMD_RDATA_FIFO_FULL BIT(2) +#define GEN_CMD_WDATA_FIFO_EMPTY BIT(3) +#define GEN_CMD_WDATA_FIFO_FULL BIT(4) +#define GEN_CMD_CMD_FIFO_EMPTY BIT(5) +#define GEN_CMD_CMD_FIFO_FULL BIT(6) +#define GEN_CMD_RDCMD_DONE BIT(7)
+#define PHY_STATUS 0x9C +#define PHY_LOCK BIT(1)
+#define PHY_MIN_STOP_TIME 0xA0 +#define PHY_LANE_NUM_CONFIG 0xA4
+#define PHY_CLKLANE_TIME_CONFIG 0xA8 +#define PHY_CLKLANE_LP_TO_HS_TIME GENMASK(15, 0) +#define PHY_CLKLANE_HS_TO_LP_TIME GENMASK(31, 16)
+#define PHY_DATALANE_TIME_CONFIG 0xAC +#define PHY_DATALANE_LP_TO_HS_TIME GENMASK(15, 0) +#define PHY_DATALANE_HS_TO_LP_TIME GENMASK(31, 16)
+#define MAX_READ_TIME 0xB0
+#define RX_PKT_CHECK_CONFIG 0xB4 +#define RX_PKT_ECC_EN BIT(0) +#define RX_PKT_CRC_EN BIT(1)
+#define TA_EN 0xB8
+#define EOTP_EN 0xBC +#define TX_EOTP_EN BIT(0) +#define RX_EOTP_EN BIT(1)
+#define VIDEO_NULLPKT_SIZE 0xC0 +#define DCS_WM_PKT_SIZE 0xC4 +#define PROTOCOL_INT_CLR 0xC8 +#define INTERNAL_INT_CLR 0xCC
+#define VIDEO_SIG_DELAY_CONFIG 0xD0 +#define VIDEO_SIG_DELAY GENMASK(23, 0) +#define VIDEO_SIG_DELAY_MODE BIT(24)
+#define PHY_TST_CTRL0 0xF0 +#define PHY_TESTCLR BIT(0) +#define PHY_TESTCLK BIT(1)
+#define PHY_TST_CTRL1 0xF4 +#define PHY_TESTDIN GENMASK(7, 0) +#define PHY_TESTDOUT GENMASK(15, 8) +#define PHY_TESTEN BIT(16)
+#define host_to_dsi(host) \
- container_of(host, struct sprd_dsi, host)
+#define connector_to_dsi(connector) \
- container_of(connector, struct sprd_dsi, connector)
+static inline u32 +dsi_reg_rd(struct dsi_context *ctx, u32 offset, u32 mask,
u32 shift)
+{
- return (readl(ctx->base + offset) & mask) >> shift;
+}
+static inline void +dsi_reg_wr(struct dsi_context *ctx, u32 offset, u32 mask,
u32 shift, u32 val)
+{
- u32 ret;
- ret = readl(ctx->base + offset);
- ret &= ~mask;
- ret |= (val << shift) & mask;
- writel(ret, ctx->base + offset);
+}
+static inline void +dsi_reg_up(struct dsi_context *ctx, u32 offset, u32 mask,
u32 val)
+{
- u32 ret = readl(ctx->base + offset);
- writel((ret & ~mask) | (val & mask), ctx->base + offset);
+}
+static int regmap_tst_io_write(void *context, u32 reg, u32 val) +{
- struct sprd_dsi *dsi = context;
- struct dsi_context *ctx = &dsi->ctx;
- if (val > 0xff || reg > 0xff)
return -EINVAL;
- drm_dbg(dsi->drm, "reg = 0x%02x, val = 0x%02x\n", reg, val);
- dsi_reg_up(ctx, PHY_TST_CTRL1, PHY_TESTEN, PHY_TESTEN);
- dsi_reg_wr(ctx, PHY_TST_CTRL1, PHY_TESTDIN, 0, reg);
- dsi_reg_up(ctx, PHY_TST_CTRL0, PHY_TESTCLK, PHY_TESTCLK);
- dsi_reg_up(ctx, PHY_TST_CTRL0, PHY_TESTCLK, 0);
- dsi_reg_up(ctx, PHY_TST_CTRL1, PHY_TESTEN, 0);
- dsi_reg_wr(ctx, PHY_TST_CTRL1, PHY_TESTDIN, 0, val);
- dsi_reg_up(ctx, PHY_TST_CTRL0, PHY_TESTCLK, PHY_TESTCLK);
- dsi_reg_up(ctx, PHY_TST_CTRL0, PHY_TESTCLK, 0);
- return 0;
+}
+static int regmap_tst_io_read(void *context, u32 reg, u32 *val) +{
- struct sprd_dsi *dsi = context;
- struct dsi_context *ctx = &dsi->ctx;
- int ret;
- if (reg > 0xff)
return -EINVAL;
- dsi_reg_up(ctx, PHY_TST_CTRL1, PHY_TESTEN, PHY_TESTEN);
- dsi_reg_wr(ctx, PHY_TST_CTRL1, PHY_TESTDIN, 0, reg);
- dsi_reg_up(ctx, PHY_TST_CTRL0, PHY_TESTCLK, PHY_TESTCLK);
- dsi_reg_up(ctx, PHY_TST_CTRL0, PHY_TESTCLK, 0);
- dsi_reg_up(ctx, PHY_TST_CTRL1, PHY_TESTEN, 0);
- udelay(1);
- ret = dsi_reg_rd(ctx, PHY_TST_CTRL1, PHY_TESTDOUT, 8);
- if (ret < 0)
return ret;
- *val = ret;
- drm_dbg(dsi->drm, "reg = 0x%02x, val = 0x%02x\n", reg, *val);
- return 0;
+}
+static struct regmap_bus regmap_tst_io = {
- .reg_write = regmap_tst_io_write,
- .reg_read = regmap_tst_io_read,
+};
+static const struct regmap_config byte_config = {
- .reg_bits = 8,
- .val_bits = 8,
+};
+static int dphy_wait_pll_locked(struct dsi_context *ctx) +{
- struct sprd_dsi *dsi = container_of(ctx, struct sprd_dsi, ctx);
- int i;
- for (i = 0; i < 50000; i++) {
if (dsi_reg_rd(ctx, PHY_STATUS, PHY_LOCK, 1))
return 0;
udelay(3);
- }
- drm_err(dsi->drm, "dphy pll can not be locked\n");
- return -ETIMEDOUT;
+}
+static int dsi_wait_tx_payload_fifo_empty(struct dsi_context *ctx) +{
- int i;
- for (i = 0; i < 5000; i++) {
if (dsi_reg_rd(ctx, CMD_MODE_STATUS, GEN_CMD_WDATA_FIFO_EMPTY, 3))
return 0;
udelay(1);
- }
- return -ETIMEDOUT;
+}
+static int dsi_wait_tx_cmd_fifo_empty(struct dsi_context *ctx) +{
- int i;
- for (i = 0; i < 5000; i++) {
if (dsi_reg_rd(ctx, CMD_MODE_STATUS, GEN_CMD_CMD_FIFO_EMPTY, 5))
return 0;
udelay(1);
- }
- return -ETIMEDOUT;
+}
+static int dsi_wait_rd_resp_completed(struct dsi_context *ctx) +{
- int i;
- for (i = 0; i < 10000; i++) {
if (dsi_reg_rd(ctx, CMD_MODE_STATUS, GEN_CMD_RDCMD_DONE, 7))
return 0;
udelay(10);
- }
- return -ETIMEDOUT;
+}
+static u16 calc_bytes_per_pixel_x100(int coding) +{
- u16 Bpp_x100;
- switch (coding) {
- case COLOR_CODE_16BIT_CONFIG1:
- case COLOR_CODE_16BIT_CONFIG2:
- case COLOR_CODE_16BIT_CONFIG3:
Bpp_x100 = 200;
break;
- case COLOR_CODE_18BIT_CONFIG1:
- case COLOR_CODE_18BIT_CONFIG2:
Bpp_x100 = 225;
break;
- case COLOR_CODE_24BIT:
Bpp_x100 = 300;
break;
- case COLOR_CODE_COMPRESSTION:
Bpp_x100 = 100;
break;
- case COLOR_CODE_20BIT_YCC422_LOOSELY:
Bpp_x100 = 250;
break;
- case COLOR_CODE_24BIT_YCC422:
Bpp_x100 = 300;
break;
- case COLOR_CODE_16BIT_YCC422:
Bpp_x100 = 200;
break;
- case COLOR_CODE_30BIT:
Bpp_x100 = 375;
break;
- case COLOR_CODE_36BIT:
Bpp_x100 = 450;
break;
- case COLOR_CODE_12BIT_YCC420:
Bpp_x100 = 150;
break;
- default:
DRM_ERROR("invalid color coding");
Bpp_x100 = 0;
break;
- }
- return Bpp_x100;
+}
+static u8 calc_video_size_step(int coding) +{
- u8 video_size_step;
- switch (coding) {
- case COLOR_CODE_16BIT_CONFIG1:
- case COLOR_CODE_16BIT_CONFIG2:
- case COLOR_CODE_16BIT_CONFIG3:
- case COLOR_CODE_18BIT_CONFIG1:
- case COLOR_CODE_18BIT_CONFIG2:
- case COLOR_CODE_24BIT:
- case COLOR_CODE_COMPRESSTION:
return video_size_step = 1;
- case COLOR_CODE_20BIT_YCC422_LOOSELY:
- case COLOR_CODE_24BIT_YCC422:
- case COLOR_CODE_16BIT_YCC422:
- case COLOR_CODE_30BIT:
- case COLOR_CODE_36BIT:
- case COLOR_CODE_12BIT_YCC420:
return video_size_step = 2;
- default:
DRM_ERROR("invalid color coding");
return 0;
- }
+}
+static u16 round_video_size(int coding, u16 video_size) +{
- switch (coding) {
- case COLOR_CODE_16BIT_YCC422:
- case COLOR_CODE_24BIT_YCC422:
- case COLOR_CODE_20BIT_YCC422_LOOSELY:
- case COLOR_CODE_12BIT_YCC420:
/* round up active H pixels to a multiple of 2 */
if ((video_size % 2) != 0)
video_size += 1;
break;
- default:
break;
- }
- return video_size;
+}
+#define SPRD_MIPI_DSI_FMT_DSC 0xff +static u32 fmt_to_coding(u32 fmt) +{
- switch (fmt) {
- case MIPI_DSI_FMT_RGB565:
return COLOR_CODE_16BIT_CONFIG1;
- case MIPI_DSI_FMT_RGB666:
- case MIPI_DSI_FMT_RGB666_PACKED:
return COLOR_CODE_18BIT_CONFIG1;
- case MIPI_DSI_FMT_RGB888:
return COLOR_CODE_24BIT;
- case SPRD_MIPI_DSI_FMT_DSC:
return COLOR_CODE_COMPRESSTION;
- default:
DRM_ERROR("Unsupported format (%d)\n", fmt);
return COLOR_CODE_24BIT;
- }
+}
+#define ns_to_cycle(ns, byte_clk) \
- DIV_ROUND_UP((ns) * (byte_clk), 1000000)
+static void sprd_dsi_init(struct dsi_context *ctx) +{
- struct sprd_dsi *dsi = container_of(ctx, struct sprd_dsi, ctx);
- u32 byte_clk = dsi->slave->hs_rate / 8;
- u16 data_hs2lp, data_lp2hs, clk_hs2lp, clk_lp2hs;
- u16 max_rd_time;
- int div;
- writel(0, ctx->base + SOFT_RESET);
- writel(0xffffffff, ctx->base + MASK_PROTOCOL_INT);
- writel(0xffffffff, ctx->base + MASK_INTERNAL_INT);
- writel(1, ctx->base + DSI_MODE_CFG);
- dsi_reg_up(ctx, EOTP_EN, RX_EOTP_EN, 0);
- dsi_reg_up(ctx, EOTP_EN, TX_EOTP_EN, 0);
- dsi_reg_up(ctx, RX_PKT_CHECK_CONFIG, RX_PKT_ECC_EN, RX_PKT_ECC_EN);
- dsi_reg_up(ctx, RX_PKT_CHECK_CONFIG, RX_PKT_CRC_EN, RX_PKT_CRC_EN);
- writel(1, ctx->base + TA_EN);
- dsi_reg_up(ctx, VIRTUAL_CHANNEL_ID, VIDEO_PKT_VCID, 0);
- dsi_reg_up(ctx, VIRTUAL_CHANNEL_ID, GEN_RX_VCID, 0);
- div = DIV_ROUND_UP(byte_clk, dsi->slave->lp_rate);
- writel(div, ctx->base + TX_ESC_CLK_CONFIG);
- max_rd_time = ns_to_cycle(ctx->max_rd_time, byte_clk);
- writel(max_rd_time, ctx->base + MAX_READ_TIME);
- data_hs2lp = ns_to_cycle(ctx->data_hs2lp, byte_clk);
- data_lp2hs = ns_to_cycle(ctx->data_lp2hs, byte_clk);
- clk_hs2lp = ns_to_cycle(ctx->clk_hs2lp, byte_clk);
- clk_lp2hs = ns_to_cycle(ctx->clk_lp2hs, byte_clk);
- dsi_reg_wr(ctx, PHY_DATALANE_TIME_CONFIG,
PHY_DATALANE_HS_TO_LP_TIME, 16, data_hs2lp);
- dsi_reg_wr(ctx, PHY_DATALANE_TIME_CONFIG,
PHY_DATALANE_LP_TO_HS_TIME, 0, data_lp2hs);
- dsi_reg_wr(ctx, PHY_CLKLANE_TIME_CONFIG,
PHY_CLKLANE_HS_TO_LP_TIME, 16, clk_hs2lp);
- dsi_reg_wr(ctx, PHY_CLKLANE_TIME_CONFIG,
PHY_CLKLANE_LP_TO_HS_TIME, 0, clk_lp2hs);
- writel(1, ctx->base + SOFT_RESET);
+}
+/*
- Free up resources and shutdown host controller and PHY
- */
+static void sprd_dsi_fini(struct dsi_context *ctx) +{
- writel(0xffffffff, ctx->base + MASK_PROTOCOL_INT);
- writel(0xffffffff, ctx->base + MASK_INTERNAL_INT);
- writel(0, ctx->base + SOFT_RESET);
+}
+/*
- If not in burst mode, it will compute the video and null packet sizes
- according to necessity.
- Configure timers for data lanes and/or clock lane to return to LP when
- bandwidth is not filled by data.
- */
+static int sprd_dsi_dpi_video(struct dsi_context *ctx) +{
- struct sprd_dsi *dsi = container_of(ctx, struct sprd_dsi, ctx);
- struct videomode *vm = &ctx->vm;
- u32 byte_clk = dsi->slave->hs_rate / 8;
- u16 Bpp_x100;
- u16 video_size;
- u32 ratio_x1000;
- u16 null_pkt_size = 0;
- u8 video_size_step;
- u32 hs_to;
- u32 total_bytes;
- u32 bytes_per_chunk;
- u32 chunks = 0;
- u32 bytes_left = 0;
- u32 chunk_overhead;
- const u8 pkt_header = 6;
- u8 coding;
- int div;
- u16 hline;
- u16 byte_cycle;
- coding = fmt_to_coding(dsi->slave->format);
- video_size = round_video_size(coding, vm->hactive);
- Bpp_x100 = calc_bytes_per_pixel_x100(coding);
- video_size_step = calc_video_size_step(coding);
- ratio_x1000 = byte_clk * 1000 / (vm->pixelclock / 1000);
- hline = vm->hactive + vm->hsync_len + vm->hfront_porch +
vm->hback_porch;
- writel(0, ctx->base + SOFT_RESET);
- dsi_reg_wr(ctx, VID_MODE_CFG, FRAME_BTA_ACK_EN, 15, ctx->frame_ack_en);
- dsi_reg_wr(ctx, DPI_VIDEO_FORMAT, DPI_VIDEO_MODE_FORMAT, 0, coding);
- dsi_reg_wr(ctx, VID_MODE_CFG, VID_MODE_TYPE, 0, ctx->burst_mode);
- byte_cycle = 95 * hline * ratio_x1000 / 100000;
- dsi_reg_wr(ctx, VIDEO_SIG_DELAY_CONFIG, VIDEO_SIG_DELAY, 0, byte_cycle);
- byte_cycle = hline * ratio_x1000 / 1000;
- writel(byte_cycle, ctx->base + VIDEO_LINE_TIME);
- byte_cycle = vm->hsync_len * ratio_x1000 / 1000;
- dsi_reg_wr(ctx, VIDEO_LINE_HBLK_TIME, VIDEO_LINE_HSA_TIME, 16, byte_cycle);
- byte_cycle = vm->hback_porch * ratio_x1000 / 1000;
- dsi_reg_wr(ctx, VIDEO_LINE_HBLK_TIME, VIDEO_LINE_HBP_TIME, 0, byte_cycle);
- writel(vm->vactive, ctx->base + VIDEO_VACTIVE_LINES);
- dsi_reg_wr(ctx, VIDEO_VBLK_LINES, VFP_LINES, 0, vm->vfront_porch);
- dsi_reg_wr(ctx, VIDEO_VBLK_LINES, VBP_LINES, 10, vm->vback_porch);
- dsi_reg_wr(ctx, VIDEO_VBLK_LINES, VSA_LINES, 20, vm->vsync_len);
- dsi_reg_up(ctx, VID_MODE_CFG, LP_HBP_EN | LP_HFP_EN | LP_VACT_EN |
LP_VFP_EN | LP_VBP_EN | LP_VSA_EN, LP_HBP_EN | LP_HFP_EN |
LP_VACT_EN | LP_VFP_EN | LP_VBP_EN | LP_VSA_EN);
- hs_to = (hline * vm->vactive) + (2 * Bpp_x100) / 100;
- for (div = 0x80; (div < hs_to) && (div > 2); div--) {
if ((hs_to % div) == 0) {
writel(div, ctx->base + TIMEOUT_CNT_CLK_CONFIG);
writel(hs_to / div, ctx->base + LRX_H_TO_CONFIG);
writel(hs_to / div, ctx->base + HTX_TO_CONFIG);
break;
}
- }
- if (ctx->burst_mode == VIDEO_BURST_WITH_SYNC_PULSES) {
dsi_reg_wr(ctx, VIDEO_PKT_CONFIG, VIDEO_PKT_SIZE, 0, video_size);
writel(0, ctx->base + VIDEO_NULLPKT_SIZE);
dsi_reg_up(ctx, VIDEO_PKT_CONFIG, VIDEO_LINE_CHUNK_NUM, 0);
- } else {
/* non burst transmission */
null_pkt_size = 0;
/* bytes to be sent - first as one chunk */
bytes_per_chunk = vm->hactive * Bpp_x100 / 100 + pkt_header;
/* hline total bytes from the DPI interface */
total_bytes = (vm->hactive + vm->hfront_porch) *
ratio_x1000 / dsi->slave->lanes / 1000;
/* check if the pixels actually fit on the DSI link */
if (total_bytes < bytes_per_chunk) {
drm_err(dsi->drm, "current resolution can not be set\n");
return -EINVAL;
}
chunk_overhead = total_bytes - bytes_per_chunk;
/* overhead higher than 1 -> enable multi packets */
if (chunk_overhead > 1) {
/* multi packets */
for (video_size = video_size_step;
video_size < vm->hactive;
video_size += video_size_step) {
if (vm->hactive * 1000 / video_size % 1000)
continue;
chunks = vm->hactive / video_size;
bytes_per_chunk = Bpp_x100 * video_size / 100
+ pkt_header;
if (total_bytes >= (bytes_per_chunk * chunks)) {
bytes_left = total_bytes -
bytes_per_chunk * chunks;
break;
}
}
/* prevent overflow (unsigned - unsigned) */
if (bytes_left > (pkt_header * chunks)) {
null_pkt_size = (bytes_left -
pkt_header * chunks) / chunks;
/* avoid register overflow */
if (null_pkt_size > 1023)
null_pkt_size = 1023;
}
} else {
/* single packet */
chunks = 1;
/* must be a multiple of 4 except 18 loosely */
for (video_size = vm->hactive;
(video_size % video_size_step) != 0;
video_size++)
;
}
dsi_reg_wr(ctx, VIDEO_PKT_CONFIG, VIDEO_PKT_SIZE, 0, video_size);
writel(null_pkt_size, ctx->base + VIDEO_NULLPKT_SIZE);
dsi_reg_wr(ctx, VIDEO_PKT_CONFIG, VIDEO_LINE_CHUNK_NUM, 16, chunks);
- }
- writel(ctx->int0_mask, ctx->base + MASK_PROTOCOL_INT);
- writel(ctx->int1_mask, ctx->base + MASK_INTERNAL_INT);
- writel(1, ctx->base + SOFT_RESET);
- return 0;
+}
+static void sprd_dsi_edpi_video(struct dsi_context *ctx) +{
- struct sprd_dsi *dsi = container_of(ctx, struct sprd_dsi, ctx);
- const u32 fifo_depth = 1096;
- const u32 word_length = 4;
- u32 hactive = ctx->vm.hactive;
- u32 Bpp_x100;
- u32 max_fifo_len;
- u8 coding;
- coding = fmt_to_coding(dsi->slave->format);
- Bpp_x100 = calc_bytes_per_pixel_x100(coding);
- max_fifo_len = word_length * fifo_depth * 100 / Bpp_x100;
- writel(0, ctx->base + SOFT_RESET);
- dsi_reg_wr(ctx, DPI_VIDEO_FORMAT, DPI_VIDEO_MODE_FORMAT, 0, coding);
- dsi_reg_wr(ctx, CMD_MODE_CFG, TEAR_FX_EN, 0, ctx->te_ack_en);
- if (max_fifo_len > hactive)
writel(hactive, ctx->base + DCS_WM_PKT_SIZE);
- else
writel(max_fifo_len, ctx->base + DCS_WM_PKT_SIZE);
- writel(ctx->int0_mask, ctx->base + MASK_PROTOCOL_INT);
- writel(ctx->int1_mask, ctx->base + MASK_INTERNAL_INT);
- writel(1, ctx->base + SOFT_RESET);
+}
+/*
- Send a packet on the generic interface,
- this function has an active delay to wait for the buffer to clear.
- The delay is limited to:
- (param_length / 4) x DSIH_FIFO_ACTIVE_WAIT x register access time
- the controller restricts the sending of.
- This function will not be able to send Null and Blanking packets due to
- controller restriction
- */
+static int sprd_dsi_wr_pkt(struct dsi_context *ctx, u8 vc, u8 type,
const u8 *param, u16 len)
+{
- struct sprd_dsi *dsi = container_of(ctx, struct sprd_dsi, ctx);
- u8 wc_lsbyte, wc_msbyte;
- u32 payload;
- int i, j, ret;
- if (vc > 3)
return -EINVAL;
- /* 1st: for long packet, must config payload first */
- ret = dsi_wait_tx_payload_fifo_empty(ctx);
- if (ret) {
drm_err(dsi->drm, "tx payload fifo is not empty\n");
return ret;
- }
- if (len > 2) {
for (i = 0, j = 0; i < len; i += j) {
payload = 0;
for (j = 0; (j < 4) && ((j + i) < (len)); j++)
payload |= param[i + j] << (j * 8);
writel(payload, ctx->base + GEN_PLD_DATA);
}
wc_lsbyte = len & 0xff;
wc_msbyte = len >> 8;
- } else {
wc_lsbyte = (len > 0) ? param[0] : 0;
wc_msbyte = (len > 1) ? param[1] : 0;
- }
- /* 2nd: then set packet header */
- ret = dsi_wait_tx_cmd_fifo_empty(ctx);
- if (ret) {
drm_err(dsi->drm, "tx cmd fifo is not empty\n");
return ret;
- }
- writel(type | (vc << 6) | (wc_lsbyte << 8) | (wc_msbyte << 16),
ctx->base + GEN_HDR);
- return 0;
+}
+/*
- Send READ packet to peripheral using the generic interface,
- this will force command mode and stop video mode (because of BTA).
- This function has an active delay to wait for the buffer to clear,
- the delay is limited to 2 x DSIH_FIFO_ACTIVE_WAIT
- (waiting for command buffer, and waiting for receiving)
- @note this function will enable BTA
- */
+static int sprd_dsi_rd_pkt(struct dsi_context *ctx, u8 vc, u8 type,
u8 msb_byte, u8 lsb_byte,
u8 *buffer, u8 bytes_to_read)
+{
- struct sprd_dsi *dsi = container_of(ctx, struct sprd_dsi, ctx);
- int i, ret;
- int count = 0;
- u32 temp;
- if (vc > 3)
return -EINVAL;
- /* 1st: send read command to peripheral */
- ret = dsi_reg_rd(ctx, CMD_MODE_STATUS, GEN_CMD_CMD_FIFO_EMPTY, 5);
- if (!ret)
return -EIO;
- writel(type | (vc << 6) | (lsb_byte << 8) | (msb_byte << 16),
ctx->base + GEN_HDR);
- /* 2nd: wait peripheral response completed */
- ret = dsi_wait_rd_resp_completed(ctx);
- if (ret) {
drm_err(dsi->drm, "wait read response time out\n");
return ret;
- }
- /* 3rd: get data from rx payload fifo */
- ret = dsi_reg_rd(ctx, CMD_MODE_STATUS, GEN_CMD_RDATA_FIFO_EMPTY, 1);
- if (ret) {
drm_err(dsi->drm, "rx payload fifo empty\n");
return -EIO;
- }
- for (i = 0; i < 100; i++) {
temp = readl(ctx->base + GEN_PLD_DATA);
if (count < bytes_to_read)
buffer[count++] = temp & 0xff;
if (count < bytes_to_read)
buffer[count++] = (temp >> 8) & 0xff;
if (count < bytes_to_read)
buffer[count++] = (temp >> 16) & 0xff;
if (count < bytes_to_read)
buffer[count++] = (temp >> 24) & 0xff;
ret = dsi_reg_rd(ctx, CMD_MODE_STATUS, GEN_CMD_RDATA_FIFO_EMPTY, 1);
if (ret)
return count;
- }
- return 0;
+}
+static void sprd_dsi_set_work_mode(struct dsi_context *ctx, u8 mode) +{
- if (mode == DSI_MODE_CMD)
writel(1, ctx->base + DSI_MODE_CFG);
- else
writel(0, ctx->base + DSI_MODE_CFG);
+}
+static void sprd_dsi_lp_cmd_enable(struct dsi_context *ctx) +{
- if (readl(ctx->base + DSI_MODE_CFG))
dsi_reg_up(ctx, CMD_MODE_CFG, GEN_SW_0P_TX | GEN_SW_1P_TX |
GEN_SW_2P_TX | GEN_SR_0P_TX | GEN_SR_1P_TX | GEN_SR_2P_TX |
GEN_LW_TX | DCS_SW_0P_TX | DCS_SW_1P_TX | DCS_SR_0P_TX |
DCS_LW_TX | MAX_RD_PKT_SIZE, GEN_SW_0P_TX | GEN_SW_1P_TX |
GEN_SW_2P_TX | GEN_SR_0P_TX | GEN_SR_1P_TX | GEN_SR_2P_TX |
GEN_LW_TX | DCS_SW_0P_TX | DCS_SW_1P_TX | DCS_SR_0P_TX |
DCS_LW_TX | MAX_RD_PKT_SIZE);
- else
dsi_reg_up(ctx, VID_MODE_CFG, LP_CMD_EN, LP_CMD_EN);
+}
+static void sprd_dsi_state_reset(struct dsi_context *ctx) +{
- writel(0, ctx->base + SOFT_RESET);
- udelay(100);
- writel(1, ctx->base + SOFT_RESET);
+}
+static int sprd_dphy_init(struct dsi_context *ctx) +{
- struct sprd_dsi *dsi = container_of(ctx, struct sprd_dsi, ctx);
- int ret;
- dsi_reg_up(ctx, PHY_INTERFACE_CTRL, RF_PHY_RESET_N, 0);
- dsi_reg_up(ctx, PHY_INTERFACE_CTRL, RF_PHY_SHUTDOWN, 0);
- dsi_reg_up(ctx, PHY_INTERFACE_CTRL, RF_PHY_CLK_EN, 0);
- dsi_reg_up(ctx, PHY_TST_CTRL0, PHY_TESTCLR, 0);
- dsi_reg_up(ctx, PHY_TST_CTRL0, PHY_TESTCLR, PHY_TESTCLR);
- dsi_reg_up(ctx, PHY_TST_CTRL0, PHY_TESTCLR, 0);
- dphy_pll_config(ctx);
- dphy_timing_config(ctx);
- dsi_reg_up(ctx, PHY_INTERFACE_CTRL, RF_PHY_SHUTDOWN, RF_PHY_SHUTDOWN);
- dsi_reg_up(ctx, PHY_INTERFACE_CTRL, RF_PHY_RESET_N, RF_PHY_RESET_N);
- writel(0x1C, ctx->base + PHY_MIN_STOP_TIME);
- dsi_reg_up(ctx, PHY_INTERFACE_CTRL, RF_PHY_CLK_EN, RF_PHY_CLK_EN);
- writel(dsi->slave->lanes - 1, ctx->base + PHY_LANE_NUM_CONFIG);
- ret = dphy_wait_pll_locked(ctx);
- if (ret) {
drm_err(dsi->drm, "dphy initial failed\n");
return ret;
- }
- return 0;
+}
+static void sprd_dphy_fini(struct dsi_context *ctx) +{
- dsi_reg_up(ctx, PHY_INTERFACE_CTRL, RF_PHY_RESET_N, 0);
- dsi_reg_up(ctx, PHY_INTERFACE_CTRL, RF_PHY_SHUTDOWN, 0);
- dsi_reg_up(ctx, PHY_INTERFACE_CTRL, RF_PHY_RESET_N, RF_PHY_RESET_N);
+}
+static void sprd_dsi_encoder_enable(struct drm_encoder *encoder) +{
- struct sprd_dsi *dsi = encoder_to_dsi(encoder);
- struct sprd_dpu *dpu = to_sprd_crtc(encoder->crtc);
- struct dsi_context *ctx = &dsi->ctx;
- if (ctx->enabled) {
drm_warn(dsi->drm, "dsi is initialized\n");
return;
- }
- sprd_dsi_init(ctx);
- if (ctx->work_mode == DSI_MODE_VIDEO)
sprd_dsi_dpi_video(ctx);
- else
sprd_dsi_edpi_video(ctx);
- sprd_dphy_init(ctx);
- sprd_dsi_lp_cmd_enable(ctx);
- if (dsi->panel) {
drm_panel_prepare(dsi->panel);
drm_panel_enable(dsi->panel);
- }
Please use the new devm_drm_of_get_bridge helper here, and use the bridge API instead.
- sprd_dsi_set_work_mode(ctx, ctx->work_mode);
- sprd_dsi_state_reset(ctx);
- if (dsi->slave->mode_flags & MIPI_DSI_CLOCK_NON_CONTINUOUS)
dsi_reg_up(ctx, PHY_CLK_LANE_LP_CTRL, AUTO_CLKLANE_CTRL_EN,
AUTO_CLKLANE_CTRL_EN);
- else {
dsi_reg_up(ctx, PHY_CLK_LANE_LP_CTRL, RF_PHY_CLK_EN, RF_PHY_CLK_EN);
dsi_reg_up(ctx, PHY_CLK_LANE_LP_CTRL, PHY_CLKLANE_TX_REQ_HS,
PHY_CLKLANE_TX_REQ_HS);
dphy_wait_pll_locked(ctx);
- }
- sprd_dpu_run(dpu);
- ctx->enabled = true;
+}
+static void sprd_dsi_encoder_disable(struct drm_encoder *encoder) +{
- struct sprd_dsi *dsi = encoder_to_dsi(encoder);
- struct sprd_dpu *dpu = to_sprd_crtc(encoder->crtc);
- struct dsi_context *ctx = &dsi->ctx;
- if (!ctx->enabled) {
drm_warn(dsi->drm, "dsi isn't initialized\n");
return;
- }
- sprd_dpu_stop(dpu);
- sprd_dsi_set_work_mode(ctx, DSI_MODE_CMD);
- sprd_dsi_lp_cmd_enable(ctx);
- if (dsi->panel) {
drm_panel_disable(dsi->panel);
drm_panel_unprepare(dsi->panel);
- }
- sprd_dphy_fini(ctx);
- sprd_dsi_fini(ctx);
- ctx->enabled = false;
+}
+static void sprd_dsi_encoder_mode_set(struct drm_encoder *encoder,
struct drm_display_mode *mode,
struct drm_display_mode *adj_mode)
+{
- struct sprd_dsi *dsi = encoder_to_dsi(encoder);
- drm_dbg(dsi->drm, "%s() set mode: %s\n", __func__, dsi->mode->name);
+}
You don't need that function?
+static int sprd_dsi_encoder_atomic_check(struct drm_encoder *encoder,
struct drm_crtc_state *crtc_state,
struct drm_connector_state *conn_state)
+{
- return 0;
+}
Ditto
+static const struct drm_encoder_helper_funcs sprd_encoder_helper_funcs = {
- .atomic_check = sprd_dsi_encoder_atomic_check,
- .mode_set = sprd_dsi_encoder_mode_set,
- .enable = sprd_dsi_encoder_enable,
- .disable = sprd_dsi_encoder_disable
+};
+static const struct drm_encoder_funcs sprd_encoder_funcs = {
- .destroy = drm_encoder_cleanup,
+};
+static struct sprd_dsi *sprd_dsi_encoder_init(struct drm_device *drm,
struct device *dev)
+{
- struct sprd_dsi *dsi;
- u32 crtc_mask;
- crtc_mask = drm_of_find_possible_crtcs(drm, dev->of_node);
- if (!crtc_mask) {
drm_err(drm, "failed to find crtc mask\n");
return ERR_PTR(-EINVAL);
- }
- drm_dbg(drm, "find possible crtcs: 0x%08x\n", crtc_mask);
- dsi = drmm_encoder_alloc(drm, struct sprd_dsi, encoder,
&sprd_encoder_funcs, DRM_MODE_ENCODER_DSI, NULL);
- if (IS_ERR(dsi)) {
drm_err(drm, "failed to init dsi encoder.\n");
return dsi;
- }
- dsi->encoder.possible_crtcs = crtc_mask;
- drm_encoder_helper_add(&dsi->encoder, &sprd_encoder_helper_funcs);
- return dsi;
+}
+static int sprd_dsi_find_panel(struct sprd_dsi *dsi) +{
- struct device *dev = dsi->host.dev;
- struct device_node *child, *lcds_node;
- struct drm_panel *panel;
- /* search /lcds child node first */
- lcds_node = of_find_node_by_path("/lcds");
- for_each_child_of_node(lcds_node, child) {
panel = of_drm_find_panel(child);
if (!IS_ERR(panel)) {
dsi->panel = panel;
return 0;
}
- }
- /*
* If /lcds child node search failed, we search
* the child of dsi host node.
*/
- for_each_child_of_node(dev->of_node, child) {
panel = of_drm_find_panel(child);
if (!IS_ERR(panel)) {
dsi->panel = panel;
return 0;
}
- }
- drm_err(dsi->drm, "of_drm_find_panel() failed\n");
- return -ENODEV;
+}
Just use devm_drm_of_get_bridge there
+static int sprd_dsi_host_attach(struct mipi_dsi_host *host,
struct mipi_dsi_device *slave)
+{
- struct sprd_dsi *dsi = host_to_dsi(host);
- struct dsi_context *ctx = &dsi->ctx;
- int ret;
- dsi->slave = slave;
- if (slave->mode_flags & MIPI_DSI_MODE_VIDEO)
ctx->work_mode = DSI_MODE_VIDEO;
- else
ctx->work_mode = DSI_MODE_CMD;
- if (slave->mode_flags & MIPI_DSI_MODE_VIDEO_BURST)
ctx->burst_mode = VIDEO_BURST_WITH_SYNC_PULSES;
- else if (slave->mode_flags & MIPI_DSI_MODE_VIDEO_SYNC_PULSE)
ctx->burst_mode = VIDEO_NON_BURST_WITH_SYNC_PULSES;
- else
ctx->burst_mode = VIDEO_NON_BURST_WITH_SYNC_EVENTS;
- ret = sprd_dsi_find_panel(dsi);
- if (ret)
return ret;
- return 0;
+}
+static int sprd_dsi_host_detach(struct mipi_dsi_host *host,
struct mipi_dsi_device *slave)
+{
- /* do nothing */
- return 0;
+}
+static ssize_t sprd_dsi_host_transfer(struct mipi_dsi_host *host,
const struct mipi_dsi_msg *msg)
+{
- struct sprd_dsi *dsi = host_to_dsi(host);
- const u8 *tx_buf = msg->tx_buf;
- if (msg->rx_buf && msg->rx_len) {
u8 lsb = (msg->tx_len > 0) ? tx_buf[0] : 0;
u8 msb = (msg->tx_len > 1) ? tx_buf[1] : 0;
return sprd_dsi_rd_pkt(&dsi->ctx, msg->channel, msg->type,
msb, lsb, msg->rx_buf, msg->rx_len);
- }
- if (msg->tx_buf && msg->tx_len)
return sprd_dsi_wr_pkt(&dsi->ctx, msg->channel, msg->type,
tx_buf, msg->tx_len);
- return 0;
+}
+static const struct mipi_dsi_host_ops sprd_dsi_host_ops = {
- .attach = sprd_dsi_host_attach,
- .detach = sprd_dsi_host_detach,
- .transfer = sprd_dsi_host_transfer,
+};
+static int sprd_dsi_host_init(struct sprd_dsi *dsi, struct device *dev) +{
- int ret;
- dsi->host.dev = dev;
- dsi->host.ops = &sprd_dsi_host_ops;
- ret = mipi_dsi_host_register(&dsi->host);
- if (ret)
drm_err(dsi->drm, "failed to register dsi host\n");
- return ret;
+}
+static int sprd_dsi_connector_get_modes(struct drm_connector *connector) +{
- struct sprd_dsi *dsi = connector_to_dsi(connector);
- return drm_panel_get_modes(dsi->panel, connector);
+}
+static enum drm_mode_status +sprd_dsi_connector_mode_valid(struct drm_connector *connector,
struct drm_display_mode *mode)
+{
- struct sprd_dsi *dsi = connector_to_dsi(connector);
- drm_dbg(dsi->drm, "%s() mode: "DRM_MODE_FMT"\n", __func__, DRM_MODE_ARG(mode));
- if (mode->type & DRM_MODE_TYPE_PREFERRED) {
dsi->mode = mode;
drm_display_mode_to_videomode(dsi->mode, &dsi->ctx.vm);
- }
I already told you this, but you shouldn't modify your state in mode_valid, and certainly not based on whether it's the preferred mode or not.
- return MODE_OK;
+}
+static struct drm_encoder * +sprd_dsi_connector_best_encoder(struct drm_connector *connector) +{
- struct sprd_dsi *dsi = connector_to_dsi(connector);
- return &dsi->encoder;
+}
+static struct drm_connector_helper_funcs sprd_dsi_connector_helper_funcs = {
- .get_modes = sprd_dsi_connector_get_modes,
- .mode_valid = sprd_dsi_connector_mode_valid,
- .best_encoder = sprd_dsi_connector_best_encoder,
+};
+static enum drm_connector_status +sprd_dsi_connector_detect(struct drm_connector *connector, bool force) +{
- struct sprd_dsi *dsi = connector_to_dsi(connector);
- if (dsi->panel) {
drm_panel_add(dsi->panel);
return connector_status_connected;
- }
- return connector_status_disconnected;
+}
+static void sprd_dsi_connector_destroy(struct drm_connector *connector) +{
- drm_connector_unregister(connector);
- drm_connector_cleanup(connector);
+}
+static const struct drm_connector_funcs sprd_dsi_atomic_connector_funcs = {
- .fill_modes = drm_helper_probe_single_connector_modes,
- .detect = sprd_dsi_connector_detect,
- .destroy = sprd_dsi_connector_destroy,
- .reset = drm_atomic_helper_connector_reset,
- .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
- .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
+};
+static int sprd_dsi_connector_init(struct drm_device *drm, struct sprd_dsi *dsi) +{
- struct drm_encoder *encoder = &dsi->encoder;
- struct drm_connector *connector = &dsi->connector;
- int ret;
- connector->polled = DRM_CONNECTOR_POLL_HPD;
- ret = drm_connector_init(drm, connector,
&sprd_dsi_atomic_connector_funcs,
DRM_MODE_CONNECTOR_DSI);
- if (ret) {
drm_err(drm, "drm_connector_init() failed\n");
return ret;
- }
- drm_connector_helper_add(connector,
&sprd_dsi_connector_helper_funcs);
- drm_connector_attach_encoder(connector, encoder);
- return 0;
+}
+static int sprd_dsi_context_init(struct sprd_dsi *dsi,
struct device *dev)
+{
- struct platform_device *pdev = to_platform_device(dev);
- struct dsi_context *ctx = &dsi->ctx;
- struct resource *res;
- res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
- ctx->base = devm_ioremap(dev, res->start, resource_size(res));
- if (!ctx->base) {
drm_err(dsi->drm, "failed to map dsi host registers\n");
return -ENXIO;
- }
- ctx->pll = devm_kzalloc(dev, sizeof(*ctx->pll), GFP_KERNEL);
- if (!ctx->pll)
return -ENOMEM;
- ctx->regmap = devm_regmap_init(dev, ®map_tst_io, dsi, &byte_config);
- if (IS_ERR(ctx->regmap)) {
drm_err(dsi->drm, "dphy regmap init failed\n");
return PTR_ERR(ctx->regmap);
- }
- ctx->data_hs2lp = 120;
- ctx->data_lp2hs = 500;
- ctx->clk_hs2lp = 4;
- ctx->clk_lp2hs = 15;
- ctx->max_rd_time = 6000;
- ctx->int0_mask = 0xffffffff;
- ctx->int1_mask = 0xffffffff;
- ctx->enabled = true;
- return 0;
+}
+static int sprd_dsi_bind(struct device *dev, struct device *master, void *data) +{
- struct drm_device *drm = data;
- struct sprd_dsi *dsi;
- int ret;
- dsi = sprd_dsi_encoder_init(drm, dev);
- if (IS_ERR(dsi))
return PTR_ERR(dsi);
- dsi->drm = drm;
- dev_set_drvdata(dev, dsi);
- ret = sprd_dsi_connector_init(drm, dsi);
- if (ret)
return ret;
- ret = sprd_dsi_context_init(dsi, dev);
- if (ret)
return ret;
- ret = sprd_dsi_host_init(dsi, dev);
- if (ret)
return ret;
- return 0;
+}
+static void sprd_dsi_unbind(struct device *dev,
struct device *master, void *data)
+{
- struct sprd_dsi *dsi = dev_get_drvdata(dev);
- mipi_dsi_host_unregister(&dsi->host);
+}
+static const struct component_ops dsi_component_ops = {
- .bind = sprd_dsi_bind,
- .unbind = sprd_dsi_unbind,
+};
+static const struct of_device_id dsi_match_table[] = {
- { .compatible = "sprd,sharkl3-dsi-host" },
- { /* sentinel */ },
+};
+static int sprd_dsi_probe(struct platform_device *pdev) +{
- return component_add(&pdev->dev, &dsi_component_ops);
In order to prevent probe issues, you need to register you mipi_dsi_host here, see: https://lore.kernel.org/dri-devel/20210910101218.1632297-3-maxime@cerno.tech...
Maxime