428 lines · c
1// SPDX-License-Identifier: GPL-2.0+2//3// Copyright(c) 2013 Mauro Carvalho Chehab4 5#include "smscoreapi.h"6 7#include <linux/module.h>8#include <linux/slab.h>9#include <linux/init.h>10#include <linux/debugfs.h>11#include <linux/spinlock.h>12#include <linux/usb.h>13 14#include <media/dmxdev.h>15#include <media/dvbdev.h>16#include <media/dvb_demux.h>17#include <media/dvb_frontend.h>18 19#include "smsdvb.h"20 21static struct dentry *smsdvb_debugfs_usb_root;22 23struct smsdvb_debugfs {24 struct kref refcount;25 spinlock_t lock;26 27 char stats_data[PAGE_SIZE];28 unsigned stats_count;29 bool stats_was_read;30 31 wait_queue_head_t stats_queue;32};33 34static void smsdvb_print_dvb_stats(struct smsdvb_debugfs *debug_data,35 struct sms_stats *p)36{37 int n = 0;38 char *buf;39 40 spin_lock(&debug_data->lock);41 if (debug_data->stats_count) {42 spin_unlock(&debug_data->lock);43 return;44 }45 46 buf = debug_data->stats_data;47 48 n += sysfs_emit_at(buf, n, "is_rf_locked = %d\n", p->is_rf_locked);49 n += sysfs_emit_at(buf, n, "is_demod_locked = %d\n", p->is_demod_locked);50 n += sysfs_emit_at(buf, n, "is_external_lna_on = %d\n", p->is_external_lna_on);51 n += sysfs_emit_at(buf, n, "SNR = %d\n", p->SNR);52 n += sysfs_emit_at(buf, n, "ber = %d\n", p->ber);53 n += sysfs_emit_at(buf, n, "FIB_CRC = %d\n", p->FIB_CRC);54 n += sysfs_emit_at(buf, n, "ts_per = %d\n", p->ts_per);55 n += sysfs_emit_at(buf, n, "MFER = %d\n", p->MFER);56 n += sysfs_emit_at(buf, n, "RSSI = %d\n", p->RSSI);57 n += sysfs_emit_at(buf, n, "in_band_pwr = %d\n", p->in_band_pwr);58 n += sysfs_emit_at(buf, n, "carrier_offset = %d\n", p->carrier_offset);59 n += sysfs_emit_at(buf, n, "modem_state = %d\n", p->modem_state);60 n += sysfs_emit_at(buf, n, "frequency = %d\n", p->frequency);61 n += sysfs_emit_at(buf, n, "bandwidth = %d\n", p->bandwidth);62 n += sysfs_emit_at(buf, n, "transmission_mode = %d\n", p->transmission_mode);63 n += sysfs_emit_at(buf, n, "modem_state = %d\n", p->modem_state);64 n += sysfs_emit_at(buf, n, "guard_interval = %d\n", p->guard_interval);65 n += sysfs_emit_at(buf, n, "code_rate = %d\n", p->code_rate);66 n += sysfs_emit_at(buf, n, "lp_code_rate = %d\n", p->lp_code_rate);67 n += sysfs_emit_at(buf, n, "hierarchy = %d\n", p->hierarchy);68 n += sysfs_emit_at(buf, n, "constellation = %d\n", p->constellation);69 n += sysfs_emit_at(buf, n, "burst_size = %d\n", p->burst_size);70 n += sysfs_emit_at(buf, n, "burst_duration = %d\n", p->burst_duration);71 n += sysfs_emit_at(buf, n, "burst_cycle_time = %d\n", p->burst_cycle_time);72 n += sysfs_emit_at(buf, n, "calc_burst_cycle_time = %d\n", p->calc_burst_cycle_time);73 n += sysfs_emit_at(buf, n, "num_of_rows = %d\n", p->num_of_rows);74 n += sysfs_emit_at(buf, n, "num_of_padd_cols = %d\n", p->num_of_padd_cols);75 n += sysfs_emit_at(buf, n, "num_of_punct_cols = %d\n", p->num_of_punct_cols);76 n += sysfs_emit_at(buf, n, "error_ts_packets = %d\n", p->error_ts_packets);77 n += sysfs_emit_at(buf, n, "total_ts_packets = %d\n", p->total_ts_packets);78 n += sysfs_emit_at(buf, n, "num_of_valid_mpe_tlbs = %d\n", p->num_of_valid_mpe_tlbs);79 n += sysfs_emit_at(buf, n, "num_of_invalid_mpe_tlbs = %d\n", p->num_of_invalid_mpe_tlbs);80 n += sysfs_emit_at(buf, n, "num_of_corrected_mpe_tlbs = %d\n",81 p->num_of_corrected_mpe_tlbs);82 n += sysfs_emit_at(buf, n, "ber_error_count = %d\n", p->ber_error_count);83 n += sysfs_emit_at(buf, n, "ber_bit_count = %d\n", p->ber_bit_count);84 n += sysfs_emit_at(buf, n, "sms_to_host_tx_errors = %d\n", p->sms_to_host_tx_errors);85 n += sysfs_emit_at(buf, n, "pre_ber = %d\n", p->pre_ber);86 n += sysfs_emit_at(buf, n, "cell_id = %d\n", p->cell_id);87 n += sysfs_emit_at(buf, n, "dvbh_srv_ind_hp = %d\n", p->dvbh_srv_ind_hp);88 n += sysfs_emit_at(buf, n, "dvbh_srv_ind_lp = %d\n", p->dvbh_srv_ind_lp);89 n += sysfs_emit_at(buf, n, "num_mpe_received = %d\n", p->num_mpe_received);90 91 debug_data->stats_count = n;92 spin_unlock(&debug_data->lock);93 wake_up(&debug_data->stats_queue);94}95 96static void smsdvb_print_isdb_stats(struct smsdvb_debugfs *debug_data,97 struct sms_isdbt_stats *p)98{99 int i, n = 0;100 char *buf;101 102 spin_lock(&debug_data->lock);103 if (debug_data->stats_count) {104 spin_unlock(&debug_data->lock);105 return;106 }107 108 buf = debug_data->stats_data;109 110 n += sysfs_emit_at(buf, n, "statistics_type = %d\t", p->statistics_type);111 n += sysfs_emit_at(buf, n, "full_size = %d\n", p->full_size);112 113 n += sysfs_emit_at(buf, n, "is_rf_locked = %d\t\t", p->is_rf_locked);114 n += sysfs_emit_at(buf, n, "is_demod_locked = %d\t", p->is_demod_locked);115 n += sysfs_emit_at(buf, n, "is_external_lna_on = %d\n", p->is_external_lna_on);116 n += sysfs_emit_at(buf, n, "SNR = %d dB\t\t", p->SNR);117 n += sysfs_emit_at(buf, n, "RSSI = %d dBm\t\t", p->RSSI);118 n += sysfs_emit_at(buf, n, "in_band_pwr = %d dBm\n", p->in_band_pwr);119 n += sysfs_emit_at(buf, n, "carrier_offset = %d\t", p->carrier_offset);120 n += sysfs_emit_at(buf, n, "bandwidth = %d\t\t", p->bandwidth);121 n += sysfs_emit_at(buf, n, "frequency = %d Hz\n", p->frequency);122 n += sysfs_emit_at(buf, n, "transmission_mode = %d\t", p->transmission_mode);123 n += sysfs_emit_at(buf, n, "modem_state = %d\t\t", p->modem_state);124 n += sysfs_emit_at(buf, n, "guard_interval = %d\n", p->guard_interval);125 n += sysfs_emit_at(buf, n, "system_type = %d\t\t", p->system_type);126 n += sysfs_emit_at(buf, n, "partial_reception = %d\t", p->partial_reception);127 n += sysfs_emit_at(buf, n, "num_of_layers = %d\n", p->num_of_layers);128 n += sysfs_emit_at(buf, n, "sms_to_host_tx_errors = %d\n", p->sms_to_host_tx_errors);129 130 for (i = 0; i < 3; i++) {131 if (p->layer_info[i].number_of_segments < 1 ||132 p->layer_info[i].number_of_segments > 13)133 continue;134 135 n += sysfs_emit_at(buf, n, "\nLayer %d\n", i);136 n += sysfs_emit_at(buf, n, "\tcode_rate = %d\t", p->layer_info[i].code_rate);137 n += sysfs_emit_at(buf, n, "constellation = %d\n", p->layer_info[i].constellation);138 n += sysfs_emit_at(buf, n, "\tber = %-5d\t", p->layer_info[i].ber);139 n += sysfs_emit_at(buf, n, "\tber_error_count = %-5d\t",140 p->layer_info[i].ber_error_count);141 n += sysfs_emit_at(buf, n, "ber_bit_count = %-5d\n",142 p->layer_info[i].ber_bit_count);143 n += sysfs_emit_at(buf, n, "\tpre_ber = %-5d\t", p->layer_info[i].pre_ber);144 n += sysfs_emit_at(buf, n, "\tts_per = %-5d\n", p->layer_info[i].ts_per);145 n += sysfs_emit_at(buf, n, "\terror_ts_packets = %-5d\t",146 p->layer_info[i].error_ts_packets);147 n += sysfs_emit_at(buf, n, "total_ts_packets = %-5d\t",148 p->layer_info[i].total_ts_packets);149 n += sysfs_emit_at(buf, n, "ti_ldepth_i = %d\n", p->layer_info[i].ti_ldepth_i);150 n += sysfs_emit_at(buf, n, "\tnumber_of_segments = %d\t",151 p->layer_info[i].number_of_segments);152 n += sysfs_emit_at(buf, n, "tmcc_errors = %d\n", p->layer_info[i].tmcc_errors);153 }154 155 debug_data->stats_count = n;156 spin_unlock(&debug_data->lock);157 wake_up(&debug_data->stats_queue);158}159 160static void smsdvb_print_isdb_stats_ex(struct smsdvb_debugfs *debug_data,161 struct sms_isdbt_stats_ex *p)162{163 int i, n = 0;164 char *buf;165 166 spin_lock(&debug_data->lock);167 if (debug_data->stats_count) {168 spin_unlock(&debug_data->lock);169 return;170 }171 172 buf = debug_data->stats_data;173 174 n += sysfs_emit_at(buf, n, "statistics_type = %d\t", p->statistics_type);175 n += sysfs_emit_at(buf, n, "full_size = %d\n", p->full_size);176 177 n += sysfs_emit_at(buf, n, "is_rf_locked = %d\t\t", p->is_rf_locked);178 n += sysfs_emit_at(buf, n, "is_demod_locked = %d\t", p->is_demod_locked);179 n += sysfs_emit_at(buf, n, "is_external_lna_on = %d\n", p->is_external_lna_on);180 n += sysfs_emit_at(buf, n, "SNR = %d dB\t\t", p->SNR);181 n += sysfs_emit_at(buf, n, "RSSI = %d dBm\t\t", p->RSSI);182 n += sysfs_emit_at(buf, n, "in_band_pwr = %d dBm\n", p->in_band_pwr);183 n += sysfs_emit_at(buf, n, "carrier_offset = %d\t", p->carrier_offset);184 n += sysfs_emit_at(buf, n, "bandwidth = %d\t\t", p->bandwidth);185 n += sysfs_emit_at(buf, n, "frequency = %d Hz\n", p->frequency);186 n += sysfs_emit_at(buf, n, "transmission_mode = %d\t", p->transmission_mode);187 n += sysfs_emit_at(buf, n, "modem_state = %d\t\t", p->modem_state);188 n += sysfs_emit_at(buf, n, "guard_interval = %d\n", p->guard_interval);189 n += sysfs_emit_at(buf, n, "system_type = %d\t\t", p->system_type);190 n += sysfs_emit_at(buf, n, "partial_reception = %d\t", p->partial_reception);191 n += sysfs_emit_at(buf, n, "num_of_layers = %d\n", p->num_of_layers);192 n += sysfs_emit_at(buf, n, "segment_number = %d\t", p->segment_number);193 n += sysfs_emit_at(buf, n, "tune_bw = %d\n", p->tune_bw);194 195 for (i = 0; i < 3; i++) {196 if (p->layer_info[i].number_of_segments < 1 ||197 p->layer_info[i].number_of_segments > 13)198 continue;199 200 n += sysfs_emit_at(buf, n, "\nLayer %d\n", i);201 n += sysfs_emit_at(buf, n, "\tcode_rate = %d\t", p->layer_info[i].code_rate);202 n += sysfs_emit_at(buf, n, "constellation = %d\n", p->layer_info[i].constellation);203 n += sysfs_emit_at(buf, n, "\tber = %-5d\t", p->layer_info[i].ber);204 n += sysfs_emit_at(buf, n, "\tber_error_count = %-5d\t",205 p->layer_info[i].ber_error_count);206 n += sysfs_emit_at(buf, n, "ber_bit_count = %-5d\n",207 p->layer_info[i].ber_bit_count);208 n += sysfs_emit_at(buf, n, "\tpre_ber = %-5d\t", p->layer_info[i].pre_ber);209 n += sysfs_emit_at(buf, n, "\tts_per = %-5d\n", p->layer_info[i].ts_per);210 n += sysfs_emit_at(buf, n, "\terror_ts_packets = %-5d\t",211 p->layer_info[i].error_ts_packets);212 n += sysfs_emit_at(buf, n, "total_ts_packets = %-5d\t",213 p->layer_info[i].total_ts_packets);214 n += sysfs_emit_at(buf, n, "ti_ldepth_i = %d\n", p->layer_info[i].ti_ldepth_i);215 n += sysfs_emit_at(buf, n, "\tnumber_of_segments = %d\t",216 p->layer_info[i].number_of_segments);217 n += sysfs_emit_at(buf, n, "tmcc_errors = %d\n", p->layer_info[i].tmcc_errors);218 }219 220 221 debug_data->stats_count = n;222 spin_unlock(&debug_data->lock);223 224 wake_up(&debug_data->stats_queue);225}226 227static int smsdvb_stats_open(struct inode *inode, struct file *file)228{229 struct smsdvb_client_t *client = inode->i_private;230 struct smsdvb_debugfs *debug_data = client->debug_data;231 232 kref_get(&debug_data->refcount);233 234 spin_lock(&debug_data->lock);235 debug_data->stats_count = 0;236 debug_data->stats_was_read = false;237 spin_unlock(&debug_data->lock);238 239 file->private_data = debug_data;240 241 return 0;242}243 244static void smsdvb_debugfs_data_release(struct kref *ref)245{246 struct smsdvb_debugfs *debug_data;247 248 debug_data = container_of(ref, struct smsdvb_debugfs, refcount);249 kfree(debug_data);250}251 252static int smsdvb_stats_wait_read(struct smsdvb_debugfs *debug_data)253{254 int rc = 1;255 256 spin_lock(&debug_data->lock);257 258 if (debug_data->stats_was_read)259 goto exit;260 261 rc = debug_data->stats_count;262 263exit:264 spin_unlock(&debug_data->lock);265 return rc;266}267 268static __poll_t smsdvb_stats_poll(struct file *file, poll_table *wait)269{270 struct smsdvb_debugfs *debug_data = file->private_data;271 int rc;272 273 kref_get(&debug_data->refcount);274 275 poll_wait(file, &debug_data->stats_queue, wait);276 277 rc = smsdvb_stats_wait_read(debug_data);278 kref_put(&debug_data->refcount, smsdvb_debugfs_data_release);279 280 return rc > 0 ? EPOLLIN | EPOLLRDNORM : 0;281}282 283static ssize_t smsdvb_stats_read(struct file *file, char __user *user_buf,284 size_t nbytes, loff_t *ppos)285{286 int rc = 0, len;287 struct smsdvb_debugfs *debug_data = file->private_data;288 289 kref_get(&debug_data->refcount);290 291 if (file->f_flags & O_NONBLOCK) {292 rc = smsdvb_stats_wait_read(debug_data);293 if (!rc) {294 rc = -EWOULDBLOCK;295 goto ret;296 }297 } else {298 rc = wait_event_interruptible(debug_data->stats_queue,299 smsdvb_stats_wait_read(debug_data));300 if (rc < 0)301 goto ret;302 }303 304 if (debug_data->stats_was_read) {305 rc = 0; /* EOF */306 goto ret;307 }308 309 len = debug_data->stats_count - *ppos;310 if (len >= 0)311 rc = simple_read_from_buffer(user_buf, nbytes, ppos,312 debug_data->stats_data, len);313 else314 rc = 0;315 316 if (*ppos >= debug_data->stats_count) {317 spin_lock(&debug_data->lock);318 debug_data->stats_was_read = true;319 spin_unlock(&debug_data->lock);320 }321ret:322 kref_put(&debug_data->refcount, smsdvb_debugfs_data_release);323 return rc;324}325 326static int smsdvb_stats_release(struct inode *inode, struct file *file)327{328 struct smsdvb_debugfs *debug_data = file->private_data;329 330 spin_lock(&debug_data->lock);331 debug_data->stats_was_read = true; /* return EOF to read() */332 spin_unlock(&debug_data->lock);333 wake_up_interruptible_sync(&debug_data->stats_queue);334 335 kref_put(&debug_data->refcount, smsdvb_debugfs_data_release);336 file->private_data = NULL;337 338 return 0;339}340 341static const struct file_operations debugfs_stats_ops = {342 .open = smsdvb_stats_open,343 .poll = smsdvb_stats_poll,344 .read = smsdvb_stats_read,345 .release = smsdvb_stats_release,346 .llseek = generic_file_llseek,347};348 349/*350 * Functions used by smsdvb, in order to create the interfaces351 */352 353int smsdvb_debugfs_create(struct smsdvb_client_t *client)354{355 struct smscore_device_t *coredev = client->coredev;356 struct smsdvb_debugfs *debug_data;357 358 if (!smsdvb_debugfs_usb_root || !coredev->is_usb_device)359 return -ENODEV;360 361 debug_data = kzalloc(sizeof(*client->debug_data), GFP_KERNEL);362 if (!debug_data)363 return -ENOMEM;364 365 client->debugfs = debugfs_create_dir(coredev->devpath,366 smsdvb_debugfs_usb_root);367 368 debugfs_create_file("stats", S_IRUGO | S_IWUSR, client->debugfs,369 client, &debugfs_stats_ops);370 371 client->debug_data = debug_data;372 client->prt_dvb_stats = smsdvb_print_dvb_stats;373 client->prt_isdb_stats = smsdvb_print_isdb_stats;374 client->prt_isdb_stats_ex = smsdvb_print_isdb_stats_ex;375 376 init_waitqueue_head(&debug_data->stats_queue);377 spin_lock_init(&debug_data->lock);378 kref_init(&debug_data->refcount);379 380 return 0;381}382 383void smsdvb_debugfs_release(struct smsdvb_client_t *client)384{385 if (!client->debugfs)386 return;387 388 client->prt_dvb_stats = NULL;389 client->prt_isdb_stats = NULL;390 client->prt_isdb_stats_ex = NULL;391 392 debugfs_remove_recursive(client->debugfs);393 kref_put(&client->debug_data->refcount, smsdvb_debugfs_data_release);394 395 client->debug_data = NULL;396 client->debugfs = NULL;397}398 399void smsdvb_debugfs_register(void)400{401 struct dentry *d;402 403 /*404 * FIXME: This was written to debug Siano USB devices. So, it creates405 * the debugfs node under <debugfs>/usb.406 * A similar logic would be needed for Siano sdio devices, but, in that407 * case, usb_debug_root is not a good choice.408 *409 * Perhaps the right fix here would be to create another sysfs root410 * node for sdio-based boards, but this may need some logic at sdio411 * subsystem.412 */413 d = debugfs_create_dir("smsdvb", usb_debug_root);414 if (IS_ERR_OR_NULL(d)) {415 pr_err("Couldn't create sysfs node for smsdvb\n");416 return;417 }418 smsdvb_debugfs_usb_root = d;419}420 421void smsdvb_debugfs_unregister(void)422{423 if (!smsdvb_debugfs_usb_root)424 return;425 debugfs_remove_recursive(smsdvb_debugfs_usb_root);426 smsdvb_debugfs_usb_root = NULL;427}428