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