1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include "smscoreapi.h"
21
22#include <linux/module.h>
23#include <linux/slab.h>
24#include <linux/init.h>
25#include <linux/debugfs.h>
26#include <linux/spinlock.h>
27#include <linux/usb.h>
28
29#include "dmxdev.h"
30#include "dvbdev.h"
31#include "dvb_demux.h"
32#include "dvb_frontend.h"
33
34#include "smsdvb.h"
35
36static struct dentry *smsdvb_debugfs_usb_root;
37
38struct smsdvb_debugfs {
39 struct kref refcount;
40 spinlock_t lock;
41
42 char stats_data[PAGE_SIZE];
43 unsigned stats_count;
44 bool stats_was_read;
45
46 wait_queue_head_t stats_queue;
47};
48
49static void smsdvb_print_dvb_stats(struct smsdvb_debugfs *debug_data,
50 struct sms_stats *p)
51{
52 int n = 0;
53 char *buf;
54
55 spin_lock(&debug_data->lock);
56 if (debug_data->stats_count) {
57 spin_unlock(&debug_data->lock);
58 return;
59 }
60
61 buf = debug_data->stats_data;
62
63 n += snprintf(&buf[n], PAGE_SIZE - n,
64 "is_rf_locked = %d\n", p->is_rf_locked);
65 n += snprintf(&buf[n], PAGE_SIZE - n,
66 "is_demod_locked = %d\n", p->is_demod_locked);
67 n += snprintf(&buf[n], PAGE_SIZE - n,
68 "is_external_lna_on = %d\n", p->is_external_lna_on);
69 n += snprintf(&buf[n], PAGE_SIZE - n,
70 "SNR = %d\n", p->SNR);
71 n += snprintf(&buf[n], PAGE_SIZE - n,
72 "ber = %d\n", p->ber);
73 n += snprintf(&buf[n], PAGE_SIZE - n,
74 "FIB_CRC = %d\n", p->FIB_CRC);
75 n += snprintf(&buf[n], PAGE_SIZE - n,
76 "ts_per = %d\n", p->ts_per);
77 n += snprintf(&buf[n], PAGE_SIZE - n,
78 "MFER = %d\n", p->MFER);
79 n += snprintf(&buf[n], PAGE_SIZE - n,
80 "RSSI = %d\n", p->RSSI);
81 n += snprintf(&buf[n], PAGE_SIZE - n,
82 "in_band_pwr = %d\n", p->in_band_pwr);
83 n += snprintf(&buf[n], PAGE_SIZE - n,
84 "carrier_offset = %d\n", p->carrier_offset);
85 n += snprintf(&buf[n], PAGE_SIZE - n,
86 "modem_state = %d\n", p->modem_state);
87 n += snprintf(&buf[n], PAGE_SIZE - n,
88 "frequency = %d\n", p->frequency);
89 n += snprintf(&buf[n], PAGE_SIZE - n,
90 "bandwidth = %d\n", p->bandwidth);
91 n += snprintf(&buf[n], PAGE_SIZE - n,
92 "transmission_mode = %d\n", p->transmission_mode);
93 n += snprintf(&buf[n], PAGE_SIZE - n,
94 "modem_state = %d\n", p->modem_state);
95 n += snprintf(&buf[n], PAGE_SIZE - n,
96 "guard_interval = %d\n", p->guard_interval);
97 n += snprintf(&buf[n], PAGE_SIZE - n,
98 "code_rate = %d\n", p->code_rate);
99 n += snprintf(&buf[n], PAGE_SIZE - n,
100 "lp_code_rate = %d\n", p->lp_code_rate);
101 n += snprintf(&buf[n], PAGE_SIZE - n,
102 "hierarchy = %d\n", p->hierarchy);
103 n += snprintf(&buf[n], PAGE_SIZE - n,
104 "constellation = %d\n", p->constellation);
105 n += snprintf(&buf[n], PAGE_SIZE - n,
106 "burst_size = %d\n", p->burst_size);
107 n += snprintf(&buf[n], PAGE_SIZE - n,
108 "burst_duration = %d\n", p->burst_duration);
109 n += snprintf(&buf[n], PAGE_SIZE - n,
110 "burst_cycle_time = %d\n", p->burst_cycle_time);
111 n += snprintf(&buf[n], PAGE_SIZE - n,
112 "calc_burst_cycle_time = %d\n",
113 p->calc_burst_cycle_time);
114 n += snprintf(&buf[n], PAGE_SIZE - n,
115 "num_of_rows = %d\n", p->num_of_rows);
116 n += snprintf(&buf[n], PAGE_SIZE - n,
117 "num_of_padd_cols = %d\n", p->num_of_padd_cols);
118 n += snprintf(&buf[n], PAGE_SIZE - n,
119 "num_of_punct_cols = %d\n", p->num_of_punct_cols);
120 n += snprintf(&buf[n], PAGE_SIZE - n,
121 "error_ts_packets = %d\n", p->error_ts_packets);
122 n += snprintf(&buf[n], PAGE_SIZE - n,
123 "total_ts_packets = %d\n", p->total_ts_packets);
124 n += snprintf(&buf[n], PAGE_SIZE - n,
125 "num_of_valid_mpe_tlbs = %d\n", p->num_of_valid_mpe_tlbs);
126 n += snprintf(&buf[n], PAGE_SIZE - n,
127 "num_of_invalid_mpe_tlbs = %d\n", p->num_of_invalid_mpe_tlbs);
128 n += snprintf(&buf[n], PAGE_SIZE - n,
129 "num_of_corrected_mpe_tlbs = %d\n", p->num_of_corrected_mpe_tlbs);
130 n += snprintf(&buf[n], PAGE_SIZE - n,
131 "ber_error_count = %d\n", p->ber_error_count);
132 n += snprintf(&buf[n], PAGE_SIZE - n,
133 "ber_bit_count = %d\n", p->ber_bit_count);
134 n += snprintf(&buf[n], PAGE_SIZE - n,
135 "sms_to_host_tx_errors = %d\n", p->sms_to_host_tx_errors);
136 n += snprintf(&buf[n], PAGE_SIZE - n,
137 "pre_ber = %d\n", p->pre_ber);
138 n += snprintf(&buf[n], PAGE_SIZE - n,
139 "cell_id = %d\n", p->cell_id);
140 n += snprintf(&buf[n], PAGE_SIZE - n,
141 "dvbh_srv_ind_hp = %d\n", p->dvbh_srv_ind_hp);
142 n += snprintf(&buf[n], PAGE_SIZE - n,
143 "dvbh_srv_ind_lp = %d\n", p->dvbh_srv_ind_lp);
144 n += snprintf(&buf[n], PAGE_SIZE - n,
145 "num_mpe_received = %d\n", p->num_mpe_received);
146
147 debug_data->stats_count = n;
148 spin_unlock(&debug_data->lock);
149 wake_up(&debug_data->stats_queue);
150}
151
152static void smsdvb_print_isdb_stats(struct smsdvb_debugfs *debug_data,
153 struct sms_isdbt_stats *p)
154{
155 int i, n = 0;
156 char *buf;
157
158 spin_lock(&debug_data->lock);
159 if (debug_data->stats_count) {
160 spin_unlock(&debug_data->lock);
161 return;
162 }
163
164 buf = debug_data->stats_data;
165
166 n += snprintf(&buf[n], PAGE_SIZE - n,
167 "statistics_type = %d\t", p->statistics_type);
168 n += snprintf(&buf[n], PAGE_SIZE - n,
169 "full_size = %d\n", p->full_size);
170
171 n += snprintf(&buf[n], PAGE_SIZE - n,
172 "is_rf_locked = %d\t\t", p->is_rf_locked);
173 n += snprintf(&buf[n], PAGE_SIZE - n,
174 "is_demod_locked = %d\t", p->is_demod_locked);
175 n += snprintf(&buf[n], PAGE_SIZE - n,
176 "is_external_lna_on = %d\n", p->is_external_lna_on);
177 n += snprintf(&buf[n], PAGE_SIZE - n,
178 "SNR = %d dB\t\t", p->SNR);
179 n += snprintf(&buf[n], PAGE_SIZE - n,
180 "RSSI = %d dBm\t\t", p->RSSI);
181 n += snprintf(&buf[n], PAGE_SIZE - n,
182 "in_band_pwr = %d dBm\n", p->in_band_pwr);
183 n += snprintf(&buf[n], PAGE_SIZE - n,
184 "carrier_offset = %d\t", p->carrier_offset);
185 n += snprintf(&buf[n], PAGE_SIZE - n,
186 "bandwidth = %d\t\t", p->bandwidth);
187 n += snprintf(&buf[n], PAGE_SIZE - n,
188 "frequency = %d Hz\n", p->frequency);
189 n += snprintf(&buf[n], PAGE_SIZE - n,
190 "transmission_mode = %d\t", p->transmission_mode);
191 n += snprintf(&buf[n], PAGE_SIZE - n,
192 "modem_state = %d\t\t", p->modem_state);
193 n += snprintf(&buf[n], PAGE_SIZE - n,
194 "guard_interval = %d\n", p->guard_interval);
195 n += snprintf(&buf[n], PAGE_SIZE - n,
196 "system_type = %d\t\t", p->system_type);
197 n += snprintf(&buf[n], PAGE_SIZE - n,
198 "partial_reception = %d\t", p->partial_reception);
199 n += snprintf(&buf[n], PAGE_SIZE - n,
200 "num_of_layers = %d\n", p->num_of_layers);
201 n += snprintf(&buf[n], PAGE_SIZE - n,
202 "sms_to_host_tx_errors = %d\n", p->sms_to_host_tx_errors);
203
204 for (i = 0; i < 3; i++) {
205 if (p->layer_info[i].number_of_segments < 1 ||
206 p->layer_info[i].number_of_segments > 13)
207 continue;
208
209 n += snprintf(&buf[n], PAGE_SIZE - n, "\nLayer %d\n", i);
210 n += snprintf(&buf[n], PAGE_SIZE - n, "\tcode_rate = %d\t",
211 p->layer_info[i].code_rate);
212 n += snprintf(&buf[n], PAGE_SIZE - n, "constellation = %d\n",
213 p->layer_info[i].constellation);
214 n += snprintf(&buf[n], PAGE_SIZE - n, "\tber = %-5d\t",
215 p->layer_info[i].ber);
216 n += snprintf(&buf[n], PAGE_SIZE - n, "\tber_error_count = %-5d\t",
217 p->layer_info[i].ber_error_count);
218 n += snprintf(&buf[n], PAGE_SIZE - n, "ber_bit_count = %-5d\n",
219 p->layer_info[i].ber_bit_count);
220 n += snprintf(&buf[n], PAGE_SIZE - n, "\tpre_ber = %-5d\t",
221 p->layer_info[i].pre_ber);
222 n += snprintf(&buf[n], PAGE_SIZE - n, "\tts_per = %-5d\n",
223 p->layer_info[i].ts_per);
224 n += snprintf(&buf[n], PAGE_SIZE - n, "\terror_ts_packets = %-5d\t",
225 p->layer_info[i].error_ts_packets);
226 n += snprintf(&buf[n], PAGE_SIZE - n, "total_ts_packets = %-5d\t",
227 p->layer_info[i].total_ts_packets);
228 n += snprintf(&buf[n], PAGE_SIZE - n, "ti_ldepth_i = %d\n",
229 p->layer_info[i].ti_ldepth_i);
230 n += snprintf(&buf[n], PAGE_SIZE - n,
231 "\tnumber_of_segments = %d\t",
232 p->layer_info[i].number_of_segments);
233 n += snprintf(&buf[n], PAGE_SIZE - n, "tmcc_errors = %d\n",
234 p->layer_info[i].tmcc_errors);
235 }
236
237 debug_data->stats_count = n;
238 spin_unlock(&debug_data->lock);
239 wake_up(&debug_data->stats_queue);
240}
241
242static void smsdvb_print_isdb_stats_ex(struct smsdvb_debugfs *debug_data,
243 struct sms_isdbt_stats_ex *p)
244{
245 int i, n = 0;
246 char *buf;
247
248 spin_lock(&debug_data->lock);
249 if (debug_data->stats_count) {
250 spin_unlock(&debug_data->lock);
251 return;
252 }
253
254 buf = debug_data->stats_data;
255
256 n += snprintf(&buf[n], PAGE_SIZE - n,
257 "statistics_type = %d\t", p->statistics_type);
258 n += snprintf(&buf[n], PAGE_SIZE - n,
259 "full_size = %d\n", p->full_size);
260
261 n += snprintf(&buf[n], PAGE_SIZE - n,
262 "is_rf_locked = %d\t\t", p->is_rf_locked);
263 n += snprintf(&buf[n], PAGE_SIZE - n,
264 "is_demod_locked = %d\t", p->is_demod_locked);
265 n += snprintf(&buf[n], PAGE_SIZE - n,
266 "is_external_lna_on = %d\n", p->is_external_lna_on);
267 n += snprintf(&buf[n], PAGE_SIZE - n,
268 "SNR = %d dB\t\t", p->SNR);
269 n += snprintf(&buf[n], PAGE_SIZE - n,
270 "RSSI = %d dBm\t\t", p->RSSI);
271 n += snprintf(&buf[n], PAGE_SIZE - n,
272 "in_band_pwr = %d dBm\n", p->in_band_pwr);
273 n += snprintf(&buf[n], PAGE_SIZE - n,
274 "carrier_offset = %d\t", p->carrier_offset);
275 n += snprintf(&buf[n], PAGE_SIZE - n,
276 "bandwidth = %d\t\t", p->bandwidth);
277 n += snprintf(&buf[n], PAGE_SIZE - n,
278 "frequency = %d Hz\n", p->frequency);
279 n += snprintf(&buf[n], PAGE_SIZE - n,
280 "transmission_mode = %d\t", p->transmission_mode);
281 n += snprintf(&buf[n], PAGE_SIZE - n,
282 "modem_state = %d\t\t", p->modem_state);
283 n += snprintf(&buf[n], PAGE_SIZE - n,
284 "guard_interval = %d\n", p->guard_interval);
285 n += snprintf(&buf[n], PAGE_SIZE - n,
286 "system_type = %d\t\t", p->system_type);
287 n += snprintf(&buf[n], PAGE_SIZE - n,
288 "partial_reception = %d\t", p->partial_reception);
289 n += snprintf(&buf[n], PAGE_SIZE - n,
290 "num_of_layers = %d\n", p->num_of_layers);
291 n += snprintf(&buf[n], PAGE_SIZE - n, "segment_number = %d\t",
292 p->segment_number);
293 n += snprintf(&buf[n], PAGE_SIZE - n, "tune_bw = %d\n",
294 p->tune_bw);
295
296 for (i = 0; i < 3; i++) {
297 if (p->layer_info[i].number_of_segments < 1 ||
298 p->layer_info[i].number_of_segments > 13)
299 continue;
300
301 n += snprintf(&buf[n], PAGE_SIZE - n, "\nLayer %d\n", i);
302 n += snprintf(&buf[n], PAGE_SIZE - n, "\tcode_rate = %d\t",
303 p->layer_info[i].code_rate);
304 n += snprintf(&buf[n], PAGE_SIZE - n, "constellation = %d\n",
305 p->layer_info[i].constellation);
306 n += snprintf(&buf[n], PAGE_SIZE - n, "\tber = %-5d\t",
307 p->layer_info[i].ber);
308 n += snprintf(&buf[n], PAGE_SIZE - n, "\tber_error_count = %-5d\t",
309 p->layer_info[i].ber_error_count);
310 n += snprintf(&buf[n], PAGE_SIZE - n, "ber_bit_count = %-5d\n",
311 p->layer_info[i].ber_bit_count);
312 n += snprintf(&buf[n], PAGE_SIZE - n, "\tpre_ber = %-5d\t",
313 p->layer_info[i].pre_ber);
314 n += snprintf(&buf[n], PAGE_SIZE - n, "\tts_per = %-5d\n",
315 p->layer_info[i].ts_per);
316 n += snprintf(&buf[n], PAGE_SIZE - n, "\terror_ts_packets = %-5d\t",
317 p->layer_info[i].error_ts_packets);
318 n += snprintf(&buf[n], PAGE_SIZE - n, "total_ts_packets = %-5d\t",
319 p->layer_info[i].total_ts_packets);
320 n += snprintf(&buf[n], PAGE_SIZE - n, "ti_ldepth_i = %d\n",
321 p->layer_info[i].ti_ldepth_i);
322 n += snprintf(&buf[n], PAGE_SIZE - n,
323 "\tnumber_of_segments = %d\t",
324 p->layer_info[i].number_of_segments);
325 n += snprintf(&buf[n], PAGE_SIZE - n, "tmcc_errors = %d\n",
326 p->layer_info[i].tmcc_errors);
327 }
328
329
330 debug_data->stats_count = n;
331 spin_unlock(&debug_data->lock);
332
333 wake_up(&debug_data->stats_queue);
334}
335
336static int smsdvb_stats_open(struct inode *inode, struct file *file)
337{
338 struct smsdvb_client_t *client = inode->i_private;
339 struct smsdvb_debugfs *debug_data = client->debug_data;
340
341 kref_get(&debug_data->refcount);
342
343 spin_lock(&debug_data->lock);
344 debug_data->stats_count = 0;
345 debug_data->stats_was_read = false;
346 spin_unlock(&debug_data->lock);
347
348 file->private_data = debug_data;
349
350 return 0;
351}
352
353static void smsdvb_debugfs_data_release(struct kref *ref)
354{
355 struct smsdvb_debugfs *debug_data;
356
357 debug_data = container_of(ref, struct smsdvb_debugfs, refcount);
358 kfree(debug_data);
359}
360
361static int smsdvb_stats_wait_read(struct smsdvb_debugfs *debug_data)
362{
363 int rc = 1;
364
365 spin_lock(&debug_data->lock);
366
367 if (debug_data->stats_was_read)
368 goto exit;
369
370 rc = debug_data->stats_count;
371
372exit:
373 spin_unlock(&debug_data->lock);
374 return rc;
375}
376
377static unsigned int smsdvb_stats_poll(struct file *file, poll_table *wait)
378{
379 struct smsdvb_debugfs *debug_data = file->private_data;
380 int rc;
381
382 kref_get(&debug_data->refcount);
383
384 poll_wait(file, &debug_data->stats_queue, wait);
385
386 rc = smsdvb_stats_wait_read(debug_data);
387 if (rc > 0)
388 rc = POLLIN | POLLRDNORM;
389
390 kref_put(&debug_data->refcount, smsdvb_debugfs_data_release);
391
392 return rc;
393}
394
395static ssize_t smsdvb_stats_read(struct file *file, char __user *user_buf,
396 size_t nbytes, loff_t *ppos)
397{
398 int rc = 0, len;
399 struct smsdvb_debugfs *debug_data = file->private_data;
400
401 kref_get(&debug_data->refcount);
402
403 if (file->f_flags & O_NONBLOCK) {
404 rc = smsdvb_stats_wait_read(debug_data);
405 if (!rc) {
406 rc = -EWOULDBLOCK;
407 goto ret;
408 }
409 } else {
410 rc = wait_event_interruptible(debug_data->stats_queue,
411 smsdvb_stats_wait_read(debug_data));
412 if (rc < 0)
413 goto ret;
414 }
415
416 if (debug_data->stats_was_read) {
417 rc = 0;
418 goto ret;
419 }
420
421 len = debug_data->stats_count - *ppos;
422 if (len >= 0)
423 rc = simple_read_from_buffer(user_buf, nbytes, ppos,
424 debug_data->stats_data, len);
425 else
426 rc = 0;
427
428 if (*ppos >= debug_data->stats_count) {
429 spin_lock(&debug_data->lock);
430 debug_data->stats_was_read = true;
431 spin_unlock(&debug_data->lock);
432 }
433ret:
434 kref_put(&debug_data->refcount, smsdvb_debugfs_data_release);
435 return rc;
436}
437
438static int smsdvb_stats_release(struct inode *inode, struct file *file)
439{
440 struct smsdvb_debugfs *debug_data = file->private_data;
441
442 spin_lock(&debug_data->lock);
443 debug_data->stats_was_read = true;
444 spin_unlock(&debug_data->lock);
445 wake_up_interruptible_sync(&debug_data->stats_queue);
446
447 kref_put(&debug_data->refcount, smsdvb_debugfs_data_release);
448 file->private_data = NULL;
449
450 return 0;
451}
452
453static const struct file_operations debugfs_stats_ops = {
454 .open = smsdvb_stats_open,
455 .poll = smsdvb_stats_poll,
456 .read = smsdvb_stats_read,
457 .release = smsdvb_stats_release,
458 .llseek = generic_file_llseek,
459};
460
461
462
463
464
465int smsdvb_debugfs_create(struct smsdvb_client_t *client)
466{
467 struct smscore_device_t *coredev = client->coredev;
468 struct dentry *d;
469 struct smsdvb_debugfs *debug_data;
470
471 if (!smsdvb_debugfs_usb_root || !coredev->is_usb_device)
472 return -ENODEV;
473
474 client->debugfs = debugfs_create_dir(coredev->devpath,
475 smsdvb_debugfs_usb_root);
476 if (IS_ERR_OR_NULL(client->debugfs)) {
477 pr_info("Unable to create debugfs %s directory.\n",
478 coredev->devpath);
479 return -ENODEV;
480 }
481
482 d = debugfs_create_file("stats", S_IRUGO | S_IWUSR, client->debugfs,
483 client, &debugfs_stats_ops);
484 if (!d) {
485 debugfs_remove(client->debugfs);
486 return -ENOMEM;
487 }
488
489 debug_data = kzalloc(sizeof(*client->debug_data), GFP_KERNEL);
490 if (!debug_data)
491 return -ENOMEM;
492
493 client->debug_data = debug_data;
494 client->prt_dvb_stats = smsdvb_print_dvb_stats;
495 client->prt_isdb_stats = smsdvb_print_isdb_stats;
496 client->prt_isdb_stats_ex = smsdvb_print_isdb_stats_ex;
497
498 init_waitqueue_head(&debug_data->stats_queue);
499 spin_lock_init(&debug_data->lock);
500 kref_init(&debug_data->refcount);
501
502 return 0;
503}
504
505void smsdvb_debugfs_release(struct smsdvb_client_t *client)
506{
507 if (!client->debugfs)
508 return;
509
510 client->prt_dvb_stats = NULL;
511 client->prt_isdb_stats = NULL;
512 client->prt_isdb_stats_ex = NULL;
513
514 debugfs_remove_recursive(client->debugfs);
515 kref_put(&client->debug_data->refcount, smsdvb_debugfs_data_release);
516
517 client->debug_data = NULL;
518 client->debugfs = NULL;
519}
520
521int smsdvb_debugfs_register(void)
522{
523 struct dentry *d;
524
525
526
527
528
529
530
531
532
533
534
535 d = debugfs_create_dir("smsdvb", usb_debug_root);
536 if (IS_ERR_OR_NULL(d)) {
537 pr_err("Couldn't create sysfs node for smsdvb\n");
538 return PTR_ERR(d);
539 } else {
540 smsdvb_debugfs_usb_root = d;
541 }
542 return 0;
543}
544
545void smsdvb_debugfs_unregister(void)
546{
547 debugfs_remove_recursive(smsdvb_debugfs_usb_root);
548 smsdvb_debugfs_usb_root = NULL;
549}
550