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