| Message ID | 20241011064732.8480-2-quic_jinlmao@quicinc.com |
|---|---|
| State | New |
| Headers | show |
| Series | Add support to configure TPDM MCMB subunit | expand |
On 11/10/2024 07:47, Mao Jinlong wrote: > MCMB (Multi-lane CMB) is a special form of CMB dataset type. MCMB > subunit TPDM has the same number and usage of registers as CMB > subunit TPDM. MCMB subunit can be enabled for data collection by > writing 1 to the first bit of CMB_CR register. The difference is > that MCMB subunit TPDM needs to select the lane and enable it in > using it. > > Signed-off-by: Tao Zhang <quic_taozha@quicinc.com> > Signed-off-by: Mao Jinlong <quic_jinlmao@quicinc.com> > --- > drivers/hwtracing/coresight/coresight-tpda.c | 5 ++- > drivers/hwtracing/coresight/coresight-tpdm.c | 41 +++++++++++++++++--- > drivers/hwtracing/coresight/coresight-tpdm.h | 26 ++++++++++++- > 3 files changed, 63 insertions(+), 9 deletions(-) > > diff --git a/drivers/hwtracing/coresight/coresight-tpda.c b/drivers/hwtracing/coresight/coresight-tpda.c > index bfca103f9f84..e063a31ff88a 100644 > --- a/drivers/hwtracing/coresight/coresight-tpda.c > +++ b/drivers/hwtracing/coresight/coresight-tpda.c > @@ -1,6 +1,6 @@ > // SPDX-License-Identifier: GPL-2.0 > /* > - * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights reserved. > + * Copyright (c) 2023-2024 Qualcomm Innovation Center, Inc. All rights reserved. > */ > > #include <linux/amba/bus.h> > @@ -72,7 +72,8 @@ static int tpdm_read_element_size(struct tpda_drvdata *drvdata, > rc = fwnode_property_read_u32(dev_fwnode(csdev->dev.parent), > "qcom,dsb-element-bits", &drvdata->dsb_esize); > } > - if (tpdm_has_cmb_dataset(tpdm_data)) { > + > + if (tpdm_has_cmb_dataset(tpdm_data) || tpdm_has_mcmb_dataset(tpdm_data)) { minor nit: All such places could be replaced by if (tdpm_data->cmb) Because at probe time we allocate the above structure ? > rc = fwnode_property_read_u32(dev_fwnode(csdev->dev.parent), > "qcom,cmb-element-bits", &drvdata->cmb_esize); > } > diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c b/drivers/hwtracing/coresight/coresight-tpdm.c > index 0726f8842552..58f8c3e804c1 100644 > --- a/drivers/hwtracing/coresight/coresight-tpdm.c > +++ b/drivers/hwtracing/coresight/coresight-tpdm.c > @@ -1,6 +1,6 @@ > // SPDX-License-Identifier: GPL-2.0 > /* > - * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights reserved. > + * Copyright (c) 2023-2024 Qualcomm Innovation Center, Inc. All rights reserved. > */ > > #include <linux/amba/bus.h> > @@ -198,7 +198,8 @@ static umode_t tpdm_cmb_is_visible(struct kobject *kobj, > struct device *dev = kobj_to_dev(kobj); > struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); > > - if (drvdata && tpdm_has_cmb_dataset(drvdata)) > + if (drvdata && (tpdm_has_cmb_dataset(drvdata) || > + tpdm_has_mcmb_dataset(drvdata))) if (drvdata && drvdata->cmb) ? > return attr->mode; > > return 0; > @@ -246,8 +247,10 @@ static void tpdm_reset_datasets(struct tpdm_drvdata *drvdata) > drvdata->dsb->trig_type = false; > } > > - if (drvdata->cmb) > + if (drvdata->cmb) { > memset(drvdata->cmb, 0, sizeof(struct cmb_dataset)); > + drvdata->cmb->trig_ts = true; > + } > } > > static void set_dsb_mode(struct tpdm_drvdata *drvdata, u32 *val) > @@ -388,7 +391,8 @@ static void tpdm_enable_cmb(struct tpdm_drvdata *drvdata) > { > u32 val, i; > > - if (!tpdm_has_cmb_dataset(drvdata)) > + if (!(tpdm_has_cmb_dataset(drvdata) || > + tpdm_has_mcmb_dataset(drvdata))) if (!drvdata->cmb) > return; > > /* Configure pattern registers */ > @@ -415,6 +419,19 @@ static void tpdm_enable_cmb(struct tpdm_drvdata *drvdata) > val |= TPDM_CMB_CR_MODE; > else > val &= ~TPDM_CMB_CR_MODE; > + > + if (tpdm_has_mcmb_dataset(drvdata)) { > + val &= ~TPDM_CMB_CR_XTRIG_LNSEL; > + /*Set the lane participates in tghe output pattern*/ minor nit: Leave a single space after '/*' and before '*/' > + val |= FIELD_PREP(TPDM_CMB_CR_XTRIG_LNSEL, > + drvdata->cmb->mcmb->mcmb_trig_lane); > + > + /* Set the enablement of the lane */ > + val &= ~TPDM_CMB_CR_E_LN; > + val |= FIELD_PREP(TPDM_CMB_CR_E_LN, > + drvdata->cmb->mcmb->mcmb_lane_select); > + } > + > /* Set the enable bit of CMB control register to 1 */ > val |= TPDM_CMB_CR_ENA; > writel_relaxed(val, drvdata->base + TPDM_CMB_CR); > @@ -474,7 +491,8 @@ static void tpdm_disable_cmb(struct tpdm_drvdata *drvdata) > { > u32 val; > > - if (!tpdm_has_cmb_dataset(drvdata)) > + if (!(tpdm_has_cmb_dataset(drvdata) || > + tpdm_has_mcmb_dataset(drvdata))) if (!drvdata->cmb) ? > return; > > val = readl_relaxed(drvdata->base + TPDM_CMB_CR); > @@ -541,6 +559,19 @@ static int tpdm_datasets_setup(struct tpdm_drvdata *drvdata) > if (!drvdata->cmb) > return -ENOMEM; > } > + > + if (tpdm_has_mcmb_dataset(drvdata) && (!drvdata->cmb)) { > + drvdata->cmb = devm_kzalloc(drvdata->dev, > + sizeof(*drvdata->cmb), GFP_KERNEL); > + if (!drvdata->cmb) > + return -ENOMEM; > + drvdata->cmb->mcmb = devm_kzalloc(drvdata->dev, > + sizeof(*drvdata->cmb->mcmb), > + GFP_KERNEL); Please avoid this ^^, instead embed the fields in drvdata as mentioned below. Is it possible that both CMB and MCMB can be present on the same TPDM ? If so, we need to be careful about ^ block ? > + if (!drvdata->cmb->mcmb) > + return -ENOMEM; > + } > + > tpdm_reset_datasets(drvdata); > > return 0; > diff --git a/drivers/hwtracing/coresight/coresight-tpdm.h b/drivers/hwtracing/coresight/coresight-tpdm.h > index e08d212642e3..2e84daad1a58 100644 > --- a/drivers/hwtracing/coresight/coresight-tpdm.h > +++ b/drivers/hwtracing/coresight/coresight-tpdm.h > @@ -1,6 +1,6 @@ > /* SPDX-License-Identifier: GPL-2.0 */ > /* > - * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights reserved. > + * Copyright (c) 2023-2024 Qualcomm Innovation Center, Inc. All rights reserved. > */ > > #ifndef _CORESIGHT_CORESIGHT_TPDM_H > @@ -9,7 +9,7 @@ > /* The max number of the datasets that TPDM supports */ > #define TPDM_DATASETS 7 > > -/* CMB Subunit Registers */ > +/* CMB/MCMB Subunit Registers */ > #define TPDM_CMB_CR (0xA00) > /* CMB subunit timestamp insertion enable register */ > #define TPDM_CMB_TIER (0xA04) > @@ -34,6 +34,10 @@ > #define TPDM_CMB_TIER_XTRIG_TSENAB BIT(1) > /* For timestamp fo all trace */ > #define TPDM_CMB_TIER_TS_ALL BIT(2) > +/* MCMB trigger lane select */ > +#define TPDM_CMB_CR_XTRIG_LNSEL GENMASK(20, 18) > +/* MCMB lane enablement */ > +#define TPDM_CMB_CR_E_LN GENMASK(17, 10) > > /* Patten register number */ > #define TPDM_CMB_MAX_PATT 2 > @@ -112,11 +116,13 @@ > * PERIPHIDR0[0] : Fix to 1 if ImplDef subunit present, else 0 > * PERIPHIDR0[1] : Fix to 1 if DSB subunit present, else 0 > * PERIPHIDR0[2] : Fix to 1 if CMB subunit present, else 0 > + * PERIPHIDR0[6] : Fix to 1 if MCMB subunit present, else 0 > */ > > #define TPDM_PIDR0_DS_IMPDEF BIT(0) > #define TPDM_PIDR0_DS_DSB BIT(1) > #define TPDM_PIDR0_DS_CMB BIT(2) > +#define TPDM_PIDR0_DS_MCMB BIT(6) > > #define TPDM_DSB_MAX_LINES 256 > /* MAX number of EDCR registers */ > @@ -245,6 +251,16 @@ struct dsb_dataset { > bool trig_type; > }; > > +/** > + * struct mcmb_dataset > + * @mcmb_trig_lane: Save data for trigger lane > + * @mcmb_lane_select: Save data for lane enablement > + */ > +struct mcmb_dataset { > + u8 mcmb_trig_lane; > + u8 mcmb_lane_select; > +}; > + If it is only these two members, why not embed this in the cmb_dataset ? This takes just 2bytes and we are instead allocating 2bytes + 4bytes for storing and additional pointer dereference + error handling of allocations etc. > /** > * struct cmb_dataset > * @trace_mode: Dataset collection mode > @@ -267,6 +283,7 @@ struct cmb_dataset { > bool patt_ts; > bool trig_ts; > bool ts_all; > + struct mcmb_dataset *mcmb; struct { u8 trig_lane; u8 lane_select; } mcmb; ? Suzuki > }; > > /** > @@ -334,4 +351,9 @@ static bool tpdm_has_cmb_dataset(struct tpdm_drvdata *drvdata) > { > return (drvdata->datasets & TPDM_PIDR0_DS_CMB); > } > + > +static bool tpdm_has_mcmb_dataset(struct tpdm_drvdata *drvdata) > +{ > + return (drvdata->datasets & TPDM_PIDR0_DS_MCMB); > +} > #endif /* _CORESIGHT_CORESIGHT_TPDM_H */
On 2024/10/23 17:33, Suzuki K Poulose wrote: > On 11/10/2024 07:47, Mao Jinlong wrote: >> MCMB (Multi-lane CMB) is a special form of CMB dataset type. MCMB >> subunit TPDM has the same number and usage of registers as CMB >> subunit TPDM. MCMB subunit can be enabled for data collection by >> writing 1 to the first bit of CMB_CR register. The difference is >> that MCMB subunit TPDM needs to select the lane and enable it in >> using it. >> >> Signed-off-by: Tao Zhang <quic_taozha@quicinc.com> >> Signed-off-by: Mao Jinlong <quic_jinlmao@quicinc.com> >> --- >> drivers/hwtracing/coresight/coresight-tpda.c | 5 ++- >> drivers/hwtracing/coresight/coresight-tpdm.c | 41 +++++++++++++++++--- >> drivers/hwtracing/coresight/coresight-tpdm.h | 26 ++++++++++++- >> 3 files changed, 63 insertions(+), 9 deletions(-) >> >> diff --git a/drivers/hwtracing/coresight/coresight-tpda.c b/drivers/ >> hwtracing/coresight/coresight-tpda.c >> index bfca103f9f84..e063a31ff88a 100644 >> --- a/drivers/hwtracing/coresight/coresight-tpda.c >> +++ b/drivers/hwtracing/coresight/coresight-tpda.c >> @@ -1,6 +1,6 @@ >> // SPDX-License-Identifier: GPL-2.0 >> /* >> - * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights >> reserved. >> + * Copyright (c) 2023-2024 Qualcomm Innovation Center, Inc. All >> rights reserved. >> */ >> #include <linux/amba/bus.h> >> @@ -72,7 +72,8 @@ static int tpdm_read_element_size(struct >> tpda_drvdata *drvdata, >> rc = fwnode_property_read_u32(dev_fwnode(csdev->dev.parent), >> "qcom,dsb-element-bits", &drvdata->dsb_esize); >> } >> - if (tpdm_has_cmb_dataset(tpdm_data)) { >> + >> + if (tpdm_has_cmb_dataset(tpdm_data) || >> tpdm_has_mcmb_dataset(tpdm_data)) { > > minor nit: All such places could be replaced by > > if (tdpm_data->cmb) > > Because at probe time we allocate the above structure ? > > >> rc = fwnode_property_read_u32(dev_fwnode(csdev->dev.parent), >> "qcom,cmb-element-bits", &drvdata->cmb_esize); >> } >> diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c b/drivers/ >> hwtracing/coresight/coresight-tpdm.c >> index 0726f8842552..58f8c3e804c1 100644 >> --- a/drivers/hwtracing/coresight/coresight-tpdm.c >> +++ b/drivers/hwtracing/coresight/coresight-tpdm.c >> @@ -1,6 +1,6 @@ >> // SPDX-License-Identifier: GPL-2.0 >> /* >> - * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights >> reserved. >> + * Copyright (c) 2023-2024 Qualcomm Innovation Center, Inc. All >> rights reserved. >> */ >> #include <linux/amba/bus.h> >> @@ -198,7 +198,8 @@ static umode_t tpdm_cmb_is_visible(struct kobject >> *kobj, >> struct device *dev = kobj_to_dev(kobj); >> struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >> - if (drvdata && tpdm_has_cmb_dataset(drvdata)) >> + if (drvdata && (tpdm_has_cmb_dataset(drvdata) || >> + tpdm_has_mcmb_dataset(drvdata))) > > if (drvdata && drvdata->cmb) ? > >> return attr->mode; >> return 0; >> @@ -246,8 +247,10 @@ static void tpdm_reset_datasets(struct >> tpdm_drvdata *drvdata) >> drvdata->dsb->trig_type = false; >> } >> - if (drvdata->cmb) >> + if (drvdata->cmb) { >> memset(drvdata->cmb, 0, sizeof(struct cmb_dataset)); >> + drvdata->cmb->trig_ts = true; >> + } >> } >> static void set_dsb_mode(struct tpdm_drvdata *drvdata, u32 *val) >> @@ -388,7 +391,8 @@ static void tpdm_enable_cmb(struct tpdm_drvdata >> *drvdata) >> { >> u32 val, i; >> - if (!tpdm_has_cmb_dataset(drvdata)) >> + if (!(tpdm_has_cmb_dataset(drvdata) || >> + tpdm_has_mcmb_dataset(drvdata))) > > if (!drvdata->cmb) > >> return; >> /* Configure pattern registers */ >> @@ -415,6 +419,19 @@ static void tpdm_enable_cmb(struct tpdm_drvdata >> *drvdata) >> val |= TPDM_CMB_CR_MODE; >> else >> val &= ~TPDM_CMB_CR_MODE; >> + >> + if (tpdm_has_mcmb_dataset(drvdata)) { >> + val &= ~TPDM_CMB_CR_XTRIG_LNSEL; >> + /*Set the lane participates in tghe output pattern*/ > > minor nit: Leave a single space after '/*' and before '*/' > >> + val |= FIELD_PREP(TPDM_CMB_CR_XTRIG_LNSEL, >> + drvdata->cmb->mcmb->mcmb_trig_lane); >> + >> + /* Set the enablement of the lane */ >> + val &= ~TPDM_CMB_CR_E_LN; >> + val |= FIELD_PREP(TPDM_CMB_CR_E_LN, >> + drvdata->cmb->mcmb->mcmb_lane_select); >> + } >> + >> /* Set the enable bit of CMB control register to 1 */ >> val |= TPDM_CMB_CR_ENA; >> writel_relaxed(val, drvdata->base + TPDM_CMB_CR); >> @@ -474,7 +491,8 @@ static void tpdm_disable_cmb(struct tpdm_drvdata >> *drvdata) >> { >> u32 val; >> - if (!tpdm_has_cmb_dataset(drvdata)) >> + if (!(tpdm_has_cmb_dataset(drvdata) || >> + tpdm_has_mcmb_dataset(drvdata))) > > if (!drvdata->cmb) ? > >> return; >> val = readl_relaxed(drvdata->base + TPDM_CMB_CR); >> @@ -541,6 +559,19 @@ static int tpdm_datasets_setup(struct >> tpdm_drvdata *drvdata) >> if (!drvdata->cmb) >> return -ENOMEM; >> } >> + >> + if (tpdm_has_mcmb_dataset(drvdata) && (!drvdata->cmb)) { >> + drvdata->cmb = devm_kzalloc(drvdata->dev, >> + sizeof(*drvdata->cmb), GFP_KERNEL); >> + if (!drvdata->cmb) >> + return -ENOMEM; >> + drvdata->cmb->mcmb = devm_kzalloc(drvdata->dev, >> + sizeof(*drvdata->cmb->mcmb), >> + GFP_KERNEL); > > Please avoid this ^^, instead embed the fields in drvdata as mentioned > below. > > Is it possible that both CMB and MCMB can be present on the same TPDM ? > If so, we need to be careful about ^ block ? CMB and MCMB won't be present on the same TPDM. > > >> + if (!drvdata->cmb->mcmb) >> + return -ENOMEM; >> + } >> + >> tpdm_reset_datasets(drvdata); >> return 0; >> diff --git a/drivers/hwtracing/coresight/coresight-tpdm.h b/drivers/ >> hwtracing/coresight/coresight-tpdm.h >> index e08d212642e3..2e84daad1a58 100644 >> --- a/drivers/hwtracing/coresight/coresight-tpdm.h >> +++ b/drivers/hwtracing/coresight/coresight-tpdm.h >> @@ -1,6 +1,6 @@ >> /* SPDX-License-Identifier: GPL-2.0 */ >> /* >> - * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights >> reserved. >> + * Copyright (c) 2023-2024 Qualcomm Innovation Center, Inc. All >> rights reserved. >> */ >> #ifndef _CORESIGHT_CORESIGHT_TPDM_H >> @@ -9,7 +9,7 @@ >> /* The max number of the datasets that TPDM supports */ >> #define TPDM_DATASETS 7 >> -/* CMB Subunit Registers */ >> +/* CMB/MCMB Subunit Registers */ >> #define TPDM_CMB_CR (0xA00) >> /* CMB subunit timestamp insertion enable register */ >> #define TPDM_CMB_TIER (0xA04) >> @@ -34,6 +34,10 @@ >> #define TPDM_CMB_TIER_XTRIG_TSENAB BIT(1) >> /* For timestamp fo all trace */ >> #define TPDM_CMB_TIER_TS_ALL BIT(2) >> +/* MCMB trigger lane select */ >> +#define TPDM_CMB_CR_XTRIG_LNSEL GENMASK(20, 18) >> +/* MCMB lane enablement */ >> +#define TPDM_CMB_CR_E_LN GENMASK(17, 10) >> /* Patten register number */ >> #define TPDM_CMB_MAX_PATT 2 >> @@ -112,11 +116,13 @@ >> * PERIPHIDR0[0] : Fix to 1 if ImplDef subunit present, else 0 >> * PERIPHIDR0[1] : Fix to 1 if DSB subunit present, else 0 >> * PERIPHIDR0[2] : Fix to 1 if CMB subunit present, else 0 >> + * PERIPHIDR0[6] : Fix to 1 if MCMB subunit present, else 0 >> */ >> #define TPDM_PIDR0_DS_IMPDEF BIT(0) >> #define TPDM_PIDR0_DS_DSB BIT(1) >> #define TPDM_PIDR0_DS_CMB BIT(2) >> +#define TPDM_PIDR0_DS_MCMB BIT(6) >> #define TPDM_DSB_MAX_LINES 256 >> /* MAX number of EDCR registers */ >> @@ -245,6 +251,16 @@ struct dsb_dataset { >> bool trig_type; >> }; >> +/** >> + * struct mcmb_dataset >> + * @mcmb_trig_lane: Save data for trigger lane >> + * @mcmb_lane_select: Save data for lane enablement >> + */ >> +struct mcmb_dataset { >> + u8 mcmb_trig_lane; >> + u8 mcmb_lane_select; >> +}; >> + > > If it is only these two members, why not embed this in the cmb_dataset ? > This takes just 2bytes and we are instead allocating 2bytes + 4bytes for > storing and additional pointer dereference + error handling of > allocations etc. > >> /** >> * struct cmb_dataset >> * @trace_mode: Dataset collection mode >> @@ -267,6 +283,7 @@ struct cmb_dataset { >> bool patt_ts; >> bool trig_ts; >> bool ts_all; >> + struct mcmb_dataset *mcmb; > > struct { > u8 trig_lane; > u8 lane_select; > } mcmb; > > ? > > Suzuki > > > >> }; >> /** >> @@ -334,4 +351,9 @@ static bool tpdm_has_cmb_dataset(struct >> tpdm_drvdata *drvdata) >> { >> return (drvdata->datasets & TPDM_PIDR0_DS_CMB); >> } >> + >> +static bool tpdm_has_mcmb_dataset(struct tpdm_drvdata *drvdata) >> +{ >> + return (drvdata->datasets & TPDM_PIDR0_DS_MCMB); >> +} >> #endif /* _CORESIGHT_CORESIGHT_TPDM_H */ >
diff --git a/drivers/hwtracing/coresight/coresight-tpda.c b/drivers/hwtracing/coresight/coresight-tpda.c index bfca103f9f84..e063a31ff88a 100644 --- a/drivers/hwtracing/coresight/coresight-tpda.c +++ b/drivers/hwtracing/coresight/coresight-tpda.c @@ -1,6 +1,6 @@ // SPDX-License-Identifier: GPL-2.0 /* - * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights reserved. + * Copyright (c) 2023-2024 Qualcomm Innovation Center, Inc. All rights reserved. */ #include <linux/amba/bus.h> @@ -72,7 +72,8 @@ static int tpdm_read_element_size(struct tpda_drvdata *drvdata, rc = fwnode_property_read_u32(dev_fwnode(csdev->dev.parent), "qcom,dsb-element-bits", &drvdata->dsb_esize); } - if (tpdm_has_cmb_dataset(tpdm_data)) { + + if (tpdm_has_cmb_dataset(tpdm_data) || tpdm_has_mcmb_dataset(tpdm_data)) { rc = fwnode_property_read_u32(dev_fwnode(csdev->dev.parent), "qcom,cmb-element-bits", &drvdata->cmb_esize); } diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c b/drivers/hwtracing/coresight/coresight-tpdm.c index 0726f8842552..58f8c3e804c1 100644 --- a/drivers/hwtracing/coresight/coresight-tpdm.c +++ b/drivers/hwtracing/coresight/coresight-tpdm.c @@ -1,6 +1,6 @@ // SPDX-License-Identifier: GPL-2.0 /* - * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights reserved. + * Copyright (c) 2023-2024 Qualcomm Innovation Center, Inc. All rights reserved. */ #include <linux/amba/bus.h> @@ -198,7 +198,8 @@ static umode_t tpdm_cmb_is_visible(struct kobject *kobj, struct device *dev = kobj_to_dev(kobj); struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); - if (drvdata && tpdm_has_cmb_dataset(drvdata)) + if (drvdata && (tpdm_has_cmb_dataset(drvdata) || + tpdm_has_mcmb_dataset(drvdata))) return attr->mode; return 0; @@ -246,8 +247,10 @@ static void tpdm_reset_datasets(struct tpdm_drvdata *drvdata) drvdata->dsb->trig_type = false; } - if (drvdata->cmb) + if (drvdata->cmb) { memset(drvdata->cmb, 0, sizeof(struct cmb_dataset)); + drvdata->cmb->trig_ts = true; + } } static void set_dsb_mode(struct tpdm_drvdata *drvdata, u32 *val) @@ -388,7 +391,8 @@ static void tpdm_enable_cmb(struct tpdm_drvdata *drvdata) { u32 val, i; - if (!tpdm_has_cmb_dataset(drvdata)) + if (!(tpdm_has_cmb_dataset(drvdata) || + tpdm_has_mcmb_dataset(drvdata))) return; /* Configure pattern registers */ @@ -415,6 +419,19 @@ static void tpdm_enable_cmb(struct tpdm_drvdata *drvdata) val |= TPDM_CMB_CR_MODE; else val &= ~TPDM_CMB_CR_MODE; + + if (tpdm_has_mcmb_dataset(drvdata)) { + val &= ~TPDM_CMB_CR_XTRIG_LNSEL; + /*Set the lane participates in tghe output pattern*/ + val |= FIELD_PREP(TPDM_CMB_CR_XTRIG_LNSEL, + drvdata->cmb->mcmb->mcmb_trig_lane); + + /* Set the enablement of the lane */ + val &= ~TPDM_CMB_CR_E_LN; + val |= FIELD_PREP(TPDM_CMB_CR_E_LN, + drvdata->cmb->mcmb->mcmb_lane_select); + } + /* Set the enable bit of CMB control register to 1 */ val |= TPDM_CMB_CR_ENA; writel_relaxed(val, drvdata->base + TPDM_CMB_CR); @@ -474,7 +491,8 @@ static void tpdm_disable_cmb(struct tpdm_drvdata *drvdata) { u32 val; - if (!tpdm_has_cmb_dataset(drvdata)) + if (!(tpdm_has_cmb_dataset(drvdata) || + tpdm_has_mcmb_dataset(drvdata))) return; val = readl_relaxed(drvdata->base + TPDM_CMB_CR); @@ -541,6 +559,19 @@ static int tpdm_datasets_setup(struct tpdm_drvdata *drvdata) if (!drvdata->cmb) return -ENOMEM; } + + if (tpdm_has_mcmb_dataset(drvdata) && (!drvdata->cmb)) { + drvdata->cmb = devm_kzalloc(drvdata->dev, + sizeof(*drvdata->cmb), GFP_KERNEL); + if (!drvdata->cmb) + return -ENOMEM; + drvdata->cmb->mcmb = devm_kzalloc(drvdata->dev, + sizeof(*drvdata->cmb->mcmb), + GFP_KERNEL); + if (!drvdata->cmb->mcmb) + return -ENOMEM; + } + tpdm_reset_datasets(drvdata); return 0; diff --git a/drivers/hwtracing/coresight/coresight-tpdm.h b/drivers/hwtracing/coresight/coresight-tpdm.h index e08d212642e3..2e84daad1a58 100644 --- a/drivers/hwtracing/coresight/coresight-tpdm.h +++ b/drivers/hwtracing/coresight/coresight-tpdm.h @@ -1,6 +1,6 @@ /* SPDX-License-Identifier: GPL-2.0 */ /* - * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights reserved. + * Copyright (c) 2023-2024 Qualcomm Innovation Center, Inc. All rights reserved. */ #ifndef _CORESIGHT_CORESIGHT_TPDM_H @@ -9,7 +9,7 @@ /* The max number of the datasets that TPDM supports */ #define TPDM_DATASETS 7 -/* CMB Subunit Registers */ +/* CMB/MCMB Subunit Registers */ #define TPDM_CMB_CR (0xA00) /* CMB subunit timestamp insertion enable register */ #define TPDM_CMB_TIER (0xA04) @@ -34,6 +34,10 @@ #define TPDM_CMB_TIER_XTRIG_TSENAB BIT(1) /* For timestamp fo all trace */ #define TPDM_CMB_TIER_TS_ALL BIT(2) +/* MCMB trigger lane select */ +#define TPDM_CMB_CR_XTRIG_LNSEL GENMASK(20, 18) +/* MCMB lane enablement */ +#define TPDM_CMB_CR_E_LN GENMASK(17, 10) /* Patten register number */ #define TPDM_CMB_MAX_PATT 2 @@ -112,11 +116,13 @@ * PERIPHIDR0[0] : Fix to 1 if ImplDef subunit present, else 0 * PERIPHIDR0[1] : Fix to 1 if DSB subunit present, else 0 * PERIPHIDR0[2] : Fix to 1 if CMB subunit present, else 0 + * PERIPHIDR0[6] : Fix to 1 if MCMB subunit present, else 0 */ #define TPDM_PIDR0_DS_IMPDEF BIT(0) #define TPDM_PIDR0_DS_DSB BIT(1) #define TPDM_PIDR0_DS_CMB BIT(2) +#define TPDM_PIDR0_DS_MCMB BIT(6) #define TPDM_DSB_MAX_LINES 256 /* MAX number of EDCR registers */ @@ -245,6 +251,16 @@ struct dsb_dataset { bool trig_type; }; +/** + * struct mcmb_dataset + * @mcmb_trig_lane: Save data for trigger lane + * @mcmb_lane_select: Save data for lane enablement + */ +struct mcmb_dataset { + u8 mcmb_trig_lane; + u8 mcmb_lane_select; +}; + /** * struct cmb_dataset * @trace_mode: Dataset collection mode @@ -267,6 +283,7 @@ struct cmb_dataset { bool patt_ts; bool trig_ts; bool ts_all; + struct mcmb_dataset *mcmb; }; /** @@ -334,4 +351,9 @@ static bool tpdm_has_cmb_dataset(struct tpdm_drvdata *drvdata) { return (drvdata->datasets & TPDM_PIDR0_DS_CMB); } + +static bool tpdm_has_mcmb_dataset(struct tpdm_drvdata *drvdata) +{ + return (drvdata->datasets & TPDM_PIDR0_DS_MCMB); +} #endif /* _CORESIGHT_CORESIGHT_TPDM_H */