From patchwork Tue Oct 9 12:52:12 2018 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Ben Whitten X-Patchwork-Id: 981185 X-Patchwork-Delegate: davem@davemloft.net Return-Path: X-Original-To: patchwork-incoming-netdev@ozlabs.org Delivered-To: patchwork-incoming-netdev@ozlabs.org Authentication-Results: ozlabs.org; spf=none (mailfrom) smtp.mailfrom=vger.kernel.org (client-ip=209.132.180.67; helo=vger.kernel.org; envelope-from=netdev-owner@vger.kernel.org; receiver=) Authentication-Results: ozlabs.org; dmarc=fail (p=none dis=none) header.from=gmail.com Authentication-Results: ozlabs.org; dkim=fail reason="signature verification failed" (2048-bit key; unprotected) header.d=gmail.com header.i=@gmail.com header.b="IXt/b8Cq"; dkim-atps=neutral Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by ozlabs.org (Postfix) with ESMTP id 42Txvy4MSvz9s89 for ; Tue, 9 Oct 2018 23:52:30 +1100 (AEDT) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1726996AbeJIUJQ (ORCPT ); Tue, 9 Oct 2018 16:09:16 -0400 Received: from mail-wr1-f68.google.com ([209.85.221.68]:43472 "EHLO mail-wr1-f68.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1726418AbeJIUJP (ORCPT ); Tue, 9 Oct 2018 16:09:15 -0400 Received: by mail-wr1-f68.google.com with SMTP id n1-v6so1693949wrt.10 for ; Tue, 09 Oct 2018 05:52:25 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=sender:from:to:cc:subject:date:message-id:in-reply-to:references; bh=3hcLtoIx+3RMJy1iKFY0lbX0ZhVJFQV9l0heT1OGdaw=; b=IXt/b8CqRfX5c9DPBTiXjbbcHSgOw9adHNyr634tiMauYM3M1pRx5EOQLA7SuQ27JY H5umkL3QLoh1sdN2/CTM3gpqR/Q7bo5SQWygQpdwKlnAALjd2q79tie2np/tDxxI1J4N XQfTKFY8KhrolwkJ3EmZgPQ6iWrUoH7lG2ysbY9yoG5uhpfUaXtirlW+k7qd0N/KdNgl U65Q1EUc1xWZKe92o5IuO0N8JSZloMPaodpnUXzVM/DPiKKXlD+g9qgV7HTTV8rxbt3Y +AX7b4cvuWe4Uhw7OlX2PLuEOntkvDIKnSYrY+NDvBPtHHmfMHjMfcXmL584t3LdzRbt X/Sw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:sender:from:to:cc:subject:date:message-id :in-reply-to:references; bh=3hcLtoIx+3RMJy1iKFY0lbX0ZhVJFQV9l0heT1OGdaw=; b=SwRCaHXh3l55NQeyRSdY4R+K5B5XrBep6lgHbJJLgTGXLAKgF3zoqjKAKx7aMHzO17 BGBYWJnzaL/hvIgBJ3nbSpZ9V0TZSvKs70HZ4S5dBMR7i0sO90kQZAC/ZylFmreVUHrc SlBUDw3Atyb40oH1AGNesShrwuO3rNypTDSsbqJFUiO2JK146VgL/h0PjqM1DbSdhIZE 0212XdNX0P1AA+Kv26FrRnRcNbHG/T8p808EgrZjM35A6ik7W3WzM+G6MNOkLUE5oKv8 zAeBTy+IzBk+eS7ofjWeYNslBejEO18v8ehFyoz8sjKM6cdaQ6VZf6suvHQ56erTzeyV wQ9A== X-Gm-Message-State: ABuFfojeToOnTFA/qMYi+ngylcw1eGfJetzVtxZ8aq0YN6f+kuIfHblH o8+9nT6AdVJzYBmD9+4l6HHTtubs8Er6Ow== X-Google-Smtp-Source: ACcGV63F31MeYYtRu7AUh1uAHSHU1/erN08LARwtXrM0wFQPVecSuToovV/Vt/7XNd0HVAavfDgA2g== X-Received: by 2002:a5d:694c:: with SMTP id r12-v6mr18726197wrw.170.1539089544550; Tue, 09 Oct 2018 05:52:24 -0700 (PDT) Received: from Sarah.corp.lairdtech.com ([109.174.151.67]) by smtp.gmail.com with ESMTPSA id g3-v6sm17216942wrw.81.2018.10.09.05.52.23 (version=TLS1_2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Tue, 09 Oct 2018 05:52:23 -0700 (PDT) From: Ben Whitten X-Google-Original-From: Ben Whitten To: afaerber@suse.de Cc: starnight@g.ncu.edu.tw, hasnain.virk@arm.com, netdev@vger.kernel.org, liuxuenetmail@gmail.com, shess@hessware.de, Ben Whitten Subject: [PATCH v2 lora-next 4/4] net: lora: sx125x sx1301: allow radio to register as a clk provider Date: Tue, 9 Oct 2018 13:52:12 +0100 Message-Id: <1539089532-2481-5-git-send-email-ben.whitten@lairdtech.com> X-Mailer: git-send-email 2.7.4 In-Reply-To: <1539089532-2481-1-git-send-email-ben.whitten@lairdtech.com> References: <1539089532-2481-1-git-send-email-ben.whitten@lairdtech.com> Sender: netdev-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: netdev@vger.kernel.org From: Ben Whitten The 32M is run from the radio, before we just enabled it based on the radio number but now we can use the clk framework to request the clk is started when we need it. The 32M clock produced from the radio is really a gated version of tcxo which is a fixed clock provided by hardware, and isn't captured in this patch. The sx1301 brings the clock up prior to calibration once the radios have probed themselves. A sample dts showing the clk link: sx1301: sx1301@0 { ... clocks = <&radio1 0>; clock-names = "clk32m"; radio-spi { radio0: radio-a@0 { ... }; radio1: radio-b@1 { #clock-cells = <0>; clock-output-names = "clk32m"; }; }; }; Signed-off-by: Ben Whitten --- drivers/net/lora/sx125x.c | 112 ++++++++++++++++++++++++++++++++++++++++++---- drivers/net/lora/sx1301.c | 13 ++++++ drivers/net/lora/sx1301.h | 2 + 3 files changed, 119 insertions(+), 8 deletions(-) diff --git a/drivers/net/lora/sx125x.c b/drivers/net/lora/sx125x.c index 36b61b1..b7ca782 100644 --- a/drivers/net/lora/sx125x.c +++ b/drivers/net/lora/sx125x.c @@ -9,6 +9,8 @@ * Copyright (c) 2013 Semtech-Cycleo */ +#include +#include #include #include #include @@ -42,10 +44,16 @@ static const struct reg_field sx125x_regmap_fields[] = { }; struct sx125x_priv { + struct clk *clkout; + struct clk_hw clkout_hw; + + struct device *dev; struct regmap *regmap; struct regmap_field *regmap_fields[ARRAY_SIZE(sx125x_regmap_fields)]; }; +#define to_clkout(_hw) container_of(_hw, struct sx125x_priv, clkout_hw) + static struct regmap_config __maybe_unused sx125x_regmap_config = { .reg_bits = 8, .val_bits = 8, @@ -64,6 +72,96 @@ static int sx125x_field_write(struct sx125x_priv *priv, return regmap_field_write(priv->regmap_fields[field_id], val); } +static int sx125x_field_read(struct sx125x_priv *priv, + enum sx125x_fields field_id, unsigned int *val) +{ + return regmap_field_read(priv->regmap_fields[field_id], val); +} + +static int sx125x_clkout_enable(struct clk_hw *hw) +{ + struct sx125x_priv *priv = to_clkout(hw); + + dev_info(priv->dev, "enabling clkout\n"); + return sx125x_field_write(priv, F_CLK_OUT, 1); +} + +static void sx125x_clkout_disable(struct clk_hw *hw) +{ + struct sx125x_priv *priv = to_clkout(hw); + int ret; + + dev_info(priv->dev, "disabling clkout\n"); + ret = sx125x_field_write(priv, F_CLK_OUT, 0); + if (ret) + dev_err(priv->dev, "error disabling clkout\n"); +} + +static int sx125x_clkout_is_enabled(struct clk_hw *hw) +{ + struct sx125x_priv *priv = to_clkout(hw); + unsigned int enabled; + int ret; + + ret = sx125x_field_read(priv, F_CLK_OUT, &enabled); + if (ret) { + dev_err(priv->dev, "error reading clk enable\n"); + return 0; + } + return enabled; +} + +static const struct clk_ops sx125x_clkout_ops = { + .enable = sx125x_clkout_enable, + .disable = sx125x_clkout_disable, + .is_enabled = sx125x_clkout_is_enabled, +}; + +static int sx125x_register_clock_provider(struct sx125x_priv *priv) +{ + struct device *dev = priv->dev; + struct clk_init_data init; + const char *parent; + int ret; + + /* Disable CLKOUT */ + ret = sx125x_field_write(priv, F_CLK_OUT, 0); + if (ret) { + dev_err(dev, "unable to disable clkout\n"); + return ret; + } + + /* Register clock provider if expected in DTB */ + if (!of_find_property(dev->of_node, "#clock-cells", NULL)) + return 0; + + dev_info(dev, "registering clkout\n"); + + parent = of_clk_get_parent_name(dev->of_node, 0); + if (!parent) { + dev_err(dev, "Unable to find parent clk\n"); + return -ENODEV; + } + + init.ops = &sx125x_clkout_ops; + init.flags = CLK_IS_BASIC; + init.parent_names = &parent; + init.num_parents = 1; + priv->clkout_hw.init = &init; + + of_property_read_string_index(dev->of_node, "clock-output-names", 0, + &init.name); + + priv->clkout = devm_clk_register(dev, &priv->clkout_hw); + if (IS_ERR(priv->clkout)) { + dev_err(dev, "failed to register clkout\n"); + return PTR_ERR(priv->clkout); + } + ret = of_clk_add_hw_provider(dev->of_node, of_clk_hw_simple_get, + &priv->clkout_hw); + return ret; +} + static int __maybe_unused sx125x_regmap_probe(struct device *dev, struct regmap *regmap, unsigned int radio) { struct sx125x_priv *priv; @@ -76,6 +174,7 @@ static int __maybe_unused sx125x_regmap_probe(struct device *dev, struct regmap return -ENOMEM; dev_set_drvdata(dev, priv); + priv->dev = dev; priv->regmap = regmap; for (i = 0; i < ARRAY_SIZE(sx125x_regmap_fields); i++) { const struct reg_field *reg_fields = sx125x_regmap_fields; @@ -99,16 +198,13 @@ static int __maybe_unused sx125x_regmap_probe(struct device *dev, struct regmap dev_info(dev, "SX125x version: %02x\n", val); } - if (radio == 1) { /* HACK */ - ret = sx125x_field_write(priv, F_CLK_OUT, 1); - if (ret) { - dev_err(dev, "enabling clock output failed\n"); - return ret; - } - - dev_info(dev, "enabling clock output\n"); + ret = sx125x_register_clock_provider(priv); + if (ret) { + dev_err(dev, "failed to register clkout provider: %d\n", ret); + return ret; } + /* TODO Only needs setting on radio on the TX path */ ret = sx125x_field_write(priv, F_TX_DAC_CLK_SEL, 1); if (ret) { dev_err(dev, "clock select failed\n"); diff --git a/drivers/net/lora/sx1301.c b/drivers/net/lora/sx1301.c index eb89af6..44a7d0b 100644 --- a/drivers/net/lora/sx1301.c +++ b/drivers/net/lora/sx1301.c @@ -10,6 +10,7 @@ */ #include +#include #include #include #include @@ -404,6 +405,18 @@ static int sx130x_loradev_open(struct net_device *netdev) return -ENXIO; } + priv->clk32m = devm_clk_get(priv->dev, "clk32m"); + if (IS_ERR(priv->clk32m)) { + dev_err(priv->dev, "failed to get clk32m\n"); + return PTR_ERR(priv->clk32m); + } + + ret = clk_prepare_enable(priv->clk32m); + if (ret) { + dev_err(priv->dev, "failed to enable clk32m: %d\n", ret); + return ret; + } + ret = sx1301_field_write(priv, F_GLOBAL_EN, 1); if (ret) { dev_err(priv->dev, "enable global clocks failed\n"); diff --git a/drivers/net/lora/sx1301.h b/drivers/net/lora/sx1301.h index 0bbd948..a1a2e38 100644 --- a/drivers/net/lora/sx1301.h +++ b/drivers/net/lora/sx1301.h @@ -9,6 +9,7 @@ #ifndef _SX1301_ #define _SX1301_ +#include #include #include #include @@ -108,6 +109,7 @@ static const struct reg_field sx1301_regmap_fields[] = { struct sx1301_priv { struct lora_dev_priv lora; struct device *dev; + struct clk *clk32m; struct gpio_desc *rst_gpio; struct regmap *regmap; struct regmap_field *regmap_fields[ARRAY_SIZE(sx1301_regmap_fields)];