1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 *
4 * Copyright (C) 2005 Mike Isely <isely@pobox.com>
5 */
6
7 #include <linux/string.h>
8 #include "pvrusb2-debugifc.h"
9 #include "pvrusb2-hdw.h"
10 #include "pvrusb2-debug.h"
11
12 struct debugifc_mask_item {
13 const char *name;
14 unsigned long msk;
15 };
16
17
debugifc_count_whitespace(const char * buf,unsigned int count)18 static unsigned int debugifc_count_whitespace(const char *buf,
19 unsigned int count)
20 {
21 unsigned int scnt;
22 char ch;
23
24 for (scnt = 0; scnt < count; scnt++) {
25 ch = buf[scnt];
26 if (ch == ' ') continue;
27 if (ch == '\t') continue;
28 if (ch == '\n') continue;
29 break;
30 }
31 return scnt;
32 }
33
34
debugifc_count_nonwhitespace(const char * buf,unsigned int count)35 static unsigned int debugifc_count_nonwhitespace(const char *buf,
36 unsigned int count)
37 {
38 unsigned int scnt;
39 char ch;
40
41 for (scnt = 0; scnt < count; scnt++) {
42 ch = buf[scnt];
43 if (ch == ' ') break;
44 if (ch == '\t') break;
45 if (ch == '\n') break;
46 }
47 return scnt;
48 }
49
50
debugifc_isolate_word(const char * buf,unsigned int count,const char ** wstrPtr,unsigned int * wlenPtr)51 static unsigned int debugifc_isolate_word(const char *buf,unsigned int count,
52 const char **wstrPtr,
53 unsigned int *wlenPtr)
54 {
55 const char *wptr;
56 unsigned int consume_cnt = 0;
57 unsigned int wlen;
58 unsigned int scnt;
59
60 wptr = NULL;
61 wlen = 0;
62 scnt = debugifc_count_whitespace(buf,count);
63 consume_cnt += scnt; count -= scnt; buf += scnt;
64 if (!count) goto done;
65
66 scnt = debugifc_count_nonwhitespace(buf,count);
67 if (!scnt) goto done;
68 wptr = buf;
69 wlen = scnt;
70 consume_cnt += scnt; count -= scnt; buf += scnt;
71
72 done:
73 *wstrPtr = wptr;
74 *wlenPtr = wlen;
75 return consume_cnt;
76 }
77
78
debugifc_parse_unsigned_number(const char * buf,unsigned int count,u32 * num_ptr)79 static int debugifc_parse_unsigned_number(const char *buf,unsigned int count,
80 u32 *num_ptr)
81 {
82 u32 result = 0;
83 int radix = 10;
84 if ((count >= 2) && (buf[0] == '0') &&
85 ((buf[1] == 'x') || (buf[1] == 'X'))) {
86 radix = 16;
87 count -= 2;
88 buf += 2;
89 } else if ((count >= 1) && (buf[0] == '0')) {
90 radix = 8;
91 }
92
93 while (count--) {
94 int val = hex_to_bin(*buf++);
95 if (val < 0 || val >= radix)
96 return -EINVAL;
97 result *= radix;
98 result += val;
99 }
100 *num_ptr = result;
101 return 0;
102 }
103
104
debugifc_match_keyword(const char * buf,unsigned int count,const char * keyword)105 static int debugifc_match_keyword(const char *buf,unsigned int count,
106 const char *keyword)
107 {
108 unsigned int kl;
109 if (!keyword) return 0;
110 kl = strlen(keyword);
111 if (kl != count) return 0;
112 return !memcmp(buf,keyword,kl);
113 }
114
115
pvr2_debugifc_print_info(struct pvr2_hdw * hdw,char * buf,unsigned int acnt)116 int pvr2_debugifc_print_info(struct pvr2_hdw *hdw,char *buf,unsigned int acnt)
117 {
118 int bcnt = 0;
119 int ccnt;
120 ccnt = scnprintf(buf, acnt, "Driver hardware description: %s\n",
121 pvr2_hdw_get_desc(hdw));
122 bcnt += ccnt; acnt -= ccnt; buf += ccnt;
123 ccnt = scnprintf(buf,acnt,"Driver state info:\n");
124 bcnt += ccnt; acnt -= ccnt; buf += ccnt;
125 ccnt = pvr2_hdw_state_report(hdw,buf,acnt);
126 bcnt += ccnt; acnt -= ccnt; buf += ccnt;
127
128 return bcnt;
129 }
130
131
pvr2_debugifc_print_status(struct pvr2_hdw * hdw,char * buf,unsigned int acnt)132 int pvr2_debugifc_print_status(struct pvr2_hdw *hdw,
133 char *buf,unsigned int acnt)
134 {
135 int bcnt = 0;
136 int ccnt;
137 int ret;
138 u32 gpio_dir,gpio_in,gpio_out;
139 struct pvr2_stream_stats stats;
140 struct pvr2_stream *sp;
141
142 ret = pvr2_hdw_is_hsm(hdw);
143 ccnt = scnprintf(buf,acnt,"USB link speed: %s\n",
144 (ret < 0 ? "FAIL" : (ret ? "high" : "full")));
145 bcnt += ccnt; acnt -= ccnt; buf += ccnt;
146
147 gpio_dir = 0; gpio_in = 0; gpio_out = 0;
148 pvr2_hdw_gpio_get_dir(hdw,&gpio_dir);
149 pvr2_hdw_gpio_get_out(hdw,&gpio_out);
150 pvr2_hdw_gpio_get_in(hdw,&gpio_in);
151 ccnt = scnprintf(buf,acnt,"GPIO state: dir=0x%x in=0x%x out=0x%x\n",
152 gpio_dir,gpio_in,gpio_out);
153 bcnt += ccnt; acnt -= ccnt; buf += ccnt;
154
155 ccnt = scnprintf(buf,acnt,"Streaming is %s\n",
156 pvr2_hdw_get_streaming(hdw) ? "on" : "off");
157 bcnt += ccnt; acnt -= ccnt; buf += ccnt;
158
159
160 sp = pvr2_hdw_get_video_stream(hdw);
161 if (sp) {
162 pvr2_stream_get_stats(sp, &stats, 0);
163 ccnt = scnprintf(
164 buf,acnt,
165 "Bytes streamed=%u URBs: queued=%u idle=%u ready=%u processed=%u failed=%u\n",
166 stats.bytes_processed,
167 stats.buffers_in_queue,
168 stats.buffers_in_idle,
169 stats.buffers_in_ready,
170 stats.buffers_processed,
171 stats.buffers_failed);
172 bcnt += ccnt; acnt -= ccnt; buf += ccnt;
173 }
174
175 return bcnt;
176 }
177
178
pvr2_debugifc_do1cmd(struct pvr2_hdw * hdw,const char * buf,unsigned int count)179 static int pvr2_debugifc_do1cmd(struct pvr2_hdw *hdw,const char *buf,
180 unsigned int count)
181 {
182 const char *wptr;
183 unsigned int wlen;
184 unsigned int scnt;
185
186 scnt = debugifc_isolate_word(buf,count,&wptr,&wlen);
187 if (!scnt) return 0;
188 count -= scnt; buf += scnt;
189 if (!wptr) return 0;
190
191 pvr2_trace(PVR2_TRACE_DEBUGIFC,"debugifc cmd: \"%.*s\"",wlen,wptr);
192 if (debugifc_match_keyword(wptr,wlen,"reset")) {
193 scnt = debugifc_isolate_word(buf,count,&wptr,&wlen);
194 if (!scnt) return -EINVAL;
195 count -= scnt; buf += scnt;
196 if (!wptr) return -EINVAL;
197 if (debugifc_match_keyword(wptr,wlen,"cpu")) {
198 pvr2_hdw_cpureset_assert(hdw,!0);
199 pvr2_hdw_cpureset_assert(hdw,0);
200 return 0;
201 } else if (debugifc_match_keyword(wptr,wlen,"bus")) {
202 pvr2_hdw_device_reset(hdw);
203 } else if (debugifc_match_keyword(wptr,wlen,"soft")) {
204 return pvr2_hdw_cmd_powerup(hdw);
205 } else if (debugifc_match_keyword(wptr,wlen,"deep")) {
206 return pvr2_hdw_cmd_deep_reset(hdw);
207 } else if (debugifc_match_keyword(wptr,wlen,"firmware")) {
208 return pvr2_upload_firmware2(hdw);
209 } else if (debugifc_match_keyword(wptr,wlen,"decoder")) {
210 return pvr2_hdw_cmd_decoder_reset(hdw);
211 } else if (debugifc_match_keyword(wptr,wlen,"worker")) {
212 return pvr2_hdw_untrip(hdw);
213 } else if (debugifc_match_keyword(wptr,wlen,"usbstats")) {
214 pvr2_stream_get_stats(pvr2_hdw_get_video_stream(hdw),
215 NULL, !0);
216 return 0;
217 }
218 return -EINVAL;
219 } else if (debugifc_match_keyword(wptr,wlen,"cpufw")) {
220 scnt = debugifc_isolate_word(buf,count,&wptr,&wlen);
221 if (!scnt) return -EINVAL;
222 count -= scnt; buf += scnt;
223 if (!wptr) return -EINVAL;
224 if (debugifc_match_keyword(wptr,wlen,"fetch")) {
225 scnt = debugifc_isolate_word(buf,count,&wptr,&wlen);
226 if (scnt && wptr) {
227 count -= scnt; buf += scnt;
228 if (debugifc_match_keyword(wptr, wlen,
229 "prom")) {
230 pvr2_hdw_cpufw_set_enabled(hdw, 2, !0);
231 } else if (debugifc_match_keyword(wptr, wlen,
232 "ram8k")) {
233 pvr2_hdw_cpufw_set_enabled(hdw, 0, !0);
234 } else if (debugifc_match_keyword(wptr, wlen,
235 "ram16k")) {
236 pvr2_hdw_cpufw_set_enabled(hdw, 1, !0);
237 } else {
238 return -EINVAL;
239 }
240 }
241 pvr2_hdw_cpufw_set_enabled(hdw,0,!0);
242 return 0;
243 } else if (debugifc_match_keyword(wptr,wlen,"done")) {
244 pvr2_hdw_cpufw_set_enabled(hdw,0,0);
245 return 0;
246 } else {
247 return -EINVAL;
248 }
249 } else if (debugifc_match_keyword(wptr,wlen,"gpio")) {
250 int dir_fl = 0;
251 int ret;
252 u32 msk,val;
253 scnt = debugifc_isolate_word(buf,count,&wptr,&wlen);
254 if (!scnt) return -EINVAL;
255 count -= scnt; buf += scnt;
256 if (!wptr) return -EINVAL;
257 if (debugifc_match_keyword(wptr,wlen,"dir")) {
258 dir_fl = !0;
259 } else if (!debugifc_match_keyword(wptr,wlen,"out")) {
260 return -EINVAL;
261 }
262 scnt = debugifc_isolate_word(buf,count,&wptr,&wlen);
263 if (!scnt) return -EINVAL;
264 count -= scnt; buf += scnt;
265 if (!wptr) return -EINVAL;
266 ret = debugifc_parse_unsigned_number(wptr,wlen,&msk);
267 if (ret) return ret;
268 scnt = debugifc_isolate_word(buf,count,&wptr,&wlen);
269 if (wptr) {
270 ret = debugifc_parse_unsigned_number(wptr,wlen,&val);
271 if (ret) return ret;
272 } else {
273 val = msk;
274 msk = 0xffffffff;
275 }
276 if (dir_fl) {
277 ret = pvr2_hdw_gpio_chg_dir(hdw,msk,val);
278 } else {
279 ret = pvr2_hdw_gpio_chg_out(hdw,msk,val);
280 }
281 return ret;
282 }
283 pvr2_trace(PVR2_TRACE_DEBUGIFC,
284 "debugifc failed to recognize cmd: \"%.*s\"",wlen,wptr);
285 return -EINVAL;
286 }
287
288
pvr2_debugifc_docmd(struct pvr2_hdw * hdw,const char * buf,unsigned int count)289 int pvr2_debugifc_docmd(struct pvr2_hdw *hdw,const char *buf,
290 unsigned int count)
291 {
292 unsigned int bcnt = 0;
293 int ret;
294
295 while (count) {
296 for (bcnt = 0; bcnt < count; bcnt++) {
297 if (buf[bcnt] == '\n') break;
298 }
299
300 ret = pvr2_debugifc_do1cmd(hdw,buf,bcnt);
301 if (ret < 0) return ret;
302 if (bcnt < count) bcnt++;
303 buf += bcnt;
304 count -= bcnt;
305 }
306
307 return 0;
308 }
309