// SPDX-License-Identifier: GPL-2.0+
|
//
|
// Copyright(c) 2013 Mauro Carvalho Chehab
|
|
#include "smscoreapi.h"
|
|
#include <linux/module.h>
|
#include <linux/slab.h>
|
#include <linux/init.h>
|
#include <linux/debugfs.h>
|
#include <linux/spinlock.h>
|
#include <linux/usb.h>
|
|
#include <media/dmxdev.h>
|
#include <media/dvbdev.h>
|
#include <media/dvb_demux.h>
|
#include <media/dvb_frontend.h>
|
|
#include "smsdvb.h"
|
|
static struct dentry *smsdvb_debugfs_usb_root;
|
|
struct smsdvb_debugfs {
|
struct kref refcount;
|
spinlock_t lock;
|
|
char stats_data[PAGE_SIZE];
|
unsigned stats_count;
|
bool stats_was_read;
|
|
wait_queue_head_t stats_queue;
|
};
|
|
static void smsdvb_print_dvb_stats(struct smsdvb_debugfs *debug_data,
|
struct sms_stats *p)
|
{
|
int n = 0;
|
char *buf;
|
|
spin_lock(&debug_data->lock);
|
if (debug_data->stats_count) {
|
spin_unlock(&debug_data->lock);
|
return;
|
}
|
|
buf = debug_data->stats_data;
|
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"is_rf_locked = %d\n", p->is_rf_locked);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"is_demod_locked = %d\n", p->is_demod_locked);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"is_external_lna_on = %d\n", p->is_external_lna_on);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"SNR = %d\n", p->SNR);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"ber = %d\n", p->ber);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"FIB_CRC = %d\n", p->FIB_CRC);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"ts_per = %d\n", p->ts_per);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"MFER = %d\n", p->MFER);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"RSSI = %d\n", p->RSSI);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"in_band_pwr = %d\n", p->in_band_pwr);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"carrier_offset = %d\n", p->carrier_offset);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"modem_state = %d\n", p->modem_state);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"frequency = %d\n", p->frequency);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"bandwidth = %d\n", p->bandwidth);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"transmission_mode = %d\n", p->transmission_mode);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"modem_state = %d\n", p->modem_state);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"guard_interval = %d\n", p->guard_interval);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"code_rate = %d\n", p->code_rate);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"lp_code_rate = %d\n", p->lp_code_rate);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"hierarchy = %d\n", p->hierarchy);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"constellation = %d\n", p->constellation);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"burst_size = %d\n", p->burst_size);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"burst_duration = %d\n", p->burst_duration);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"burst_cycle_time = %d\n", p->burst_cycle_time);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"calc_burst_cycle_time = %d\n",
|
p->calc_burst_cycle_time);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"num_of_rows = %d\n", p->num_of_rows);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"num_of_padd_cols = %d\n", p->num_of_padd_cols);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"num_of_punct_cols = %d\n", p->num_of_punct_cols);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"error_ts_packets = %d\n", p->error_ts_packets);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"total_ts_packets = %d\n", p->total_ts_packets);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"num_of_valid_mpe_tlbs = %d\n", p->num_of_valid_mpe_tlbs);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"num_of_invalid_mpe_tlbs = %d\n", p->num_of_invalid_mpe_tlbs);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"num_of_corrected_mpe_tlbs = %d\n", p->num_of_corrected_mpe_tlbs);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"ber_error_count = %d\n", p->ber_error_count);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"ber_bit_count = %d\n", p->ber_bit_count);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"sms_to_host_tx_errors = %d\n", p->sms_to_host_tx_errors);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"pre_ber = %d\n", p->pre_ber);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"cell_id = %d\n", p->cell_id);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"dvbh_srv_ind_hp = %d\n", p->dvbh_srv_ind_hp);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"dvbh_srv_ind_lp = %d\n", p->dvbh_srv_ind_lp);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"num_mpe_received = %d\n", p->num_mpe_received);
|
|
debug_data->stats_count = n;
|
spin_unlock(&debug_data->lock);
|
wake_up(&debug_data->stats_queue);
|
}
|
|
static void smsdvb_print_isdb_stats(struct smsdvb_debugfs *debug_data,
|
struct sms_isdbt_stats *p)
|
{
|
int i, n = 0;
|
char *buf;
|
|
spin_lock(&debug_data->lock);
|
if (debug_data->stats_count) {
|
spin_unlock(&debug_data->lock);
|
return;
|
}
|
|
buf = debug_data->stats_data;
|
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"statistics_type = %d\t", p->statistics_type);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"full_size = %d\n", p->full_size);
|
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"is_rf_locked = %d\t\t", p->is_rf_locked);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"is_demod_locked = %d\t", p->is_demod_locked);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"is_external_lna_on = %d\n", p->is_external_lna_on);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"SNR = %d dB\t\t", p->SNR);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"RSSI = %d dBm\t\t", p->RSSI);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"in_band_pwr = %d dBm\n", p->in_band_pwr);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"carrier_offset = %d\t", p->carrier_offset);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"bandwidth = %d\t\t", p->bandwidth);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"frequency = %d Hz\n", p->frequency);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"transmission_mode = %d\t", p->transmission_mode);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"modem_state = %d\t\t", p->modem_state);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"guard_interval = %d\n", p->guard_interval);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"system_type = %d\t\t", p->system_type);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"partial_reception = %d\t", p->partial_reception);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"num_of_layers = %d\n", p->num_of_layers);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"sms_to_host_tx_errors = %d\n", p->sms_to_host_tx_errors);
|
|
for (i = 0; i < 3; i++) {
|
if (p->layer_info[i].number_of_segments < 1 ||
|
p->layer_info[i].number_of_segments > 13)
|
continue;
|
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "\nLayer %d\n", i);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "\tcode_rate = %d\t",
|
p->layer_info[i].code_rate);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "constellation = %d\n",
|
p->layer_info[i].constellation);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "\tber = %-5d\t",
|
p->layer_info[i].ber);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"\tber_error_count = %-5d\t",
|
p->layer_info[i].ber_error_count);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "ber_bit_count = %-5d\n",
|
p->layer_info[i].ber_bit_count);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "\tpre_ber = %-5d\t",
|
p->layer_info[i].pre_ber);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "\tts_per = %-5d\n",
|
p->layer_info[i].ts_per);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"\terror_ts_packets = %-5d\t",
|
p->layer_info[i].error_ts_packets);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"total_ts_packets = %-5d\t",
|
p->layer_info[i].total_ts_packets);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "ti_ldepth_i = %d\n",
|
p->layer_info[i].ti_ldepth_i);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"\tnumber_of_segments = %d\t",
|
p->layer_info[i].number_of_segments);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "tmcc_errors = %d\n",
|
p->layer_info[i].tmcc_errors);
|
}
|
|
debug_data->stats_count = n;
|
spin_unlock(&debug_data->lock);
|
wake_up(&debug_data->stats_queue);
|
}
|
|
static void smsdvb_print_isdb_stats_ex(struct smsdvb_debugfs *debug_data,
|
struct sms_isdbt_stats_ex *p)
|
{
|
int i, n = 0;
|
char *buf;
|
|
spin_lock(&debug_data->lock);
|
if (debug_data->stats_count) {
|
spin_unlock(&debug_data->lock);
|
return;
|
}
|
|
buf = debug_data->stats_data;
|
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"statistics_type = %d\t", p->statistics_type);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"full_size = %d\n", p->full_size);
|
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"is_rf_locked = %d\t\t", p->is_rf_locked);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"is_demod_locked = %d\t", p->is_demod_locked);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"is_external_lna_on = %d\n", p->is_external_lna_on);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"SNR = %d dB\t\t", p->SNR);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"RSSI = %d dBm\t\t", p->RSSI);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"in_band_pwr = %d dBm\n", p->in_band_pwr);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"carrier_offset = %d\t", p->carrier_offset);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"bandwidth = %d\t\t", p->bandwidth);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"frequency = %d Hz\n", p->frequency);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"transmission_mode = %d\t", p->transmission_mode);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"modem_state = %d\t\t", p->modem_state);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"guard_interval = %d\n", p->guard_interval);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"system_type = %d\t\t", p->system_type);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"partial_reception = %d\t", p->partial_reception);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"num_of_layers = %d\n", p->num_of_layers);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "segment_number = %d\t",
|
p->segment_number);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "tune_bw = %d\n",
|
p->tune_bw);
|
|
for (i = 0; i < 3; i++) {
|
if (p->layer_info[i].number_of_segments < 1 ||
|
p->layer_info[i].number_of_segments > 13)
|
continue;
|
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "\nLayer %d\n", i);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "\tcode_rate = %d\t",
|
p->layer_info[i].code_rate);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "constellation = %d\n",
|
p->layer_info[i].constellation);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "\tber = %-5d\t",
|
p->layer_info[i].ber);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"\tber_error_count = %-5d\t",
|
p->layer_info[i].ber_error_count);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "ber_bit_count = %-5d\n",
|
p->layer_info[i].ber_bit_count);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "\tpre_ber = %-5d\t",
|
p->layer_info[i].pre_ber);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "\tts_per = %-5d\n",
|
p->layer_info[i].ts_per);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"\terror_ts_packets = %-5d\t",
|
p->layer_info[i].error_ts_packets);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"total_ts_packets = %-5d\t",
|
p->layer_info[i].total_ts_packets);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "ti_ldepth_i = %d\n",
|
p->layer_info[i].ti_ldepth_i);
|
n += scnprintf(&buf[n], PAGE_SIZE - n,
|
"\tnumber_of_segments = %d\t",
|
p->layer_info[i].number_of_segments);
|
n += scnprintf(&buf[n], PAGE_SIZE - n, "tmcc_errors = %d\n",
|
p->layer_info[i].tmcc_errors);
|
}
|
|
|
debug_data->stats_count = n;
|
spin_unlock(&debug_data->lock);
|
|
wake_up(&debug_data->stats_queue);
|
}
|
|
static int smsdvb_stats_open(struct inode *inode, struct file *file)
|
{
|
struct smsdvb_client_t *client = inode->i_private;
|
struct smsdvb_debugfs *debug_data = client->debug_data;
|
|
kref_get(&debug_data->refcount);
|
|
spin_lock(&debug_data->lock);
|
debug_data->stats_count = 0;
|
debug_data->stats_was_read = false;
|
spin_unlock(&debug_data->lock);
|
|
file->private_data = debug_data;
|
|
return 0;
|
}
|
|
static void smsdvb_debugfs_data_release(struct kref *ref)
|
{
|
struct smsdvb_debugfs *debug_data;
|
|
debug_data = container_of(ref, struct smsdvb_debugfs, refcount);
|
kfree(debug_data);
|
}
|
|
static int smsdvb_stats_wait_read(struct smsdvb_debugfs *debug_data)
|
{
|
int rc = 1;
|
|
spin_lock(&debug_data->lock);
|
|
if (debug_data->stats_was_read)
|
goto exit;
|
|
rc = debug_data->stats_count;
|
|
exit:
|
spin_unlock(&debug_data->lock);
|
return rc;
|
}
|
|
static __poll_t smsdvb_stats_poll(struct file *file, poll_table *wait)
|
{
|
struct smsdvb_debugfs *debug_data = file->private_data;
|
int rc;
|
|
kref_get(&debug_data->refcount);
|
|
poll_wait(file, &debug_data->stats_queue, wait);
|
|
rc = smsdvb_stats_wait_read(debug_data);
|
kref_put(&debug_data->refcount, smsdvb_debugfs_data_release);
|
|
return rc > 0 ? EPOLLIN | EPOLLRDNORM : 0;
|
}
|
|
static ssize_t smsdvb_stats_read(struct file *file, char __user *user_buf,
|
size_t nbytes, loff_t *ppos)
|
{
|
int rc = 0, len;
|
struct smsdvb_debugfs *debug_data = file->private_data;
|
|
kref_get(&debug_data->refcount);
|
|
if (file->f_flags & O_NONBLOCK) {
|
rc = smsdvb_stats_wait_read(debug_data);
|
if (!rc) {
|
rc = -EWOULDBLOCK;
|
goto ret;
|
}
|
} else {
|
rc = wait_event_interruptible(debug_data->stats_queue,
|
smsdvb_stats_wait_read(debug_data));
|
if (rc < 0)
|
goto ret;
|
}
|
|
if (debug_data->stats_was_read) {
|
rc = 0; /* EOF */
|
goto ret;
|
}
|
|
len = debug_data->stats_count - *ppos;
|
if (len >= 0)
|
rc = simple_read_from_buffer(user_buf, nbytes, ppos,
|
debug_data->stats_data, len);
|
else
|
rc = 0;
|
|
if (*ppos >= debug_data->stats_count) {
|
spin_lock(&debug_data->lock);
|
debug_data->stats_was_read = true;
|
spin_unlock(&debug_data->lock);
|
}
|
ret:
|
kref_put(&debug_data->refcount, smsdvb_debugfs_data_release);
|
return rc;
|
}
|
|
static int smsdvb_stats_release(struct inode *inode, struct file *file)
|
{
|
struct smsdvb_debugfs *debug_data = file->private_data;
|
|
spin_lock(&debug_data->lock);
|
debug_data->stats_was_read = true; /* return EOF to read() */
|
spin_unlock(&debug_data->lock);
|
wake_up_interruptible_sync(&debug_data->stats_queue);
|
|
kref_put(&debug_data->refcount, smsdvb_debugfs_data_release);
|
file->private_data = NULL;
|
|
return 0;
|
}
|
|
static const struct file_operations debugfs_stats_ops = {
|
.open = smsdvb_stats_open,
|
.poll = smsdvb_stats_poll,
|
.read = smsdvb_stats_read,
|
.release = smsdvb_stats_release,
|
.llseek = generic_file_llseek,
|
};
|
|
/*
|
* Functions used by smsdvb, in order to create the interfaces
|
*/
|
|
int smsdvb_debugfs_create(struct smsdvb_client_t *client)
|
{
|
struct smscore_device_t *coredev = client->coredev;
|
struct dentry *d;
|
struct smsdvb_debugfs *debug_data;
|
|
if (!smsdvb_debugfs_usb_root || !coredev->is_usb_device)
|
return -ENODEV;
|
|
client->debugfs = debugfs_create_dir(coredev->devpath,
|
smsdvb_debugfs_usb_root);
|
if (IS_ERR_OR_NULL(client->debugfs)) {
|
pr_info("Unable to create debugfs %s directory.\n",
|
coredev->devpath);
|
return -ENODEV;
|
}
|
|
d = debugfs_create_file("stats", S_IRUGO | S_IWUSR, client->debugfs,
|
client, &debugfs_stats_ops);
|
if (!d) {
|
debugfs_remove(client->debugfs);
|
return -ENOMEM;
|
}
|
|
debug_data = kzalloc(sizeof(*client->debug_data), GFP_KERNEL);
|
if (!debug_data)
|
return -ENOMEM;
|
|
client->debug_data = debug_data;
|
client->prt_dvb_stats = smsdvb_print_dvb_stats;
|
client->prt_isdb_stats = smsdvb_print_isdb_stats;
|
client->prt_isdb_stats_ex = smsdvb_print_isdb_stats_ex;
|
|
init_waitqueue_head(&debug_data->stats_queue);
|
spin_lock_init(&debug_data->lock);
|
kref_init(&debug_data->refcount);
|
|
return 0;
|
}
|
|
void smsdvb_debugfs_release(struct smsdvb_client_t *client)
|
{
|
if (!client->debugfs)
|
return;
|
|
client->prt_dvb_stats = NULL;
|
client->prt_isdb_stats = NULL;
|
client->prt_isdb_stats_ex = NULL;
|
|
debugfs_remove_recursive(client->debugfs);
|
kref_put(&client->debug_data->refcount, smsdvb_debugfs_data_release);
|
|
client->debug_data = NULL;
|
client->debugfs = NULL;
|
}
|
|
void smsdvb_debugfs_register(void)
|
{
|
struct dentry *d;
|
|
/*
|
* FIXME: This was written to debug Siano USB devices. So, it creates
|
* the debugfs node under <debugfs>/usb.
|
* A similar logic would be needed for Siano sdio devices, but, in that
|
* case, usb_debug_root is not a good choice.
|
*
|
* Perhaps the right fix here would be to create another sysfs root
|
* node for sdio-based boards, but this may need some logic at sdio
|
* subsystem.
|
*/
|
d = debugfs_create_dir("smsdvb", usb_debug_root);
|
if (IS_ERR_OR_NULL(d)) {
|
pr_err("Couldn't create sysfs node for smsdvb\n");
|
return;
|
}
|
smsdvb_debugfs_usb_root = d;
|
}
|
|
void smsdvb_debugfs_unregister(void)
|
{
|
if (!smsdvb_debugfs_usb_root)
|
return;
|
debugfs_remove_recursive(smsdvb_debugfs_usb_root);
|
smsdvb_debugfs_usb_root = NULL;
|
}
|
