Blame view
drivers/reset/reset-zynqmp.c
3.49 KB
62f0d7dc3 reset: reset-zynq... |
1 2 3 4 5 6 7 8 9 10 11 |
// SPDX-License-Identifier: GPL-2.0+ /* * Copyright (C) 2018 Xilinx, Inc. * */ #include <linux/err.h> #include <linux/of.h> #include <linux/platform_device.h> #include <linux/reset-controller.h> #include <linux/firmware/xlnx-zynqmp.h> |
552f388bb reset: reset-zynq... |
12 |
#include <linux/of_device.h> |
62f0d7dc3 reset: reset-zynq... |
13 14 15 |
#define ZYNQMP_NR_RESETS (ZYNQMP_PM_RESET_END - ZYNQMP_PM_RESET_START) #define ZYNQMP_RESET_ID ZYNQMP_PM_RESET_START |
552f388bb reset: reset-zynq... |
16 17 18 19 20 21 |
#define VERSAL_NR_RESETS 95 struct zynqmp_reset_soc_data { u32 reset_id; u32 num_resets; }; |
62f0d7dc3 reset: reset-zynq... |
22 23 24 |
struct zynqmp_reset_data { struct reset_controller_dev rcdev; |
552f388bb reset: reset-zynq... |
25 |
const struct zynqmp_reset_soc_data *data; |
62f0d7dc3 reset: reset-zynq... |
26 27 28 29 30 31 32 33 34 35 36 |
}; static inline struct zynqmp_reset_data * to_zynqmp_reset_data(struct reset_controller_dev *rcdev) { return container_of(rcdev, struct zynqmp_reset_data, rcdev); } static int zynqmp_reset_assert(struct reset_controller_dev *rcdev, unsigned long id) { |
552f388bb reset: reset-zynq... |
37 38 39 |
struct zynqmp_reset_data *priv = to_zynqmp_reset_data(rcdev); return zynqmp_pm_reset_assert(priv->data->reset_id + id, |
cf23ec353 firmware: xilinx:... |
40 |
PM_RESET_ACTION_ASSERT); |
62f0d7dc3 reset: reset-zynq... |
41 42 43 44 45 |
} static int zynqmp_reset_deassert(struct reset_controller_dev *rcdev, unsigned long id) { |
552f388bb reset: reset-zynq... |
46 47 48 |
struct zynqmp_reset_data *priv = to_zynqmp_reset_data(rcdev); return zynqmp_pm_reset_assert(priv->data->reset_id + id, |
cf23ec353 firmware: xilinx:... |
49 |
PM_RESET_ACTION_RELEASE); |
62f0d7dc3 reset: reset-zynq... |
50 51 52 53 54 |
} static int zynqmp_reset_status(struct reset_controller_dev *rcdev, unsigned long id) { |
552f388bb reset: reset-zynq... |
55 |
struct zynqmp_reset_data *priv = to_zynqmp_reset_data(rcdev); |
62f0d7dc3 reset: reset-zynq... |
56 |
int val, err; |
552f388bb reset: reset-zynq... |
57 |
err = zynqmp_pm_reset_get_status(priv->data->reset_id + id, &val); |
62f0d7dc3 reset: reset-zynq... |
58 59 60 61 62 63 64 65 66 |
if (err) return err; return val; } static int zynqmp_reset_reset(struct reset_controller_dev *rcdev, unsigned long id) { |
552f388bb reset: reset-zynq... |
67 68 69 |
struct zynqmp_reset_data *priv = to_zynqmp_reset_data(rcdev); return zynqmp_pm_reset_assert(priv->data->reset_id + id, |
cf23ec353 firmware: xilinx:... |
70 |
PM_RESET_ACTION_PULSE); |
62f0d7dc3 reset: reset-zynq... |
71 |
} |
552f388bb reset: reset-zynq... |
72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 |
static int zynqmp_reset_of_xlate(struct reset_controller_dev *rcdev, const struct of_phandle_args *reset_spec) { return reset_spec->args[0]; } static const struct zynqmp_reset_soc_data zynqmp_reset_data = { .reset_id = ZYNQMP_RESET_ID, .num_resets = ZYNQMP_NR_RESETS, }; static const struct zynqmp_reset_soc_data versal_reset_data = { .reset_id = 0, .num_resets = VERSAL_NR_RESETS, }; |
c1b065b4f reset: zynqmp: Ma... |
87 |
static const struct reset_control_ops zynqmp_reset_ops = { |
62f0d7dc3 reset: reset-zynq... |
88 89 90 91 92 93 94 95 96 97 98 99 100 |
.reset = zynqmp_reset_reset, .assert = zynqmp_reset_assert, .deassert = zynqmp_reset_deassert, .status = zynqmp_reset_status, }; static int zynqmp_reset_probe(struct platform_device *pdev) { struct zynqmp_reset_data *priv; priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); if (!priv) return -ENOMEM; |
552f388bb reset: reset-zynq... |
101 102 103 |
priv->data = of_device_get_match_data(&pdev->dev); if (!priv->data) return -EINVAL; |
3d0313786 drivers: Defer pr... |
104 |
platform_set_drvdata(pdev, priv); |
62f0d7dc3 reset: reset-zynq... |
105 106 107 108 |
priv->rcdev.ops = &zynqmp_reset_ops; priv->rcdev.owner = THIS_MODULE; priv->rcdev.of_node = pdev->dev.of_node; |
552f388bb reset: reset-zynq... |
109 110 111 |
priv->rcdev.nr_resets = priv->data->num_resets; priv->rcdev.of_reset_n_cells = 1; priv->rcdev.of_xlate = zynqmp_reset_of_xlate; |
62f0d7dc3 reset: reset-zynq... |
112 113 114 115 116 |
return devm_reset_controller_register(&pdev->dev, &priv->rcdev); } static const struct of_device_id zynqmp_reset_dt_ids[] = { |
552f388bb reset: reset-zynq... |
117 118 |
{ .compatible = "xlnx,zynqmp-reset", .data = &zynqmp_reset_data, }, { .compatible = "xlnx,versal-reset", .data = &versal_reset_data, }, |
62f0d7dc3 reset: reset-zynq... |
119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 |
{ /* sentinel */ }, }; static struct platform_driver zynqmp_reset_driver = { .probe = zynqmp_reset_probe, .driver = { .name = KBUILD_MODNAME, .of_match_table = zynqmp_reset_dt_ids, }, }; static int __init zynqmp_reset_init(void) { return platform_driver_register(&zynqmp_reset_driver); } arch_initcall(zynqmp_reset_init); |