1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (C) ST-Ericsson SA 2010
4 *
5 * Authors: Sundar Iyer <sundar.iyer@stericsson.com> for ST-Ericsson
6 * Bengt Jonsson <bengt.g.jonsson@stericsson.com> for ST-Ericsson
7 *
8 * UX500 common part of Power domain regulators
9 */
10
11 #include <linux/kernel.h>
12 #include <linux/err.h>
13 #include <linux/regulator/driver.h>
14 #include <linux/debugfs.h>
15 #include <linux/seq_file.h>
16 #include <linux/slab.h>
17 #include <linux/module.h>
18
19 #include "dbx500-prcmu.h"
20
21 /*
22 * power state reference count
23 */
24 static int power_state_active_cnt; /* will initialize to zero */
25 static DEFINE_SPINLOCK(power_state_active_lock);
26
power_state_active_enable(void)27 void power_state_active_enable(void)
28 {
29 unsigned long flags;
30
31 spin_lock_irqsave(&power_state_active_lock, flags);
32 power_state_active_cnt++;
33 spin_unlock_irqrestore(&power_state_active_lock, flags);
34 }
35
power_state_active_disable(void)36 int power_state_active_disable(void)
37 {
38 int ret = 0;
39 unsigned long flags;
40
41 spin_lock_irqsave(&power_state_active_lock, flags);
42 if (power_state_active_cnt <= 0) {
43 pr_err("power state: unbalanced enable/disable calls\n");
44 ret = -EINVAL;
45 goto out;
46 }
47
48 power_state_active_cnt--;
49 out:
50 spin_unlock_irqrestore(&power_state_active_lock, flags);
51 return ret;
52 }
53
54 #ifdef CONFIG_REGULATOR_DEBUG
55
power_state_active_get(void)56 static int power_state_active_get(void)
57 {
58 unsigned long flags;
59 int cnt;
60
61 spin_lock_irqsave(&power_state_active_lock, flags);
62 cnt = power_state_active_cnt;
63 spin_unlock_irqrestore(&power_state_active_lock, flags);
64
65 return cnt;
66 }
67
68 static struct ux500_regulator_debug {
69 struct dentry *dir;
70 struct dentry *status_file;
71 struct dentry *power_state_cnt_file;
72 struct dbx500_regulator_info *regulator_array;
73 int num_regulators;
74 u8 *state_before_suspend;
75 u8 *state_after_suspend;
76 } rdebug;
77
ux500_regulator_power_state_cnt_show(struct seq_file * s,void * p)78 static int ux500_regulator_power_state_cnt_show(struct seq_file *s, void *p)
79 {
80 /* print power state count */
81 seq_printf(s, "ux500-regulator power state count: %i\n",
82 power_state_active_get());
83
84 return 0;
85 }
86 DEFINE_SHOW_ATTRIBUTE(ux500_regulator_power_state_cnt);
87
ux500_regulator_status_show(struct seq_file * s,void * p)88 static int ux500_regulator_status_show(struct seq_file *s, void *p)
89 {
90 int i;
91
92 /* print dump header */
93 seq_puts(s, "ux500-regulator status:\n");
94 seq_printf(s, "%31s : %8s : %8s\n", "current", "before", "after");
95
96 for (i = 0; i < rdebug.num_regulators; i++) {
97 struct dbx500_regulator_info *info;
98 /* Access per-regulator data */
99 info = &rdebug.regulator_array[i];
100
101 /* print status */
102 seq_printf(s, "%20s : %8s : %8s : %8s\n",
103 info->desc.name,
104 info->is_enabled ? "enabled" : "disabled",
105 rdebug.state_before_suspend[i] ? "enabled" : "disabled",
106 rdebug.state_after_suspend[i] ? "enabled" : "disabled");
107 }
108
109 return 0;
110 }
111 DEFINE_SHOW_ATTRIBUTE(ux500_regulator_status);
112
dbx500_regulator_testcase(struct dbx500_regulator_info * regulator_info,int num_regulators)113 int __attribute__((weak)) dbx500_regulator_testcase(
114 struct dbx500_regulator_info *regulator_info,
115 int num_regulators)
116 {
117 return 0;
118 }
119
120 int
ux500_regulator_debug_init(struct platform_device * pdev,struct dbx500_regulator_info * regulator_info,int num_regulators)121 ux500_regulator_debug_init(struct platform_device *pdev,
122 struct dbx500_regulator_info *regulator_info,
123 int num_regulators)
124 {
125 /* create directory */
126 rdebug.dir = debugfs_create_dir("ux500-regulator", NULL);
127 if (!rdebug.dir)
128 goto exit_no_debugfs;
129
130 /* create "status" file */
131 rdebug.status_file = debugfs_create_file("status",
132 S_IRUGO, rdebug.dir, &pdev->dev,
133 &ux500_regulator_status_fops);
134 if (!rdebug.status_file)
135 goto exit_destroy_dir;
136
137 /* create "power-state-count" file */
138 rdebug.power_state_cnt_file = debugfs_create_file("power-state-count",
139 S_IRUGO, rdebug.dir, &pdev->dev,
140 &ux500_regulator_power_state_cnt_fops);
141 if (!rdebug.power_state_cnt_file)
142 goto exit_destroy_status;
143
144 rdebug.regulator_array = regulator_info;
145 rdebug.num_regulators = num_regulators;
146
147 rdebug.state_before_suspend = kzalloc(num_regulators, GFP_KERNEL);
148 if (!rdebug.state_before_suspend)
149 goto exit_destroy_power_state;
150
151 rdebug.state_after_suspend = kzalloc(num_regulators, GFP_KERNEL);
152 if (!rdebug.state_after_suspend)
153 goto exit_free;
154
155 dbx500_regulator_testcase(regulator_info, num_regulators);
156 return 0;
157
158 exit_free:
159 kfree(rdebug.state_before_suspend);
160 exit_destroy_power_state:
161 debugfs_remove(rdebug.power_state_cnt_file);
162 exit_destroy_status:
163 debugfs_remove(rdebug.status_file);
164 exit_destroy_dir:
165 debugfs_remove(rdebug.dir);
166 exit_no_debugfs:
167 dev_err(&pdev->dev, "failed to create debugfs entries.\n");
168 return -ENOMEM;
169 }
170
ux500_regulator_debug_exit(void)171 int ux500_regulator_debug_exit(void)
172 {
173 debugfs_remove_recursive(rdebug.dir);
174 kfree(rdebug.state_after_suspend);
175 kfree(rdebug.state_before_suspend);
176
177 return 0;
178 }
179 #endif
180