drivers/clk/qcom/clk-regmap.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (c) 2014, The Linux Foundation. All rights reserved.
   4  */
   5
   6 #include <linux/device.h>
   7 #include <linux/clk-provider.h>
   8 #include <linux/regmap.h>
   9 #include <linux/export.h>
  10
  11 #include "clk-regmap.h"
  12
  13 /**
  14  * clk_is_enabled_regmap - standard is_enabled() for regmap users
  15  *
  16  * @hw: clk to operate on
  17  *
  18  * Clocks that use regmap for their register I/O can set the
  19  * enable_reg and enable_mask fields in their struct clk_regmap and then use
  20  * this as their is_enabled operation, saving some code.
  21  */
  22 int clk_is_enabled_regmap(struct clk_hw *hw)
  23 {
  24         struct clk_regmap *rclk = to_clk_regmap(hw);
  25         unsigned int val;
  26         int ret;
  27
  28         ret = regmap_read(rclk->regmap, rclk->enable_reg, &val);
  29         if (ret != 0)
  30                 return ret;
  31
  32         if (rclk->enable_is_inverted)
  33                 return (val & rclk->enable_mask) == 0;
  34         else
  35                 return (val & rclk->enable_mask) != 0;
  36 }
  37 EXPORT_SYMBOL_GPL(clk_is_enabled_regmap);
  38
  39 /**
  40  * clk_enable_regmap - standard enable() for regmap users
  41  *
  42  * @hw: clk to operate on
  43  *
  44  * Clocks that use regmap for their register I/O can set the
  45  * enable_reg and enable_mask fields in their struct clk_regmap and then use
  46  * this as their enable() operation, saving some code.
  47  */
  48 int clk_enable_regmap(struct clk_hw *hw)
  49 {
  50         struct clk_regmap *rclk = to_clk_regmap(hw);
  51         unsigned int val;
  52
  53         if (rclk->enable_is_inverted)
  54                 val = 0;
  55         else
  56                 val = rclk->enable_mask;
  57
  58         return regmap_update_bits(rclk->regmap, rclk->enable_reg,
  59                                   rclk->enable_mask, val);
  60 }
  61 EXPORT_SYMBOL_GPL(clk_enable_regmap);
  62
  63 /**
  64  * clk_disable_regmap - standard disable() for regmap users
  65  *
  66  * @hw: clk to operate on
  67  *
  68  * Clocks that use regmap for their register I/O can set the
  69  * enable_reg and enable_mask fields in their struct clk_regmap and then use
  70  * this as their disable() operation, saving some code.
  71  */
  72 void clk_disable_regmap(struct clk_hw *hw)
  73 {
  74         struct clk_regmap *rclk = to_clk_regmap(hw);
  75         unsigned int val;
  76
  77         if (rclk->enable_is_inverted)
  78                 val = rclk->enable_mask;
  79         else
  80                 val = 0;
  81
  82         regmap_update_bits(rclk->regmap, rclk->enable_reg, rclk->enable_mask,
  83                            val);
  84 }
  85 EXPORT_SYMBOL_GPL(clk_disable_regmap);
  86
  87 /**
  88  * devm_clk_register_regmap - register a clk_regmap clock
  89  *
  90  * @rclk: clk to operate on
  91  *
  92  * Clocks that use regmap for their register I/O should register their
  93  * clk_regmap struct via this function so that the regmap is initialized
  94  * and so that the clock is registered with the common clock framework.
  95  */
  96 int devm_clk_register_regmap(struct device *dev, struct clk_regmap *rclk)
  97 {
  98         if (dev && dev_get_regmap(dev, NULL))
  99                 rclk->regmap = dev_get_regmap(dev, NULL);
 100         else if (dev && dev->parent)
 101                 rclk->regmap = dev_get_regmap(dev->parent, NULL);
 102
 103         return devm_clk_hw_register(dev, &rclk->hw);
 104 }
 105 EXPORT_SYMBOL_GPL(devm_clk_register_regmap);