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 }; 68