Blame view

drivers/sysreset/sysreset_sti.c 1.83 KB
d41ce506b   Eric Lee   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
  /*
   * Copyright (C) 2017, STMicroelectronics - All Rights Reserved
   * Author(s): Patrice Chotard, <patrice.chotard@st.com> for STMicroelectronics.
   *
   * SPDX-License-Identifier:	GPL-2.0+
   */
  
  #include <common.h>
  #include <dm.h>
  #include <regmap.h>
  #include <syscon.h>
  #include <sysreset.h>
  #include <asm/io.h>
  
  DECLARE_GLOBAL_DATA_PTR;
  
  struct sti_sysreset_priv {
  	phys_addr_t base;
  };
  
  static int sti_sysreset_request(struct udevice *dev, enum sysreset_t type)
  {
  	struct sti_sysreset_priv *priv = dev_get_priv(dev);
  
  	generic_clear_bit(0, (void __iomem *)priv->base);
  
  	return -EINPROGRESS;
  }
  
  static int sti_sysreset_probe(struct udevice *dev)
  {
  	struct sti_sysreset_priv *priv = dev_get_priv(dev);
  	struct udevice *syscon;
  	struct regmap *regmap;
  	struct fdtdec_phandle_args syscfg_phandle;
  	int ret;
  
  	/* get corresponding syscon phandle */
  	ret = fdtdec_parse_phandle_with_args(gd->fdt_blob, dev_of_offset(dev),
  					     "st,syscfg", NULL, 0, 0,
  					     &syscfg_phandle);
  	if (ret < 0) {
  		pr_err("Can't get syscfg phandle: %d
  ", ret);
  		return ret;
  	}
  
  	ret = uclass_get_device_by_of_offset(UCLASS_SYSCON,
  					     syscfg_phandle.node,
  					     &syscon);
  	if (ret) {
  		pr_err("%s: uclass_get_device_by_of_offset failed: %d
  ",
  		      __func__, ret);
  		return ret;
  	}
  
  	regmap = syscon_get_regmap(syscon);
  	if (!regmap) {
  		pr_err("unable to get regmap for %s
  ", syscon->name);
  		return -ENODEV;
  	}
  
  	priv->base = regmap->base;
  
  	return 0;
  }
  
  static struct sysreset_ops sti_sysreset = {
  	.request	= sti_sysreset_request,
  };
  
  static const struct udevice_id sti_sysreset_ids[] = {
  	{ .compatible = "st,stih407-restart" },
  	{ }
  };
  
  U_BOOT_DRIVER(sysreset_sti) = {
  	.name = "sysreset_sti",
  	.id = UCLASS_SYSRESET,
  	.ops = &sti_sysreset,
  	.probe = sti_sysreset_probe,
  	.of_match = sti_sysreset_ids,
  	.priv_auto_alloc_size = sizeof(struct sti_sysreset_priv),
  };