cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

owl-gate.c (1766B)

      1// SPDX-License-Identifier: GPL-2.0+
      2//
      3// OWL gate clock driver
      4//
      5// Copyright (c) 2014 Actions Semi Inc.
      6// Author: David Liu <liuwei@actions-semi.com>
      7//
      8// Copyright (c) 2018 Linaro Ltd.
      9// Author: Manivannan Sadhasivam <manivannan.sadhasivam@linaro.org>
     10
     11#include <linux/clk-provider.h>
     12#include <linux/regmap.h>
     13
     14#include "owl-gate.h"
     15
     16void owl_gate_set(const struct owl_clk_common *common,
     17		 const struct owl_gate_hw *gate_hw, bool enable)
     18{
     19	int set = gate_hw->gate_flags & CLK_GATE_SET_TO_DISABLE ? 1 : 0;
     20	u32 reg;
     21
     22	set ^= enable;
     23
     24	regmap_read(common->regmap, gate_hw->reg, &reg);
     25
     26	if (set)
     27		reg |= BIT(gate_hw->bit_idx);
     28	else
     29		reg &= ~BIT(gate_hw->bit_idx);
     30
     31	regmap_write(common->regmap, gate_hw->reg, reg);
     32}
     33
     34static void owl_gate_disable(struct clk_hw *hw)
     35{
     36	struct owl_gate *gate = hw_to_owl_gate(hw);
     37	struct owl_clk_common *common = &gate->common;
     38
     39	owl_gate_set(common, &gate->gate_hw, false);
     40}
     41
     42static int owl_gate_enable(struct clk_hw *hw)
     43{
     44	struct owl_gate *gate = hw_to_owl_gate(hw);
     45	struct owl_clk_common *common = &gate->common;
     46
     47	owl_gate_set(common, &gate->gate_hw, true);
     48
     49	return 0;
     50}
     51
     52int owl_gate_clk_is_enabled(const struct owl_clk_common *common,
     53		   const struct owl_gate_hw *gate_hw)
     54{
     55	u32 reg;
     56
     57	regmap_read(common->regmap, gate_hw->reg, &reg);
     58
     59	if (gate_hw->gate_flags & CLK_GATE_SET_TO_DISABLE)
     60		reg ^= BIT(gate_hw->bit_idx);
     61
     62	return !!(reg & BIT(gate_hw->bit_idx));
     63}
     64
     65static int owl_gate_is_enabled(struct clk_hw *hw)
     66{
     67	struct owl_gate *gate = hw_to_owl_gate(hw);
     68	struct owl_clk_common *common = &gate->common;
     69
     70	return owl_gate_clk_is_enabled(common, &gate->gate_hw);
     71}
     72
     73const struct clk_ops owl_gate_ops = {
     74	.disable	= owl_gate_disable,
     75	.enable		= owl_gate_enable,
     76	.is_enabled	= owl_gate_is_enabled,
     77};