Blame view
drivers/reset/reset-pistachio.c
3.44 KB
81f7e3824 Initial Release, ... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 |
/* * Pistachio SoC Reset Controller driver * * Copyright (C) 2015 Imagination Technologies Ltd. * * Author: Damien Horsley <Damien.Horsley@imgtec.com> * * This program is free software; you can redistribute it and/or modify it * under the terms and conditions of the GNU General Public License, * version 2, as published by the Free Software Foundation. */ #include <linux/init.h> #include <linux/of.h> #include <linux/platform_device.h> #include <linux/regmap.h> #include <linux/reset-controller.h> #include <linux/slab.h> #include <linux/mfd/syscon.h> #include <dt-bindings/reset/pistachio-resets.h> #define PISTACHIO_SOFT_RESET 0 struct pistachio_reset_data { struct reset_controller_dev rcdev; struct regmap *periph_regs; }; static inline int pistachio_reset_shift(unsigned long id) { switch (id) { case PISTACHIO_RESET_I2C0: case PISTACHIO_RESET_I2C1: case PISTACHIO_RESET_I2C2: case PISTACHIO_RESET_I2C3: case PISTACHIO_RESET_I2S_IN: case PISTACHIO_RESET_PRL_OUT: case PISTACHIO_RESET_SPDIF_OUT: case PISTACHIO_RESET_SPI: case PISTACHIO_RESET_PWM_PDM: case PISTACHIO_RESET_UART0: case PISTACHIO_RESET_UART1: case PISTACHIO_RESET_QSPI: case PISTACHIO_RESET_MDC: case PISTACHIO_RESET_SDHOST: case PISTACHIO_RESET_ETHERNET: case PISTACHIO_RESET_IR: case PISTACHIO_RESET_HASH: case PISTACHIO_RESET_TIMER: return id; case PISTACHIO_RESET_I2S_OUT: case PISTACHIO_RESET_SPDIF_IN: case PISTACHIO_RESET_EVT: return id + 6; case PISTACHIO_RESET_USB_H: case PISTACHIO_RESET_USB_PR: case PISTACHIO_RESET_USB_PHY_PR: case PISTACHIO_RESET_USB_PHY_PON: return id + 7; default: return -EINVAL; } } static int pistachio_reset_assert(struct reset_controller_dev *rcdev, unsigned long id) { struct pistachio_reset_data *rd; u32 mask; int shift; rd = container_of(rcdev, struct pistachio_reset_data, rcdev); shift = pistachio_reset_shift(id); if (shift < 0) return shift; mask = BIT(shift); return regmap_update_bits(rd->periph_regs, PISTACHIO_SOFT_RESET, mask, mask); } static int pistachio_reset_deassert(struct reset_controller_dev *rcdev, unsigned long id) { struct pistachio_reset_data *rd; u32 mask; int shift; rd = container_of(rcdev, struct pistachio_reset_data, rcdev); shift = pistachio_reset_shift(id); if (shift < 0) return shift; mask = BIT(shift); return regmap_update_bits(rd->periph_regs, PISTACHIO_SOFT_RESET, mask, 0); } static const struct reset_control_ops pistachio_reset_ops = { .assert = pistachio_reset_assert, .deassert = pistachio_reset_deassert, }; static int pistachio_reset_probe(struct platform_device *pdev) { struct pistachio_reset_data *rd; struct device *dev = &pdev->dev; struct device_node *np = pdev->dev.of_node; rd = devm_kzalloc(dev, sizeof(*rd), GFP_KERNEL); if (!rd) return -ENOMEM; rd->periph_regs = syscon_node_to_regmap(np->parent); if (IS_ERR(rd->periph_regs)) return PTR_ERR(rd->periph_regs); rd->rcdev.owner = THIS_MODULE; rd->rcdev.nr_resets = PISTACHIO_RESET_MAX + 1; rd->rcdev.ops = &pistachio_reset_ops; rd->rcdev.of_node = np; return devm_reset_controller_register(dev, &rd->rcdev); } static const struct of_device_id pistachio_reset_dt_ids[] = { { .compatible = "img,pistachio-reset", }, { /* sentinel */ }, }; static struct platform_driver pistachio_reset_driver = { .probe = pistachio_reset_probe, .driver = { .name = "pistachio-reset", .of_match_table = pistachio_reset_dt_ids, }, }; builtin_platform_driver(pistachio_reset_driver); |