clk: sunxi-ng: Add common infrastructure
Start our new clock infrastructure by adding the registration code, common structure and common code. Signed-off-by: Maxime Ripard <maxime.ripard@free-electrons.com> Signed-off-by: Michael Turquette <mturquette@baylibre.com> Link: lkml.kernel.org/r/20160629190535.11855-3-maxime.ripard@free-electrons.com
This commit is contained in:

committed by
Michael Turquette

parent
c0692d68a8
commit
1d80c14248
55
drivers/clk/sunxi-ng/ccu_reset.c
Normal file
55
drivers/clk/sunxi-ng/ccu_reset.c
Normal file
@@ -0,0 +1,55 @@
|
||||
/*
|
||||
* Copyright (C) 2016 Maxime Ripard
|
||||
* Maxime Ripard <maxime.ripard@free-electrons.com>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or
|
||||
* modify it under the terms of the GNU General Public License as
|
||||
* published by the Free Software Foundation; either version 2 of
|
||||
* the License, or (at your option) any later version.
|
||||
*/
|
||||
|
||||
#include <linux/io.h>
|
||||
#include <linux/reset-controller.h>
|
||||
|
||||
#include "ccu_reset.h"
|
||||
|
||||
static int ccu_reset_assert(struct reset_controller_dev *rcdev,
|
||||
unsigned long id)
|
||||
{
|
||||
struct ccu_reset *ccu = rcdev_to_ccu_reset(rcdev);
|
||||
const struct ccu_reset_map *map = &ccu->reset_map[id];
|
||||
unsigned long flags;
|
||||
u32 reg;
|
||||
|
||||
spin_lock_irqsave(ccu->lock, flags);
|
||||
|
||||
reg = readl(ccu->base + map->reg);
|
||||
writel(reg & ~map->bit, ccu->base + map->reg);
|
||||
|
||||
spin_unlock_irqrestore(ccu->lock, flags);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ccu_reset_deassert(struct reset_controller_dev *rcdev,
|
||||
unsigned long id)
|
||||
{
|
||||
struct ccu_reset *ccu = rcdev_to_ccu_reset(rcdev);
|
||||
const struct ccu_reset_map *map = &ccu->reset_map[id];
|
||||
unsigned long flags;
|
||||
u32 reg;
|
||||
|
||||
spin_lock_irqsave(ccu->lock, flags);
|
||||
|
||||
reg = readl(ccu->base + map->reg);
|
||||
writel(reg | map->bit, ccu->base + map->reg);
|
||||
|
||||
spin_unlock_irqrestore(ccu->lock, flags);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
const struct reset_control_ops ccu_reset_ops = {
|
||||
.assert = ccu_reset_assert,
|
||||
.deassert = ccu_reset_deassert,
|
||||
};
|
Reference in New Issue
Block a user