1 // SPDX-License-Identifier: GPL-2.0
2 #include <linux/debugfs.h>
3 #include <linux/slab.h>
4 
5 #define BIG_BUFFER_SIZE	(1024)
6 
7 static char big_buffer[BIG_BUFFER_SIZE];
8 
9 struct mbxfb_debugfs_data {
10 	struct dentry *dir;
11 	struct dentry *sysconf;
12 	struct dentry *clock;
13 	struct dentry *display;
14 	struct dentry *gsctl;
15 	struct dentry *sdram;
16 	struct dentry *misc;
17 };
18 
write_file_dummy(struct file * file,const char __user * buf,size_t count,loff_t * ppos)19 static ssize_t write_file_dummy(struct file *file, const char __user *buf,
20 				size_t count, loff_t *ppos)
21 {
22 	return count;
23 }
24 
sysconf_read_file(struct file * file,char __user * userbuf,size_t count,loff_t * ppos)25 static ssize_t sysconf_read_file(struct file *file, char __user *userbuf,
26 				 size_t count, loff_t *ppos)
27 {
28 	char * s = big_buffer;
29 
30 	s += sprintf(s, "SYSCFG = %08x\n", readl(SYSCFG));
31 	s += sprintf(s, "PFBASE = %08x\n", readl(PFBASE));
32 	s += sprintf(s, "PFCEIL = %08x\n", readl(PFCEIL));
33 	s += sprintf(s, "POLLFLAG = %08x\n", readl(POLLFLAG));
34 	s += sprintf(s, "SYSRST = %08x\n", readl(SYSRST));
35 
36 	return  simple_read_from_buffer(userbuf, count, ppos,
37 					big_buffer, s-big_buffer);
38 }
39 
40 
gsctl_read_file(struct file * file,char __user * userbuf,size_t count,loff_t * ppos)41 static ssize_t gsctl_read_file(struct file *file, char __user *userbuf,
42 			       size_t count, loff_t *ppos)
43 {
44 	char * s = big_buffer;
45 
46 	s += sprintf(s, "GSCTRL = %08x\n", readl(GSCTRL));
47 	s += sprintf(s, "VSCTRL = %08x\n", readl(VSCTRL));
48 	s += sprintf(s, "GBBASE = %08x\n", readl(GBBASE));
49 	s += sprintf(s, "VBBASE = %08x\n", readl(VBBASE));
50 	s += sprintf(s, "GDRCTRL = %08x\n", readl(GDRCTRL));
51 	s += sprintf(s, "VCMSK = %08x\n", readl(VCMSK));
52 	s += sprintf(s, "GSCADR = %08x\n", readl(GSCADR));
53 	s += sprintf(s, "VSCADR = %08x\n", readl(VSCADR));
54 	s += sprintf(s, "VUBASE = %08x\n", readl(VUBASE));
55 	s += sprintf(s, "VVBASE = %08x\n", readl(VVBASE));
56 	s += sprintf(s, "GSADR = %08x\n", readl(GSADR));
57 	s += sprintf(s, "VSADR = %08x\n", readl(VSADR));
58 	s += sprintf(s, "HCCTRL = %08x\n", readl(HCCTRL));
59 	s += sprintf(s, "HCSIZE = %08x\n", readl(HCSIZE));
60 	s += sprintf(s, "HCPOS = %08x\n", readl(HCPOS));
61 	s += sprintf(s, "HCBADR = %08x\n", readl(HCBADR));
62 	s += sprintf(s, "HCCKMSK = %08x\n", readl(HCCKMSK));
63 	s += sprintf(s, "GPLUT = %08x\n", readl(GPLUT));
64 
65 	return  simple_read_from_buffer(userbuf, count, ppos,
66 					big_buffer, s-big_buffer);
67 }
68 
display_read_file(struct file * file,char __user * userbuf,size_t count,loff_t * ppos)69 static ssize_t display_read_file(struct file *file, char __user *userbuf,
70 				 size_t count, loff_t *ppos)
71 {
72 	char * s = big_buffer;
73 
74 	s += sprintf(s, "DSCTRL = %08x\n", readl(DSCTRL));
75 	s += sprintf(s, "DHT01 = %08x\n", readl(DHT01));
76 	s += sprintf(s, "DHT02 = %08x\n", readl(DHT02));
77 	s += sprintf(s, "DHT03 = %08x\n", readl(DHT03));
78 	s += sprintf(s, "DVT01 = %08x\n", readl(DVT01));
79 	s += sprintf(s, "DVT02 = %08x\n", readl(DVT02));
80 	s += sprintf(s, "DVT03 = %08x\n", readl(DVT03));
81 	s += sprintf(s, "DBCOL = %08x\n", readl(DBCOL));
82 	s += sprintf(s, "BGCOLOR = %08x\n", readl(BGCOLOR));
83 	s += sprintf(s, "DINTRS = %08x\n", readl(DINTRS));
84 	s += sprintf(s, "DINTRE = %08x\n", readl(DINTRE));
85 	s += sprintf(s, "DINTRCNT = %08x\n", readl(DINTRCNT));
86 	s += sprintf(s, "DSIG = %08x\n", readl(DSIG));
87 	s += sprintf(s, "DMCTRL = %08x\n", readl(DMCTRL));
88 	s += sprintf(s, "CLIPCTRL = %08x\n", readl(CLIPCTRL));
89 	s += sprintf(s, "SPOCTRL = %08x\n", readl(SPOCTRL));
90 	s += sprintf(s, "SVCTRL = %08x\n", readl(SVCTRL));
91 	s += sprintf(s, "DLSTS = %08x\n", readl(DLSTS));
92 	s += sprintf(s, "DLLCTRL = %08x\n", readl(DLLCTRL));
93 	s += sprintf(s, "DVLNUM = %08x\n", readl(DVLNUM));
94 	s += sprintf(s, "DUCTRL = %08x\n", readl(DUCTRL));
95 	s += sprintf(s, "DVECTRL = %08x\n", readl(DVECTRL));
96 	s += sprintf(s, "DHDET = %08x\n", readl(DHDET));
97 	s += sprintf(s, "DVDET = %08x\n", readl(DVDET));
98 	s += sprintf(s, "DODMSK = %08x\n", readl(DODMSK));
99 	s += sprintf(s, "CSC01 = %08x\n", readl(CSC01));
100 	s += sprintf(s, "CSC02 = %08x\n", readl(CSC02));
101 	s += sprintf(s, "CSC03 = %08x\n", readl(CSC03));
102 	s += sprintf(s, "CSC04 = %08x\n", readl(CSC04));
103 	s += sprintf(s, "CSC05 = %08x\n", readl(CSC05));
104 
105 	return  simple_read_from_buffer(userbuf, count, ppos,
106 					big_buffer, s-big_buffer);
107 }
108 
clock_read_file(struct file * file,char __user * userbuf,size_t count,loff_t * ppos)109 static ssize_t clock_read_file(struct file *file, char __user *userbuf,
110 			       size_t count, loff_t *ppos)
111 {
112 	char * s = big_buffer;
113 
114 	s += sprintf(s, "SYSCLKSRC = %08x\n", readl(SYSCLKSRC));
115 	s += sprintf(s, "PIXCLKSRC = %08x\n", readl(PIXCLKSRC));
116 	s += sprintf(s, "CLKSLEEP = %08x\n", readl(CLKSLEEP));
117 	s += sprintf(s, "COREPLL = %08x\n", readl(COREPLL));
118 	s += sprintf(s, "DISPPLL = %08x\n", readl(DISPPLL));
119 	s += sprintf(s, "PLLSTAT = %08x\n", readl(PLLSTAT));
120 	s += sprintf(s, "VOVRCLK = %08x\n", readl(VOVRCLK));
121 	s += sprintf(s, "PIXCLK = %08x\n", readl(PIXCLK));
122 	s += sprintf(s, "MEMCLK = %08x\n", readl(MEMCLK));
123 	s += sprintf(s, "M24CLK = %08x\n", readl(M24CLK));
124 	s += sprintf(s, "MBXCLK = %08x\n", readl(MBXCLK));
125 	s += sprintf(s, "SDCLK = %08x\n", readl(SDCLK));
126 	s += sprintf(s, "PIXCLKDIV = %08x\n", readl(PIXCLKDIV));
127 
128 	return  simple_read_from_buffer(userbuf, count, ppos,
129 					big_buffer, s-big_buffer);
130 }
131 
sdram_read_file(struct file * file,char __user * userbuf,size_t count,loff_t * ppos)132 static ssize_t sdram_read_file(struct file *file, char __user *userbuf,
133 			       size_t count, loff_t *ppos)
134 {
135 	char * s = big_buffer;
136 
137 	s += sprintf(s, "LMRST = %08x\n", readl(LMRST));
138 	s += sprintf(s, "LMCFG = %08x\n", readl(LMCFG));
139 	s += sprintf(s, "LMPWR = %08x\n", readl(LMPWR));
140 	s += sprintf(s, "LMPWRSTAT = %08x\n", readl(LMPWRSTAT));
141 	s += sprintf(s, "LMCEMR = %08x\n", readl(LMCEMR));
142 	s += sprintf(s, "LMTYPE = %08x\n", readl(LMTYPE));
143 	s += sprintf(s, "LMTIM = %08x\n", readl(LMTIM));
144 	s += sprintf(s, "LMREFRESH = %08x\n", readl(LMREFRESH));
145 	s += sprintf(s, "LMPROTMIN = %08x\n", readl(LMPROTMIN));
146 	s += sprintf(s, "LMPROTMAX = %08x\n", readl(LMPROTMAX));
147 	s += sprintf(s, "LMPROTCFG = %08x\n", readl(LMPROTCFG));
148 	s += sprintf(s, "LMPROTERR = %08x\n", readl(LMPROTERR));
149 
150 	return  simple_read_from_buffer(userbuf, count, ppos,
151 					big_buffer, s-big_buffer);
152 }
153 
misc_read_file(struct file * file,char __user * userbuf,size_t count,loff_t * ppos)154 static ssize_t misc_read_file(struct file *file, char __user *userbuf,
155 			       size_t count, loff_t *ppos)
156 {
157 	char * s = big_buffer;
158 
159 	s += sprintf(s, "LCD_CONFIG = %08x\n", readl(LCD_CONFIG));
160 	s += sprintf(s, "ODFBPWR = %08x\n", readl(ODFBPWR));
161 	s += sprintf(s, "ODFBSTAT = %08x\n", readl(ODFBSTAT));
162 	s += sprintf(s, "ID = %08x\n", readl(ID));
163 
164 	return  simple_read_from_buffer(userbuf, count, ppos,
165 					big_buffer, s-big_buffer);
166 }
167 
168 
169 static const struct file_operations sysconf_fops = {
170 	.read = sysconf_read_file,
171 	.write = write_file_dummy,
172 	.open = simple_open,
173 	.llseek = default_llseek,
174 };
175 
176 static const struct file_operations clock_fops = {
177 	.read = clock_read_file,
178 	.write = write_file_dummy,
179 	.open = simple_open,
180 	.llseek = default_llseek,
181 };
182 
183 static const struct file_operations display_fops = {
184 	.read = display_read_file,
185 	.write = write_file_dummy,
186 	.open = simple_open,
187 	.llseek = default_llseek,
188 };
189 
190 static const struct file_operations gsctl_fops = {
191 	.read = gsctl_read_file,
192 	.write = write_file_dummy,
193 	.open = simple_open,
194 	.llseek = default_llseek,
195 };
196 
197 static const struct file_operations sdram_fops = {
198 	.read = sdram_read_file,
199 	.write = write_file_dummy,
200 	.open = simple_open,
201 	.llseek = default_llseek,
202 };
203 
204 static const struct file_operations misc_fops = {
205 	.read = misc_read_file,
206 	.write = write_file_dummy,
207 	.open = simple_open,
208 	.llseek = default_llseek,
209 };
210 
mbxfb_debugfs_init(struct fb_info * fbi)211 static void mbxfb_debugfs_init(struct fb_info *fbi)
212 {
213 	struct mbxfb_info *mfbi = fbi->par;
214 	struct dentry *dir;
215 
216 	dir = debugfs_create_dir("mbxfb", NULL);
217 	mfbi->debugfs_dir = dir;
218 
219 	debugfs_create_file("sysconf", 0444, dir, fbi, &sysconf_fops);
220 	debugfs_create_file("clock", 0444, dir, fbi, &clock_fops);
221 	debugfs_create_file("display", 0444, dir, fbi, &display_fops);
222 	debugfs_create_file("gsctl", 0444, dir, fbi, &gsctl_fops);
223 	debugfs_create_file("sdram", 0444, dir, fbi, &sdram_fops);
224 	debugfs_create_file("misc", 0444, dir, fbi, &misc_fops);
225 }
226 
mbxfb_debugfs_remove(struct fb_info * fbi)227 static void mbxfb_debugfs_remove(struct fb_info *fbi)
228 {
229 	struct mbxfb_info *mfbi = fbi->par;
230 
231 	debugfs_remove_recursive(mfbi->debugfs_dir);
232 }
233