Message ID | 1682586037-25973-8-git-send-email-quic_taozha@quicinc.com |
---|---|
State | New |
Headers |
Return-Path: <linux-kernel-owner@vger.kernel.org> Delivered-To: ouuuleilei@gmail.com Received: by 2002:a59:b0ea:0:b0:3b6:4342:cba0 with SMTP id b10csp134922vqo; Thu, 27 Apr 2023 02:12:11 -0700 (PDT) X-Google-Smtp-Source: ACHHUZ4uCbdhoOY20hWDNdIjgRtTtCPHjwtEq5iEvc3huxpJRjoBuEwBhOBKTUcU5ndvnUupufKd X-Received: by 2002:a05:6a00:179c:b0:63a:fb40:891a with SMTP id s28-20020a056a00179c00b0063afb40891amr1610460pfg.2.1682586730629; Thu, 27 Apr 2023 02:12:10 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1682586730; cv=none; d=google.com; s=arc-20160816; b=gbNDMiQElkXJ9Bf3ZPYm1ajuYZL7WR0j8pFsORBa4AL5mOSzcsQQRBs+/Wobqlf0ag RFZica667gW9Bv04Gjsmc0WamcK4d/UMtRmOZpGD6Hib57tskr8imtXoFcOgoOU+zR/l qJnantbOWVOaUJNw57ewJS59myNHvWGrvPVyP4w5fzO9siOLyEV4ZgmPLNtwkhR8aHt8 QENlgrJ0g574sXwF71fSC9+pXMbrREOWoyH5De71HTncW/33YYDXLuB5Bo5RvJC5frpu t+IGjQtWVZNy7u+t9HUq1kNTei5WYmLlK8srws8S3/dyQFjFQuZC2B51F9B8bogxEv+h fT9g== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:mime-version:references:in-reply-to:message-id :date:subject:cc:to:from:dkim-signature; bh=0ZsHHOKnuD9AjAdbRdKQweBmK02l6JcS/F5+BYBNwKo=; b=Z7F4Qw7b0XQOD27UMlxBkSuncFdI7fF8KynWcSv+KlhJoBY12X0vcM9MW9gJEMKdAM cBqCKYWW98cSYBgA+QDMS3vuHAZ9fKvT3Bv53Nnz+lYKPeyf7kHkT1gYUEFNcy5CLnMp 1ggzxnewFWU/Gr8hhwGLDYGFtUV8NGn93m9l4JcpUF40GEq4WCmPj4a29JoHioDEZgFF JV9J8MBNVj2xwrJOV3yiNPKTGHQNBg+JHEm4bonTvhd63vyyMSyi4XSldoszbYgmf9xr iSzSc9rLR7dMb98NV9j/92AwVYJu7cnL7buWnf8Plz9HI6eF3QcSEW45ztQcQIhTgas9 suhg== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@quicinc.com header.s=qcppdkim1 header.b=fuuN72Jz; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=quicinc.com Received: from out1.vger.email (out1.vger.email. [2620:137:e000::1:20]) by mx.google.com with ESMTP id 79-20020a621952000000b0063d6708d1c9si18165036pfz.105.2023.04.27.02.11.55; Thu, 27 Apr 2023 02:12:10 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20; Authentication-Results: mx.google.com; dkim=pass header.i=@quicinc.com header.s=qcppdkim1 header.b=fuuN72Jz; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=quicinc.com Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S243325AbjD0JC3 (ORCPT <rfc822;zxc52fgh@gmail.com> + 99 others); Thu, 27 Apr 2023 05:02:29 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:60128 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S243274AbjD0JCH (ORCPT <rfc822;linux-kernel@vger.kernel.org>); Thu, 27 Apr 2023 05:02:07 -0400 Received: from mx0a-0031df01.pphosted.com (mx0a-0031df01.pphosted.com [205.220.168.131]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id CB2D64EF6; Thu, 27 Apr 2023 02:01:50 -0700 (PDT) Received: from pps.filterd (m0279867.ppops.net [127.0.0.1]) by mx0a-0031df01.pphosted.com (8.17.1.19/8.17.1.19) with ESMTP id 33R82Q9Y014563; Thu, 27 Apr 2023 09:01:33 GMT DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=quicinc.com; h=from : to : cc : subject : date : message-id : in-reply-to : references : mime-version : content-type; s=qcppdkim1; bh=0ZsHHOKnuD9AjAdbRdKQweBmK02l6JcS/F5+BYBNwKo=; b=fuuN72Jz7pNLi9wkxu7uKTJEuCm1ix2Rb8f67QhqeJFKyYzp6Gcai3XJ71TgitCNXPMl GsH0iv6ujP7/Cs8gFh/jTCGI9EOtF8E++TDAv/WRQqfzS0N0MbKaDyK6tMqrOCK3g6Qz mBal1qiNTM3IKrw7uaRHLbbXue+o48YwndkXvO5iiXA0n5Pup78aZ05eHOXDyC5rOtK1 ZH4OauveZn2dCF8aCvlbTlEMeuHhtolFfdzR/0gEUkeULNrLFcoLy/eWQdjbLcV3SY3z PmwJd9gi94ghq950zt595/863O0TUsdfKxUmv5VsmAq9yuTrMwuR7xYoI7Rt13/yki7U hw== Received: from nalasppmta01.qualcomm.com (Global_NAT1.qualcomm.com [129.46.96.20]) by mx0a-0031df01.pphosted.com (PPS) with ESMTPS id 3q7dh2h1uk-1 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-GCM-SHA384 bits=256 verify=NOT); Thu, 27 Apr 2023 09:01:33 +0000 Received: from nalasex01c.na.qualcomm.com (nalasex01c.na.qualcomm.com [10.47.97.35]) by NALASPPMTA01.qualcomm.com (8.17.1.5/8.17.1.5) with ESMTPS id 33R91Wlt013582 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-GCM-SHA384 bits=256 verify=NOT); Thu, 27 Apr 2023 09:01:32 GMT Received: from taozha-gv.qualcomm.com (10.80.80.8) by nalasex01c.na.qualcomm.com (10.47.97.35) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.2.986.42; Thu, 27 Apr 2023 02:01:27 -0700 From: Tao Zhang <quic_taozha@quicinc.com> To: Mathieu Poirier <mathieu.poirier@linaro.org>, Suzuki K Poulose <suzuki.poulose@arm.com>, Alexander Shishkin <alexander.shishkin@linux.intel.com>, Konrad Dybcio <konradybcio@gmail.com>, Mike Leach <mike.leach@linaro.org>, Rob Herring <robh+dt@kernel.org>, Krzysztof Kozlowski <krzysztof.kozlowski+dt@linaro.org> CC: Tao Zhang <quic_taozha@quicinc.com>, Jinlong Mao <quic_jinlmao@quicinc.com>, Leo Yan <leo.yan@linaro.org>, Greg Kroah-Hartman <gregkh@linuxfoundation.org>, <coresight@lists.linaro.org>, <linux-arm-kernel@lists.infradead.org>, <linux-kernel@vger.kernel.org>, <devicetree@vger.kernel.org>, Tingwei Zhang <quic_tingweiz@quicinc.com>, Yuanfang Zhang <quic_yuanfang@quicinc.com>, Trilok Soni <quic_tsoni@quicinc.com>, Hao Zhang <quic_hazha@quicinc.com>, <linux-arm-msm@vger.kernel.org>, <andersson@kernel.org> Subject: [PATCH v4 07/11] coresight-tpdm: Add nodes for dsb edge control Date: Thu, 27 Apr 2023 17:00:33 +0800 Message-ID: <1682586037-25973-8-git-send-email-quic_taozha@quicinc.com> X-Mailer: git-send-email 2.7.4 In-Reply-To: <1682586037-25973-1-git-send-email-quic_taozha@quicinc.com> References: <1682586037-25973-1-git-send-email-quic_taozha@quicinc.com> MIME-Version: 1.0 Content-Type: text/plain X-Originating-IP: [10.80.80.8] X-ClientProxiedBy: nasanex01b.na.qualcomm.com (10.46.141.250) To nalasex01c.na.qualcomm.com (10.47.97.35) X-QCInternal: smtphost X-Proofpoint-Virus-Version: vendor=nai engine=6200 definitions=5800 signatures=585085 X-Proofpoint-ORIG-GUID: CWn79pK6wlLkg2PJ-p3vbEJn7PhJvJ1n X-Proofpoint-GUID: CWn79pK6wlLkg2PJ-p3vbEJn7PhJvJ1n X-Proofpoint-Virus-Version: vendor=baseguard engine=ICAP:2.0.254,Aquarius:18.0.942,Hydra:6.0.573,FMLib:17.11.170.22 definitions=2023-04-27_06,2023-04-26_03,2023-02-09_01 X-Proofpoint-Spam-Details: rule=outbound_notspam policy=outbound score=0 clxscore=1015 malwarescore=0 spamscore=0 adultscore=0 priorityscore=1501 phishscore=0 bulkscore=0 mlxlogscore=999 mlxscore=0 lowpriorityscore=0 impostorscore=0 suspectscore=0 classifier=spam adjust=0 reason=mlx scancount=1 engine=8.12.0-2303200000 definitions=main-2304270078 X-Spam-Status: No, score=-2.8 required=5.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,DKIM_VALID_EF,RCVD_IN_DNSWL_LOW,SPF_HELO_NONE, SPF_PASS,T_SCC_BODY_TEXT_LINE autolearn=ham autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on lindbergh.monkeyblade.net Precedence: bulk List-ID: <linux-kernel.vger.kernel.org> X-Mailing-List: linux-kernel@vger.kernel.org X-getmail-retrieved-from-mailbox: =?utf-8?q?INBOX?= X-GMAIL-THRID: =?utf-8?q?1764320063688865396?= X-GMAIL-MSGID: =?utf-8?q?1764320063688865396?= |
Series |
Add support to configure TPDM DSB subunit
|
|
Commit Message
Tao Zhang
April 27, 2023, 9 a.m. UTC
Add the nodes to set value for DSB edge control and DSB edge
control mask. Each DSB subunit TPDM has maximum of n(n<16) EDCR
resgisters to configure edge control. DSB edge detection control
00: Rising edge detection
01: Falling edge detection
10: Rising and falling edge detection (toggle detection)
And each DSB subunit TPDM has maximum of m(m<8) ECDMR registers to
configure mask. Eight 32 bit registers providing DSB interface
edge detection mask control.
Signed-off-by: Tao Zhang <quic_taozha@quicinc.com>
---
.../ABI/testing/sysfs-bus-coresight-devices-tpdm | 32 +++++
drivers/hwtracing/coresight/coresight-tpdm.c | 135 ++++++++++++++++++++-
drivers/hwtracing/coresight/coresight-tpdm.h | 21 ++++
3 files changed, 187 insertions(+), 1 deletion(-)
Comments
On 27/04/2023 10:00, Tao Zhang wrote: > Add the nodes to set value for DSB edge control and DSB edge > control mask. Each DSB subunit TPDM has maximum of n(n<16) EDCR > resgisters to configure edge control. DSB edge detection control > 00: Rising edge detection > 01: Falling edge detection > 10: Rising and falling edge detection (toggle detection) > And each DSB subunit TPDM has maximum of m(m<8) ECDMR registers to > configure mask. Eight 32 bit registers providing DSB interface > edge detection mask control. > > Signed-off-by: Tao Zhang <quic_taozha@quicinc.com> > --- > .../ABI/testing/sysfs-bus-coresight-devices-tpdm | 32 +++++ > drivers/hwtracing/coresight/coresight-tpdm.c | 135 ++++++++++++++++++++- > drivers/hwtracing/coresight/coresight-tpdm.h | 21 ++++ > 3 files changed, 187 insertions(+), 1 deletion(-) > > diff --git a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm > index 348e167..a57f000 100644 > --- a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm > +++ b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm > @@ -60,3 +60,35 @@ Description: > Bit[3] : Set to 0 for low performance mode. > Set to 1 for high performance mode. > Bit[4:8] : Select byte lane for high performance mode. > + > +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl > +Date: March 2023 > +KernelVersion 6.3 > +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao Zhang (QUIC) <quic_taozha@quicinc.com> > +Description: > + Read/Write a set of the edge control registers of the DSB > + in TPDM. > + > + Expected format is the following: > + <integer1> <integer2> <integer3> > + > + Where: > + <integer1> : Start EDCR register number > + <integer2> : End EDCR register number > + <integer3> : The value need to be written > + > +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl_mask > +Date: March 2023 > +KernelVersion 6.3 > +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao Zhang (QUIC) <quic_taozha@quicinc.com> > +Description: > + Read/Write a set of the edge control mask registers of the > + DSB in TPDM. > + > + Expected format is the following: > + <integer1> <integer2> <integer3> > + > + Where: > + <integer1> : Start EDCMR register number > + <integer2> : End EDCMR register number > + <integer3> : The value need to be written > diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c b/drivers/hwtracing/coresight/coresight-tpdm.c > index 1bacaa5..a40e458 100644 > --- a/drivers/hwtracing/coresight/coresight-tpdm.c > +++ b/drivers/hwtracing/coresight/coresight-tpdm.c > @@ -80,7 +80,14 @@ static void set_trigger_type(struct tpdm_drvdata *drvdata, u32 *val) > > static void tpdm_enable_dsb(struct tpdm_drvdata *drvdata) > { > - u32 val; > + u32 val, i; > + > + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) > + writel_relaxed(drvdata->dsb->edge_ctrl[i], > + drvdata->base + TPDM_DSB_EDCR(i)); > + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) > + writel_relaxed(drvdata->dsb->edge_ctrl_mask[i], > + drvdata->base + TPDM_DSB_EDCMR(i)); Do all TPDM DSBs have MAX_EDCR registers ? Or some have less than that ? If it is latter, do we need special care to avoid writing to inexistent registers ? > > val = readl_relaxed(drvdata->base + TPDM_DSB_TIER); > /* Set trigger timestamp */ > @@ -313,6 +320,130 @@ static ssize_t dsb_mode_store(struct device *dev, > } > static DEVICE_ATTR_RW(dsb_mode); > > +static ssize_t dsb_edge_ctrl_show(struct device *dev, > + struct device_attribute *attr, > + char *buf) > +{ > + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); > + ssize_t size = 0; > + int i; > + > + spin_lock(&drvdata->spinlock); > + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) { > + size += sysfs_emit_at(buf, size, > + "Index:0x%x Val:0x%x\n", i, > + drvdata->dsb->edge_ctrl[i]); It may be safe, but please add a check to make sure that we don't overflow. At least bail out when we hit a return of 0, indicating reached the end of buffer. > + } > + spin_unlock(&drvdata->spinlock); > + return size; > +} > + > +/* > + * value 1: Start EDCR register number > + * value 2: End EDCR register number > + * value 3: The value need to be written > + * The EDCR registers can include up to 16 32-bit registers, and each > + * one can be configured to control up to 16 edge detections(2 bits > + * control one edge detection). So a total 256 edge detections can be > + * configured. So the starting number(value 1) and ending number(value 2) > + * cannot be greater than 256, and value 1 should be less than value 2. > + * The following values are the rage of value 3. > + * 0 - Rising edge detection > + * 1 - Falling edge detection > + * 2 - Rising and falling edge detection (toggle detection) > + */ > +static ssize_t dsb_edge_ctrl_store(struct device *dev, > + struct device_attribute *attr, > + const char *buf, > + size_t size) > +{ > + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); > + unsigned long val, mask, start, end, edge_ctrl, edge_ctrl_shift; > + int i, reg; > + > + if (sscanf(buf, "%lx %lx %lx", &start, &end, &edge_ctrl) != 3) > + return -EINVAL; > + if ((start >= TPDM_DSB_MAX_LINES) || (end >= TPDM_DSB_MAX_LINES) || > + (start > end) || (edge_ctrl > 0x2)) > + return -EPERM; > + > + spin_lock(&drvdata->spinlock); > + for (i = start; i <= end; i++) { > + /* > + * There are 2 bit per DSB Edge Control line. > + * Thus we have 16 lines in a 32bit word. > + */ > + reg = EDCR_TO_WORD_IDX(i); > + mask = EDCR_TO_WORD_MASK(i); > + val = drvdata->dsb->edge_ctrl[reg]; > + edge_ctrl_shift = EDCR_TO_WORD_VAL(edge_ctrl, i); > + bitmap_replace(&val, &val, &edge_ctrl_shift, &mask, 32); Could we simply do : reg &= ~mask; reg |= FIELD_PREP(mask, edge_ctrl); > + drvdata->dsb->edge_ctrl[reg] = val; > + } > + spin_unlock(&drvdata->spinlock); > + > + return size; > +} > +static DEVICE_ATTR_RW(dsb_edge_ctrl); > + > +static ssize_t dsb_edge_ctrl_mask_show(struct device *dev, > + struct device_attribute *attr, > + char *buf) > +{ > + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); > + ssize_t size = 0; > + int i; > + > + spin_lock(&drvdata->spinlock); > + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) { > + size += sysfs_emit_at(buf, size, > + "Index:0x%x Val:0x%x\n", i, > + drvdata->dsb->edge_ctrl_mask[i]); > + } > + spin_unlock(&drvdata->spinlock); > + return size; > +} > + > +/* > + * value 1: Start EDCMR register number > + * value 2: End EDCMR register number > + * value 3: The value need to be written > + */ > +static ssize_t dsb_edge_ctrl_mask_store(struct device *dev, > + struct device_attribute *attr, > + const char *buf, > + size_t size) > +{ > + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); > + unsigned long start, end, val; > + u32 set; > + int i, reg; > + > + if (sscanf(buf, "%lx %lx %lx", &start, &end, &val) != 3) > + return -EINVAL; > + if ((start >= TPDM_DSB_MAX_LINES) || (end >= TPDM_DSB_MAX_LINES) > + || (start > end) || (val & ~1UL)) > + return -EPERM; > + > + spin_lock(&drvdata->spinlock); > + for (i = start; i <= end; i++) { > + /* > + * There is 1 bit per DSB Edge Control Mark line. > + * Thus we have 32 lines in a 32bit word. > + */ > + reg = EDCMR_TO_WORD_IDX(i); > + set = drvdata->dsb->edge_ctrl_mask[reg]; > + if (val) > + set |= BIT(EDCR_TO_WORD_SHIFT(i)); > + else > + set &= ~BIT(EDCR_TO_WORD_SHIFT(i)); > + drvdata->dsb->edge_ctrl_mask[reg] = set; > + } > + spin_unlock(&drvdata->spinlock); > + return size; > +} > +static DEVICE_ATTR_RW(dsb_edge_ctrl_mask); > + > static ssize_t dsb_trig_type_show(struct device *dev, > struct device_attribute *attr, char *buf) > { > @@ -385,6 +516,8 @@ static DEVICE_ATTR_RW(dsb_trig_ts); > > static struct attribute *tpdm_dsb_attrs[] = { > &dev_attr_dsb_mode.attr, > + &dev_attr_dsb_edge_ctrl.attr, > + &dev_attr_dsb_edge_ctrl_mask.attr, > &dev_attr_dsb_trig_ts.attr, > &dev_attr_dsb_trig_type.attr, > NULL, > diff --git a/drivers/hwtracing/coresight/coresight-tpdm.h b/drivers/hwtracing/coresight/coresight-tpdm.h > index 79df07e..f25dcdec 100644 > --- a/drivers/hwtracing/coresight/coresight-tpdm.h > +++ b/drivers/hwtracing/coresight/coresight-tpdm.h > @@ -12,6 +12,8 @@ > /* DSB Subunit Registers */ > #define TPDM_DSB_CR (0x780) > #define TPDM_DSB_TIER (0x784) > +#define TPDM_DSB_EDCR(n) (0x808 + (n * 4)) > +#define TPDM_DSB_EDCMR(n) (0x848 + (n * 4)) > > /* Enable bit for DSB subunit */ > #define TPDM_DSB_CR_ENA BIT(0) > @@ -34,6 +36,15 @@ > #define TPDM_DSB_TEST_MODE GENMASK(10, 9) > #define TPDM_DSB_HPSEL GENMASK(6, 2) > > +#define EDCRS_PER_WORD 16 > +#define EDCR_TO_WORD_IDX(r) ((r) / EDCRS_PER_WORD) > +#define EDCR_TO_WORD_SHIFT(r) ((r % EDCRS_PER_WORD) * 2) > +#define EDCR_TO_WORD_VAL(val, r) (val << EDCR_TO_WORD_SHIFT(r)) > +#define EDCR_TO_WORD_MASK(r) EDCR_TO_WORD_VAL(0x3, r) minor nit: add a new line here please > +#define EDCMRS_PER_WORD 32 > +#define EDCMR_TO_WORD_IDX(r) ((r) / EDCMRS_PER_WORD) > +#define EDCMR_TO_WORD_SHIFT(r) ((r) % EDCMRS_PER_WORD) > + > /* TPDM integration test registers */ > #define TPDM_ITATBCNTRL (0xEF0) > #define TPDM_ITCNTRL (0xF00) > @@ -60,14 +71,24 @@ > #define TPDM_PIDR0_DS_IMPDEF BIT(0) > #define TPDM_PIDR0_DS_DSB BIT(1) > > +#define TPDM_DSB_MAX_LINES 256 > +/* MAX number of EDCR registers */ > +#define TPDM_DSB_MAX_EDCR 16 > +/* MAX number of EDCMR registers */ > +#define TPDM_DSB_MAX_EDCMR 8 > + > /** > * struct dsb_dataset - specifics associated to dsb dataset > * @mode: DSB programming mode > + * @edge_ctrl: Save value for edge control > + * @edge_ctrl_mask: Save value for edge control mask > * @trig_ts: Enable/Disable trigger timestamp. > * @trig_type: Enable/Disable trigger type. > */ > struct dsb_dataset { > u32 mode; > + u32 edge_ctrl[TPDM_DSB_MAX_EDCR]; > + u32 edge_ctrl_mask[TPDM_DSB_MAX_EDCMR]; minor nit: Please align it with the fields below. > bool trig_ts; > bool trig_type; > }; Suzuki
On 6/1/2023 8:14 PM, Suzuki K Poulose wrote: > On 27/04/2023 10:00, Tao Zhang wrote: >> Add the nodes to set value for DSB edge control and DSB edge >> control mask. Each DSB subunit TPDM has maximum of n(n<16) EDCR >> resgisters to configure edge control. DSB edge detection control >> 00: Rising edge detection >> 01: Falling edge detection >> 10: Rising and falling edge detection (toggle detection) >> And each DSB subunit TPDM has maximum of m(m<8) ECDMR registers to >> configure mask. Eight 32 bit registers providing DSB interface >> edge detection mask control. >> >> Signed-off-by: Tao Zhang <quic_taozha@quicinc.com> >> --- >> .../ABI/testing/sysfs-bus-coresight-devices-tpdm | 32 +++++ >> drivers/hwtracing/coresight/coresight-tpdm.c | 135 >> ++++++++++++++++++++- >> drivers/hwtracing/coresight/coresight-tpdm.h | 21 ++++ >> 3 files changed, 187 insertions(+), 1 deletion(-) >> >> diff --git >> a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >> b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >> index 348e167..a57f000 100644 >> --- a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >> +++ b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >> @@ -60,3 +60,35 @@ Description: >> Bit[3] : Set to 0 for low performance mode. >> Set to 1 for high performance mode. >> Bit[4:8] : Select byte lane for high performance mode. >> + >> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl >> +Date: March 2023 >> +KernelVersion 6.3 >> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao Zhang >> (QUIC) <quic_taozha@quicinc.com> >> +Description: >> + Read/Write a set of the edge control registers of the DSB >> + in TPDM. >> + >> + Expected format is the following: >> + <integer1> <integer2> <integer3> >> + >> + Where: >> + <integer1> : Start EDCR register number >> + <integer2> : End EDCR register number >> + <integer3> : The value need to be written >> + >> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl_mask >> +Date: March 2023 >> +KernelVersion 6.3 >> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao Zhang >> (QUIC) <quic_taozha@quicinc.com> >> +Description: >> + Read/Write a set of the edge control mask registers of the >> + DSB in TPDM. >> + >> + Expected format is the following: >> + <integer1> <integer2> <integer3> >> + >> + Where: >> + <integer1> : Start EDCMR register number >> + <integer2> : End EDCMR register number >> + <integer3> : The value need to be written >> diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c >> b/drivers/hwtracing/coresight/coresight-tpdm.c >> index 1bacaa5..a40e458 100644 >> --- a/drivers/hwtracing/coresight/coresight-tpdm.c >> +++ b/drivers/hwtracing/coresight/coresight-tpdm.c >> @@ -80,7 +80,14 @@ static void set_trigger_type(struct tpdm_drvdata >> *drvdata, u32 *val) >> static void tpdm_enable_dsb(struct tpdm_drvdata *drvdata) >> { >> - u32 val; >> + u32 val, i; >> + >> + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) >> + writel_relaxed(drvdata->dsb->edge_ctrl[i], >> + drvdata->base + TPDM_DSB_EDCR(i)); >> + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) >> + writel_relaxed(drvdata->dsb->edge_ctrl_mask[i], >> + drvdata->base + TPDM_DSB_EDCMR(i)); > > Do all TPDM DSBs have MAX_EDCR registers ? Or some have less than that ? > If it is latter, do we need special care to avoid writing to inexistent > registers ? > You are right, not all DSB TPDMs have MAX_EDCR registers. In our design, the inexistent register addresses are not occupied and safe for accessing. Currently we don't have a good way to know the quantity of EDCR/EDCMR registers for DSB TPDMs. The only way we can think of is to set it in device tree manually. Do you have other suggestion for this? >> val = readl_relaxed(drvdata->base + TPDM_DSB_TIER); >> /* Set trigger timestamp */ >> @@ -313,6 +320,130 @@ static ssize_t dsb_mode_store(struct device *dev, >> } >> static DEVICE_ATTR_RW(dsb_mode); >> +static ssize_t dsb_edge_ctrl_show(struct device *dev, >> + struct device_attribute *attr, >> + char *buf) >> +{ >> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >> + ssize_t size = 0; >> + int i; >> + >> + spin_lock(&drvdata->spinlock); >> + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) { >> + size += sysfs_emit_at(buf, size, >> + "Index:0x%x Val:0x%x\n", i, >> + drvdata->dsb->edge_ctrl[i]); > > It may be safe, but please add a check to make sure that we don't > overflow. At least bail out when we hit a return of 0, indicating > reached the end of buffer. > Can I add the following check to replace the current code?? int ret = 0; for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) { ret = sysfs_emit_at(buf, size, "Index:0x%x Val:0x%x\n", i, drvdata->dsb->edge_ctrl[i]); if (!ret) { dev_warn(drvdata->dev, "The buffer has been overflowed\n"); spin_unlock(&drvdata->spinlock); return size; } else size += ret; } >> + } >> + spin_unlock(&drvdata->spinlock); >> + return size; >> +} >> + >> +/* >> + * value 1: Start EDCR register number >> + * value 2: End EDCR register number >> + * value 3: The value need to be written >> + * The EDCR registers can include up to 16 32-bit registers, and each >> + * one can be configured to control up to 16 edge detections(2 bits >> + * control one edge detection). So a total 256 edge detections can be >> + * configured. So the starting number(value 1) and ending >> number(value 2) >> + * cannot be greater than 256, and value 1 should be less than value 2. >> + * The following values are the rage of value 3. >> + * 0 - Rising edge detection >> + * 1 - Falling edge detection >> + * 2 - Rising and falling edge detection (toggle detection) >> + */ >> +static ssize_t dsb_edge_ctrl_store(struct device *dev, >> + struct device_attribute *attr, >> + const char *buf, >> + size_t size) >> +{ >> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >> + unsigned long val, mask, start, end, edge_ctrl, edge_ctrl_shift; >> + int i, reg; >> + >> + if (sscanf(buf, "%lx %lx %lx", &start, &end, &edge_ctrl) != 3) >> + return -EINVAL; >> + if ((start >= TPDM_DSB_MAX_LINES) || (end >= TPDM_DSB_MAX_LINES) || >> + (start > end) || (edge_ctrl > 0x2)) >> + return -EPERM; >> + >> + spin_lock(&drvdata->spinlock); >> + for (i = start; i <= end; i++) { >> + /* >> + * There are 2 bit per DSB Edge Control line. >> + * Thus we have 16 lines in a 32bit word. >> + */ >> + reg = EDCR_TO_WORD_IDX(i); >> + mask = EDCR_TO_WORD_MASK(i); >> + val = drvdata->dsb->edge_ctrl[reg]; > >> + edge_ctrl_shift = EDCR_TO_WORD_VAL(edge_ctrl, i); >> + bitmap_replace(&val, &val, &edge_ctrl_shift, &mask, 32); > > Could we simply do : > > reg &= ~mask; > reg |= FIELD_PREP(mask, edge_ctrl); > Perhaps "FIELD_PREP" cannot be used here since "mask" must be constant in this macro. But in our code, the variable "mask" is not constant. > >> + drvdata->dsb->edge_ctrl[reg] = val; >> + } >> + spin_unlock(&drvdata->spinlock); >> + >> + return size; >> +} >> +static DEVICE_ATTR_RW(dsb_edge_ctrl); >> + >> +static ssize_t dsb_edge_ctrl_mask_show(struct device *dev, >> + struct device_attribute *attr, >> + char *buf) >> +{ >> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >> + ssize_t size = 0; >> + int i; >> + >> + spin_lock(&drvdata->spinlock); >> + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) { >> + size += sysfs_emit_at(buf, size, >> + "Index:0x%x Val:0x%x\n", i, >> + drvdata->dsb->edge_ctrl_mask[i]); >> + } >> + spin_unlock(&drvdata->spinlock); >> + return size; >> +} >> + >> +/* >> + * value 1: Start EDCMR register number >> + * value 2: End EDCMR register number >> + * value 3: The value need to be written >> + */ >> +static ssize_t dsb_edge_ctrl_mask_store(struct device *dev, >> + struct device_attribute *attr, >> + const char *buf, >> + size_t size) >> +{ >> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >> + unsigned long start, end, val; >> + u32 set; >> + int i, reg; >> + >> + if (sscanf(buf, "%lx %lx %lx", &start, &end, &val) != 3) >> + return -EINVAL; >> + if ((start >= TPDM_DSB_MAX_LINES) || (end >= TPDM_DSB_MAX_LINES) >> + || (start > end) || (val & ~1UL)) >> + return -EPERM; >> + >> + spin_lock(&drvdata->spinlock); >> + for (i = start; i <= end; i++) { >> + /* >> + * There is 1 bit per DSB Edge Control Mark line. >> + * Thus we have 32 lines in a 32bit word. >> + */ >> + reg = EDCMR_TO_WORD_IDX(i); >> + set = drvdata->dsb->edge_ctrl_mask[reg]; >> + if (val) >> + set |= BIT(EDCR_TO_WORD_SHIFT(i)); >> + else >> + set &= ~BIT(EDCR_TO_WORD_SHIFT(i)); >> + drvdata->dsb->edge_ctrl_mask[reg] = set; >> + } >> + spin_unlock(&drvdata->spinlock); >> + return size; >> +} >> +static DEVICE_ATTR_RW(dsb_edge_ctrl_mask); >> + >> static ssize_t dsb_trig_type_show(struct device *dev, >> struct device_attribute *attr, char *buf) >> { >> @@ -385,6 +516,8 @@ static DEVICE_ATTR_RW(dsb_trig_ts); >> static struct attribute *tpdm_dsb_attrs[] = { >> &dev_attr_dsb_mode.attr, >> + &dev_attr_dsb_edge_ctrl.attr, >> + &dev_attr_dsb_edge_ctrl_mask.attr, >> &dev_attr_dsb_trig_ts.attr, >> &dev_attr_dsb_trig_type.attr, >> NULL, >> diff --git a/drivers/hwtracing/coresight/coresight-tpdm.h >> b/drivers/hwtracing/coresight/coresight-tpdm.h >> index 79df07e..f25dcdec 100644 >> --- a/drivers/hwtracing/coresight/coresight-tpdm.h >> +++ b/drivers/hwtracing/coresight/coresight-tpdm.h >> @@ -12,6 +12,8 @@ >> /* DSB Subunit Registers */ >> #define TPDM_DSB_CR (0x780) >> #define TPDM_DSB_TIER (0x784) >> +#define TPDM_DSB_EDCR(n) (0x808 + (n * 4)) >> +#define TPDM_DSB_EDCMR(n) (0x848 + (n * 4)) >> /* Enable bit for DSB subunit */ >> #define TPDM_DSB_CR_ENA BIT(0) >> @@ -34,6 +36,15 @@ >> #define TPDM_DSB_TEST_MODE GENMASK(10, 9) >> #define TPDM_DSB_HPSEL GENMASK(6, 2) >> +#define EDCRS_PER_WORD 16 >> +#define EDCR_TO_WORD_IDX(r) ((r) / EDCRS_PER_WORD) >> +#define EDCR_TO_WORD_SHIFT(r) ((r % EDCRS_PER_WORD) * 2) >> +#define EDCR_TO_WORD_VAL(val, r) (val << EDCR_TO_WORD_SHIFT(r)) >> +#define EDCR_TO_WORD_MASK(r) EDCR_TO_WORD_VAL(0x3, r) > > minor nit: add a new line here please Sure, I will update this in the next patch series. > >> +#define EDCMRS_PER_WORD 32 >> +#define EDCMR_TO_WORD_IDX(r) ((r) / EDCMRS_PER_WORD) >> +#define EDCMR_TO_WORD_SHIFT(r) ((r) % EDCMRS_PER_WORD) >> + >> /* TPDM integration test registers */ >> #define TPDM_ITATBCNTRL (0xEF0) >> #define TPDM_ITCNTRL (0xF00) >> @@ -60,14 +71,24 @@ >> #define TPDM_PIDR0_DS_IMPDEF BIT(0) >> #define TPDM_PIDR0_DS_DSB BIT(1) >> +#define TPDM_DSB_MAX_LINES 256 >> +/* MAX number of EDCR registers */ >> +#define TPDM_DSB_MAX_EDCR 16 >> +/* MAX number of EDCMR registers */ >> +#define TPDM_DSB_MAX_EDCMR 8 >> + >> /** >> * struct dsb_dataset - specifics associated to dsb dataset >> * @mode: DSB programming mode >> + * @edge_ctrl: Save value for edge control >> + * @edge_ctrl_mask: Save value for edge control mask >> * @trig_ts: Enable/Disable trigger timestamp. >> * @trig_type: Enable/Disable trigger type. >> */ >> struct dsb_dataset { >> u32 mode; >> + u32 edge_ctrl[TPDM_DSB_MAX_EDCR]; >> + u32 edge_ctrl_mask[TPDM_DSB_MAX_EDCMR]; > > minor nit: Please align it with the fields below. Sure, I will update this in the next patch series. Best, Tao > >> bool trig_ts; >> bool trig_type; >> }; > > Suzuki
On 02/06/2023 09:21, Tao Zhang wrote: > > On 6/1/2023 8:14 PM, Suzuki K Poulose wrote: >> On 27/04/2023 10:00, Tao Zhang wrote: >>> Add the nodes to set value for DSB edge control and DSB edge >>> control mask. Each DSB subunit TPDM has maximum of n(n<16) EDCR >>> resgisters to configure edge control. DSB edge detection control >>> 00: Rising edge detection >>> 01: Falling edge detection >>> 10: Rising and falling edge detection (toggle detection) >>> And each DSB subunit TPDM has maximum of m(m<8) ECDMR registers to >>> configure mask. Eight 32 bit registers providing DSB interface >>> edge detection mask control. >>> >>> Signed-off-by: Tao Zhang <quic_taozha@quicinc.com> >>> --- >>> .../ABI/testing/sysfs-bus-coresight-devices-tpdm | 32 +++++ >>> drivers/hwtracing/coresight/coresight-tpdm.c | 135 >>> ++++++++++++++++++++- >>> drivers/hwtracing/coresight/coresight-tpdm.h | 21 ++++ >>> 3 files changed, 187 insertions(+), 1 deletion(-) >>> >>> diff --git >>> a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>> b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>> index 348e167..a57f000 100644 >>> --- a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>> +++ b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>> @@ -60,3 +60,35 @@ Description: >>> Bit[3] : Set to 0 for low performance mode. >>> Set to 1 for high performance mode. >>> Bit[4:8] : Select byte lane for high performance mode. >>> + >>> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl >>> +Date: March 2023 >>> +KernelVersion 6.3 >>> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao Zhang >>> (QUIC) <quic_taozha@quicinc.com> >>> +Description: >>> + Read/Write a set of the edge control registers of the DSB >>> + in TPDM. >>> + >>> + Expected format is the following: >>> + <integer1> <integer2> <integer3> >>> + >>> + Where: >>> + <integer1> : Start EDCR register number >>> + <integer2> : End EDCR register number >>> + <integer3> : The value need to be written >>> + >>> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl_mask >>> +Date: March 2023 >>> +KernelVersion 6.3 >>> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao Zhang >>> (QUIC) <quic_taozha@quicinc.com> >>> +Description: >>> + Read/Write a set of the edge control mask registers of the >>> + DSB in TPDM. >>> + >>> + Expected format is the following: >>> + <integer1> <integer2> <integer3> >>> + >>> + Where: >>> + <integer1> : Start EDCMR register number >>> + <integer2> : End EDCMR register number >>> + <integer3> : The value need to be written >>> diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c >>> b/drivers/hwtracing/coresight/coresight-tpdm.c >>> index 1bacaa5..a40e458 100644 >>> --- a/drivers/hwtracing/coresight/coresight-tpdm.c >>> +++ b/drivers/hwtracing/coresight/coresight-tpdm.c >>> @@ -80,7 +80,14 @@ static void set_trigger_type(struct tpdm_drvdata >>> *drvdata, u32 *val) >>> static void tpdm_enable_dsb(struct tpdm_drvdata *drvdata) >>> { >>> - u32 val; >>> + u32 val, i; >>> + >>> + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) >>> + writel_relaxed(drvdata->dsb->edge_ctrl[i], >>> + drvdata->base + TPDM_DSB_EDCR(i)); >>> + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) >>> + writel_relaxed(drvdata->dsb->edge_ctrl_mask[i], >>> + drvdata->base + TPDM_DSB_EDCMR(i)); >> >> Do all TPDM DSBs have MAX_EDCR registers ? Or some have less than that ? >> If it is latter, do we need special care to avoid writing to inexistent >> registers ? >> > You are right, not all DSB TPDMs have MAX_EDCR registers. In our design, > the inexistent register addresses > > are not occupied and safe for accessing. > > Currently we don't have a good way to know the quantity of EDCR/EDCMR > registers for DSB TPDMs. > > The only way we can think of is to set it in device tree manually. > > Do you have other suggestion for this? > >>> val = readl_relaxed(drvdata->base + TPDM_DSB_TIER); >>> /* Set trigger timestamp */ >>> @@ -313,6 +320,130 @@ static ssize_t dsb_mode_store(struct device *dev, >>> } >>> static DEVICE_ATTR_RW(dsb_mode); >>> +static ssize_t dsb_edge_ctrl_show(struct device *dev, >>> + struct device_attribute *attr, >>> + char *buf) >>> +{ >>> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >>> + ssize_t size = 0; >>> + int i; >>> + >>> + spin_lock(&drvdata->spinlock); >>> + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) { >>> + size += sysfs_emit_at(buf, size, >>> + "Index:0x%x Val:0x%x\n", i, >>> + drvdata->dsb->edge_ctrl[i]); >> >> It may be safe, but please add a check to make sure that we don't >> overflow. At least bail out when we hit a return of 0, indicating >> reached the end of buffer. >> > Can I add the following check to replace the current code?? > > int ret = 0; > > > for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) { > > ret = sysfs_emit_at(buf, size, "Index:0x%x Val:0x%x\n", i, > drvdata->dsb->edge_ctrl[i]); > > if (!ret) { > > dev_warn(drvdata->dev, "The buffer has been overflowed\n"); You don't need this, it already triggers a WARN() in sysfs_emit_at(). So you could do: for (....) { unsigned long bytes = sysfs_emit_at(buf, size, ....); if (bytes <= 0) break; size += bytes; } > > spin_unlock(&drvdata->spinlock); > > return size; > > } else > > size += ret; > > } > >>> + } >>> + spin_unlock(&drvdata->spinlock); >>> + return size; >>> +} >>> + >>> +/* >>> + * value 1: Start EDCR register number >>> + * value 2: End EDCR register number >>> + * value 3: The value need to be written >>> + * The EDCR registers can include up to 16 32-bit registers, and each >>> + * one can be configured to control up to 16 edge detections(2 bits >>> + * control one edge detection). So a total 256 edge detections can be >>> + * configured. So the starting number(value 1) and ending >>> number(value 2) >>> + * cannot be greater than 256, and value 1 should be less than value 2. >>> + * The following values are the rage of value 3. >>> + * 0 - Rising edge detection >>> + * 1 - Falling edge detection >>> + * 2 - Rising and falling edge detection (toggle detection) >>> + */ >>> +static ssize_t dsb_edge_ctrl_store(struct device *dev, >>> + struct device_attribute *attr, >>> + const char *buf, >>> + size_t size) >>> +{ >>> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >>> + unsigned long val, mask, start, end, edge_ctrl, edge_ctrl_shift; >>> + int i, reg; >>> + >>> + if (sscanf(buf, "%lx %lx %lx", &start, &end, &edge_ctrl) != 3) >>> + return -EINVAL; >>> + if ((start >= TPDM_DSB_MAX_LINES) || (end >= TPDM_DSB_MAX_LINES) || >>> + (start > end) || (edge_ctrl > 0x2)) >>> + return -EPERM; >>> + >>> + spin_lock(&drvdata->spinlock); >>> + for (i = start; i <= end; i++) { >>> + /* >>> + * There are 2 bit per DSB Edge Control line. >>> + * Thus we have 16 lines in a 32bit word. >>> + */ >>> + reg = EDCR_TO_WORD_IDX(i); >>> + mask = EDCR_TO_WORD_MASK(i); >>> + val = drvdata->dsb->edge_ctrl[reg]; >> >>> + edge_ctrl_shift = EDCR_TO_WORD_VAL(edge_ctrl, i); >>> + bitmap_replace(&val, &val, &edge_ctrl_shift, &mask, 32); >> >> Could we simply do : >> >> reg &= ~mask; >> reg |= FIELD_PREP(mask, edge_ctrl); >> > Perhaps "FIELD_PREP" cannot be used here since "mask" must be constant > in this macro. Ah, you are right. Sorry about that. > > But in our code, the variable "mask" is not constant. Still I think using the bitmap_replace is an overkill. We could simply do: val &= ~mask; val |= EDCR_TO_WORD_VAL(edge_ctrl, i); Suzuki >> >>> + drvdata->dsb->edge_ctrl[reg] = val; >>> + } >>> + spin_unlock(&drvdata->spinlock); >>> + >>> + return size; >>> +} >>> +static DEVICE_ATTR_RW(dsb_edge_ctrl); >>> + >>> +static ssize_t dsb_edge_ctrl_mask_show(struct device *dev, >>> + struct device_attribute *attr, >>> + char *buf) >>> +{ >>> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >>> + ssize_t size = 0; >>> + int i; >>> + >>> + spin_lock(&drvdata->spinlock); >>> + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) { >>> + size += sysfs_emit_at(buf, size, >>> + "Index:0x%x Val:0x%x\n", i, >>> + drvdata->dsb->edge_ctrl_mask[i]); >>> + } >>> + spin_unlock(&drvdata->spinlock); >>> + return size; >>> +} >>> + >>> +/* >>> + * value 1: Start EDCMR register number >>> + * value 2: End EDCMR register number >>> + * value 3: The value need to be written >>> + */ >>> +static ssize_t dsb_edge_ctrl_mask_store(struct device *dev, >>> + struct device_attribute *attr, >>> + const char *buf, >>> + size_t size) >>> +{ >>> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >>> + unsigned long start, end, val; >>> + u32 set; >>> + int i, reg; >>> + >>> + if (sscanf(buf, "%lx %lx %lx", &start, &end, &val) != 3) >>> + return -EINVAL; >>> + if ((start >= TPDM_DSB_MAX_LINES) || (end >= TPDM_DSB_MAX_LINES) >>> + || (start > end) || (val & ~1UL)) >>> + return -EPERM; >>> + >>> + spin_lock(&drvdata->spinlock); >>> + for (i = start; i <= end; i++) { >>> + /* >>> + * There is 1 bit per DSB Edge Control Mark line. >>> + * Thus we have 32 lines in a 32bit word. >>> + */ >>> + reg = EDCMR_TO_WORD_IDX(i); >>> + set = drvdata->dsb->edge_ctrl_mask[reg]; >>> + if (val) >>> + set |= BIT(EDCR_TO_WORD_SHIFT(i)); >>> + else >>> + set &= ~BIT(EDCR_TO_WORD_SHIFT(i)); >>> + drvdata->dsb->edge_ctrl_mask[reg] = set; >>> + } >>> + spin_unlock(&drvdata->spinlock); >>> + return size; >>> +} >>> +static DEVICE_ATTR_RW(dsb_edge_ctrl_mask); >>> + >>> static ssize_t dsb_trig_type_show(struct device *dev, >>> struct device_attribute *attr, char *buf) >>> { >>> @@ -385,6 +516,8 @@ static DEVICE_ATTR_RW(dsb_trig_ts); >>> static struct attribute *tpdm_dsb_attrs[] = { >>> &dev_attr_dsb_mode.attr, >>> + &dev_attr_dsb_edge_ctrl.attr, >>> + &dev_attr_dsb_edge_ctrl_mask.attr, >>> &dev_attr_dsb_trig_ts.attr, >>> &dev_attr_dsb_trig_type.attr, >>> NULL, >>> diff --git a/drivers/hwtracing/coresight/coresight-tpdm.h >>> b/drivers/hwtracing/coresight/coresight-tpdm.h >>> index 79df07e..f25dcdec 100644 >>> --- a/drivers/hwtracing/coresight/coresight-tpdm.h >>> +++ b/drivers/hwtracing/coresight/coresight-tpdm.h >>> @@ -12,6 +12,8 @@ >>> /* DSB Subunit Registers */ >>> #define TPDM_DSB_CR (0x780) >>> #define TPDM_DSB_TIER (0x784) >>> +#define TPDM_DSB_EDCR(n) (0x808 + (n * 4)) >>> +#define TPDM_DSB_EDCMR(n) (0x848 + (n * 4)) >>> /* Enable bit for DSB subunit */ >>> #define TPDM_DSB_CR_ENA BIT(0) >>> @@ -34,6 +36,15 @@ >>> #define TPDM_DSB_TEST_MODE GENMASK(10, 9) >>> #define TPDM_DSB_HPSEL GENMASK(6, 2) >>> +#define EDCRS_PER_WORD 16 >>> +#define EDCR_TO_WORD_IDX(r) ((r) / EDCRS_PER_WORD) >>> +#define EDCR_TO_WORD_SHIFT(r) ((r % EDCRS_PER_WORD) * 2) >>> +#define EDCR_TO_WORD_VAL(val, r) (val << EDCR_TO_WORD_SHIFT(r)) >>> +#define EDCR_TO_WORD_MASK(r) EDCR_TO_WORD_VAL(0x3, r) >> >> minor nit: add a new line here please > Sure, I will update this in the next patch series. >> >>> +#define EDCMRS_PER_WORD 32 >>> +#define EDCMR_TO_WORD_IDX(r) ((r) / EDCMRS_PER_WORD) >>> +#define EDCMR_TO_WORD_SHIFT(r) ((r) % EDCMRS_PER_WORD) >>> + >>> /* TPDM integration test registers */ >>> #define TPDM_ITATBCNTRL (0xEF0) >>> #define TPDM_ITCNTRL (0xF00) >>> @@ -60,14 +71,24 @@ >>> #define TPDM_PIDR0_DS_IMPDEF BIT(0) >>> #define TPDM_PIDR0_DS_DSB BIT(1) >>> +#define TPDM_DSB_MAX_LINES 256 >>> +/* MAX number of EDCR registers */ >>> +#define TPDM_DSB_MAX_EDCR 16 >>> +/* MAX number of EDCMR registers */ >>> +#define TPDM_DSB_MAX_EDCMR 8 >>> + >>> /** >>> * struct dsb_dataset - specifics associated to dsb dataset >>> * @mode: DSB programming mode >>> + * @edge_ctrl: Save value for edge control >>> + * @edge_ctrl_mask: Save value for edge control mask >>> * @trig_ts: Enable/Disable trigger timestamp. >>> * @trig_type: Enable/Disable trigger type. >>> */ >>> struct dsb_dataset { >>> u32 mode; >>> + u32 edge_ctrl[TPDM_DSB_MAX_EDCR]; >>> + u32 edge_ctrl_mask[TPDM_DSB_MAX_EDCMR]; >> >> minor nit: Please align it with the fields below. > > Sure, I will update this in the next patch series. > > > Best, > > Tao > >> >>> bool trig_ts; >>> bool trig_type; >>> }; >> >> Suzuki
On 02/06/2023 09:45, Suzuki K Poulose wrote: > On 02/06/2023 09:21, Tao Zhang wrote: >> >> On 6/1/2023 8:14 PM, Suzuki K Poulose wrote: >>> On 27/04/2023 10:00, Tao Zhang wrote: >>>> Add the nodes to set value for DSB edge control and DSB edge >>>> control mask. Each DSB subunit TPDM has maximum of n(n<16) EDCR >>>> resgisters to configure edge control. DSB edge detection control >>>> 00: Rising edge detection >>>> 01: Falling edge detection >>>> 10: Rising and falling edge detection (toggle detection) >>>> And each DSB subunit TPDM has maximum of m(m<8) ECDMR registers to >>>> configure mask. Eight 32 bit registers providing DSB interface >>>> edge detection mask control. >>>> >>>> Signed-off-by: Tao Zhang <quic_taozha@quicinc.com> >>>> --- >>>> .../ABI/testing/sysfs-bus-coresight-devices-tpdm | 32 +++++ >>>> drivers/hwtracing/coresight/coresight-tpdm.c | 135 >>>> ++++++++++++++++++++- >>>> drivers/hwtracing/coresight/coresight-tpdm.h | 21 ++++ >>>> 3 files changed, 187 insertions(+), 1 deletion(-) >>>> >>>> diff --git >>>> a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>> b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>> index 348e167..a57f000 100644 >>>> --- a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>> +++ b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>> @@ -60,3 +60,35 @@ Description: >>>> Bit[3] : Set to 0 for low performance mode. >>>> Set to 1 for high performance mode. >>>> Bit[4:8] : Select byte lane for high performance mode. >>>> + >>>> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl >>>> +Date: March 2023 >>>> +KernelVersion 6.3 >>>> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao >>>> Zhang (QUIC) <quic_taozha@quicinc.com> >>>> +Description: >>>> + Read/Write a set of the edge control registers of the DSB >>>> + in TPDM. >>>> + >>>> + Expected format is the following: >>>> + <integer1> <integer2> <integer3> >>>> + >>>> + Where: >>>> + <integer1> : Start EDCR register number >>>> + <integer2> : End EDCR register number >>>> + <integer3> : The value need to be written >>>> + >>>> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl_mask >>>> +Date: March 2023 >>>> +KernelVersion 6.3 >>>> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao >>>> Zhang (QUIC) <quic_taozha@quicinc.com> >>>> +Description: >>>> + Read/Write a set of the edge control mask registers of the >>>> + DSB in TPDM. >>>> + >>>> + Expected format is the following: >>>> + <integer1> <integer2> <integer3> >>>> + >>>> + Where: >>>> + <integer1> : Start EDCMR register number >>>> + <integer2> : End EDCMR register number >>>> + <integer3> : The value need to be written >>>> diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c >>>> b/drivers/hwtracing/coresight/coresight-tpdm.c >>>> index 1bacaa5..a40e458 100644 >>>> --- a/drivers/hwtracing/coresight/coresight-tpdm.c >>>> +++ b/drivers/hwtracing/coresight/coresight-tpdm.c >>>> @@ -80,7 +80,14 @@ static void set_trigger_type(struct tpdm_drvdata >>>> *drvdata, u32 *val) >>>> static void tpdm_enable_dsb(struct tpdm_drvdata *drvdata) >>>> { >>>> - u32 val; >>>> + u32 val, i; >>>> + >>>> + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) >>>> + writel_relaxed(drvdata->dsb->edge_ctrl[i], >>>> + drvdata->base + TPDM_DSB_EDCR(i)); >>>> + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) >>>> + writel_relaxed(drvdata->dsb->edge_ctrl_mask[i], >>>> + drvdata->base + TPDM_DSB_EDCMR(i)); >>> >>> Do all TPDM DSBs have MAX_EDCR registers ? Or some have less than that ? >>> If it is latter, do we need special care to avoid writing to inexistent >>> registers ? >>> >> You are right, not all DSB TPDMs have MAX_EDCR registers. In our >> design, the inexistent register addresses >> >> are not occupied and safe for accessing. Does the TRM for the component say so ? Or is it by luck ? If the spec says it is RAZ/WriteIgnore, then we could keep the code as it is, with a comment. Otherwise, we could add a DT property. So please get this clarified with the H/W designers. Suzuki
On 6/2/2023 4:45 PM, Suzuki K Poulose wrote: > On 02/06/2023 09:21, Tao Zhang wrote: >> >> On 6/1/2023 8:14 PM, Suzuki K Poulose wrote: >>> On 27/04/2023 10:00, Tao Zhang wrote: >>>> Add the nodes to set value for DSB edge control and DSB edge >>>> control mask. Each DSB subunit TPDM has maximum of n(n<16) EDCR >>>> resgisters to configure edge control. DSB edge detection control >>>> 00: Rising edge detection >>>> 01: Falling edge detection >>>> 10: Rising and falling edge detection (toggle detection) >>>> And each DSB subunit TPDM has maximum of m(m<8) ECDMR registers to >>>> configure mask. Eight 32 bit registers providing DSB interface >>>> edge detection mask control. >>>> >>>> Signed-off-by: Tao Zhang <quic_taozha@quicinc.com> >>>> --- >>>> .../ABI/testing/sysfs-bus-coresight-devices-tpdm | 32 +++++ >>>> drivers/hwtracing/coresight/coresight-tpdm.c | 135 >>>> ++++++++++++++++++++- >>>> drivers/hwtracing/coresight/coresight-tpdm.h | 21 ++++ >>>> 3 files changed, 187 insertions(+), 1 deletion(-) >>>> >>>> diff --git >>>> a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>> b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>> index 348e167..a57f000 100644 >>>> --- a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>> +++ b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>> @@ -60,3 +60,35 @@ Description: >>>> Bit[3] : Set to 0 for low performance mode. >>>> Set to 1 for high performance mode. >>>> Bit[4:8] : Select byte lane for high performance mode. >>>> + >>>> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl >>>> +Date: March 2023 >>>> +KernelVersion 6.3 >>>> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao >>>> Zhang (QUIC) <quic_taozha@quicinc.com> >>>> +Description: >>>> + Read/Write a set of the edge control registers of the DSB >>>> + in TPDM. >>>> + >>>> + Expected format is the following: >>>> + <integer1> <integer2> <integer3> >>>> + >>>> + Where: >>>> + <integer1> : Start EDCR register number >>>> + <integer2> : End EDCR register number >>>> + <integer3> : The value need to be written >>>> + >>>> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl_mask >>>> +Date: March 2023 >>>> +KernelVersion 6.3 >>>> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao >>>> Zhang (QUIC) <quic_taozha@quicinc.com> >>>> +Description: >>>> + Read/Write a set of the edge control mask registers of the >>>> + DSB in TPDM. >>>> + >>>> + Expected format is the following: >>>> + <integer1> <integer2> <integer3> >>>> + >>>> + Where: >>>> + <integer1> : Start EDCMR register number >>>> + <integer2> : End EDCMR register number >>>> + <integer3> : The value need to be written >>>> diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c >>>> b/drivers/hwtracing/coresight/coresight-tpdm.c >>>> index 1bacaa5..a40e458 100644 >>>> --- a/drivers/hwtracing/coresight/coresight-tpdm.c >>>> +++ b/drivers/hwtracing/coresight/coresight-tpdm.c >>>> @@ -80,7 +80,14 @@ static void set_trigger_type(struct tpdm_drvdata >>>> *drvdata, u32 *val) >>>> static void tpdm_enable_dsb(struct tpdm_drvdata *drvdata) >>>> { >>>> - u32 val; >>>> + u32 val, i; >>>> + >>>> + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) >>>> + writel_relaxed(drvdata->dsb->edge_ctrl[i], >>>> + drvdata->base + TPDM_DSB_EDCR(i)); >>>> + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) >>>> + writel_relaxed(drvdata->dsb->edge_ctrl_mask[i], >>>> + drvdata->base + TPDM_DSB_EDCMR(i)); >>> >>> Do all TPDM DSBs have MAX_EDCR registers ? Or some have less than >>> that ? >>> If it is latter, do we need special care to avoid writing to inexistent >>> registers ? >>> >> You are right, not all DSB TPDMs have MAX_EDCR registers. In our >> design, the inexistent register addresses >> >> are not occupied and safe for accessing. >> >> Currently we don't have a good way to know the quantity of EDCR/EDCMR >> registers for DSB TPDMs. >> >> The only way we can think of is to set it in device tree manually. >> >> Do you have other suggestion for this? >> >>>> val = readl_relaxed(drvdata->base + TPDM_DSB_TIER); >>>> /* Set trigger timestamp */ >>>> @@ -313,6 +320,130 @@ static ssize_t dsb_mode_store(struct device >>>> *dev, >>>> } >>>> static DEVICE_ATTR_RW(dsb_mode); >>>> +static ssize_t dsb_edge_ctrl_show(struct device *dev, >>>> + struct device_attribute *attr, >>>> + char *buf) >>>> +{ >>>> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >>>> + ssize_t size = 0; >>>> + int i; >>>> + >>>> + spin_lock(&drvdata->spinlock); >>>> + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) { >>>> + size += sysfs_emit_at(buf, size, >>>> + "Index:0x%x Val:0x%x\n", i, >>>> + drvdata->dsb->edge_ctrl[i]); >>> >>> It may be safe, but please add a check to make sure that we don't >>> overflow. At least bail out when we hit a return of 0, indicating >>> reached the end of buffer. >>> >> Can I add the following check to replace the current code?? >> >> int ret = 0; >> >> >> for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) { >> >> ret = sysfs_emit_at(buf, size, "Index:0x%x Val:0x%x\n", i, >> drvdata->dsb->edge_ctrl[i]); >> >> if (!ret) { >> >> dev_warn(drvdata->dev, "The buffer has been overflowed\n"); > > You don't need this, it already triggers a WARN() in sysfs_emit_at(). > So you could do: > > for (....) { > unsigned long bytes = sysfs_emit_at(buf, size, ....); > > if (bytes <= 0) > break; > size += bytes; > } > Sure, I will update in the next patch series. > >> >> spin_unlock(&drvdata->spinlock); >> >> return size; >> >> } else >> >> size += ret; >> >> } >> >>>> + } >>>> + spin_unlock(&drvdata->spinlock); >>>> + return size; >>>> +} >>>> + >>>> +/* >>>> + * value 1: Start EDCR register number >>>> + * value 2: End EDCR register number >>>> + * value 3: The value need to be written >>>> + * The EDCR registers can include up to 16 32-bit registers, and each >>>> + * one can be configured to control up to 16 edge detections(2 bits >>>> + * control one edge detection). So a total 256 edge detections can be >>>> + * configured. So the starting number(value 1) and ending >>>> number(value 2) >>>> + * cannot be greater than 256, and value 1 should be less than >>>> value 2. >>>> + * The following values are the rage of value 3. >>>> + * 0 - Rising edge detection >>>> + * 1 - Falling edge detection >>>> + * 2 - Rising and falling edge detection (toggle detection) >>>> + */ >>>> +static ssize_t dsb_edge_ctrl_store(struct device *dev, >>>> + struct device_attribute *attr, >>>> + const char *buf, >>>> + size_t size) >>>> +{ >>>> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >>>> + unsigned long val, mask, start, end, edge_ctrl, edge_ctrl_shift; >>>> + int i, reg; >>>> + >>>> + if (sscanf(buf, "%lx %lx %lx", &start, &end, &edge_ctrl) != 3) >>>> + return -EINVAL; >>>> + if ((start >= TPDM_DSB_MAX_LINES) || (end >= >>>> TPDM_DSB_MAX_LINES) || >>>> + (start > end) || (edge_ctrl > 0x2)) >>>> + return -EPERM; >>>> + >>>> + spin_lock(&drvdata->spinlock); >>>> + for (i = start; i <= end; i++) { >>>> + /* >>>> + * There are 2 bit per DSB Edge Control line. >>>> + * Thus we have 16 lines in a 32bit word. >>>> + */ >>>> + reg = EDCR_TO_WORD_IDX(i); >>>> + mask = EDCR_TO_WORD_MASK(i); >>>> + val = drvdata->dsb->edge_ctrl[reg]; >>> >>>> + edge_ctrl_shift = EDCR_TO_WORD_VAL(edge_ctrl, i); >>>> + bitmap_replace(&val, &val, &edge_ctrl_shift, &mask, 32); >>> >>> Could we simply do : >>> >>> reg &= ~mask; >>> reg |= FIELD_PREP(mask, edge_ctrl); >>> >> Perhaps "FIELD_PREP" cannot be used here since "mask" must be >> constant in this macro. > > Ah, you are right. Sorry about that. > >> >> But in our code, the variable "mask" is not constant. > > Still I think using the bitmap_replace is an overkill. We could simply > do: > val &= ~mask; > val |= EDCR_TO_WORD_VAL(edge_ctrl, i); Sure, I will update in the next patch series. Best, Tao > > Suzuki > >>> >>>> + drvdata->dsb->edge_ctrl[reg] = val; >>>> + } >>>> + spin_unlock(&drvdata->spinlock); >>>> + >>>> + return size; >>>> +} >>>> +static DEVICE_ATTR_RW(dsb_edge_ctrl); >>>> + >>>> +static ssize_t dsb_edge_ctrl_mask_show(struct device *dev, >>>> + struct device_attribute *attr, >>>> + char *buf) >>>> +{ >>>> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >>>> + ssize_t size = 0; >>>> + int i; >>>> + >>>> + spin_lock(&drvdata->spinlock); >>>> + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) { >>>> + size += sysfs_emit_at(buf, size, >>>> + "Index:0x%x Val:0x%x\n", i, >>>> + drvdata->dsb->edge_ctrl_mask[i]); >>>> + } >>>> + spin_unlock(&drvdata->spinlock); >>>> + return size; >>>> +} >>>> + >>>> +/* >>>> + * value 1: Start EDCMR register number >>>> + * value 2: End EDCMR register number >>>> + * value 3: The value need to be written >>>> + */ >>>> +static ssize_t dsb_edge_ctrl_mask_store(struct device *dev, >>>> + struct device_attribute *attr, >>>> + const char *buf, >>>> + size_t size) >>>> +{ >>>> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >>>> + unsigned long start, end, val; >>>> + u32 set; >>>> + int i, reg; >>>> + >>>> + if (sscanf(buf, "%lx %lx %lx", &start, &end, &val) != 3) >>>> + return -EINVAL; >>>> + if ((start >= TPDM_DSB_MAX_LINES) || (end >= TPDM_DSB_MAX_LINES) >>>> + || (start > end) || (val & ~1UL)) >>>> + return -EPERM; >>>> + >>>> + spin_lock(&drvdata->spinlock); >>>> + for (i = start; i <= end; i++) { >>>> + /* >>>> + * There is 1 bit per DSB Edge Control Mark line. >>>> + * Thus we have 32 lines in a 32bit word. >>>> + */ >>>> + reg = EDCMR_TO_WORD_IDX(i); >>>> + set = drvdata->dsb->edge_ctrl_mask[reg]; >>>> + if (val) >>>> + set |= BIT(EDCR_TO_WORD_SHIFT(i)); >>>> + else >>>> + set &= ~BIT(EDCR_TO_WORD_SHIFT(i)); >>>> + drvdata->dsb->edge_ctrl_mask[reg] = set; >>>> + } >>>> + spin_unlock(&drvdata->spinlock); >>>> + return size; >>>> +} >>>> +static DEVICE_ATTR_RW(dsb_edge_ctrl_mask); >>>> + >>>> static ssize_t dsb_trig_type_show(struct device *dev, >>>> struct device_attribute *attr, char *buf) >>>> { >>>> @@ -385,6 +516,8 @@ static DEVICE_ATTR_RW(dsb_trig_ts); >>>> static struct attribute *tpdm_dsb_attrs[] = { >>>> &dev_attr_dsb_mode.attr, >>>> + &dev_attr_dsb_edge_ctrl.attr, >>>> + &dev_attr_dsb_edge_ctrl_mask.attr, >>>> &dev_attr_dsb_trig_ts.attr, >>>> &dev_attr_dsb_trig_type.attr, >>>> NULL, >>>> diff --git a/drivers/hwtracing/coresight/coresight-tpdm.h >>>> b/drivers/hwtracing/coresight/coresight-tpdm.h >>>> index 79df07e..f25dcdec 100644 >>>> --- a/drivers/hwtracing/coresight/coresight-tpdm.h >>>> +++ b/drivers/hwtracing/coresight/coresight-tpdm.h >>>> @@ -12,6 +12,8 @@ >>>> /* DSB Subunit Registers */ >>>> #define TPDM_DSB_CR (0x780) >>>> #define TPDM_DSB_TIER (0x784) >>>> +#define TPDM_DSB_EDCR(n) (0x808 + (n * 4)) >>>> +#define TPDM_DSB_EDCMR(n) (0x848 + (n * 4)) >>>> /* Enable bit for DSB subunit */ >>>> #define TPDM_DSB_CR_ENA BIT(0) >>>> @@ -34,6 +36,15 @@ >>>> #define TPDM_DSB_TEST_MODE GENMASK(10, 9) >>>> #define TPDM_DSB_HPSEL GENMASK(6, 2) >>>> +#define EDCRS_PER_WORD 16 >>>> +#define EDCR_TO_WORD_IDX(r) ((r) / EDCRS_PER_WORD) >>>> +#define EDCR_TO_WORD_SHIFT(r) ((r % EDCRS_PER_WORD) * 2) >>>> +#define EDCR_TO_WORD_VAL(val, r) (val << EDCR_TO_WORD_SHIFT(r)) >>>> +#define EDCR_TO_WORD_MASK(r) EDCR_TO_WORD_VAL(0x3, r) >>> >>> minor nit: add a new line here please >> Sure, I will update this in the next patch series. >>> >>>> +#define EDCMRS_PER_WORD 32 >>>> +#define EDCMR_TO_WORD_IDX(r) ((r) / EDCMRS_PER_WORD) >>>> +#define EDCMR_TO_WORD_SHIFT(r) ((r) % EDCMRS_PER_WORD) >>>> + >>>> /* TPDM integration test registers */ >>>> #define TPDM_ITATBCNTRL (0xEF0) >>>> #define TPDM_ITCNTRL (0xF00) >>>> @@ -60,14 +71,24 @@ >>>> #define TPDM_PIDR0_DS_IMPDEF BIT(0) >>>> #define TPDM_PIDR0_DS_DSB BIT(1) >>>> +#define TPDM_DSB_MAX_LINES 256 >>>> +/* MAX number of EDCR registers */ >>>> +#define TPDM_DSB_MAX_EDCR 16 >>>> +/* MAX number of EDCMR registers */ >>>> +#define TPDM_DSB_MAX_EDCMR 8 >>>> + >>>> /** >>>> * struct dsb_dataset - specifics associated to dsb dataset >>>> * @mode: DSB programming mode >>>> + * @edge_ctrl: Save value for edge control >>>> + * @edge_ctrl_mask: Save value for edge control mask >>>> * @trig_ts: Enable/Disable trigger timestamp. >>>> * @trig_type: Enable/Disable trigger type. >>>> */ >>>> struct dsb_dataset { >>>> u32 mode; >>>> + u32 edge_ctrl[TPDM_DSB_MAX_EDCR]; >>>> + u32 edge_ctrl_mask[TPDM_DSB_MAX_EDCMR]; >>> >>> minor nit: Please align it with the fields below. >> >> Sure, I will update this in the next patch series. >> >> >> Best, >> >> Tao >> >>> >>>> bool trig_ts; >>>> bool trig_type; >>>> }; >>> >>> Suzuki >
On 02/06/2023 15:38, Tao Zhang wrote: > > On 6/2/2023 4:45 PM, Suzuki K Poulose wrote: >> On 02/06/2023 09:21, Tao Zhang wrote: >>> >>> On 6/1/2023 8:14 PM, Suzuki K Poulose wrote: >>>> On 27/04/2023 10:00, Tao Zhang wrote: >>>>> Add the nodes to set value for DSB edge control and DSB edge >>>>> control mask. Each DSB subunit TPDM has maximum of n(n<16) EDCR >>>>> resgisters to configure edge control. DSB edge detection control >>>>> 00: Rising edge detection >>>>> 01: Falling edge detection >>>>> 10: Rising and falling edge detection (toggle detection) >>>>> And each DSB subunit TPDM has maximum of m(m<8) ECDMR registers to >>>>> configure mask. Eight 32 bit registers providing DSB interface >>>>> edge detection mask control. >>>>> >>>>> Signed-off-by: Tao Zhang <quic_taozha@quicinc.com> >>>>> --- >>>>> .../ABI/testing/sysfs-bus-coresight-devices-tpdm | 32 +++++ >>>>> drivers/hwtracing/coresight/coresight-tpdm.c | 135 >>>>> ++++++++++++++++++++- >>>>> drivers/hwtracing/coresight/coresight-tpdm.h | 21 ++++ >>>>> 3 files changed, 187 insertions(+), 1 deletion(-) >>>>> >>>>> diff --git >>>>> a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>>> b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>>> index 348e167..a57f000 100644 >>>>> --- a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>>> +++ b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>>> @@ -60,3 +60,35 @@ Description: >>>>> Bit[3] : Set to 0 for low performance mode. >>>>> Set to 1 for high performance mode. >>>>> Bit[4:8] : Select byte lane for high performance mode. >>>>> + >>>>> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl >>>>> +Date: March 2023 >>>>> +KernelVersion 6.3 >>>>> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao >>>>> Zhang (QUIC) <quic_taozha@quicinc.com> >>>>> +Description: >>>>> + Read/Write a set of the edge control registers of the DSB >>>>> + in TPDM. >>>>> + >>>>> + Expected format is the following: >>>>> + <integer1> <integer2> <integer3> >>>>> + >>>>> + Where: >>>>> + <integer1> : Start EDCR register number >>>>> + <integer2> : End EDCR register number >>>>> + <integer3> : The value need to be written >>>>> + >>>>> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl_mask >>>>> +Date: March 2023 >>>>> +KernelVersion 6.3 >>>>> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao >>>>> Zhang (QUIC) <quic_taozha@quicinc.com> >>>>> +Description: >>>>> + Read/Write a set of the edge control mask registers of the >>>>> + DSB in TPDM. >>>>> + >>>>> + Expected format is the following: >>>>> + <integer1> <integer2> <integer3> >>>>> + >>>>> + Where: >>>>> + <integer1> : Start EDCMR register number >>>>> + <integer2> : End EDCMR register number >>>>> + <integer3> : The value need to be written >>>>> diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c >>>>> b/drivers/hwtracing/coresight/coresight-tpdm.c >>>>> index 1bacaa5..a40e458 100644 >>>>> --- a/drivers/hwtracing/coresight/coresight-tpdm.c >>>>> +++ b/drivers/hwtracing/coresight/coresight-tpdm.c >>>>> @@ -80,7 +80,14 @@ static void set_trigger_type(struct tpdm_drvdata >>>>> *drvdata, u32 *val) >>>>> static void tpdm_enable_dsb(struct tpdm_drvdata *drvdata) >>>>> { >>>>> - u32 val; >>>>> + u32 val, i; >>>>> + >>>>> + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) >>>>> + writel_relaxed(drvdata->dsb->edge_ctrl[i], >>>>> + drvdata->base + TPDM_DSB_EDCR(i)); >>>>> + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) >>>>> + writel_relaxed(drvdata->dsb->edge_ctrl_mask[i], >>>>> + drvdata->base + TPDM_DSB_EDCMR(i)); >>>> >>>> Do all TPDM DSBs have MAX_EDCR registers ? Or some have less than >>>> that ? >>>> If it is latter, do we need special care to avoid writing to inexistent >>>> registers ? >>>> >>> You are right, not all DSB TPDMs have MAX_EDCR registers. In our >>> design, the inexistent register addresses >>> >>> are not occupied and safe for accessing. >>> >>> Currently we don't have a good way to know the quantity of EDCR/EDCMR >>> registers for DSB TPDMs. >>> >>> The only way we can think of is to set it in device tree manually. >>> >>> Do you have other suggestion for this? >>> >>>>> val = readl_relaxed(drvdata->base + TPDM_DSB_TIER); >>>>> /* Set trigger timestamp */ >>>>> @@ -313,6 +320,130 @@ static ssize_t dsb_mode_store(struct device >>>>> *dev, >>>>> } >>>>> static DEVICE_ATTR_RW(dsb_mode); >>>>> +static ssize_t dsb_edge_ctrl_show(struct device *dev, >>>>> + struct device_attribute *attr, >>>>> + char *buf) >>>>> +{ >>>>> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >>>>> + ssize_t size = 0; >>>>> + int i; >>>>> + >>>>> + spin_lock(&drvdata->spinlock); >>>>> + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) { >>>>> + size += sysfs_emit_at(buf, size, >>>>> + "Index:0x%x Val:0x%x\n", i, >>>>> + drvdata->dsb->edge_ctrl[i]); >>>> >>>> It may be safe, but please add a check to make sure that we don't >>>> overflow. At least bail out when we hit a return of 0, indicating >>>> reached the end of buffer. >>>> >>> Can I add the following check to replace the current code?? >>> >>> int ret = 0; >>> >>> >>> for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) { >>> >>> ret = sysfs_emit_at(buf, size, "Index:0x%x Val:0x%x\n", i, >>> drvdata->dsb->edge_ctrl[i]); >>> >>> if (!ret) { >>> >>> dev_warn(drvdata->dev, "The buffer has been overflowed\n"); >> >> You don't need this, it already triggers a WARN() in sysfs_emit_at(). >> So you could do: >> >> for (....) { >> unsigned long bytes = sysfs_emit_at(buf, size, ....); >> >> if (bytes <= 0) >> break; >> size += bytes; >> } >> > Sure, I will update in the next patch series. >> >>> >>> spin_unlock(&drvdata->spinlock); >>> >>> return size; >>> >>> } else >>> >>> size += ret; >>> >>> } >>> >>>>> + } >>>>> + spin_unlock(&drvdata->spinlock); >>>>> + return size; >>>>> +} >>>>> + >>>>> +/* >>>>> + * value 1: Start EDCR register number >>>>> + * value 2: End EDCR register number >>>>> + * value 3: The value need to be written >>>>> + * The EDCR registers can include up to 16 32-bit registers, and each >>>>> + * one can be configured to control up to 16 edge detections(2 bits >>>>> + * control one edge detection). So a total 256 edge detections can be >>>>> + * configured. So the starting number(value 1) and ending >>>>> number(value 2) >>>>> + * cannot be greater than 256, and value 1 should be less than >>>>> value 2. >>>>> + * The following values are the rage of value 3. >>>>> + * 0 - Rising edge detection >>>>> + * 1 - Falling edge detection >>>>> + * 2 - Rising and falling edge detection (toggle detection) >>>>> + */ >>>>> +static ssize_t dsb_edge_ctrl_store(struct device *dev, >>>>> + struct device_attribute *attr, >>>>> + const char *buf, >>>>> + size_t size) >>>>> +{ >>>>> + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); >>>>> + unsigned long val, mask, start, end, edge_ctrl, edge_ctrl_shift; >>>>> + int i, reg; >>>>> + >>>>> + if (sscanf(buf, "%lx %lx %lx", &start, &end, &edge_ctrl) != 3) >>>>> + return -EINVAL; >>>>> + if ((start >= TPDM_DSB_MAX_LINES) || (end >= >>>>> TPDM_DSB_MAX_LINES) || >>>>> + (start > end) || (edge_ctrl > 0x2)) >>>>> + return -EPERM; >>>>> + >>>>> + spin_lock(&drvdata->spinlock); >>>>> + for (i = start; i <= end; i++) { >>>>> + /* >>>>> + * There are 2 bit per DSB Edge Control line. >>>>> + * Thus we have 16 lines in a 32bit word. >>>>> + */ >>>>> + reg = EDCR_TO_WORD_IDX(i); >>>>> + mask = EDCR_TO_WORD_MASK(i); >>>>> + val = drvdata->dsb->edge_ctrl[reg]; >>>> >>>>> + edge_ctrl_shift = EDCR_TO_WORD_VAL(edge_ctrl, i); >>>>> + bitmap_replace(&val, &val, &edge_ctrl_shift, &mask, 32); >>>> >>>> Could we simply do : >>>> >>>> reg &= ~mask; >>>> reg |= FIELD_PREP(mask, edge_ctrl); >>>> >>> Perhaps "FIELD_PREP" cannot be used here since "mask" must be >>> constant in this macro. >> >> Ah, you are right. Sorry about that. >> >>> >>> But in our code, the variable "mask" is not constant. >> >> Still I think using the bitmap_replace is an overkill. We could simply >> do: >> val &= ~mask; >> val |= EDCR_TO_WORD_VAL(edge_ctrl, i); Since we don't need mask any longer we could even do : val &= ~EDCR_TO_WORD_MASK(i); val |= EDCR_TO_WORD_VAL(edge_ctrl, i); Suzuki
On 6/2/2023 5:00 PM, Suzuki K Poulose wrote: > On 02/06/2023 09:45, Suzuki K Poulose wrote: >> On 02/06/2023 09:21, Tao Zhang wrote: >>> >>> On 6/1/2023 8:14 PM, Suzuki K Poulose wrote: >>>> On 27/04/2023 10:00, Tao Zhang wrote: >>>>> Add the nodes to set value for DSB edge control and DSB edge >>>>> control mask. Each DSB subunit TPDM has maximum of n(n<16) EDCR >>>>> resgisters to configure edge control. DSB edge detection control >>>>> 00: Rising edge detection >>>>> 01: Falling edge detection >>>>> 10: Rising and falling edge detection (toggle detection) >>>>> And each DSB subunit TPDM has maximum of m(m<8) ECDMR registers to >>>>> configure mask. Eight 32 bit registers providing DSB interface >>>>> edge detection mask control. >>>>> >>>>> Signed-off-by: Tao Zhang <quic_taozha@quicinc.com> >>>>> --- >>>>> .../ABI/testing/sysfs-bus-coresight-devices-tpdm | 32 +++++ >>>>> drivers/hwtracing/coresight/coresight-tpdm.c | 135 >>>>> ++++++++++++++++++++- >>>>> drivers/hwtracing/coresight/coresight-tpdm.h | 21 ++++ >>>>> 3 files changed, 187 insertions(+), 1 deletion(-) >>>>> >>>>> diff --git >>>>> a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>>> b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>>> index 348e167..a57f000 100644 >>>>> --- a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>>> +++ b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm >>>>> @@ -60,3 +60,35 @@ Description: >>>>> Bit[3] : Set to 0 for low performance mode. >>>>> Set to 1 for high performance mode. >>>>> Bit[4:8] : Select byte lane for high performance mode. >>>>> + >>>>> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl >>>>> +Date: March 2023 >>>>> +KernelVersion 6.3 >>>>> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao >>>>> Zhang (QUIC) <quic_taozha@quicinc.com> >>>>> +Description: >>>>> + Read/Write a set of the edge control registers of the DSB >>>>> + in TPDM. >>>>> + >>>>> + Expected format is the following: >>>>> + <integer1> <integer2> <integer3> >>>>> + >>>>> + Where: >>>>> + <integer1> : Start EDCR register number >>>>> + <integer2> : End EDCR register number >>>>> + <integer3> : The value need to be written >>>>> + >>>>> +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl_mask >>>>> +Date: March 2023 >>>>> +KernelVersion 6.3 >>>>> +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao >>>>> Zhang (QUIC) <quic_taozha@quicinc.com> >>>>> +Description: >>>>> + Read/Write a set of the edge control mask registers of the >>>>> + DSB in TPDM. >>>>> + >>>>> + Expected format is the following: >>>>> + <integer1> <integer2> <integer3> >>>>> + >>>>> + Where: >>>>> + <integer1> : Start EDCMR register number >>>>> + <integer2> : End EDCMR register number >>>>> + <integer3> : The value need to be written >>>>> diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c >>>>> b/drivers/hwtracing/coresight/coresight-tpdm.c >>>>> index 1bacaa5..a40e458 100644 >>>>> --- a/drivers/hwtracing/coresight/coresight-tpdm.c >>>>> +++ b/drivers/hwtracing/coresight/coresight-tpdm.c >>>>> @@ -80,7 +80,14 @@ static void set_trigger_type(struct >>>>> tpdm_drvdata *drvdata, u32 *val) >>>>> static void tpdm_enable_dsb(struct tpdm_drvdata *drvdata) >>>>> { >>>>> - u32 val; >>>>> + u32 val, i; >>>>> + >>>>> + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) >>>>> + writel_relaxed(drvdata->dsb->edge_ctrl[i], >>>>> + drvdata->base + TPDM_DSB_EDCR(i)); >>>>> + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) >>>>> + writel_relaxed(drvdata->dsb->edge_ctrl_mask[i], >>>>> + drvdata->base + TPDM_DSB_EDCMR(i)); >>>> >>>> Do all TPDM DSBs have MAX_EDCR registers ? Or some have less than >>>> that ? >>>> If it is latter, do we need special care to avoid writing to >>>> inexistent >>>> registers ? >>>> >>> You are right, not all DSB TPDMs have MAX_EDCR registers. In our >>> design, the inexistent register addresses >>> >>> are not occupied and safe for accessing. > > Does the TRM for the component say so ? Or is it by luck ? If the spec > says it is RAZ/WriteIgnore, then we could keep the code as it is, > with a comment. Otherwise, we could add a DT property. So please get > this clarified with the H/W designers. Confirmed with H/W designers, these addresses are reserved for the maximum quantity of EDCR/EDCMR registers. It is safe to write data to them and it will not impact anything. Best, Tao > > Suzuki
diff --git a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm index 348e167..a57f000 100644 --- a/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm +++ b/Documentation/ABI/testing/sysfs-bus-coresight-devices-tpdm @@ -60,3 +60,35 @@ Description: Bit[3] : Set to 0 for low performance mode. Set to 1 for high performance mode. Bit[4:8] : Select byte lane for high performance mode. + +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl +Date: March 2023 +KernelVersion 6.3 +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao Zhang (QUIC) <quic_taozha@quicinc.com> +Description: + Read/Write a set of the edge control registers of the DSB + in TPDM. + + Expected format is the following: + <integer1> <integer2> <integer3> + + Where: + <integer1> : Start EDCR register number + <integer2> : End EDCR register number + <integer3> : The value need to be written + +What: /sys/bus/coresight/devices/<tpdm-name>/dsb_edge_ctrl_mask +Date: March 2023 +KernelVersion 6.3 +Contact: Jinlong Mao (QUIC) <quic_jinlmao@quicinc.com>, Tao Zhang (QUIC) <quic_taozha@quicinc.com> +Description: + Read/Write a set of the edge control mask registers of the + DSB in TPDM. + + Expected format is the following: + <integer1> <integer2> <integer3> + + Where: + <integer1> : Start EDCMR register number + <integer2> : End EDCMR register number + <integer3> : The value need to be written diff --git a/drivers/hwtracing/coresight/coresight-tpdm.c b/drivers/hwtracing/coresight/coresight-tpdm.c index 1bacaa5..a40e458 100644 --- a/drivers/hwtracing/coresight/coresight-tpdm.c +++ b/drivers/hwtracing/coresight/coresight-tpdm.c @@ -80,7 +80,14 @@ static void set_trigger_type(struct tpdm_drvdata *drvdata, u32 *val) static void tpdm_enable_dsb(struct tpdm_drvdata *drvdata) { - u32 val; + u32 val, i; + + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) + writel_relaxed(drvdata->dsb->edge_ctrl[i], + drvdata->base + TPDM_DSB_EDCR(i)); + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) + writel_relaxed(drvdata->dsb->edge_ctrl_mask[i], + drvdata->base + TPDM_DSB_EDCMR(i)); val = readl_relaxed(drvdata->base + TPDM_DSB_TIER); /* Set trigger timestamp */ @@ -313,6 +320,130 @@ static ssize_t dsb_mode_store(struct device *dev, } static DEVICE_ATTR_RW(dsb_mode); +static ssize_t dsb_edge_ctrl_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); + ssize_t size = 0; + int i; + + spin_lock(&drvdata->spinlock); + for (i = 0; i < TPDM_DSB_MAX_EDCR; i++) { + size += sysfs_emit_at(buf, size, + "Index:0x%x Val:0x%x\n", i, + drvdata->dsb->edge_ctrl[i]); + } + spin_unlock(&drvdata->spinlock); + return size; +} + +/* + * value 1: Start EDCR register number + * value 2: End EDCR register number + * value 3: The value need to be written + * The EDCR registers can include up to 16 32-bit registers, and each + * one can be configured to control up to 16 edge detections(2 bits + * control one edge detection). So a total 256 edge detections can be + * configured. So the starting number(value 1) and ending number(value 2) + * cannot be greater than 256, and value 1 should be less than value 2. + * The following values are the rage of value 3. + * 0 - Rising edge detection + * 1 - Falling edge detection + * 2 - Rising and falling edge detection (toggle detection) + */ +static ssize_t dsb_edge_ctrl_store(struct device *dev, + struct device_attribute *attr, + const char *buf, + size_t size) +{ + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); + unsigned long val, mask, start, end, edge_ctrl, edge_ctrl_shift; + int i, reg; + + if (sscanf(buf, "%lx %lx %lx", &start, &end, &edge_ctrl) != 3) + return -EINVAL; + if ((start >= TPDM_DSB_MAX_LINES) || (end >= TPDM_DSB_MAX_LINES) || + (start > end) || (edge_ctrl > 0x2)) + return -EPERM; + + spin_lock(&drvdata->spinlock); + for (i = start; i <= end; i++) { + /* + * There are 2 bit per DSB Edge Control line. + * Thus we have 16 lines in a 32bit word. + */ + reg = EDCR_TO_WORD_IDX(i); + mask = EDCR_TO_WORD_MASK(i); + val = drvdata->dsb->edge_ctrl[reg]; + edge_ctrl_shift = EDCR_TO_WORD_VAL(edge_ctrl, i); + bitmap_replace(&val, &val, &edge_ctrl_shift, &mask, 32); + drvdata->dsb->edge_ctrl[reg] = val; + } + spin_unlock(&drvdata->spinlock); + + return size; +} +static DEVICE_ATTR_RW(dsb_edge_ctrl); + +static ssize_t dsb_edge_ctrl_mask_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); + ssize_t size = 0; + int i; + + spin_lock(&drvdata->spinlock); + for (i = 0; i < TPDM_DSB_MAX_EDCMR; i++) { + size += sysfs_emit_at(buf, size, + "Index:0x%x Val:0x%x\n", i, + drvdata->dsb->edge_ctrl_mask[i]); + } + spin_unlock(&drvdata->spinlock); + return size; +} + +/* + * value 1: Start EDCMR register number + * value 2: End EDCMR register number + * value 3: The value need to be written + */ +static ssize_t dsb_edge_ctrl_mask_store(struct device *dev, + struct device_attribute *attr, + const char *buf, + size_t size) +{ + struct tpdm_drvdata *drvdata = dev_get_drvdata(dev->parent); + unsigned long start, end, val; + u32 set; + int i, reg; + + if (sscanf(buf, "%lx %lx %lx", &start, &end, &val) != 3) + return -EINVAL; + if ((start >= TPDM_DSB_MAX_LINES) || (end >= TPDM_DSB_MAX_LINES) + || (start > end) || (val & ~1UL)) + return -EPERM; + + spin_lock(&drvdata->spinlock); + for (i = start; i <= end; i++) { + /* + * There is 1 bit per DSB Edge Control Mark line. + * Thus we have 32 lines in a 32bit word. + */ + reg = EDCMR_TO_WORD_IDX(i); + set = drvdata->dsb->edge_ctrl_mask[reg]; + if (val) + set |= BIT(EDCR_TO_WORD_SHIFT(i)); + else + set &= ~BIT(EDCR_TO_WORD_SHIFT(i)); + drvdata->dsb->edge_ctrl_mask[reg] = set; + } + spin_unlock(&drvdata->spinlock); + return size; +} +static DEVICE_ATTR_RW(dsb_edge_ctrl_mask); + static ssize_t dsb_trig_type_show(struct device *dev, struct device_attribute *attr, char *buf) { @@ -385,6 +516,8 @@ static DEVICE_ATTR_RW(dsb_trig_ts); static struct attribute *tpdm_dsb_attrs[] = { &dev_attr_dsb_mode.attr, + &dev_attr_dsb_edge_ctrl.attr, + &dev_attr_dsb_edge_ctrl_mask.attr, &dev_attr_dsb_trig_ts.attr, &dev_attr_dsb_trig_type.attr, NULL, diff --git a/drivers/hwtracing/coresight/coresight-tpdm.h b/drivers/hwtracing/coresight/coresight-tpdm.h index 79df07e..f25dcdec 100644 --- a/drivers/hwtracing/coresight/coresight-tpdm.h +++ b/drivers/hwtracing/coresight/coresight-tpdm.h @@ -12,6 +12,8 @@ /* DSB Subunit Registers */ #define TPDM_DSB_CR (0x780) #define TPDM_DSB_TIER (0x784) +#define TPDM_DSB_EDCR(n) (0x808 + (n * 4)) +#define TPDM_DSB_EDCMR(n) (0x848 + (n * 4)) /* Enable bit for DSB subunit */ #define TPDM_DSB_CR_ENA BIT(0) @@ -34,6 +36,15 @@ #define TPDM_DSB_TEST_MODE GENMASK(10, 9) #define TPDM_DSB_HPSEL GENMASK(6, 2) +#define EDCRS_PER_WORD 16 +#define EDCR_TO_WORD_IDX(r) ((r) / EDCRS_PER_WORD) +#define EDCR_TO_WORD_SHIFT(r) ((r % EDCRS_PER_WORD) * 2) +#define EDCR_TO_WORD_VAL(val, r) (val << EDCR_TO_WORD_SHIFT(r)) +#define EDCR_TO_WORD_MASK(r) EDCR_TO_WORD_VAL(0x3, r) +#define EDCMRS_PER_WORD 32 +#define EDCMR_TO_WORD_IDX(r) ((r) / EDCMRS_PER_WORD) +#define EDCMR_TO_WORD_SHIFT(r) ((r) % EDCMRS_PER_WORD) + /* TPDM integration test registers */ #define TPDM_ITATBCNTRL (0xEF0) #define TPDM_ITCNTRL (0xF00) @@ -60,14 +71,24 @@ #define TPDM_PIDR0_DS_IMPDEF BIT(0) #define TPDM_PIDR0_DS_DSB BIT(1) +#define TPDM_DSB_MAX_LINES 256 +/* MAX number of EDCR registers */ +#define TPDM_DSB_MAX_EDCR 16 +/* MAX number of EDCMR registers */ +#define TPDM_DSB_MAX_EDCMR 8 + /** * struct dsb_dataset - specifics associated to dsb dataset * @mode: DSB programming mode + * @edge_ctrl: Save value for edge control + * @edge_ctrl_mask: Save value for edge control mask * @trig_ts: Enable/Disable trigger timestamp. * @trig_type: Enable/Disable trigger type. */ struct dsb_dataset { u32 mode; + u32 edge_ctrl[TPDM_DSB_MAX_EDCR]; + u32 edge_ctrl_mask[TPDM_DSB_MAX_EDCMR]; bool trig_ts; bool trig_type; };