Ben Skeggs
2023-Sep-14 08:46 UTC
[Nouveau] [PATCH 34/44] drm/nouveau/disp: add support for post-LT adjust
From: Ben Skeggs <bskeggs at redhat.com> - fixes regression from previous commit Signed-off-by: Ben Skeggs <bskeggs at redhat.com> --- drivers/gpu/drm/nouveau/include/nvif/if0012.h | 11 +++ drivers/gpu/drm/nouveau/include/nvif/outp.h | 1 + drivers/gpu/drm/nouveau/nouveau_dp.c | 72 ++++++++++++++++++- drivers/gpu/drm/nouveau/nvif/outp.c | 16 +++++ drivers/gpu/drm/nouveau/nvkm/engine/disp/dp.c | 17 +++++ .../gpu/drm/nouveau/nvkm/engine/disp/outp.h | 1 + .../gpu/drm/nouveau/nvkm/engine/disp/uoutp.c | 14 ++++ 7 files changed, 130 insertions(+), 2 deletions(-) diff --git a/drivers/gpu/drm/nouveau/include/nvif/if0012.h b/drivers/gpu/drm/nouveau/include/nvif/if0012.h index 14972b942be7..00ce0a46c152 100644 --- a/drivers/gpu/drm/nouveau/include/nvif/if0012.h +++ b/drivers/gpu/drm/nouveau/include/nvif/if0012.h @@ -35,6 +35,7 @@ union nvif_outp_args { #define NVIF_OUTP_V0_DP_AUX_XFER 0x71 #define NVIF_OUTP_V0_DP_RATES 0x72 #define NVIF_OUTP_V0_DP_TRAIN 0x73 +#define NVIF_OUTP_V0_DP_DRIVE 0x74 #define NVIF_OUTP_V0_DP_MST_VCPI 0x78 union nvif_outp_detect_args { @@ -211,6 +212,16 @@ union nvif_outp_dp_train_args { } v0; }; +union nvif_outp_dp_drive_args { + struct nvif_outp_dp_drive_v0 { + __u8 version; + __u8 pad01[2]; + __u8 lanes; + __u8 pe[4]; + __u8 vs[4]; + } v0; +}; + union nvif_outp_dp_mst_vcpi_args { struct nvif_outp_dp_mst_vcpi_v0 { __u8 version; diff --git a/drivers/gpu/drm/nouveau/include/nvif/outp.h b/drivers/gpu/drm/nouveau/include/nvif/outp.h index 9a78483e0289..b4f97fabecbd 100644 --- a/drivers/gpu/drm/nouveau/include/nvif/outp.h +++ b/drivers/gpu/drm/nouveau/include/nvif/outp.h @@ -67,6 +67,7 @@ int nvif_outp_dp_rates(struct nvif_outp *, struct nvif_outp_dp_rate *rate, int r int nvif_outp_dp_train(struct nvif_outp *, u8 dpcd[DP_RECEIVER_CAP_SIZE], u8 lttprs, u8 link_nr, u32 link_bw, bool mst, bool post_lt_adj, bool retrain); +int nvif_outp_dp_drive(struct nvif_outp *, u8 link_nr, u8 pe[4], u8 vs[4]); int nvif_outp_dp_mst_vcpi(struct nvif_outp *, int head, u8 start_slot, u8 num_slots, u16 pbn, u16 aligned_pbn); #endif diff --git a/drivers/gpu/drm/nouveau/nouveau_dp.c b/drivers/gpu/drm/nouveau/nouveau_dp.c index cd03c29c1063..7de7707ec6a8 100644 --- a/drivers/gpu/drm/nouveau/nouveau_dp.c +++ b/drivers/gpu/drm/nouveau/nouveau_dp.c @@ -320,15 +320,83 @@ nouveau_dp_power_down(struct nouveau_encoder *outp) static bool nouveau_dp_train_link(struct nouveau_encoder *outp, bool retrain) { - int ret; + struct drm_dp_aux *aux = &outp->conn->aux; + bool post_lt = false; + int ret, retries = 0; + if ( (outp->dp.dpcd[DP_MAX_LANE_COUNT] & 0x20) && + !(outp->dp.dpcd[DP_MAX_DOWNSPREAD] & DP_TPS4_SUPPORTED)) + post_lt = true; + +retry: ret = nvif_outp_dp_train(&outp->outp, outp->dp.dpcd, outp->dp.lttpr.nr, outp->dp.lt.nr, outp->dp.lt.bw, outp->dp.lt.mst, - false, + post_lt, retrain); + if (ret) + return false; + + if (post_lt) { + u8 stat[DP_LINK_STATUS_SIZE]; + u8 prev[2]; + u8 time = 0, adjusts = 0, tmp; + + ret = drm_dp_dpcd_read_phy_link_status(aux, DP_PHY_DPRX, stat); + if (ret) + return false; + + for (;;) { + if (!drm_dp_channel_eq_ok(stat, outp->dp.lt.nr)) { + ret = 1; + break; + } + + if (!(stat[2] & 0x02)) + break; + + msleep(5); + time += 5; + + memcpy(prev, &stat[4], sizeof(prev)); + ret = drm_dp_dpcd_read_phy_link_status(aux, DP_PHY_DPRX, stat); + if (ret) + break; + + if (!memcmp(prev, &stat[4], sizeof(prev))) { + if (time > 200) + break; + } else { + u8 pe[4], vs[4]; + + if (adjusts++ == 6) + break; + + for (int i = 0; i < outp->dp.lt.nr; i++) { + pe[i] = drm_dp_get_adjust_request_pre_emphasis(stat, i) >> + DP_TRAIN_PRE_EMPHASIS_SHIFT; + vs[i] = drm_dp_get_adjust_request_voltage(stat, i) >> + DP_TRAIN_VOLTAGE_SWING_SHIFT; + } + + ret = nvif_outp_dp_drive(&outp->outp, outp->dp.lt.nr, pe, vs); + if (ret) + break; + + time = 0; + } + } + + if (drm_dp_dpcd_readb(aux, DP_LANE_COUNT_SET, &tmp) == 1) { + tmp &= ~0x20; + drm_dp_dpcd_writeb(aux, DP_LANE_COUNT_SET, tmp); + } + } + + if (ret == 1 && retries++ < 3) + goto retry; return ret == 0; } diff --git a/drivers/gpu/drm/nouveau/nvif/outp.c b/drivers/gpu/drm/nouveau/nvif/outp.c index 7ffd57d82f89..5fe5523587e6 100644 --- a/drivers/gpu/drm/nouveau/nvif/outp.c +++ b/drivers/gpu/drm/nouveau/nvif/outp.c @@ -46,6 +46,22 @@ nvif_outp_dp_mst_vcpi(struct nvif_outp *outp, int head, return ret; } +int +nvif_outp_dp_drive(struct nvif_outp *outp, u8 link_nr, u8 pe[4], u8 vs[4]) +{ + struct nvif_outp_dp_drive_v0 args; + int ret; + + args.version = 0; + args.lanes = link_nr; + memcpy(args.pe, pe, sizeof(args.pe)); + memcpy(args.vs, vs, sizeof(args.vs)); + + ret = nvif_object_mthd(&outp->object, NVIF_OUTP_V0_DP_DRIVE, &args, sizeof(args)); + NVIF_ERRON(ret, &outp->object, "[DP_DRIVE lanes:%d]", args.lanes); + return ret; +} + int nvif_outp_dp_train(struct nvif_outp *outp, u8 dpcd[DP_RECEIVER_CAP_SIZE], u8 lttprs, u8 link_nr, u32 link_bw, bool mst, bool post_lt_adj, bool retrain) diff --git a/drivers/gpu/drm/nouveau/nvkm/engine/disp/dp.c b/drivers/gpu/drm/nouveau/nvkm/engine/disp/dp.c index 6f08ff8b1fba..77a91d42b977 100644 --- a/drivers/gpu/drm/nouveau/nvkm/engine/disp/dp.c +++ b/drivers/gpu/drm/nouveau/nvkm/engine/disp/dp.c @@ -315,6 +315,8 @@ nvkm_dp_train_link(struct nvkm_outp *outp, int rate) sink[1] = ior->dp.nr; if (ior->dp.ef) sink[1] |= DPCD_LC01_ENHANCED_FRAME_EN; + if (outp->dp.lt.post_adj) + sink[1] |= 0x20; ret = nvkm_wraux(outp->dp.aux, DPCD_LC00_LINK_BW_SET, sink, 2); if (ret) @@ -454,6 +456,20 @@ nvkm_dp_train_init(struct nvkm_outp *outp) } } +static int +nvkm_dp_drive(struct nvkm_outp *outp, u8 lanes, u8 pe[4], u8 vs[4]) +{ + struct lt_state lt = { + .outp = outp, + .stat[4] = (pe[0] << 2) | (vs[0] << 0) | + (pe[1] << 6) | (vs[1] << 4), + .stat[5] = (pe[2] << 2) | (vs[2] << 0) | + (pe[3] << 6) | (vs[3] << 4), + }; + + return nvkm_dp_train_drive(<, false); +} + static int nvkm_dp_train(struct nvkm_outp *outp, bool retrain) { @@ -597,6 +613,7 @@ nvkm_dp_func = { .dp.aux_pwr = nvkm_dp_aux_pwr, .dp.aux_xfer = nvkm_dp_aux_xfer, .dp.train = nvkm_dp_train, + .dp.drive = nvkm_dp_drive, }; int diff --git a/drivers/gpu/drm/nouveau/nvkm/engine/disp/outp.h b/drivers/gpu/drm/nouveau/nvkm/engine/disp/outp.h index 014b95b0f561..cda17941de89 100644 --- a/drivers/gpu/drm/nouveau/nvkm/engine/disp/outp.h +++ b/drivers/gpu/drm/nouveau/nvkm/engine/disp/outp.h @@ -108,6 +108,7 @@ struct nvkm_outp_func { int (*aux_xfer)(struct nvkm_outp *, u8 type, u32 addr, u8 *data, u8 *size); int (*rates)(struct nvkm_outp *); int (*train)(struct nvkm_outp *, bool retrain); + int (*drive)(struct nvkm_outp *, u8 lanes, u8 pe[4], u8 vs[4]); } dp; }; diff --git a/drivers/gpu/drm/nouveau/nvkm/engine/disp/uoutp.c b/drivers/gpu/drm/nouveau/nvkm/engine/disp/uoutp.c index a256b35ce79c..b634e76c2a9b 100644 --- a/drivers/gpu/drm/nouveau/nvkm/engine/disp/uoutp.c +++ b/drivers/gpu/drm/nouveau/nvkm/engine/disp/uoutp.c @@ -45,6 +45,19 @@ nvkm_uoutp_mthd_dp_mst_vcpi(struct nvkm_outp *outp, void *argv, u32 argc) return 0; } +static int +nvkm_uoutp_mthd_dp_drive(struct nvkm_outp *outp, void *argv, u32 argc) +{ + union nvif_outp_dp_drive_args *args = argv; + + if (argc != sizeof(args->v0) || args->v0.version != 0) + return -ENOSYS; + if (!outp->func->dp.drive) + return -EINVAL; + + return outp->func->dp.drive(outp, args->v0.lanes, args->v0.pe, args->v0.vs); +} + static int nvkm_uoutp_mthd_dp_train(struct nvkm_outp *outp, void *argv, u32 argc) { @@ -447,6 +460,7 @@ nvkm_uoutp_mthd_acquired(struct nvkm_outp *outp, u32 mthd, void *argv, u32 argc) case NVIF_OUTP_V0_INFOFRAME : return nvkm_uoutp_mthd_infoframe (outp, argv, argc); case NVIF_OUTP_V0_HDA_ELD : return nvkm_uoutp_mthd_hda_eld (outp, argv, argc); case NVIF_OUTP_V0_DP_TRAIN : return nvkm_uoutp_mthd_dp_train (outp, argv, argc); + case NVIF_OUTP_V0_DP_DRIVE : return nvkm_uoutp_mthd_dp_drive (outp, argv, argc); case NVIF_OUTP_V0_DP_MST_VCPI : return nvkm_uoutp_mthd_dp_mst_vcpi (outp, argv, argc); default: break; -- 2.41.0
Danilo Krummrich
2023-Sep-15 22:47 UTC
[Nouveau] [PATCH 34/44] drm/nouveau/disp: add support for post-LT adjust
On 9/14/23 10:46, Ben Skeggs wrote:> From: Ben Skeggs <bskeggs at redhat.com> > > - fixes regression from previous commitFrom "drm/nouveau/disp: move link training out of supervisor"? I'd probably prefer to either re-order or combine them rather than having a regression in the series.> > Signed-off-by: Ben Skeggs <bskeggs at redhat.com> > --- > drivers/gpu/drm/nouveau/include/nvif/if0012.h | 11 +++ > drivers/gpu/drm/nouveau/include/nvif/outp.h | 1 + > drivers/gpu/drm/nouveau/nouveau_dp.c | 72 ++++++++++++++++++- > drivers/gpu/drm/nouveau/nvif/outp.c | 16 +++++ > drivers/gpu/drm/nouveau/nvkm/engine/disp/dp.c | 17 +++++ > .../gpu/drm/nouveau/nvkm/engine/disp/outp.h | 1 + > .../gpu/drm/nouveau/nvkm/engine/disp/uoutp.c | 14 ++++ > 7 files changed, 130 insertions(+), 2 deletions(-) > > diff --git a/drivers/gpu/drm/nouveau/include/nvif/if0012.h b/drivers/gpu/drm/nouveau/include/nvif/if0012.h > index 14972b942be7..00ce0a46c152 100644 > --- a/drivers/gpu/drm/nouveau/include/nvif/if0012.h > +++ b/drivers/gpu/drm/nouveau/include/nvif/if0012.h > @@ -35,6 +35,7 @@ union nvif_outp_args { > #define NVIF_OUTP_V0_DP_AUX_XFER 0x71 > #define NVIF_OUTP_V0_DP_RATES 0x72 > #define NVIF_OUTP_V0_DP_TRAIN 0x73 > +#define NVIF_OUTP_V0_DP_DRIVE 0x74 > #define NVIF_OUTP_V0_DP_MST_VCPI 0x78 > > union nvif_outp_detect_args { > @@ -211,6 +212,16 @@ union nvif_outp_dp_train_args { > } v0; > }; > > +union nvif_outp_dp_drive_args { > + struct nvif_outp_dp_drive_v0 { > + __u8 version; > + __u8 pad01[2]; > + __u8 lanes; > + __u8 pe[4]; > + __u8 vs[4]; > + } v0; > +}; > + > union nvif_outp_dp_mst_vcpi_args { > struct nvif_outp_dp_mst_vcpi_v0 { > __u8 version; > diff --git a/drivers/gpu/drm/nouveau/include/nvif/outp.h b/drivers/gpu/drm/nouveau/include/nvif/outp.h > index 9a78483e0289..b4f97fabecbd 100644 > --- a/drivers/gpu/drm/nouveau/include/nvif/outp.h > +++ b/drivers/gpu/drm/nouveau/include/nvif/outp.h > @@ -67,6 +67,7 @@ int nvif_outp_dp_rates(struct nvif_outp *, struct nvif_outp_dp_rate *rate, int r > int nvif_outp_dp_train(struct nvif_outp *, u8 dpcd[DP_RECEIVER_CAP_SIZE], > u8 lttprs, u8 link_nr, u32 link_bw, bool mst, bool post_lt_adj, > bool retrain); > +int nvif_outp_dp_drive(struct nvif_outp *, u8 link_nr, u8 pe[4], u8 vs[4]); > int nvif_outp_dp_mst_vcpi(struct nvif_outp *, int head, > u8 start_slot, u8 num_slots, u16 pbn, u16 aligned_pbn); > #endif > diff --git a/drivers/gpu/drm/nouveau/nouveau_dp.c b/drivers/gpu/drm/nouveau/nouveau_dp.c > index cd03c29c1063..7de7707ec6a8 100644 > --- a/drivers/gpu/drm/nouveau/nouveau_dp.c > +++ b/drivers/gpu/drm/nouveau/nouveau_dp.c > @@ -320,15 +320,83 @@ nouveau_dp_power_down(struct nouveau_encoder *outp) > static bool > nouveau_dp_train_link(struct nouveau_encoder *outp, bool retrain) > { > - int ret; > + struct drm_dp_aux *aux = &outp->conn->aux; > + bool post_lt = false; > + int ret, retries = 0; > > + if ( (outp->dp.dpcd[DP_MAX_LANE_COUNT] & 0x20) && > + !(outp->dp.dpcd[DP_MAX_DOWNSPREAD] & DP_TPS4_SUPPORTED)) > + post_lt = true; > + > +retry: > ret = nvif_outp_dp_train(&outp->outp, outp->dp.dpcd, > outp->dp.lttpr.nr, > outp->dp.lt.nr, > outp->dp.lt.bw, > outp->dp.lt.mst, > - false, > + post_lt, > retrain); > + if (ret) > + return false; > + > + if (post_lt) { > + u8 stat[DP_LINK_STATUS_SIZE]; > + u8 prev[2]; > + u8 time = 0, adjusts = 0, tmp; > + > + ret = drm_dp_dpcd_read_phy_link_status(aux, DP_PHY_DPRX, stat); > + if (ret) > + return false; > + > + for (;;) { > + if (!drm_dp_channel_eq_ok(stat, outp->dp.lt.nr)) { > + ret = 1; > + break; > + } > + > + if (!(stat[2] & 0x02)) > + break; > + > + msleep(5); > + time += 5; > + > + memcpy(prev, &stat[4], sizeof(prev)); > + ret = drm_dp_dpcd_read_phy_link_status(aux, DP_PHY_DPRX, stat); > + if (ret) > + break; > + > + if (!memcmp(prev, &stat[4], sizeof(prev))) { > + if (time > 200) > + break; > + } else { > + u8 pe[4], vs[4]; > + > + if (adjusts++ == 6) > + break; > + > + for (int i = 0; i < outp->dp.lt.nr; i++) { > + pe[i] = drm_dp_get_adjust_request_pre_emphasis(stat, i) >> > + DP_TRAIN_PRE_EMPHASIS_SHIFT; > + vs[i] = drm_dp_get_adjust_request_voltage(stat, i) >> > + DP_TRAIN_VOLTAGE_SWING_SHIFT; > + } > + > + ret = nvif_outp_dp_drive(&outp->outp, outp->dp.lt.nr, pe, vs); > + if (ret) > + break; > + > + time = 0; > + } > + } > + > + if (drm_dp_dpcd_readb(aux, DP_LANE_COUNT_SET, &tmp) == 1) { > + tmp &= ~0x20; > + drm_dp_dpcd_writeb(aux, DP_LANE_COUNT_SET, tmp); > + } > + } > + > + if (ret == 1 && retries++ < 3) > + goto retry; > > return ret == 0; > } > diff --git a/drivers/gpu/drm/nouveau/nvif/outp.c b/drivers/gpu/drm/nouveau/nvif/outp.c > index 7ffd57d82f89..5fe5523587e6 100644 > --- a/drivers/gpu/drm/nouveau/nvif/outp.c > +++ b/drivers/gpu/drm/nouveau/nvif/outp.c > @@ -46,6 +46,22 @@ nvif_outp_dp_mst_vcpi(struct nvif_outp *outp, int head, > return ret; > } > > +int > +nvif_outp_dp_drive(struct nvif_outp *outp, u8 link_nr, u8 pe[4], u8 vs[4]) > +{ > + struct nvif_outp_dp_drive_v0 args; > + int ret; > + > + args.version = 0; > + args.lanes = link_nr; > + memcpy(args.pe, pe, sizeof(args.pe)); > + memcpy(args.vs, vs, sizeof(args.vs)); > + > + ret = nvif_object_mthd(&outp->object, NVIF_OUTP_V0_DP_DRIVE, &args, sizeof(args)); > + NVIF_ERRON(ret, &outp->object, "[DP_DRIVE lanes:%d]", args.lanes); > + return ret; > +} > + > int > nvif_outp_dp_train(struct nvif_outp *outp, u8 dpcd[DP_RECEIVER_CAP_SIZE], u8 lttprs, > u8 link_nr, u32 link_bw, bool mst, bool post_lt_adj, bool retrain) > diff --git a/drivers/gpu/drm/nouveau/nvkm/engine/disp/dp.c b/drivers/gpu/drm/nouveau/nvkm/engine/disp/dp.c > index 6f08ff8b1fba..77a91d42b977 100644 > --- a/drivers/gpu/drm/nouveau/nvkm/engine/disp/dp.c > +++ b/drivers/gpu/drm/nouveau/nvkm/engine/disp/dp.c > @@ -315,6 +315,8 @@ nvkm_dp_train_link(struct nvkm_outp *outp, int rate) > sink[1] = ior->dp.nr; > if (ior->dp.ef) > sink[1] |= DPCD_LC01_ENHANCED_FRAME_EN; > + if (outp->dp.lt.post_adj) > + sink[1] |= 0x20; > > ret = nvkm_wraux(outp->dp.aux, DPCD_LC00_LINK_BW_SET, sink, 2); > if (ret) > @@ -454,6 +456,20 @@ nvkm_dp_train_init(struct nvkm_outp *outp) > } > } > > +static int > +nvkm_dp_drive(struct nvkm_outp *outp, u8 lanes, u8 pe[4], u8 vs[4]) > +{ > + struct lt_state lt = { > + .outp = outp, > + .stat[4] = (pe[0] << 2) | (vs[0] << 0) | > + (pe[1] << 6) | (vs[1] << 4), > + .stat[5] = (pe[2] << 2) | (vs[2] << 0) | > + (pe[3] << 6) | (vs[3] << 4), > + }; > + > + return nvkm_dp_train_drive(<, false); > +} > + > static int > nvkm_dp_train(struct nvkm_outp *outp, bool retrain) > { > @@ -597,6 +613,7 @@ nvkm_dp_func = { > .dp.aux_pwr = nvkm_dp_aux_pwr, > .dp.aux_xfer = nvkm_dp_aux_xfer, > .dp.train = nvkm_dp_train, > + .dp.drive = nvkm_dp_drive, > }; > > int > diff --git a/drivers/gpu/drm/nouveau/nvkm/engine/disp/outp.h b/drivers/gpu/drm/nouveau/nvkm/engine/disp/outp.h > index 014b95b0f561..cda17941de89 100644 > --- a/drivers/gpu/drm/nouveau/nvkm/engine/disp/outp.h > +++ b/drivers/gpu/drm/nouveau/nvkm/engine/disp/outp.h > @@ -108,6 +108,7 @@ struct nvkm_outp_func { > int (*aux_xfer)(struct nvkm_outp *, u8 type, u32 addr, u8 *data, u8 *size); > int (*rates)(struct nvkm_outp *); > int (*train)(struct nvkm_outp *, bool retrain); > + int (*drive)(struct nvkm_outp *, u8 lanes, u8 pe[4], u8 vs[4]); > } dp; > }; > > diff --git a/drivers/gpu/drm/nouveau/nvkm/engine/disp/uoutp.c b/drivers/gpu/drm/nouveau/nvkm/engine/disp/uoutp.c > index a256b35ce79c..b634e76c2a9b 100644 > --- a/drivers/gpu/drm/nouveau/nvkm/engine/disp/uoutp.c > +++ b/drivers/gpu/drm/nouveau/nvkm/engine/disp/uoutp.c > @@ -45,6 +45,19 @@ nvkm_uoutp_mthd_dp_mst_vcpi(struct nvkm_outp *outp, void *argv, u32 argc) > return 0; > } > > +static int > +nvkm_uoutp_mthd_dp_drive(struct nvkm_outp *outp, void *argv, u32 argc) > +{ > + union nvif_outp_dp_drive_args *args = argv; > + > + if (argc != sizeof(args->v0) || args->v0.version != 0) > + return -ENOSYS; > + if (!outp->func->dp.drive) > + return -EINVAL; > + > + return outp->func->dp.drive(outp, args->v0.lanes, args->v0.pe, args->v0.vs); > +} > + > static int > nvkm_uoutp_mthd_dp_train(struct nvkm_outp *outp, void *argv, u32 argc) > { > @@ -447,6 +460,7 @@ nvkm_uoutp_mthd_acquired(struct nvkm_outp *outp, u32 mthd, void *argv, u32 argc) > case NVIF_OUTP_V0_INFOFRAME : return nvkm_uoutp_mthd_infoframe (outp, argv, argc); > case NVIF_OUTP_V0_HDA_ELD : return nvkm_uoutp_mthd_hda_eld (outp, argv, argc); > case NVIF_OUTP_V0_DP_TRAIN : return nvkm_uoutp_mthd_dp_train (outp, argv, argc); > + case NVIF_OUTP_V0_DP_DRIVE : return nvkm_uoutp_mthd_dp_drive (outp, argv, argc); > case NVIF_OUTP_V0_DP_MST_VCPI : return nvkm_uoutp_mthd_dp_mst_vcpi (outp, argv, argc); > default: > break;