cregit-Linux how code gets into the kernel

Release 4.11 drivers/media/common/siano/smsdvb-debugfs.c

/***********************************************************************
 *
 * Copyright(c) 2013 Mauro Carvalho Chehab
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 2 of the License, or
 * (at your option) any later version.

 *  This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 *
 ***********************************************************************/

#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 "dmxdev.h"
#include "dvbdev.h"
#include "dvb_demux.h"
#include "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 += snprintf(&buf[n], PAGE_SIZE - n, "is_rf_locked = %d\n", p->is_rf_locked); n += snprintf(&buf[n], PAGE_SIZE - n, "is_demod_locked = %d\n", p->is_demod_locked); n += snprintf(&buf[n], PAGE_SIZE - n, "is_external_lna_on = %d\n", p->is_external_lna_on); n += snprintf(&buf[n], PAGE_SIZE - n, "SNR = %d\n", p->SNR); n += snprintf(&buf[n], PAGE_SIZE - n, "ber = %d\n", p->ber); n += snprintf(&buf[n], PAGE_SIZE - n, "FIB_CRC = %d\n", p->FIB_CRC); n += snprintf(&buf[n], PAGE_SIZE - n, "ts_per = %d\n", p->ts_per); n += snprintf(&buf[n], PAGE_SIZE - n, "MFER = %d\n", p->MFER); n += snprintf(&buf[n], PAGE_SIZE - n, "RSSI = %d\n", p->RSSI); n += snprintf(&buf[n], PAGE_SIZE - n, "in_band_pwr = %d\n", p->in_band_pwr); n += snprintf(&buf[n], PAGE_SIZE - n, "carrier_offset = %d\n", p->carrier_offset); n += snprintf(&buf[n], PAGE_SIZE - n, "modem_state = %d\n", p->modem_state); n += snprintf(&buf[n], PAGE_SIZE - n, "frequency = %d\n", p->frequency); n += snprintf(&buf[n], PAGE_SIZE - n, "bandwidth = %d\n", p->bandwidth); n += snprintf(&buf[n], PAGE_SIZE - n, "transmission_mode = %d\n", p->transmission_mode); n += snprintf(&buf[n], PAGE_SIZE - n, "modem_state = %d\n", p->modem_state); n += snprintf(&buf[n], PAGE_SIZE - n, "guard_interval = %d\n", p->guard_interval); n += snprintf(&buf[n], PAGE_SIZE - n, "code_rate = %d\n", p->code_rate); n += snprintf(&buf[n], PAGE_SIZE - n, "lp_code_rate = %d\n", p->lp_code_rate); n += snprintf(&buf[n], PAGE_SIZE - n, "hierarchy = %d\n", p->hierarchy); n += snprintf(&buf[n], PAGE_SIZE - n, "constellation = %d\n", p->constellation); n += snprintf(&buf[n], PAGE_SIZE - n, "burst_size = %d\n", p->burst_size); n += snprintf(&buf[n], PAGE_SIZE - n, "burst_duration = %d\n", p->burst_duration); n += snprintf(&buf[n], PAGE_SIZE - n, "burst_cycle_time = %d\n", p->burst_cycle_time); n += snprintf(&buf[n], PAGE_SIZE - n, "calc_burst_cycle_time = %d\n", p->calc_burst_cycle_time); n += snprintf(&buf[n], PAGE_SIZE - n, "num_of_rows = %d\n", p->num_of_rows); n += snprintf(&buf[n], PAGE_SIZE - n, "num_of_padd_cols = %d\n", p->num_of_padd_cols); n += snprintf(&buf[n], PAGE_SIZE - n, "num_of_punct_cols = %d\n", p->num_of_punct_cols); n += snprintf(&buf[n], PAGE_SIZE - n, "error_ts_packets = %d\n", p->error_ts_packets); n += snprintf(&buf[n], PAGE_SIZE - n, "total_ts_packets = %d\n", p->total_ts_packets); n += snprintf(&buf[n], PAGE_SIZE - n, "num_of_valid_mpe_tlbs = %d\n", p->num_of_valid_mpe_tlbs); n += snprintf(&buf[n], PAGE_SIZE - n, "num_of_invalid_mpe_tlbs = %d\n", p->num_of_invalid_mpe_tlbs); n += snprintf(&buf[n], PAGE_SIZE - n, "num_of_corrected_mpe_tlbs = %d\n", p->num_of_corrected_mpe_tlbs); n += snprintf(&buf[n], PAGE_SIZE - n, "ber_error_count = %d\n", p->ber_error_count); n += snprintf(&buf[n], PAGE_SIZE - n, "ber_bit_count = %d\n", p->ber_bit_count); n += snprintf(&buf[n], PAGE_SIZE - n, "sms_to_host_tx_errors = %d\n", p->sms_to_host_tx_errors); n += snprintf(&buf[n], PAGE_SIZE - n, "pre_ber = %d\n", p->pre_ber); n += snprintf(&buf[n], PAGE_SIZE - n, "cell_id = %d\n", p->cell_id); n += snprintf(&buf[n], PAGE_SIZE - n, "dvbh_srv_ind_hp = %d\n", p->dvbh_srv_ind_hp); n += snprintf(&buf[n], PAGE_SIZE - n, "dvbh_srv_ind_lp = %d\n", p->dvbh_srv_ind_lp); n += snprintf(&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); }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab939100.00%5100.00%
Total939100.00%5100.00%


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 += snprintf(&buf[n], PAGE_SIZE - n, "statistics_type = %d\t", p->statistics_type); n += snprintf(&buf[n], PAGE_SIZE - n, "full_size = %d\n", p->full_size); n += snprintf(&buf[n], PAGE_SIZE - n, "is_rf_locked = %d\t\t", p->is_rf_locked); n += snprintf(&buf[n], PAGE_SIZE - n, "is_demod_locked = %d\t", p->is_demod_locked); n += snprintf(&buf[n], PAGE_SIZE - n, "is_external_lna_on = %d\n", p->is_external_lna_on); n += snprintf(&buf[n], PAGE_SIZE - n, "SNR = %d dB\t\t", p->SNR); n += snprintf(&buf[n], PAGE_SIZE - n, "RSSI = %d dBm\t\t", p->RSSI); n += snprintf(&buf[n], PAGE_SIZE - n, "in_band_pwr = %d dBm\n", p->in_band_pwr); n += snprintf(&buf[n], PAGE_SIZE - n, "carrier_offset = %d\t", p->carrier_offset); n += snprintf(&buf[n], PAGE_SIZE - n, "bandwidth = %d\t\t", p->bandwidth); n += snprintf(&buf[n], PAGE_SIZE - n, "frequency = %d Hz\n", p->frequency); n += snprintf(&buf[n], PAGE_SIZE - n, "transmission_mode = %d\t", p->transmission_mode); n += snprintf(&buf[n], PAGE_SIZE - n, "modem_state = %d\t\t", p->modem_state); n += snprintf(&buf[n], PAGE_SIZE - n, "guard_interval = %d\n", p->guard_interval); n += snprintf(&buf[n], PAGE_SIZE - n, "system_type = %d\t\t", p->system_type); n += snprintf(&buf[n], PAGE_SIZE - n, "partial_reception = %d\t", p->partial_reception); n += snprintf(&buf[n], PAGE_SIZE - n, "num_of_layers = %d\n", p->num_of_layers); n += snprintf(&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 += snprintf(&buf[n], PAGE_SIZE - n, "\nLayer %d\n", i); n += snprintf(&buf[n], PAGE_SIZE - n, "\tcode_rate = %d\t", p->layer_info[i].code_rate); n += snprintf(&buf[n], PAGE_SIZE - n, "constellation = %d\n", p->layer_info[i].constellation); n += snprintf(&buf[n], PAGE_SIZE - n, "\tber = %-5d\t", p->layer_info[i].ber); n += snprintf(&buf[n], PAGE_SIZE - n, "\tber_error_count = %-5d\t", p->layer_info[i].ber_error_count); n += snprintf(&buf[n], PAGE_SIZE - n, "ber_bit_count = %-5d\n", p->layer_info[i].ber_bit_count); n += snprintf(&buf[n], PAGE_SIZE - n, "\tpre_ber = %-5d\t", p->layer_info[i].pre_ber); n += snprintf(&buf[n], PAGE_SIZE - n, "\tts_per = %-5d\n", p->layer_info[i].ts_per); n += snprintf(&buf[n], PAGE_SIZE - n, "\terror_ts_packets = %-5d\t", p->layer_info[i].error_ts_packets); n += snprintf(&buf[n], PAGE_SIZE - n, "total_ts_packets = %-5d\t", p->layer_info[i].total_ts_packets); n += snprintf(&buf[n], PAGE_SIZE - n, "ti_ldepth_i = %d\n", p->layer_info[i].ti_ldepth_i); n += snprintf(&buf[n], PAGE_SIZE - n, "\tnumber_of_segments = %d\t", p->layer_info[i].number_of_segments); n += snprintf(&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); }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab829100.00%6100.00%
Total829100.00%6100.00%


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 += snprintf(&buf[n], PAGE_SIZE - n, "statistics_type = %d\t", p->statistics_type); n += snprintf(&buf[n], PAGE_SIZE - n, "full_size = %d\n", p->full_size); n += snprintf(&buf[n], PAGE_SIZE - n, "is_rf_locked = %d\t\t", p->is_rf_locked); n += snprintf(&buf[n], PAGE_SIZE - n, "is_demod_locked = %d\t", p->is_demod_locked); n += snprintf(&buf[n], PAGE_SIZE - n, "is_external_lna_on = %d\n", p->is_external_lna_on); n += snprintf(&buf[n], PAGE_SIZE - n, "SNR = %d dB\t\t", p->SNR); n += snprintf(&buf[n], PAGE_SIZE - n, "RSSI = %d dBm\t\t", p->RSSI); n += snprintf(&buf[n], PAGE_SIZE - n, "in_band_pwr = %d dBm\n", p->in_band_pwr); n += snprintf(&buf[n], PAGE_SIZE - n, "carrier_offset = %d\t", p->carrier_offset); n += snprintf(&buf[n], PAGE_SIZE - n, "bandwidth = %d\t\t", p->bandwidth); n += snprintf(&buf[n], PAGE_SIZE - n, "frequency = %d Hz\n", p->frequency); n += snprintf(&buf[n], PAGE_SIZE - n, "transmission_mode = %d\t", p->transmission_mode); n += snprintf(&buf[n], PAGE_SIZE - n, "modem_state = %d\t\t", p->modem_state); n += snprintf(&buf[n], PAGE_SIZE - n, "guard_interval = %d\n", p->guard_interval); n += snprintf(&buf[n], PAGE_SIZE - n, "system_type = %d\t\t", p->system_type); n += snprintf(&buf[n], PAGE_SIZE - n, "partial_reception = %d\t", p->partial_reception); n += snprintf(&buf[n], PAGE_SIZE - n, "num_of_layers = %d\n", p->num_of_layers); n += snprintf(&buf[n], PAGE_SIZE - n, "segment_number = %d\t", p->segment_number); n += snprintf(&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 += snprintf(&buf[n], PAGE_SIZE - n, "\nLayer %d\n", i); n += snprintf(&buf[n], PAGE_SIZE - n, "\tcode_rate = %d\t", p->layer_info[i].code_rate); n += snprintf(&buf[n], PAGE_SIZE - n, "constellation = %d\n", p->layer_info[i].constellation); n += snprintf(&buf[n], PAGE_SIZE - n, "\tber = %-5d\t", p->layer_info[i].ber); n += snprintf(&buf[n], PAGE_SIZE - n, "\tber_error_count = %-5d\t", p->layer_info[i].ber_error_count); n += snprintf(&buf[n], PAGE_SIZE - n, "ber_bit_count = %-5d\n", p->layer_info[i].ber_bit_count); n += snprintf(&buf[n], PAGE_SIZE - n, "\tpre_ber = %-5d\t", p->layer_info[i].pre_ber); n += snprintf(&buf[n], PAGE_SIZE - n, "\tts_per = %-5d\n", p->layer_info[i].ts_per); n += snprintf(&buf[n], PAGE_SIZE - n, "\terror_ts_packets = %-5d\t", p->layer_info[i].error_ts_packets); n += snprintf(&buf[n], PAGE_SIZE - n, "total_ts_packets = %-5d\t", p->layer_info[i].total_ts_packets); n += snprintf(&buf[n], PAGE_SIZE - n, "ti_ldepth_i = %d\n", p->layer_info[i].ti_ldepth_i); n += snprintf(&buf[n], PAGE_SIZE - n, "\tnumber_of_segments = %d\t", p->layer_info[i].number_of_segments); n += snprintf(&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); }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab850100.00%6100.00%
Total850100.00%6100.00%


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; }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab79100.00%1100.00%
Total79100.00%1100.00%


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); }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab33100.00%1100.00%
Total33100.00%1100.00%


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; }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab52100.00%1100.00%
Total52100.00%1100.00%


static unsigned int 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); if (rc > 0) rc = POLLIN | POLLRDNORM; kref_put(&debug_data->refcount, smsdvb_debugfs_data_release); return rc; }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab80100.00%1100.00%
Total80100.00%1100.00%


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; }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab206100.00%2100.00%
Total206100.00%2100.00%


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; }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab75100.00%2100.00%
Total75100.00%2100.00%

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; }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab193100.00%1100.00%
Total193100.00%1100.00%


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; }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab67100.00%1100.00%
Total67100.00%1100.00%


int 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 PTR_ERR(d); } else { smsdvb_debugfs_usb_root = d; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab52100.00%2100.00%
Total52100.00%2100.00%


void smsdvb_debugfs_unregister(void) { debugfs_remove_recursive(smsdvb_debugfs_usb_root); smsdvb_debugfs_usb_root = NULL; }

Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab16100.00%1100.00%
Total16100.00%1100.00%


Overall Contributors

PersonTokensPropCommitsCommitProp
Mauro Carvalho Chehab3575100.00%10100.00%
Total3575100.00%10100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.