77 lines
1.8 KiB
C
77 lines
1.8 KiB
C
// 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, ®);
|
|
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 &= ~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);
|