Commit cdce3546 authored by Chao Xie's avatar Chao Xie Committed by Michael Turquette
Browse files

clk: mmp: add mmp private gate clock 



Some SOCes have this kind of the gate clock
1. There are some bits to control the gate not only one bit.
2. It is not always that "1" is to enable while "0" is to disable
   when write register.

So we have to define the "mask", "enable_val", "disable_val" for
this kind of gate clock.

Signed-off-by: default avatarChao Xie <chao.xie@marvell.com>
Acked-by: default avatarHaojian Zhuang <haojian.zhuang@gmail.com>
Signed-off-by: default avatarMichael Turquette <mturquette@linaro.org>
parent ee81f4ee

drivers/clk/mmp/Makefile

+1 −1
Original line number Diff line number Diff line
@@ -2,7 +2,7 @@ 
# Makefile for mmp specific clk

#



obj-y += clk-apbc.o clk-apmu.o clk-frac.o clk-mix.o

obj-y += clk-apbc.o clk-apmu.o clk-frac.o clk-mix.o clk-gate.o



obj-$(CONFIG_CPU_PXA168) += clk-pxa168.o

obj-$(CONFIG_CPU_PXA910) += clk-pxa910.o

drivers/clk/mmp/clk-gate.c

0 → 100644
+133 −0
Original line number Diff line number Diff line 
/*

 * mmp gate clock operation source file

 *

 * Copyright (C) 2014 Marvell

 * Chao Xie <chao.xie@marvell.com>

 *

 * This file is licensed under the terms of the GNU General Public

 * License version 2. This program is licensed "as is" without any

 * warranty of any kind, whether express or implied.

 */



#include <linux/clk-provider.h>

#include <linux/slab.h>

#include <linux/io.h>

#include <linux/err.h>

#include <linux/delay.h>



#include "clk.h"



/*

 * Some clocks will have mutiple bits to enable the clocks, and

 * the bits to disable the clock is not same as enabling bits.

 */



#define to_clk_mmp_gate(hw)	container_of(hw, struct mmp_clk_gate, hw)



static int mmp_clk_gate_enable(struct clk_hw *hw)

{

	struct mmp_clk_gate *gate = to_clk_mmp_gate(hw);

	struct clk *clk = hw->clk;

	unsigned long flags = 0;

	unsigned long rate;

	u32 tmp;



	if (gate->lock)

		spin_lock_irqsave(gate->lock, flags);



	tmp = readl(gate->reg);

	tmp &= ~gate->mask;

	tmp |= gate->val_enable;

	writel(tmp, gate->reg);



	if (gate->lock)

		spin_unlock_irqrestore(gate->lock, flags);



	if (gate->flags & MMP_CLK_GATE_NEED_DELAY) {

		rate = __clk_get_rate(clk);

		/* Need delay 2 cycles. */

		udelay(2000000/rate);

	}



	return 0;

}



static void mmp_clk_gate_disable(struct clk_hw *hw)

{

	struct mmp_clk_gate *gate = to_clk_mmp_gate(hw);

	unsigned long flags = 0;

	u32 tmp;



	if (gate->lock)

		spin_lock_irqsave(gate->lock, flags);



	tmp = readl(gate->reg);

	tmp &= ~gate->mask;

	tmp |= gate->val_disable;

	writel(tmp, gate->reg);



	if (gate->lock)

		spin_unlock_irqrestore(gate->lock, flags);

}



static int mmp_clk_gate_is_enabled(struct clk_hw *hw)

{

	struct mmp_clk_gate *gate = to_clk_mmp_gate(hw);

	unsigned long flags = 0;

	u32 tmp;



	if (gate->lock)

		spin_lock_irqsave(gate->lock, flags);



	tmp = readl(gate->reg);



	if (gate->lock)

		spin_unlock_irqrestore(gate->lock, flags);



	return (tmp & gate->mask) == gate->val_enable;

}



const struct clk_ops mmp_clk_gate_ops = {

	.enable = mmp_clk_gate_enable,

	.disable = mmp_clk_gate_disable,

	.is_enabled = mmp_clk_gate_is_enabled,

};



struct clk *mmp_clk_register_gate(struct device *dev, const char *name,

		const char *parent_name, unsigned long flags,

		void __iomem *reg, u32 mask, u32 val_enable, u32 val_disable,

		unsigned int gate_flags, spinlock_t *lock)

{

	struct mmp_clk_gate *gate;

	struct clk *clk;

	struct clk_init_data init;



	/* allocate the gate */

	gate = kzalloc(sizeof(*gate), GFP_KERNEL);

	if (!gate) {

		pr_err("%s:%s could not allocate gate clk\n", __func__, name);

		return ERR_PTR(-ENOMEM);

	}



	init.name = name;

	init.ops = &mmp_clk_gate_ops;

	init.flags = flags | CLK_IS_BASIC;

	init.parent_names = (parent_name ? &parent_name : NULL);

	init.num_parents = (parent_name ? 1 : 0);



	/* struct clk_gate assignments */

	gate->reg = reg;

	gate->mask = mask;

	gate->val_enable = val_enable;

	gate->val_disable = val_disable;

	gate->flags = gate_flags;

	gate->lock = lock;

	gate->hw.init = &init;



	clk = clk_register(dev, &gate->hw);



	if (IS_ERR(clk))

		kfree(gate);



	return clk;

}

drivers/clk/mmp/clk.h

+21 −0
Original line number Diff line number Diff line
@@ -103,6 +103,27 @@ extern struct clk *mmp_clk_register_mix(struct device *dev, 
					spinlock_t *lock);





/* Clock type "gate". MMP private gate */

#define MMP_CLK_GATE_NEED_DELAY		BIT(0)



struct mmp_clk_gate {

	struct clk_hw hw;

	void __iomem *reg;

	u32 mask;

	u32 val_enable;

	u32 val_disable;

	unsigned int flags;

	spinlock_t *lock;

};



extern const struct clk_ops mmp_clk_gate_ops;

extern struct clk *mmp_clk_register_gate(struct device *dev, const char *name,

			const char *parent_name, unsigned long flags,

			void __iomem *reg, u32 mask, u32 val_enable,

			u32 val_disable, unsigned int gate_flags,

			spinlock_t *lock);





extern struct clk *mmp_clk_register_pll2(const char *name,

		const char *parent_name, unsigned long flags);

extern struct clk *mmp_clk_register_apbc(const char *name,

CRA Git | Maintained and supported by SUSTech CRA and CCSE