drivers/clk/sunxi-ng/ccu_reset.c

   1 /*
   2  * Copyright (C) 2016 Maxime Ripard
   3  * Maxime Ripard <maxime.ripard@free-electrons.com>
   4  *
   5  * This program is free software; you can redistribute it and/or
   6  * modify it under the terms of the GNU General Public License as
   7  * published by the Free Software Foundation; either version 2 of
   8  * the License, or (at your option) any later version.
   9  */
  10
  11 #include <linux/delay.h>
  12 #include <linux/io.h>
  13 #include <linux/reset-controller.h>
  14
  15 #include "ccu_reset.h"
  16
  17 static int ccu_reset_assert(struct reset_controller_dev *rcdev,
  18                             unsigned long id)
  19 {
  20         struct ccu_reset *ccu = rcdev_to_ccu_reset(rcdev);
  21         const struct ccu_reset_map *map = &ccu->reset_map[id];
  22         unsigned long flags;
  23         u32 reg;
  24
  25         spin_lock_irqsave(ccu->lock, flags);
  26
  27         reg = readl(ccu->base + map->reg);
  28         writel(reg & ~map->bit, ccu->base + map->reg);
  29
  30         spin_unlock_irqrestore(ccu->lock, flags);
  31
  32         return 0;
  33 }
  34
  35 static int ccu_reset_deassert(struct reset_controller_dev *rcdev,
  36                               unsigned long id)
  37 {
  38         struct ccu_reset *ccu = rcdev_to_ccu_reset(rcdev);
  39         const struct ccu_reset_map *map = &ccu->reset_map[id];
  40         unsigned long flags;
  41         u32 reg;
  42
  43         spin_lock_irqsave(ccu->lock, flags);
  44
  45         reg = readl(ccu->base + map->reg);
  46         writel(reg | map->bit, ccu->base + map->reg);
  47
  48         spin_unlock_irqrestore(ccu->lock, flags);
  49
  50         return 0;
  51 }
  52
  53 static int ccu_reset_reset(struct reset_controller_dev *rcdev,
  54                            unsigned long id)
  55 {
  56         ccu_reset_assert(rcdev, id);
  57         udelay(10);
  58         ccu_reset_deassert(rcdev, id);
  59
  60         return 0;
  61 }
  62
  63 const struct reset_control_ops ccu_reset_ops = {
  64         .assert         = ccu_reset_assert,
  65         .deassert       = ccu_reset_deassert,
  66         .reset          = ccu_reset_reset,
  67 };