hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
// SPDX-License-Identifier: GPL-2.0
//
// Spreadtrum multiplexer clock driver
//
// Copyright (C) 2017 Spreadtrum, Inc.
// Author: Chunyan Zhang <chunyan.zhang@spreadtrum.com>
 
#include <linux/clk.h>
#include <linux/clk-provider.h>
#include <linux/regmap.h>
 
#include "mux.h"
 
u8 sprd_mux_helper_get_parent(const struct sprd_clk_common *common,
                 const struct sprd_mux_ssel *mux)
{
   unsigned int reg;
   u8 parent;
   int num_parents;
   int i;
 
   regmap_read(common->regmap, common->reg, &reg);
   parent = reg >> mux->shift;
   parent &= (1 << mux->width) - 1;
 
   if (!mux->table)
       return parent;
 
   num_parents = clk_hw_get_num_parents(&common->hw);
 
   for (i = 0; i < num_parents - 1; i++)
       if (parent >= mux->table[i] && parent < mux->table[i + 1])
           return i;
 
   return num_parents - 1;
}
EXPORT_SYMBOL_GPL(sprd_mux_helper_get_parent);
 
static u8 sprd_mux_get_parent(struct clk_hw *hw)
{
   struct sprd_mux *cm = hw_to_sprd_mux(hw);
 
   return sprd_mux_helper_get_parent(&cm->common, &cm->mux);
}
 
int sprd_mux_helper_set_parent(const struct sprd_clk_common *common,
                  const struct sprd_mux_ssel *mux,
                  u8 index)
{
   unsigned int reg;
 
   if (mux->table)
       index = mux->table[index];
 
   regmap_read(common->regmap, common->reg, &reg);
   reg &= ~GENMASK(mux->width + mux->shift - 1, mux->shift);
   regmap_write(common->regmap, common->reg,
             reg | (index << mux->shift));
 
   return 0;
}
EXPORT_SYMBOL_GPL(sprd_mux_helper_set_parent);
 
static int sprd_mux_set_parent(struct clk_hw *hw, u8 index)
{
   struct sprd_mux *cm = hw_to_sprd_mux(hw);
 
   return sprd_mux_helper_set_parent(&cm->common, &cm->mux, index);
}
 
const struct clk_ops sprd_mux_ops = {
   .get_parent = sprd_mux_get_parent,
   .set_parent = sprd_mux_set_parent,
   .determine_rate = __clk_mux_determine_rate,
};
EXPORT_SYMBOL_GPL(sprd_mux_ops);