1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Copyright (c) 2013, The Linux Foundation. All rights reserved. 4 */ 5 6 #include <linux/bitops.h> 7 #include <linux/export.h> 8 #include <linux/regmap.h> 9 #include <linux/reset-controller.h> 10 #include <linux/delay.h> 11 12 #include "reset.h" 13 14 static int qcom_reset(struct reset_controller_dev *rcdev, unsigned long id) 15 { 16 struct qcom_reset_controller *rst = to_qcom_reset_controller(rcdev); 17 18 rcdev->ops->assert(rcdev, id); 19 udelay(rst->reset_map[id].udelay ?: 1); /* use 1 us as default */ 20 rcdev->ops->deassert(rcdev, id); 21 return 0; 22 } 23 24 static int 25 qcom_reset_assert(struct reset_controller_dev *rcdev, unsigned long id) 26 { 27 struct qcom_reset_controller *rst; 28 const struct qcom_reset_map *map; 29 u32 mask; 30 31 rst = to_qcom_reset_controller(rcdev); 32 map = &rst->reset_map[id]; 33 mask = map->bitmask ? map->bitmask : BIT(map->bit); 34 35 return regmap_update_bits(rst->regmap, map->reg, mask, mask); 36 } 37 38 static int 39 qcom_reset_deassert(struct reset_controller_dev *rcdev, unsigned long id) 40 { 41 struct qcom_reset_controller *rst; 42 const struct qcom_reset_map *map; 43 u32 mask; 44 45 rst = to_qcom_reset_controller(rcdev); 46 map = &rst->reset_map[id]; 47 mask = map->bitmask ? map->bitmask : BIT(map->bit); 48 49 return regmap_update_bits(rst->regmap, map->reg, mask, 0); 50 } 51 52 const struct reset_control_ops qcom_reset_ops = { 53 .reset = qcom_reset, 54 .assert = qcom_reset_assert, 55 .deassert = qcom_reset_deassert, 56 }; 57 EXPORT_SYMBOL_GPL(qcom_reset_ops); 58