linux-imx

// SPDX-License-Identifier: GPL-2.0

//

// Spreadtrum pll clock driver

//

// Copyright (C) 2015~2017 Spreadtrum, Inc.

// Author: Chunyan Zhang <chunyan.zhang@spreadtrum.com>

​

#include <linux/delay.h>

#include <linux/err.h>

#include <linux/regmap.h>

#include <linux/slab.h>

​

#include "pll.h"

​

#define CLK_PLL_1M  1000000

#define CLK_PLL_10M (CLK_PLL_1M * 10)

​

#define pindex(pll, member)     \

    (pll->factors[member].shift / (8 * sizeof(pll->regs_num)))

​

#define pshift(pll, member)     \

    (pll->factors[member].shift % (8 * sizeof(pll->regs_num)))

​

#define pwidth(pll, member)     \

    pll->factors[member].width

​

#define pmask(pll, member)                  \

    ((pwidth(pll, member)) ?                \

    GENMASK(pwidth(pll, member) + pshift(pll, member) - 1,  \

    pshift(pll, member)) : 0)

​

#define pinternal(pll, cfg, member) \

    (cfg[pindex(pll, member)] & pmask(pll, member))

​

#define pinternal_val(pll, cfg, member) \

    (pinternal(pll, cfg, member) >> pshift(pll, member))

​

static inline unsigned int

sprd_pll_read(const struct sprd_pll *pll, u8 index)

{

    const struct sprd_clk_common *common = &pll->common;

    unsigned int val = 0;

​

    if (WARN_ON(index >= pll->regs_num))

        return 0;

​

    regmap_read(common->regmap, common->reg + index * 4, &val);

​

    return val;

}

​

static inline void

sprd_pll_write(const struct sprd_pll *pll, u8 index,

                  u32 msk, u32 val)

{

    const struct sprd_clk_common *common = &pll->common;

    unsigned int offset, reg;

    int ret = 0;

​

    if (WARN_ON(index >= pll->regs_num))

        return;

​

    offset = common->reg + index * 4;