From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id 512FCC3DA6F for ; Thu, 24 Aug 2023 15:49:49 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S242267AbjHXPtS (ORCPT ); Thu, 24 Aug 2023 11:49:18 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:46860 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S242306AbjHXPsz (ORCPT ); Thu, 24 Aug 2023 11:48:55 -0400 Received: from phobos.denx.de (phobos.denx.de [IPv6:2a01:238:438b:c500:173d:9f52:ddab:ee01]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id B44E3199F; Thu, 24 Aug 2023 08:48:52 -0700 (PDT) Received: from localhost.localdomain (85-222-111-42.dynamic.chello.pl [85.222.111.42]) (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits)) (No client certificate requested) (Authenticated sender: lukma@denx.de) by phobos.denx.de (Postfix) with ESMTPSA id 2054A8609B; Thu, 24 Aug 2023 17:48:50 +0200 (CEST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=denx.de; s=phobos-20191101; t=1692892131; bh=H7FM7ibaZ+AGk5z5tKpm5KmKsPsHbA7ASKu0Pd5KuWE=; h=From:To:Cc:Subject:Date:From; b=XQ5ZqWUaW6StxQF2LrjwD437t1fpL1Q+gl3CzHps57TvOvLXbRJdPTfJ+6PBU3K4M JK2ufVxymKLDflSu6BrwFVwm7JotTIb/gP1vz3gSataV/XJwDFIS+49allJTpFYTnr x71ZUgZtQDdMaucvsModMn99Yo9Dcfe3L6c+Vt9aOGs7R6II6/VrGGwanQIosGwj50 56r6zUzBoPCyletjIq2WJXxyGyPqEkkKXmnTWuEqWjuuBHu/b4SXlAOzPzJhASnTyL 90raq2VxV2KNytTurs3Y1pCEhTXTCxZp1GK7vU4tdCdUQcFR9kYYFWtyqWo4cRJ1sk 9lsxFSQQLp3TA== From: Lukasz Majewski To: Woojung Huh , UNGLinuxDriver@microchip.com Cc: Andrew Lunn , Florian Fainelli , Vladimir Oltean , davem@davemloft.net, Eric Dumazet , Jakub Kicinski , Paolo Abeni , netdev@vger.kernel.org, linux-kernel@vger.kernel.org, Lukasz Majewski Subject: [PATCH 1/2] net: dsa: microchip: KSZ9477: Provide functions to access MMD registers Date: Thu, 24 Aug 2023 17:48:26 +0200 Message-Id: <20230824154827.166274-1-lukma@denx.de> X-Mailer: git-send-email 2.39.2 MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Virus-Scanned: clamav-milter 0.103.8 at phobos.denx.de X-Virus-Status: Clean Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Those function are necessary to access MMD (indirect) port registers of the KSZ9477 device. Signed-off-by: Lukasz Majewski --- drivers/net/dsa/microchip/ksz9477.c | 31 +++++++++++++++++++++++++++++ 1 file changed, 31 insertions(+) diff --git a/drivers/net/dsa/microchip/ksz9477.c b/drivers/net/dsa/microchip/ksz9477.c index 83b7f2d5c1ea..cb6aa7c668a8 100644 --- a/drivers/net/dsa/microchip/ksz9477.c +++ b/drivers/net/dsa/microchip/ksz9477.c @@ -43,6 +43,37 @@ static void ksz9477_port_cfg32(struct ksz_device *dev, int port, int offset, bits, set ? bits : 0); } +static void ksz9477_port_mmd_setup(struct ksz_device *dev, uint port, u16 devid, + u16 reg, u16 len) +{ + u16 ctrl = PORT_MMD_OP_DATA_NO_INCR; + + if (len > 1) + ctrl = PORT_MMD_OP_DATA_INCR_RW; + + ksz_pwrite16(dev, port, REG_PORT_PHY_MMD_SETUP, + MMD_SETUP(PORT_MMD_OP_INDEX, devid)); + ksz_pwrite16(dev, port, REG_PORT_PHY_MMD_INDEX_DATA, reg); + ksz_pwrite16(dev, port, REG_PORT_PHY_MMD_SETUP, + MMD_SETUP(ctrl, devid)); +} + +static void ksz9477_port_mmd_read(struct ksz_device *dev, uint port, u16 devid, + u16 reg, u16 *buf, u16 len) +{ + ksz9477_port_mmd_setup(dev, port, devid, reg, len); + for (; len; buf++, len--) + ksz_pread16(dev, port, REG_PORT_PHY_MMD_INDEX_DATA, buf); +} + +static void ksz9477_port_mmd_write(struct ksz_device *dev, uint port, u16 devid, + u16 reg, u16 *buf, u16 len) +{ + ksz9477_port_mmd_setup(dev, port, devid, reg, len); + for (; len; buf++, len--) + ksz_pwrite16(dev, port, REG_PORT_PHY_MMD_INDEX_DATA, *buf); +} + int ksz9477_change_mtu(struct ksz_device *dev, int port, int mtu) { u16 frame_size; -- 2.20.1