From patchwork Tue Feb 6 11:43:46 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Piyush Malgujar X-Patchwork-Id: 197357 Return-Path: Delivered-To: ouuuleilei@gmail.com Received: by 2002:a05:7301:168b:b0:106:860b:bbdd with SMTP id ma11csp1484952dyb; Tue, 6 Feb 2024 03:59:58 -0800 (PST) X-Google-Smtp-Source: AGHT+IHO86LviILgzm/AvM5sGJ/S8YN7Nfrql8G9m7Z8Bs/+8pqp5bGyDRh/7Q8pJkZhCeruFkjd X-Received: by 2002:ad4:5cc6:0:b0:68c:aeef:d72b with SMTP id iu6-20020ad45cc6000000b0068caeefd72bmr3227094qvb.13.1707220798064; Tue, 06 Feb 2024 03:59:58 -0800 (PST) ARC-Seal: i=2; a=rsa-sha256; t=1707220798; cv=pass; d=google.com; s=arc-20160816; b=wZB9uqyh/eK5/wTz5OrQxeALPFkyj8NYR9uEUB1ec/Q7tkHgoKEzjkG+ViRk9YKvaE Nk+qESLWIm89kBJRMg9I2JqXLc2Q/zv2SDLPTRUSOZq//VKA9/67T0v7w+VHo7oYDaB5 kq45Xl/bkJgtzztOLNjS6Hf7EDzH7loJA1aKhMztK9o+KkGCX55FcBHT2AWOi7eUSCLb fPNnsMtJgKj7F/P6ilDxQ55kdipgBfRGp/1qGl5tm+mvRp9NzsGvCmfReqsd1xyV8W13 Dtzyt/8j3JxVK5PCSGFarC5Zym30bw6LulXu2wbXVyANcayaomlM18kGEQdduJR98Plf qDPg== ARC-Message-Signature: i=2; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=content-transfer-encoding:mime-version:list-unsubscribe :list-subscribe:list-id:precedence:references:in-reply-to:message-id :date:subject:cc:to:from:dkim-signature; bh=B5mI7VIbKym+fTTfsiZYmoPh7jPpg7En2bzpHJh3tJg=; fh=dTF8HGh/6LpTC/8sXiSwBWAmWSYLM6/dNMVqvdVlLDY=; b=Hwiayr19/IsjVkILCvrPWhbeeP1tkWn7TtVgauyofNtYlZ3ya1igwdMl6xwXfLorB0 fW1h2C0E+6PNrPVR5hd/NlE7Tf6zo7Lv41Vf/zWkb6ifEJl7ScNaM/h3kyZIHCzqKqMD J92yK7LB5Pd5xI3RoLZjGwsRcDhygbLkLsFf6VRLzIG5hAc8wk2trFK1fOlUIMHkyBcu /BfzMz2ncl4sNAhZCTK2TRHetfCGJqeYsOWn+UnvDU81vUAlUzCphaYCMVpprfA2Z4j6 O9uO4OUz9kXij5/3hF5OtuA0Z2x08BPH1lvijDrR5kRfBiwJqEPZyvuupqtfR3ecRWnz kJVA==; dara=google.com ARC-Authentication-Results: i=2; mx.google.com; dkim=pass header.i=@marvell.com header.s=pfpt0220 header.b=Jdfw+7WA; arc=pass (i=1 spf=pass spfdomain=marvell.com dkim=pass dkdomain=marvell.com dmarc=pass fromdomain=marvell.com); spf=pass (google.com: domain of linux-kernel+bounces-54820-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) smtp.mailfrom="linux-kernel+bounces-54820-ouuuleilei=gmail.com@vger.kernel.org"; dmarc=pass (p=NONE sp=REJECT dis=NONE) header.from=marvell.com X-Forwarded-Encrypted: i=1; AJvYcCURs4pl6ZMUGVaIRjNJRJqZpnQv0d9ddYDV9vqQ076JD2LNsJJRQ+uGQiL9MMhCT8db0Oj93Gu2tNd7cXuZpJmJNRCU1Q== Received: from ny.mirrors.kernel.org (ny.mirrors.kernel.org. [2604:1380:45d1:ec00::1]) by mx.google.com with ESMTPS id ct7-20020a056214178700b00683699d4df8si2214471qvb.139.2024.02.06.03.59.57 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 06 Feb 2024 03:59:58 -0800 (PST) Received-SPF: pass (google.com: domain of linux-kernel+bounces-54820-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) client-ip=2604:1380:45d1:ec00::1; Authentication-Results: mx.google.com; dkim=pass header.i=@marvell.com header.s=pfpt0220 header.b=Jdfw+7WA; arc=pass (i=1 spf=pass spfdomain=marvell.com dkim=pass dkdomain=marvell.com dmarc=pass fromdomain=marvell.com); spf=pass (google.com: domain of linux-kernel+bounces-54820-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) smtp.mailfrom="linux-kernel+bounces-54820-ouuuleilei=gmail.com@vger.kernel.org"; dmarc=pass (p=NONE sp=REJECT dis=NONE) header.from=marvell.com Received: from smtp.subspace.kernel.org (wormhole.subspace.kernel.org [52.25.139.140]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by ny.mirrors.kernel.org (Postfix) with ESMTPS id C78641C23178 for ; Tue, 6 Feb 2024 11:59:57 +0000 (UTC) Received: from localhost.localdomain (localhost.localdomain [127.0.0.1]) by smtp.subspace.kernel.org (Postfix) with ESMTP id DF95213173F; Tue, 6 Feb 2024 11:44:57 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=marvell.com header.i=@marvell.com header.b="Jdfw+7WA" Received: from mx0b-0016f401.pphosted.com (mx0b-0016f401.pphosted.com [67.231.156.173]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id D5721130E48; Tue, 6 Feb 2024 11:44:52 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=67.231.156.173 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1707219894; cv=none; b=aAwYib4W82WNh2KmNSjy8r5ZsWycrEi2IC4PHlRcjGk0kd1yO63ijdSDGJ0YsoE6zLt61WeFvzlWgP8Wrqsve6mQ8W7Dx4LQzeQE3b2IlGHgezO94xZs28lUug/XgaQDvMlHeadX1UP/be3Nyr+/NDtL+tBP0iIulYrjq2KPnQQ= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1707219894; c=relaxed/simple; bh=HmzDG0AiV7w0OKL7BZvlkkqTDKXM+dijNSIJal0cpS4=; h=From:To:CC:Subject:Date:Message-ID:In-Reply-To:References: MIME-Version:Content-Type; b=tX9hEETKt3buDQKMWW+0Mc1l1QB8UciZXK+hGlw4ukAv1GOoxWr326L9s+AfmajjDYHy0Zjw0ZCoZUQMAQCzDEV3Vx2udD9SVA+0xtOWKrzmLisV3InVYtAxbiFfQF0mwHd6IICMOgnDVBETdlonmcVD4VKuY0G1H6wQVqrABfg= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=marvell.com; spf=pass smtp.mailfrom=marvell.com; dkim=pass (2048-bit key) header.d=marvell.com header.i=@marvell.com header.b=Jdfw+7WA; arc=none smtp.client-ip=67.231.156.173 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=marvell.com Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=marvell.com Received: from pps.filterd (m0045851.ppops.net [127.0.0.1]) by mx0b-0016f401.pphosted.com (8.17.1.24/8.17.1.24) with ESMTP id 415Mr1BV028264; Tue, 6 Feb 2024 03:44:49 -0800 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=marvell.com; h= from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding:content-type; s= pfpt0220; bh=B5mI7VIbKym+fTTfsiZYmoPh7jPpg7En2bzpHJh3tJg=; b=Jdf w+7WAb966YGVnnuwV5vKw2doqOyvVl4oiIRYyC9rspnztM0SBH+zqsLh58rhy/8d 8gBZuBf78fcW54x0KmeDR6OxPKFhEiiZ8+muMybmS9xMe8dfqT3bkMd/Omk/TXzo +TALnKkA6OQDzd/KTpfow2dBG4KlUaSuz3vIU95NkbkeZYSWUcI/q0N1aeD7imwD 7BOpiTwHSfTNXX3iWtm8kG8poN/UndD/Jvv8Id5Wk7CTTcOaNyqK9CuNMlJxPJU5 KXauLfSN8OZlun+mGC320FZm5MNFawxZp9LnOubyAAM1m8NE7H+jmtYZLVcnZgCA Jnb6OH6q/dPekPaElrw== Received: from dc5-exch02.marvell.com ([199.233.59.182]) by mx0b-0016f401.pphosted.com (PPS) with ESMTPS id 3w38u81xur-1 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-SHA384 bits=256 verify=NOT); Tue, 06 Feb 2024 03:44:49 -0800 (PST) Received: from DC5-EXCH01.marvell.com (10.69.176.38) by DC5-EXCH02.marvell.com (10.69.176.39) with Microsoft SMTP Server (TLS) id 15.0.1497.48; Tue, 6 Feb 2024 03:44:47 -0800 Received: from maili.marvell.com (10.69.176.80) by DC5-EXCH01.marvell.com (10.69.176.38) with Microsoft SMTP Server id 15.0.1497.48 via Frontend Transport; Tue, 6 Feb 2024 03:44:47 -0800 Received: from localhost.localdomain (unknown [10.110.150.250]) by maili.marvell.com (Postfix) with ESMTP id EECB73F7041; Tue, 6 Feb 2024 03:44:46 -0800 (PST) From: Piyush Malgujar To: , , CC: , , , Piyush Malgujar Subject: [PATCH v3 1/4] i2c: thunderx: Clock divisor logic changes Date: Tue, 6 Feb 2024 03:43:46 -0800 Message-ID: <20240206114349.32197-2-pmalgujar@marvell.com> X-Mailer: git-send-email 2.42.0 In-Reply-To: <20240206114349.32197-1-pmalgujar@marvell.com> References: <20240206114349.32197-1-pmalgujar@marvell.com> Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 X-Proofpoint-ORIG-GUID: rCvXaKtdDjjl3MF5DsDteJp67qwfC4VN X-Proofpoint-GUID: rCvXaKtdDjjl3MF5DsDteJp67qwfC4VN X-Proofpoint-Virus-Version: vendor=baseguard engine=ICAP:2.0.272,Aquarius:18.0.1011,Hydra:6.0.619,FMLib:17.11.176.26 definitions=2024-02-06_04,2024-01-31_01,2023-05-22_02 X-getmail-retrieved-from-mailbox: INBOX X-GMAIL-THRID: 1790150755839165608 X-GMAIL-MSGID: 1790150755839165608 From: Suneel Garapati Handle changes to clock divisor logic for OcteonTX2 SoC family using subsystem ID and using default reference clock source as 100MHz. Signed-off-by: Suneel Garapati Signed-off-by: Piyush Malgujar Acked-by: Andi Shyti --- MAINTAINERS | 1 + drivers/i2c/busses/i2c-octeon-core.c | 29 ++++++++++++++++++++---- drivers/i2c/busses/i2c-octeon-core.h | 17 ++++++++++++++ drivers/i2c/busses/i2c-thunderx-pcidrv.c | 7 ++++++ 4 files changed, 50 insertions(+), 4 deletions(-) diff --git a/MAINTAINERS b/MAINTAINERS index 960512bec42885c0f1632a7c90851c3d32fbf20e..92b0a55c36e41cf54c7cbf52576d5424b591aa31 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -4725,6 +4725,7 @@ F: drivers/net/wireless/ath/carl9170/ CAVIUM I2C DRIVER M: Robert Richter +M: Suneel Garapati S: Odd Fixes W: http://www.marvell.com F: drivers/i2c/busses/i2c-octeon* diff --git a/drivers/i2c/busses/i2c-octeon-core.c b/drivers/i2c/busses/i2c-octeon-core.c index 845eda70b8cab52a0453c9f4cb545010fba4305d..1d8e1f4ad859dc44c08629637530842a0ed50bc4 100644 --- a/drivers/i2c/busses/i2c-octeon-core.c +++ b/drivers/i2c/busses/i2c-octeon-core.c @@ -17,6 +17,7 @@ #include #include #include +#include #include "i2c-octeon-core.h" @@ -658,31 +659,51 @@ int octeon_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num) void octeon_i2c_set_clock(struct octeon_i2c *i2c) { int tclk, thp_base, inc, thp_idx, mdiv_idx, ndiv_idx, foscl, diff; - int thp = 0x18, mdiv = 2, ndiv = 0, delta_hz = 1000000; + int mdiv_min = 2; + /* starting value on search for lowest diff */ + const int huge_delta = INITIAL_DELTA_HZ; + /* + * Find divisors to produce target frequency, start with large delta + * to cover wider range of divisors, note thp = TCLK half period. + */ + unsigned int thp = 0x18, mdiv = 2, ndiv = 0, delta_hz = huge_delta; + + if (octeon_i2c_is_otx2(to_pci_dev(i2c->dev))) { + thp = 0x3; + mdiv_min = 0; + } for (ndiv_idx = 0; ndiv_idx < 8 && delta_hz != 0; ndiv_idx++) { /* * An mdiv value of less than 2 seems to not work well * with ds1337 RTCs, so we constrain it to larger values. */ - for (mdiv_idx = 15; mdiv_idx >= 2 && delta_hz != 0; mdiv_idx--) { + for (mdiv_idx = 15; mdiv_idx >= mdiv_min && delta_hz != 0; mdiv_idx--) { /* * For given ndiv and mdiv values check the * two closest thp values. */ tclk = i2c->twsi_freq * (mdiv_idx + 1) * 10; tclk *= (1 << ndiv_idx); - thp_base = (i2c->sys_freq / (tclk * 2)) - 1; + if (octeon_i2c_is_otx2(to_pci_dev(i2c->dev))) + thp_base = (i2c->sys_freq / tclk) - 2; + else + thp_base = (i2c->sys_freq / (tclk * 2)) - 1; for (inc = 0; inc <= 1; inc++) { thp_idx = thp_base + inc; if (thp_idx < 5 || thp_idx > 0xff) continue; - foscl = i2c->sys_freq / (2 * (thp_idx + 1)); + if (octeon_i2c_is_otx2(to_pci_dev(i2c->dev))) + foscl = i2c->sys_freq / (thp_idx + 2); + else + foscl = i2c->sys_freq / + (2 * (thp_idx + 1)); foscl = foscl / (1 << ndiv_idx); foscl = foscl / (mdiv_idx + 1) / 10; diff = abs(foscl - i2c->twsi_freq); + /* Use it if smaller diff from target */ if (diff < delta_hz) { delta_hz = diff; thp = thp_idx; diff --git a/drivers/i2c/busses/i2c-octeon-core.h b/drivers/i2c/busses/i2c-octeon-core.h index 9bb9f64fdda0392364638ecbaafe3fab5612baf6..694c24cecb7b144c1021549d1661b040c21bb998 100644 --- a/drivers/i2c/busses/i2c-octeon-core.h +++ b/drivers/i2c/busses/i2c-octeon-core.h @@ -7,6 +7,7 @@ #include #include #include +#include /* Controller command patterns */ #define SW_TWSI_V BIT_ULL(63) /* Valid bit */ @@ -98,6 +99,8 @@ struct octeon_i2c_reg_offset { #define TWSI_INT(x) (x->roff.twsi_int) #define SW_TWSI_EXT(x) (x->roff.sw_twsi_ext) +#define INITIAL_DELTA_HZ 1000000 + struct octeon_i2c { wait_queue_head_t queue; struct i2c_adapter adap; @@ -211,6 +214,20 @@ static inline void octeon_i2c_write_int(struct octeon_i2c *i2c, u64 data) octeon_i2c_writeq_flush(data, i2c->twsi_base + TWSI_INT(i2c)); } +#define PCI_SUBSYS_DEVID_9XXX 0xB +/** + * octeon_i2c_is_otx2 - check for chip ID + * @pdev: PCI dev structure + * + * Returns TRUE if OcteonTX2, FALSE otherwise. + */ +static inline bool octeon_i2c_is_otx2(struct pci_dev *pdev) +{ + u32 chip_id = (pdev->subsystem_device >> 12) & 0xF; + + return (chip_id == PCI_SUBSYS_DEVID_9XXX); +} + /* Prototypes */ irqreturn_t octeon_i2c_isr(int irq, void *dev_id); int octeon_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num); diff --git a/drivers/i2c/busses/i2c-thunderx-pcidrv.c b/drivers/i2c/busses/i2c-thunderx-pcidrv.c index a77cd86fe75ed7401bc041b27c651b9fedf67285..75569774003857dc984e8540ef8f4d1bb084cfb0 100644 --- a/drivers/i2c/busses/i2c-thunderx-pcidrv.c +++ b/drivers/i2c/busses/i2c-thunderx-pcidrv.c @@ -28,6 +28,7 @@ #define PCI_DEVICE_ID_THUNDER_TWSI 0xa012 #define SYS_FREQ_DEFAULT 700000000 +#define OTX2_REF_FREQ_DEFAULT 100000000 #define TWSI_INT_ENA_W1C 0x1028 #define TWSI_INT_ENA_W1S 0x1030 @@ -205,6 +206,12 @@ static int thunder_i2c_probe_pci(struct pci_dev *pdev, if (ret) goto error; + /* + * For OcteonTX2 chips, set reference frequency to 100MHz + * as refclk_src in TWSI_MODE register defaults to 100MHz. + */ + if (octeon_i2c_is_otx2(pdev)) + i2c->sys_freq = OTX2_REF_FREQ_DEFAULT; octeon_i2c_set_clock(i2c); i2c->adap = thunderx_i2c_ops; From patchwork Tue Feb 6 11:43:47 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Piyush Malgujar X-Patchwork-Id: 197358 Return-Path: Delivered-To: ouuuleilei@gmail.com Received: by 2002:a05:7301:168b:b0:106:860b:bbdd with SMTP id ma11csp1485168dyb; Tue, 6 Feb 2024 04:00:16 -0800 (PST) X-Google-Smtp-Source: AGHT+IHfzQNIgDN+OiSue+rXChHELcbmGyfPlZAsiaonkwxZClTaYW8FZgKuhg+kcohIxozMIGwN X-Received: by 2002:a17:90a:e509:b0:296:5bdd:3ff5 with SMTP id t9-20020a17090ae50900b002965bdd3ff5mr3527638pjy.3.1707220816779; Tue, 06 Feb 2024 04:00:16 -0800 (PST) ARC-Seal: i=2; a=rsa-sha256; t=1707220816; cv=pass; d=google.com; s=arc-20160816; b=dVZcpvhnT3Rh4yYuX36SHe9Zn/ruKyz0e7GxO8gSly/g6/e/0w1m61XSDErUO+xVlv AvdcEQUlKBeC8i0NwCbW3rZOho2w3kiIP2DxsleO2mos6OWEm2o1rG3WQ0QdepD/nrYS iWxPQPDV4gB3b0AZ3q2sa9THhLP45zKdAQhJpIH9eWacIvIGKh4a6K+L8esiNl0X7ZYb Z5HrhwIb1kuAsS64/yNKaYnERcW44/+3nEC137b/Vh7KwDlfDZSMsgPfeYMFhTeQPOBI Ajey8ouSUF14EEr2pLrznmM6FDAHMpMtL1EExb2ho0D5yrBm2Fjg8Mb4eW2zb3AuYEfT oYKg== ARC-Message-Signature: i=2; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=content-transfer-encoding:mime-version:list-unsubscribe :list-subscribe:list-id:precedence:references:in-reply-to:message-id :date:subject:cc:to:from:dkim-signature; bh=C/7FJMK/S8fhHx1QXDFcUQaidLGVGc2n44lkTILdK5Q=; fh=FNwZ3nLZi+FaBAPSQAG+RMGltBx5ldsUpc6NYhw186M=; b=bLfBXQCFQJ8mgq9bHNOzXbPoP4SnQRvjZ80a00war+lCOr3VB5tppXXLY+g61Mg4tu ENBRm45UR2Iou1asgVktOh0xijaFsM55bBSdQ+V6KGn+VwJLe61UKnjwEx/siXehn6SI m2lLe1MDnNtTeT7xvduZEWqBvAXm+mBiwnNLlur6y6OEytZACzP+tbO37zr9f7b6iMJ1 z5K7Er9yX0o/uee56w1LijtvOscWu1D8bVPgebhcYKNuXyzLpGHIkBP49tO598GmY+xa vnu1BO0CvYWe0QSYuafKx8s+EMGn8IpnSwCi10bK4qW/YGBJcSTf/p8gqUT7WVykwwev p4OQ==; dara=google.com ARC-Authentication-Results: i=2; mx.google.com; dkim=pass header.i=@marvell.com header.s=pfpt0220 header.b=LuS2IpRv; arc=pass (i=1 spf=pass spfdomain=marvell.com dkim=pass dkdomain=marvell.com dmarc=pass fromdomain=marvell.com); spf=pass (google.com: domain of linux-kernel+bounces-54821-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45e3:2400::1 as permitted sender) smtp.mailfrom="linux-kernel+bounces-54821-ouuuleilei=gmail.com@vger.kernel.org"; dmarc=pass (p=NONE sp=REJECT dis=NONE) header.from=marvell.com X-Forwarded-Encrypted: i=2; AJvYcCXynNwf4/s5tlTBvE/5jfgvT+2qFWa4vz839KK4rPDEPaXCX5eQgPth1ELEtguaNbvtwyDLMLEJL7LzOsuVl76jxitrZQ== Received: from sv.mirrors.kernel.org (sv.mirrors.kernel.org. [2604:1380:45e3:2400::1]) by mx.google.com with ESMTPS id nv13-20020a17090b1b4d00b00296a42c0f14si1045191pjb.73.2024.02.06.04.00.16 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 06 Feb 2024 04:00:16 -0800 (PST) Received-SPF: pass (google.com: domain of linux-kernel+bounces-54821-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45e3:2400::1 as permitted sender) client-ip=2604:1380:45e3:2400::1; Authentication-Results: mx.google.com; dkim=pass header.i=@marvell.com header.s=pfpt0220 header.b=LuS2IpRv; arc=pass (i=1 spf=pass spfdomain=marvell.com dkim=pass dkdomain=marvell.com dmarc=pass fromdomain=marvell.com); spf=pass (google.com: domain of linux-kernel+bounces-54821-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45e3:2400::1 as permitted sender) smtp.mailfrom="linux-kernel+bounces-54821-ouuuleilei=gmail.com@vger.kernel.org"; dmarc=pass (p=NONE sp=REJECT dis=NONE) header.from=marvell.com Received: from smtp.subspace.kernel.org (wormhole.subspace.kernel.org [52.25.139.140]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by sv.mirrors.kernel.org (Postfix) with ESMTPS id 85E3F2888B5 for ; Tue, 6 Feb 2024 12:00:14 +0000 (UTC) Received: from localhost.localdomain (localhost.localdomain [127.0.0.1]) by smtp.subspace.kernel.org (Postfix) with ESMTP id 2C498131E4D; Tue, 6 Feb 2024 11:45:06 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=marvell.com header.i=@marvell.com header.b="LuS2IpRv" Received: from mx0b-0016f401.pphosted.com (mx0a-0016f401.pphosted.com [67.231.148.174]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 2C564131E33; Tue, 6 Feb 2024 11:45:00 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=67.231.148.174 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1707219902; cv=none; b=BwuRn4RXzSLdfEi4vV6IphB7auZTIbJNXXHQ7vZGMT5CRyRYfzdsN1hOJqbQsr4jjmcy17DvePheeNqAuPHNljkWv1WCaPKIbH/oO42BInH+Q1SRoci4es1cnX4h5hINUO910I3lMXMYVfkD5dHQxXNfY9Im+UN0ozjqAs2ga4o= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1707219902; c=relaxed/simple; bh=g4n7QrSkD5h6OGYag/2Ky4TCrp8ytBA18eY+bA/8dMA=; h=From:To:CC:Subject:Date:Message-ID:In-Reply-To:References: MIME-Version:Content-Type; b=i5tFw4F1tz60h++2Adj/gkZnhpBoWwMHVtOIpqWkLkddp4Um6vSFyp8t+5a0IvoXdOUDAUNgVu9bxGnqP7Y9kBFWh1e6JEqgwgKObpRKBF5Q69eXUGuH7SxY2lu+2ukOwomhUsFWo7Ucjwts+cY99gxRooxFSx3fnqtdnx8Us8o= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=marvell.com; spf=pass smtp.mailfrom=marvell.com; dkim=pass (2048-bit key) header.d=marvell.com header.i=@marvell.com header.b=LuS2IpRv; arc=none smtp.client-ip=67.231.148.174 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=marvell.com Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=marvell.com Received: from pps.filterd (m0045849.ppops.net [127.0.0.1]) by mx0a-0016f401.pphosted.com (8.17.1.24/8.17.1.24) with ESMTP id 416B2Acf024715; Tue, 6 Feb 2024 03:44:58 -0800 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=marvell.com; h= from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding:content-type; s= pfpt0220; bh=C/7FJMK/S8fhHx1QXDFcUQaidLGVGc2n44lkTILdK5Q=; b=LuS 2IpRv/YxoC+UlbU3ovLOAR2H2MQMQ6SjD15RmV8ugSLUsZVNWhnJcsfyGp3IcdmB 2Q+daThLqWKbovPBL2FTQcM+qjNGp2D4xaih7gcf55cCBUSOttWi4TcwKGZK7w8y cRnaO0UN0HxKPySSi4CvEAfJgnrg8n9Q/KLl/08FRRNF5abDGwxvx+0zO9anIeEl EsKnhnEwPxEbt+4+uVr5nE6kOj49uvJtI5eFc0TfHfy5bV8n/7D0wY9CSuybcsIr J74X8tbxJFI1+M5VG2Da+hB2+X94ruUPtB3vfZQIA2zyVLjdMpG3QNDy04ZeLLuK H78U+Rfo8zfuQXGY8Vw== Received: from dc5-exch02.marvell.com ([199.233.59.182]) by mx0a-0016f401.pphosted.com (PPS) with ESMTPS id 3w38y4hyyw-1 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-SHA384 bits=256 verify=NOT); Tue, 06 Feb 2024 03:44:58 -0800 (PST) Received: from DC5-EXCH02.marvell.com (10.69.176.39) by DC5-EXCH02.marvell.com (10.69.176.39) with Microsoft SMTP Server (TLS) id 15.0.1497.48; Tue, 6 Feb 2024 03:44:56 -0800 Received: from maili.marvell.com (10.69.176.80) by DC5-EXCH02.marvell.com (10.69.176.39) with Microsoft SMTP Server id 15.0.1497.48 via Frontend Transport; Tue, 6 Feb 2024 03:44:56 -0800 Received: from localhost.localdomain (unknown [10.110.150.250]) by maili.marvell.com (Postfix) with ESMTP id 7F7E43F7085; Tue, 6 Feb 2024 03:44:56 -0800 (PST) From: Piyush Malgujar To: , , CC: , , , Piyush Malgujar Subject: [PATCH v3 2/4] i2c: thunderx: Add support for High speed mode Date: Tue, 6 Feb 2024 03:43:47 -0800 Message-ID: <20240206114349.32197-3-pmalgujar@marvell.com> X-Mailer: git-send-email 2.42.0 In-Reply-To: <20240206114349.32197-1-pmalgujar@marvell.com> References: <20240206114349.32197-1-pmalgujar@marvell.com> Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 X-Proofpoint-ORIG-GUID: WAPG1hkwoFCKqmxo-Z3ENI_PpV6LpfS9 X-Proofpoint-GUID: WAPG1hkwoFCKqmxo-Z3ENI_PpV6LpfS9 X-Proofpoint-Virus-Version: vendor=baseguard engine=ICAP:2.0.272,Aquarius:18.0.1011,Hydra:6.0.619,FMLib:17.11.176.26 definitions=2024-02-06_04,2024-01-31_01,2023-05-22_02 X-getmail-retrieved-from-mailbox: INBOX X-GMAIL-THRID: 1790150775088595235 X-GMAIL-MSGID: 1790150775088595235 From: Suneel Garapati Support High speed mode clock setup for OcteonTX2 platforms. Signed-off-by: Suneel Garapati Signed-off-by: Piyush Malgujar --- drivers/i2c/busses/i2c-octeon-core.c | 61 +++++++++++++++--------- drivers/i2c/busses/i2c-octeon-core.h | 6 +++ drivers/i2c/busses/i2c-thunderx-pcidrv.c | 3 +- 3 files changed, 47 insertions(+), 23 deletions(-) diff --git a/drivers/i2c/busses/i2c-octeon-core.c b/drivers/i2c/busses/i2c-octeon-core.c index 1d8e1f4ad859dc44c08629637530842a0ed50bc4..6636719ca8f005056230620e2cee19de7154e024 100644 --- a/drivers/i2c/busses/i2c-octeon-core.c +++ b/drivers/i2c/busses/i2c-octeon-core.c @@ -608,25 +608,27 @@ int octeon_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num) struct octeon_i2c *i2c = i2c_get_adapdata(adap); int i, ret = 0; - if (num == 1) { - if (msgs[0].len > 0 && msgs[0].len <= 8) { - if (msgs[0].flags & I2C_M_RD) - ret = octeon_i2c_hlc_read(i2c, msgs); - else - ret = octeon_i2c_hlc_write(i2c, msgs); - goto out; - } - } else if (num == 2) { - if ((msgs[0].flags & I2C_M_RD) == 0 && - (msgs[1].flags & I2C_M_RECV_LEN) == 0 && - msgs[0].len > 0 && msgs[0].len <= 2 && - msgs[1].len > 0 && msgs[1].len <= 8 && - msgs[0].addr == msgs[1].addr) { - if (msgs[1].flags & I2C_M_RD) - ret = octeon_i2c_hlc_comp_read(i2c, msgs); - else - ret = octeon_i2c_hlc_comp_write(i2c, msgs); - goto out; + if (IS_LS_FREQ(i2c->twsi_freq)) { + if (num == 1) { + if (msgs[0].len > 0 && msgs[0].len <= 8) { + if (msgs[0].flags & I2C_M_RD) + ret = octeon_i2c_hlc_read(i2c, msgs); + else + ret = octeon_i2c_hlc_write(i2c, msgs); + goto out; + } + } else if (num == 2) { + if ((msgs[0].flags & I2C_M_RD) == 0 && + (msgs[1].flags & I2C_M_RECV_LEN) == 0 && + msgs[0].len > 0 && msgs[0].len <= 2 && + msgs[1].len > 0 && msgs[1].len <= 8 && + msgs[0].addr == msgs[1].addr) { + if (msgs[1].flags & I2C_M_RD) + ret = octeon_i2c_hlc_comp_read(i2c, msgs); + else + ret = octeon_i2c_hlc_comp_write(i2c, msgs); + goto out; + } } } @@ -666,11 +668,13 @@ void octeon_i2c_set_clock(struct octeon_i2c *i2c) * Find divisors to produce target frequency, start with large delta * to cover wider range of divisors, note thp = TCLK half period. */ - unsigned int thp = 0x18, mdiv = 2, ndiv = 0, delta_hz = huge_delta; + unsigned int ds = 10, thp = 0x18, mdiv = 2, ndiv = 0, delta_hz = huge_delta; if (octeon_i2c_is_otx2(to_pci_dev(i2c->dev))) { thp = 0x3; mdiv_min = 0; + if (!IS_LS_FREQ(i2c->twsi_freq)) + ds = 15; } for (ndiv_idx = 0; ndiv_idx < 8 && delta_hz != 0; ndiv_idx++) { @@ -683,7 +687,7 @@ void octeon_i2c_set_clock(struct octeon_i2c *i2c) * For given ndiv and mdiv values check the * two closest thp values. */ - tclk = i2c->twsi_freq * (mdiv_idx + 1) * 10; + tclk = i2c->twsi_freq * (mdiv_idx + 1) * ds; tclk *= (1 << ndiv_idx); if (octeon_i2c_is_otx2(to_pci_dev(i2c->dev))) thp_base = (i2c->sys_freq / tclk) - 2; @@ -701,7 +705,9 @@ void octeon_i2c_set_clock(struct octeon_i2c *i2c) foscl = i2c->sys_freq / (2 * (thp_idx + 1)); foscl = foscl / (1 << ndiv_idx); - foscl = foscl / (mdiv_idx + 1) / 10; + foscl = foscl / (mdiv_idx + 1) / ds; + if (foscl > i2c->twsi_freq) + continue; diff = abs(foscl - i2c->twsi_freq); /* Use it if smaller diff from target */ if (diff < delta_hz) { @@ -715,6 +721,17 @@ void octeon_i2c_set_clock(struct octeon_i2c *i2c) } octeon_i2c_reg_write(i2c, SW_TWSI_OP_TWSI_CLK, thp); octeon_i2c_reg_write(i2c, SW_TWSI_EOP_TWSI_CLKCTL, (mdiv << 3) | ndiv); + if (octeon_i2c_is_otx2(to_pci_dev(i2c->dev))) { + u64 mode; + + mode = __raw_readq(i2c->twsi_base + MODE(i2c)); + /* Set REFCLK_SRC and HS_MODE in TWSX_MODE register */ + if (!IS_LS_FREQ(i2c->twsi_freq)) + mode |= TWSX_MODE_HS_MASK; + else + mode &= ~TWSX_MODE_HS_MASK; + octeon_i2c_writeq_flush(mode, i2c->twsi_base + MODE(i2c)); + } } int octeon_i2c_init_lowlevel(struct octeon_i2c *i2c) diff --git a/drivers/i2c/busses/i2c-octeon-core.h b/drivers/i2c/busses/i2c-octeon-core.h index 694c24cecb7b144c1021549d1661b040c21bb998..e89f041550ace5f7cbcdd94146d0193abe51d466 100644 --- a/drivers/i2c/busses/i2c-octeon-core.h +++ b/drivers/i2c/busses/i2c-octeon-core.h @@ -93,14 +93,19 @@ struct octeon_i2c_reg_offset { unsigned int sw_twsi; unsigned int twsi_int; unsigned int sw_twsi_ext; + unsigned int mode; }; #define SW_TWSI(x) (x->roff.sw_twsi) #define TWSI_INT(x) (x->roff.twsi_int) #define SW_TWSI_EXT(x) (x->roff.sw_twsi_ext) +#define MODE(x) (x->roff.mode) #define INITIAL_DELTA_HZ 1000000 +/* Set REFCLK_SRC and HS_MODE in TWSX_MODE register */ +#define TWSX_MODE_HS_MASK (BIT(4) | BIT(0)) + struct octeon_i2c { wait_queue_head_t queue; struct i2c_adapter adap; @@ -214,6 +219,7 @@ static inline void octeon_i2c_write_int(struct octeon_i2c *i2c, u64 data) octeon_i2c_writeq_flush(data, i2c->twsi_base + TWSI_INT(i2c)); } +#define IS_LS_FREQ(twsi_freq) ((twsi_freq) <= 400000) #define PCI_SUBSYS_DEVID_9XXX 0xB /** * octeon_i2c_is_otx2 - check for chip ID diff --git a/drivers/i2c/busses/i2c-thunderx-pcidrv.c b/drivers/i2c/busses/i2c-thunderx-pcidrv.c index 75569774003857dc984e8540ef8f4d1bb084cfb0..31f11b77ab663626967c86086a03213876bf4a07 100644 --- a/drivers/i2c/busses/i2c-thunderx-pcidrv.c +++ b/drivers/i2c/busses/i2c-thunderx-pcidrv.c @@ -166,6 +166,7 @@ static int thunder_i2c_probe_pci(struct pci_dev *pdev, i2c->roff.sw_twsi = 0x1000; i2c->roff.twsi_int = 0x1010; i2c->roff.sw_twsi_ext = 0x1018; + i2c->roff.mode = 0x1038; i2c->dev = dev; pci_set_drvdata(pdev, i2c); @@ -210,7 +211,7 @@ static int thunder_i2c_probe_pci(struct pci_dev *pdev, * For OcteonTX2 chips, set reference frequency to 100MHz * as refclk_src in TWSI_MODE register defaults to 100MHz. */ - if (octeon_i2c_is_otx2(pdev)) + if (octeon_i2c_is_otx2(pdev) && IS_LS_FREQ(i2c->twsi_freq)) i2c->sys_freq = OTX2_REF_FREQ_DEFAULT; octeon_i2c_set_clock(i2c); From patchwork Tue Feb 6 11:43:48 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Piyush Malgujar X-Patchwork-Id: 197359 Return-Path: Delivered-To: ouuuleilei@gmail.com Received: by 2002:a05:7301:168b:b0:106:860b:bbdd with SMTP id ma11csp1485514dyb; Tue, 6 Feb 2024 04:00:46 -0800 (PST) X-Google-Smtp-Source: AGHT+IEAyuzU1pjQvxb9zlZbKnBoJ+n+Ae2iI7vTF8A8Q02VXRT7N68s8RLVciKaQulK0aBILcXp X-Received: by 2002:a05:6820:e05:b0:59c:e5d3:45cb with SMTP id el5-20020a0568200e0500b0059ce5d345cbmr1540801oob.0.1707220846257; Tue, 06 Feb 2024 04:00:46 -0800 (PST) ARC-Seal: i=2; a=rsa-sha256; t=1707220846; cv=pass; d=google.com; s=arc-20160816; b=mO8DLCfYK3WwsTjNRXaPWowXGUG3S3+bycW/yFiOJ58d0wP+Cv2Hg6Nk1NgLPivIwh gEU2KcKndG2VHu5yGg/TFQAQnH2CYjl9ZdcyWL5eHMmodNq3AP0YA3LI9tGgJfYMorjL CFyNJzqqItCKfewFgOF6cka073KxgRus3+8OaKNv+6gCsPs3GaPb6L+l5WhZ72jBJov3 naAiEFssxJHWAtK86gIRccpGlI8e0/5noYyiuZbTIvQhLudY0XiGTv9ThuGVBvCr87k0 3vZQcHJ4rpGnnb11ZCHzXLMLTikHnrCUCmyD5jUnr2jm3W7LxaE6RsQSBsG4aNxbe4t4 AJbg== ARC-Message-Signature: i=2; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=content-transfer-encoding:mime-version:list-unsubscribe :list-subscribe:list-id:precedence:references:in-reply-to:message-id :date:subject:cc:to:from:dkim-signature; bh=ej+YcMoyPkSvf5dqTkEkDG2azTmL1gzXIrSHqaw8k2s=; fh=HBI/RVUS629tHjdSCXmy5FNfKb14jJJ3ruscYvrlIBM=; b=uGVOCM/VaC9m4x3uatsIzKeIZ9lQzAAFsrDUsQ/+XcJz9wPgB5Kd+MjcvOo9w3yBBH rB+GYNo74BPxOJnA4P36M9Jc5vamPsoj67jwEx63XuCaNITWVWo/gPTGTgPXnKywkqBe etwEtJl9E/627FhUSxCGdrPYSqBo0SX4mCvDL7Gx+dUw5pKm931WusD+uasGzc0D54CW CRrh4Iuk2QUi5xU9q+5RygFgMyRIP5Jp70GpF8wAOUJdBsom1tD+KnHgKpa7QI/Dfi8Y 7mMqBKEa40/CejoEZno0zai+k7VfRouCZ9Xz91CTLxVdAsXXzgJ6TvC2He2qu0JME2sn 4xkA==; dara=google.com ARC-Authentication-Results: i=2; mx.google.com; dkim=pass header.i=@marvell.com header.s=pfpt0220 header.b=PwY89Ou4; arc=pass (i=1 spf=pass spfdomain=marvell.com dkim=pass dkdomain=marvell.com dmarc=pass fromdomain=marvell.com); spf=pass (google.com: domain of linux-kernel+bounces-54823-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) smtp.mailfrom="linux-kernel+bounces-54823-ouuuleilei=gmail.com@vger.kernel.org"; dmarc=pass (p=NONE sp=REJECT dis=NONE) header.from=marvell.com X-Forwarded-Encrypted: i=1; AJvYcCVz8NHSgKPO8MKCXewEkO64g1G+N2NOBLH/kc+0ea6oC6w6YwUr4Y+iJIeI1T8kCxScJqjAahjNFXGp32qGBhuhkPxsBw== Received: from ny.mirrors.kernel.org (ny.mirrors.kernel.org. [2604:1380:45d1:ec00::1]) by mx.google.com with ESMTPS id f13-20020a05621400cd00b0068c47b4f6dcsi2161754qvs.610.2024.02.06.04.00.46 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 06 Feb 2024 04:00:46 -0800 (PST) Received-SPF: pass (google.com: domain of linux-kernel+bounces-54823-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) client-ip=2604:1380:45d1:ec00::1; Authentication-Results: mx.google.com; dkim=pass header.i=@marvell.com header.s=pfpt0220 header.b=PwY89Ou4; arc=pass (i=1 spf=pass spfdomain=marvell.com dkim=pass dkdomain=marvell.com dmarc=pass fromdomain=marvell.com); spf=pass (google.com: domain of linux-kernel+bounces-54823-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) smtp.mailfrom="linux-kernel+bounces-54823-ouuuleilei=gmail.com@vger.kernel.org"; dmarc=pass (p=NONE sp=REJECT dis=NONE) header.from=marvell.com Received: from smtp.subspace.kernel.org (wormhole.subspace.kernel.org [52.25.139.140]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by ny.mirrors.kernel.org (Postfix) with ESMTPS id D584D1C21254 for ; Tue, 6 Feb 2024 12:00:45 +0000 (UTC) Received: from localhost.localdomain (localhost.localdomain [127.0.0.1]) by smtp.subspace.kernel.org (Postfix) with ESMTP id 379F4132C01; Tue, 6 Feb 2024 11:45:14 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=marvell.com header.i=@marvell.com header.b="PwY89Ou4" Received: from mx0b-0016f401.pphosted.com (mx0a-0016f401.pphosted.com [67.231.148.174]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id E5276131E33; Tue, 6 Feb 2024 11:45:08 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=67.231.148.174 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1707219911; cv=none; b=QvlrRl1f7rhvz5aeWmNvJimgvxadTdvNNU6d+EImBi34nXVEw+kbPBL+Tskd/rpbWQqhPmfRjZ6r63tRGwWdUc2hRjvCRwgBj4/1v+z8Tc8rUNRJ4uxQZvm2H65F5mMVrdWiaHwlF+qDYxU2CCyHcBDDcWt6ncPacQA93AQWets= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1707219911; c=relaxed/simple; bh=5MaI+SAJmeMZipScJnfmg2EXRGX8tvxaCG/kfIfa3yc=; h=From:To:CC:Subject:Date:Message-ID:In-Reply-To:References: MIME-Version:Content-Type; b=GwPQSbWrS6oHM5Ra85qt3U1zm/FjF6sYt/vYtD6DwH/WdBFaLbwQcNipfzRkt9ca1TONhX4Dg2H6H3JNJ9SQlVBZMi4MXVqafogRRTWXiaOWinD3JuNP6blwur1oZWZM5zvcCCpaTBil5nAH7U1ivTa6UdcLuNbTxwidn+kOipI= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=marvell.com; spf=pass smtp.mailfrom=marvell.com; dkim=pass (2048-bit key) header.d=marvell.com header.i=@marvell.com header.b=PwY89Ou4; arc=none smtp.client-ip=67.231.148.174 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=marvell.com Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=marvell.com Received: from pps.filterd (m0045849.ppops.net [127.0.0.1]) by mx0a-0016f401.pphosted.com (8.17.1.24/8.17.1.24) with ESMTP id 416BBNGf024712; Tue, 6 Feb 2024 03:45:06 -0800 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=marvell.com; h= from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding:content-type; s= pfpt0220; bh=ej+YcMoyPkSvf5dqTkEkDG2azTmL1gzXIrSHqaw8k2s=; b=PwY 89Ou4CP7KP/EL1UXGuITR96P9+zcw2ndN+d2w92oV28Fs3DHzrGC2sskqEKuY74h t6J8kfoMI8j4OfwUEaOO390T5h8KOhBZOVDNJIJiDK4f25rTNORSNEhEd4qZZ4WU Z768UmjV8R2VZYqzMk8LwO3vztbPpIoODoD72hw2XLyCjabVcGLnUcAKgyE3eta+ oUddK0V6FD9BgD7EDwtIJXy67PxRKK8L8y6LMJgLxrc+3jQWP9UzgJ9ko1N62WPq 3dJyJOqiklqwijWfXA7Fa3viPOSaZetb/ewSB9JnRmA9FKBUTShFxuL3vpN5FF4B vIMqJOMnoTWpc+XFxhA== Received: from dc5-exch01.marvell.com ([199.233.59.181]) by mx0a-0016f401.pphosted.com (PPS) with ESMTPS id 3w38y4j006-1 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-SHA384 bits=256 verify=NOT); Tue, 06 Feb 2024 03:45:06 -0800 (PST) Received: from DC5-EXCH02.marvell.com (10.69.176.39) by DC5-EXCH01.marvell.com (10.69.176.38) with Microsoft SMTP Server (TLS) id 15.0.1497.48; Tue, 6 Feb 2024 03:45:05 -0800 Received: from maili.marvell.com (10.69.176.80) by DC5-EXCH02.marvell.com (10.69.176.39) with Microsoft SMTP Server id 15.0.1497.48 via Frontend Transport; Tue, 6 Feb 2024 03:45:05 -0800 Received: from localhost.localdomain (unknown [10.110.150.250]) by maili.marvell.com (Postfix) with ESMTP id A503A3F7041; Tue, 6 Feb 2024 03:45:04 -0800 (PST) From: Piyush Malgujar To: , , CC: , , , Piyush Malgujar Subject: [PATCH v3 3/4] i2c: octeon: Handle watchdog timeout Date: Tue, 6 Feb 2024 03:43:48 -0800 Message-ID: <20240206114349.32197-4-pmalgujar@marvell.com> X-Mailer: git-send-email 2.42.0 In-Reply-To: <20240206114349.32197-1-pmalgujar@marvell.com> References: <20240206114349.32197-1-pmalgujar@marvell.com> Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 X-Proofpoint-ORIG-GUID: afM_f96TIEIfEP7b4ojVOv2hQGf_qfaS X-Proofpoint-GUID: afM_f96TIEIfEP7b4ojVOv2hQGf_qfaS X-Proofpoint-Virus-Version: vendor=baseguard engine=ICAP:2.0.272,Aquarius:18.0.1011,Hydra:6.0.619,FMLib:17.11.176.26 definitions=2024-02-06_04,2024-01-31_01,2023-05-22_02 X-getmail-retrieved-from-mailbox: INBOX X-GMAIL-THRID: 1790150806293298559 X-GMAIL-MSGID: 1790150806293298559 From: Suneel Garapati Status code 0xF0 refers to expiry of TWSI controller access watchdog and needs bus monitor reset using MODE register. Signed-off-by: Suneel Garapati Signed-off-by: Piyush Malgujar Acked-by: Andi Shyti --- drivers/i2c/busses/i2c-octeon-core.c | 8 ++++++++ drivers/i2c/busses/i2c-octeon-core.h | 4 ++++ 2 files changed, 12 insertions(+) diff --git a/drivers/i2c/busses/i2c-octeon-core.c b/drivers/i2c/busses/i2c-octeon-core.c index 6636719ca8f005056230620e2cee19de7154e024..0c89d8d640424356f1ea4f7da11d528631ae7efd 100644 --- a/drivers/i2c/busses/i2c-octeon-core.c +++ b/drivers/i2c/busses/i2c-octeon-core.c @@ -178,6 +178,7 @@ static int octeon_i2c_hlc_wait(struct octeon_i2c *i2c) static int octeon_i2c_check_status(struct octeon_i2c *i2c, int final_read) { u8 stat; + u64 mode; /* * This is ugly... in HLC mode the status is not in the status register @@ -240,6 +241,13 @@ static int octeon_i2c_check_status(struct octeon_i2c *i2c, int final_read) case STAT_RXADDR_NAK: case STAT_AD2W_NAK: return -ENXIO; + + case STAT_WDOG_TOUT: + mode = __raw_readq(i2c->twsi_base + MODE(i2c)); + /* Set BUS_MON_RST to reset bus monitor */ + mode |= BUS_MON_RST_MASK; + octeon_i2c_writeq_flush(mode, i2c->twsi_base + MODE(i2c)); + return -EIO; default: dev_err(i2c->dev, "unhandled state: %d\n", stat); return -EIO; diff --git a/drivers/i2c/busses/i2c-octeon-core.h b/drivers/i2c/busses/i2c-octeon-core.h index e89f041550ace5f7cbcdd94146d0193abe51d466..e53fe60a41b7feb7ccc081cc671cec7be00c5a97 100644 --- a/drivers/i2c/busses/i2c-octeon-core.h +++ b/drivers/i2c/busses/i2c-octeon-core.h @@ -72,6 +72,7 @@ #define STAT_SLAVE_ACK 0xC8 #define STAT_AD2W_ACK 0xD0 #define STAT_AD2W_NAK 0xD8 +#define STAT_WDOG_TOUT 0xF0 #define STAT_IDLE 0xF8 /* TWSI_INT values */ @@ -106,6 +107,9 @@ struct octeon_i2c_reg_offset { /* Set REFCLK_SRC and HS_MODE in TWSX_MODE register */ #define TWSX_MODE_HS_MASK (BIT(4) | BIT(0)) +/* Set BUS_MON_RST to reset bus monitor */ +#define BUS_MON_RST_MASK BIT(3) + struct octeon_i2c { wait_queue_head_t queue; struct i2c_adapter adap; From patchwork Tue Feb 6 11:43:49 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Piyush Malgujar X-Patchwork-Id: 197360 Return-Path: Delivered-To: ouuuleilei@gmail.com Received: by 2002:a05:7301:168b:b0:106:860b:bbdd with SMTP id ma11csp1485906dyb; Tue, 6 Feb 2024 04:01:20 -0800 (PST) X-Google-Smtp-Source: AGHT+IE9D8vnaIo9eUfE8paumwMT0BP0ttCbtUH49TcfZCBDODPIor1R/nYuUWKxRcWYuIjwzV6h X-Received: by 2002:a05:6808:2116:b0:3bf:d136:62bd with SMTP id r22-20020a056808211600b003bfd13662bdmr2393338oiw.32.1707220880050; Tue, 06 Feb 2024 04:01:20 -0800 (PST) ARC-Seal: i=2; a=rsa-sha256; t=1707220880; cv=pass; d=google.com; s=arc-20160816; b=hKWaSWRVEFHXVGB4+gi7QzugS8Uw5izt1u6ERVxNNeDTLKWElTTbnccq62IdO/Od8d +GOYp/Z1lJHLzKxgeMV6ulmdklZCGeU2FP0Wxo+YmwUBz6u53hIaguijYZ9npYhAEhwe M/LI0zI0afPqxhmtohAMRQcciyAyqkz7Y/+5Q3ff95iSp2jjdpLlAaQzHQvQdH1+lAaO vNcjgNbIBMs8zZ/6sC4eHx6896yc1BuZS7VFJdetVj0s1L0fF7OhjbxX4JpAORoVMgA6 +H4rsfXyPAmDJmfQKSx6uz1/35NYvU2Pl1DnPJOQOKplcxIo/tDbLPx1BT+lZI7sShf+ F7/g== ARC-Message-Signature: i=2; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=content-transfer-encoding:mime-version:list-unsubscribe :list-subscribe:list-id:precedence:references:in-reply-to:message-id :date:subject:cc:to:from:dkim-signature; bh=I7YJVFpHyhttKaVQSn+im9bTu9lSBp0OqXLztLyaCtY=; fh=+hW3MtQl/yR3/KP6cmTDji8FPPB57ns5y2h83Iij0Q0=; b=UnVUsVu6ixebmkekuXDZRCm8pBZLd66vat/S/X5TiLkDgA1YDS2lxDfXnHuUIdROPe 4/gK8OFJx/yY5z1ihw4XnCwFRXDzJSiMXZBuZMcSFNutdtV99U86mpb7ripqmxvc8Zxd 5eMy8Ei5mQ21Ub7cwC9q48rvwZWBL7ZhAW5T9ji4Stdcas6mVt0RzWg3P+1yv2Zkw9KF hwyQMJG3vrzBTrKFQAPMU0BbFm0WNEVgiU8a0UajH6zeFaiXvKlyPqIcDdKL2kMXRF+u VjwbQI2METskyz280CsSE1bSDTqnxwsa8EZh6lFldcVO5HXoQlu95hfGEUWQ3NdHX580 jWIg==; dara=google.com ARC-Authentication-Results: i=2; mx.google.com; dkim=pass header.i=@marvell.com header.s=pfpt0220 header.b=bJfVVmN2; arc=pass (i=1 spf=pass spfdomain=marvell.com dkim=pass dkdomain=marvell.com dmarc=pass fromdomain=marvell.com); spf=pass (google.com: domain of linux-kernel+bounces-54825-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) smtp.mailfrom="linux-kernel+bounces-54825-ouuuleilei=gmail.com@vger.kernel.org"; dmarc=pass (p=NONE sp=REJECT dis=NONE) header.from=marvell.com X-Forwarded-Encrypted: i=1; AJvYcCW6vtTBwOSdGxAzYKzsNhapeiS5KxVBZmms2Ap0oCQYWOAYW99SLc9OTAhEw/M9zcz58rdwPKHdYRdGFCt0KMuSyYFjrQ== Received: from ny.mirrors.kernel.org (ny.mirrors.kernel.org. [2604:1380:45d1:ec00::1]) by mx.google.com with ESMTPS id o21-20020a05620a2a1500b007859019f10dsi1132528qkp.203.2024.02.06.04.01.19 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 06 Feb 2024 04:01:20 -0800 (PST) Received-SPF: pass (google.com: domain of linux-kernel+bounces-54825-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) client-ip=2604:1380:45d1:ec00::1; Authentication-Results: mx.google.com; dkim=pass header.i=@marvell.com header.s=pfpt0220 header.b=bJfVVmN2; arc=pass (i=1 spf=pass spfdomain=marvell.com dkim=pass dkdomain=marvell.com dmarc=pass fromdomain=marvell.com); spf=pass (google.com: domain of linux-kernel+bounces-54825-ouuuleilei=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) smtp.mailfrom="linux-kernel+bounces-54825-ouuuleilei=gmail.com@vger.kernel.org"; dmarc=pass (p=NONE sp=REJECT dis=NONE) header.from=marvell.com Received: from smtp.subspace.kernel.org (wormhole.subspace.kernel.org [52.25.139.140]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by ny.mirrors.kernel.org (Postfix) with ESMTPS id BC2C71C20AE8 for ; Tue, 6 Feb 2024 12:01:19 +0000 (UTC) Received: from localhost.localdomain (localhost.localdomain [127.0.0.1]) by smtp.subspace.kernel.org (Postfix) with ESMTP id 8CC30132C2C; Tue, 6 Feb 2024 11:45:23 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=marvell.com header.i=@marvell.com header.b="bJfVVmN2" Received: from mx0b-0016f401.pphosted.com (mx0b-0016f401.pphosted.com [67.231.156.173]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 7CADF132C2B; Tue, 6 Feb 2024 11:45:19 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=67.231.156.173 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1707219921; cv=none; b=kszi8mhfZlftwtHdFn4OlizFdmy4h2R4j9vsGfpqCORhFrP6QYp1tS09TJBChT+43FIq1m2dX3pNHfW3CFE6VQ5YEVA5utCKQd78wloUqBj1ukrcWrOrQDhiJc4vWwIfpWRnpZntok1CJHellmTAvbWwEMaINI7pitjQir9Fni0= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1707219921; c=relaxed/simple; bh=CvtzeV3LJoPwbA5d/XDUSj8ICkXD0P1E718iT2JTfg8=; h=From:To:CC:Subject:Date:Message-ID:In-Reply-To:References: MIME-Version:Content-Type; b=OxMRgoA1XutswAHQg1g/VuPAnfaMqvfB4O7uT8q0Uxt4wHkO+74/fYdwa9KHasMsuNAMFET/zy5gfl1HfYoVVcrG/J5XlI7OjbmRrRnbV2aB6vj/6i7Yc9wMxINhPmz217XAwqhzqPcLgd4Tof0ST2RCxs5hUv27EI0pSXOO+d0= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=marvell.com; spf=pass smtp.mailfrom=marvell.com; dkim=pass (2048-bit key) header.d=marvell.com header.i=@marvell.com header.b=bJfVVmN2; arc=none smtp.client-ip=67.231.156.173 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=marvell.com Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=marvell.com Received: from pps.filterd (m0045851.ppops.net [127.0.0.1]) by mx0b-0016f401.pphosted.com (8.17.1.24/8.17.1.24) with ESMTP id 416B5pjH027405; Tue, 6 Feb 2024 03:45:16 -0800 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=marvell.com; h= from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding:content-type; s= pfpt0220; bh=I7YJVFpHyhttKaVQSn+im9bTu9lSBp0OqXLztLyaCtY=; b=bJf VVmN27517dICSL874oGjKtDHMq5puiyUCjqonmrgFWzrxh8rcXSKH10NZ1PeW1lf 40izrpQFdeNKO7bdFeHCvt6/+32X9Cn10uCu+jzQwu9Ud73evXKFpf1jM1BsUWMA P3Edr9NICGZ3OWjWtTOOwdUpeNWku7zfLB/Qkt1K/pjpO6eI1WV3SHolB4ZQqPZN rA4vY9UkCJi+J0N8iep5An+O2au0AuaAgS2fEurOUPrFUFDeLIgLtnN8tvKkoE1H 2PULZ/q4R2j1bq93/Ge8701F6AzVFXVdvQYo0ph2O6cMf3EyEjNn668uqysxL/kf Ep+C9bJRHF+IzCjpgiw== Received: from dc5-exch01.marvell.com ([199.233.59.181]) by mx0b-0016f401.pphosted.com (PPS) with ESMTPS id 3w38u81xvt-1 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-SHA384 bits=256 verify=NOT); Tue, 06 Feb 2024 03:45:16 -0800 (PST) Received: from DC5-EXCH01.marvell.com (10.69.176.38) by DC5-EXCH01.marvell.com (10.69.176.38) with Microsoft SMTP Server (TLS) id 15.0.1497.48; Tue, 6 Feb 2024 03:45:14 -0800 Received: from maili.marvell.com (10.69.176.80) by DC5-EXCH01.marvell.com (10.69.176.38) with Microsoft SMTP Server id 15.0.1497.48 via Frontend Transport; Tue, 6 Feb 2024 03:45:14 -0800 Received: from localhost.localdomain (unknown [10.110.150.250]) by maili.marvell.com (Postfix) with ESMTP id 0E5723F7088; Tue, 6 Feb 2024 03:45:14 -0800 (PST) From: Piyush Malgujar To: , , CC: , , , Piyush Malgujar Subject: [PATCH v3 4/4] i2c: thunderx: Adding ioclk support Date: Tue, 6 Feb 2024 03:43:49 -0800 Message-ID: <20240206114349.32197-5-pmalgujar@marvell.com> X-Mailer: git-send-email 2.42.0 In-Reply-To: <20240206114349.32197-1-pmalgujar@marvell.com> References: <20240206114349.32197-1-pmalgujar@marvell.com> Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 X-Proofpoint-ORIG-GUID: z5SwNWQCHvtpq0aAnR00QFbgnzIt3PiB X-Proofpoint-GUID: z5SwNWQCHvtpq0aAnR00QFbgnzIt3PiB X-Proofpoint-Virus-Version: vendor=baseguard engine=ICAP:2.0.272,Aquarius:18.0.1011,Hydra:6.0.619,FMLib:17.11.176.26 definitions=2024-02-06_04,2024-01-31_01,2023-05-22_02 X-getmail-retrieved-from-mailbox: INBOX X-GMAIL-THRID: 1790150841550104576 X-GMAIL-MSGID: 1790150841550104576 Adding support to use ioclk as reference clock if sclk not present to make it SOC agnostic. In case, it's not defined in dts/acpi table, use 800MHz as default clock. Signed-off-by: Piyush Malgujar --- drivers/i2c/busses/i2c-thunderx-pcidrv.c | 15 ++++++++++----- 1 file changed, 10 insertions(+), 5 deletions(-) diff --git a/drivers/i2c/busses/i2c-thunderx-pcidrv.c b/drivers/i2c/busses/i2c-thunderx-pcidrv.c index 31f11b77ab663626967c86086a03213876bf4a07..15cf794a776533d1b0dbb08597fc0d9acf791b44 100644 --- a/drivers/i2c/busses/i2c-thunderx-pcidrv.c +++ b/drivers/i2c/busses/i2c-thunderx-pcidrv.c @@ -27,7 +27,7 @@ #define PCI_DEVICE_ID_THUNDER_TWSI 0xa012 -#define SYS_FREQ_DEFAULT 700000000 +#define SYS_FREQ_DEFAULT 800000000 #define OTX2_REF_FREQ_DEFAULT 100000000 #define TWSI_INT_ENA_W1C 0x1028 @@ -100,7 +100,8 @@ static void thunder_i2c_clock_enable(struct device *dev, struct octeon_i2c *i2c) i2c->sys_freq = clk_get_rate(i2c->clk); } else { /* ACPI */ - device_property_read_u32(dev, "sclk", &i2c->sys_freq); + if (device_property_read_u32(dev, "sclk", &i2c->sys_freq)) + device_property_read_u32(dev, "ioclk", &i2c->sys_freq); } skip: @@ -182,7 +183,6 @@ static int thunder_i2c_probe_pci(struct pci_dev *pdev, if (!i2c->twsi_base) return -EINVAL; - thunder_i2c_clock_enable(dev, i2c); ret = device_property_read_u32(dev, "clock-frequency", &i2c->twsi_freq); if (ret) i2c->twsi_freq = I2C_MAX_STANDARD_MODE_FREQ; @@ -196,12 +196,12 @@ static int thunder_i2c_probe_pci(struct pci_dev *pdev, ret = pci_alloc_irq_vectors(pdev, 1, 1, PCI_IRQ_MSIX); if (ret < 0) - goto error; + return ret; ret = devm_request_irq(dev, pci_irq_vector(pdev, 0), octeon_i2c_isr, 0, DRV_NAME, i2c); if (ret) - goto error; + return ret; ret = octeon_i2c_init_lowlevel(i2c); if (ret) @@ -213,6 +213,9 @@ static int thunder_i2c_probe_pci(struct pci_dev *pdev, */ if (octeon_i2c_is_otx2(pdev) && IS_LS_FREQ(i2c->twsi_freq)) i2c->sys_freq = OTX2_REF_FREQ_DEFAULT; + else + thunder_i2c_clock_enable(dev, i2c); + octeon_i2c_set_clock(i2c); i2c->adap = thunderx_i2c_ops; @@ -240,6 +243,8 @@ static int thunder_i2c_probe_pci(struct pci_dev *pdev, error: thunder_i2c_clock_disable(dev, i2c->clk); + if (!IS_LS_FREQ(i2c->twsi_freq)) + thunder_i2c_clock_disable(dev, i2c->clk); return ret; }