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 
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 
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 
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 
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 
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 
113 int
114 ux500_regulator_debug_init(struct platform_device *pdev,
115 	struct dbx500_regulator_info *regulator_info,
116 	int num_regulators)
117 {
118 	/* create directory */
119 	rdebug.dir = debugfs_create_dir("ux500-regulator", NULL);
120 	if (!rdebug.dir)
121 		goto exit_no_debugfs;
122 
123 	/* create "status" file */
124 	rdebug.status_file = debugfs_create_file("status",
125 		S_IRUGO, rdebug.dir, &pdev->dev,
126 		&ux500_regulator_status_fops);
127 	if (!rdebug.status_file)
128 		goto exit_destroy_dir;
129 
130 	/* create "power-state-count" file */
131 	rdebug.power_state_cnt_file = debugfs_create_file("power-state-count",
132 		S_IRUGO, rdebug.dir, &pdev->dev,
133 		&ux500_regulator_power_state_cnt_fops);
134 	if (!rdebug.power_state_cnt_file)
135 		goto exit_destroy_status;
136 
137 	rdebug.regulator_array = regulator_info;
138 	rdebug.num_regulators = num_regulators;
139 
140 	rdebug.state_before_suspend = kzalloc(num_regulators, GFP_KERNEL);
141 	if (!rdebug.state_before_suspend)
142 		goto exit_destroy_power_state;
143 
144 	rdebug.state_after_suspend = kzalloc(num_regulators, GFP_KERNEL);
145 	if (!rdebug.state_after_suspend)
146 		goto exit_free;
147 
148 	return 0;
149 
150 exit_free:
151 	kfree(rdebug.state_before_suspend);
152 exit_destroy_power_state:
153 	debugfs_remove(rdebug.power_state_cnt_file);
154 exit_destroy_status:
155 	debugfs_remove(rdebug.status_file);
156 exit_destroy_dir:
157 	debugfs_remove(rdebug.dir);
158 exit_no_debugfs:
159 	dev_err(&pdev->dev, "failed to create debugfs entries.\n");
160 	return -ENOMEM;
161 }
162 
163 int ux500_regulator_debug_exit(void)
164 {
165 	debugfs_remove_recursive(rdebug.dir);
166 	kfree(rdebug.state_after_suspend);
167 	kfree(rdebug.state_before_suspend);
168 
169 	return 0;
170 }
171 #endif
172