[deliverable/linux.git] / arch / s390 / appldata / appldata_base.c

/*
 * arch/s390/appldata/appldata_base.c
 *
 * Base infrastructure for Linux-z/VM Monitor Stream, Stage 1.
 * Exports appldata_register_ops() and appldata_unregister_ops() for the
 * data gathering modules.
 *
 * Copyright (C) 2003,2006 IBM Corporation, IBM Deutschland Entwicklung GmbH.
 *
 * Author: Gerald Schaefer <gerald.schaefer@de.ibm.com>
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/errno.h>
#include <linux/interrupt.h>
#include <linux/proc_fs.h>
#include <linux/mm.h>
#include <linux/swap.h>
#include <linux/pagemap.h>
#include <linux/sysctl.h>
#include <linux/notifier.h>
#include <linux/cpu.h>
#include <linux/workqueue.h>
#include <asm/appldata.h>
#include <asm/timer.h>
#include <asm/uaccess.h>
#include <asm/io.h>
#include <asm/smp.h>

#include "appldata.h"


#define MY_PRINT_NAME	"appldata"		/* for debug messages, etc. */
#define APPLDATA_CPU_INTERVAL	10000		/* default (CPU) time for
						   sampling interval in
						   milliseconds */

#define TOD_MICRO	0x01000			/* nr. of TOD clock units
						   for 1 microsecond */
/*
 * /proc entries (sysctl)
 */
static const char appldata_proc_name[APPLDATA_PROC_NAME_LENGTH] = "appldata";
static int appldata_timer_handler(ctl_table *ctl, int write, struct file *filp,
				  void __user *buffer, size_t *lenp, loff_t *ppos);
static int appldata_interval_handler(ctl_table *ctl, int write,
					 struct file *filp,
					 void __user *buffer,
					 size_t *lenp, loff_t *ppos);

static struct ctl_table_header *appldata_sysctl_header;
static struct ctl_table appldata_table[] = {
	{
		.ctl_name	= CTL_APPLDATA_TIMER,
		.procname	= "timer",
		.mode		= S_IRUGO | S_IWUSR,
		.proc_handler	= &appldata_timer_handler,
	},
	{
		.ctl_name	= CTL_APPLDATA_INTERVAL,
		.procname	= "interval",
		.mode		= S_IRUGO | S_IWUSR,
		.proc_handler	= &appldata_interval_handler,
	},
	{ .ctl_name = 0 }
};

static struct ctl_table appldata_dir_table[] = {
	{
		.ctl_name	= CTL_APPLDATA,
		.procname	= appldata_proc_name,
		.maxlen		= 0,
		.mode		= S_IRUGO | S_IXUGO,
		.child		= appldata_table,
	},
	{ .ctl_name = 0 }
};

/*
 * Timer
 */
static DEFINE_PER_CPU(struct vtimer_list, appldata_timer);
static atomic_t appldata_expire_count = ATOMIC_INIT(0);

static DEFINE_SPINLOCK(appldata_timer_lock);
static int appldata_interval = APPLDATA_CPU_INTERVAL;
static int appldata_timer_active;

/*
 * Work queue
 */
static struct workqueue_struct *appldata_wq;
static void appldata_work_fn(struct work_struct *work);
static DECLARE_WORK(appldata_work, appldata_work_fn);


/*
 * Ops list
 */
static DEFINE_SPINLOCK(appldata_ops_lock);
static LIST_HEAD(appldata_ops_list);


/*************************** timer, work, DIAG *******************************/
/*
 * appldata_timer_function()
 *
 * schedule work and reschedule timer
 */
static void appldata_timer_function(unsigned long data)
{
	P_DEBUG("   -= Timer =-\n");
	P_DEBUG("CPU: %i, expire_count: %i\n", smp_processor_id(),
		atomic_read(&appldata_expire_count));
	if (atomic_dec_and_test(&appldata_expire_count)) {
		atomic_set(&appldata_expire_count, num_online_cpus());
		queue_work(appldata_wq, (struct work_struct *) data);
	}
}

/*
 * appldata_work_fn()
 *
 * call data gathering function for each (active) module
 */
static void appldata_work_fn(struct work_struct *work)
{
	struct list_head *lh;
	struct appldata_ops *ops;
	int i;

	P_DEBUG("  -= Work Queue =-\n");
	i = 0;
	spin_lock(&appldata_ops_lock);
	list_for_each(lh, &appldata_ops_list) {
		ops = list_entry(lh, struct appldata_ops, list);
		P_DEBUG("list_for_each loop: %i) active = %u, name = %s\n",
			++i, ops->active, ops->name);
		if (ops->active == 1) {
			ops->callback(ops->data);
		}
	}
	spin_unlock(&appldata_ops_lock);
}

/*
 * appldata_diag()
 *
 * prepare parameter list, issue DIAG 0xDC
 */
int appldata_diag(char record_nr, u16 function, unsigned long buffer,
			u16 length, char *mod_lvl)
{
	struct appldata_product_id id = {
		.prod_nr    = {0xD3, 0xC9, 0xD5, 0xE4,
			       0xE7, 0xD2, 0xD9},	/* "LINUXKR" */
		.prod_fn    = 0xD5D3,			/* "NL" */
		.version_nr = 0xF2F6,			/* "26" */
		.release_nr = 0xF0F1,			/* "01" */
	};

	id.record_nr = record_nr;
	id.mod_lvl = (mod_lvl[0]) << 8 | mod_lvl[1];
	return appldata_asm(&id, function, (void *) buffer, length);
}
/************************ timer, work, DIAG <END> ****************************/


/****************************** /proc stuff **********************************/

/*
 * appldata_mod_vtimer_wrap()
 *
 * wrapper function for mod_virt_timer(), because smp_call_function_single()
 * accepts only one parameter.
 */
static void __appldata_mod_vtimer_wrap(void *p) {
	struct {
		struct vtimer_list *timer;
		u64    expires;
	} *args = p;
	mod_virt_timer(args->timer, args->expires);
}

#define APPLDATA_ADD_TIMER	0
#define APPLDATA_DEL_TIMER	1
#define APPLDATA_MOD_TIMER	2

/*
 * __appldata_vtimer_setup()
 *
 * Add, delete or modify virtual timers on all online cpus.
 * The caller needs to get the appldata_timer_lock spinlock.
 */
static void
__appldata_vtimer_setup(int cmd)
{
	u64 per_cpu_interval;
	int i;

	switch (cmd) {
	case APPLDATA_ADD_TIMER:
		if (appldata_timer_active)
			break;
		per_cpu_interval = (u64) (appldata_interval*1000 /
					  num_online_cpus()) * TOD_MICRO;
		for_each_online_cpu(i) {
			per_cpu(appldata_timer, i).expires = per_cpu_interval;
			smp_call_function_single(i, add_virt_timer_periodic,
						 &per_cpu(appldata_timer, i),
						 0, 1);
		}
		appldata_timer_active = 1;
		P_INFO("Monitoring timer started.\n");
		break;
	case APPLDATA_DEL_TIMER:
		for_each_online_cpu(i)
			del_virt_timer(&per_cpu(appldata_timer, i));
		if (!appldata_timer_active)
			break;
		appldata_timer_active = 0;
		atomic_set(&appldata_expire_count, num_online_cpus());
		P_INFO("Monitoring timer stopped.\n");
		break;
	case APPLDATA_MOD_TIMER:
		per_cpu_interval = (u64) (appldata_interval*1000 /
					  num_online_cpus()) * TOD_MICRO;
		if (!appldata_timer_active)
			break;
		for_each_online_cpu(i) {
			struct {
				struct vtimer_list *timer;
				u64    expires;
			} args;
			args.timer = &per_cpu(appldata_timer, i);
			args.expires = per_cpu_interval;
			smp_call_function_single(i, __appldata_mod_vtimer_wrap,
						 &args, 0, 1);
		}
	}
}

/*
 * appldata_timer_handler()
 *
 * Start/Stop timer, show status of timer (0 = not active, 1 = active)
 */
static int
appldata_timer_handler(ctl_table *ctl, int write, struct file *filp,
			   void __user *buffer, size_t *lenp, loff_t *ppos)
{
	int len;
	char buf[2];

	if (!*lenp || *ppos) {
		*lenp = 0;
		return 0;
	}
	if (!write) {
		len = sprintf(buf, appldata_timer_active ? "1\n" : "0\n");
		if (len > *lenp)
			len = *lenp;
		if (copy_to_user(buffer, buf, len))
			return -EFAULT;
		goto out;
	}
	len = *lenp;
	if (copy_from_user(buf, buffer, len > sizeof(buf) ? sizeof(buf) : len))
		return -EFAULT;
	spin_lock(&appldata_timer_lock);
	if (buf[0] == '1')
		__appldata_vtimer_setup(APPLDATA_ADD_TIMER);
	else if (buf[0] == '0')
		__appldata_vtimer_setup(APPLDATA_DEL_TIMER);
	spin_unlock(&appldata_timer_lock);
out:
	*lenp = len;
	*ppos += len;
	return 0;
}

/*
 * appldata_interval_handler()
 *
 * Set (CPU) timer interval for collection of data (in milliseconds), show
 * current timer interval.
 */
static int
appldata_interval_handler(ctl_table *ctl, int write, struct file *filp,
			   void __user *buffer, size_t *lenp, loff_t *ppos)
{
	int len, interval;
	char buf[16];

	if (!*lenp || *ppos) {
		*lenp = 0;
		return 0;
	}
	if (!write) {
		len = sprintf(buf, "%i\n", appldata_interval);
		if (len > *lenp)
			len = *lenp;
		if (copy_to_user(buffer, buf, len))
			return -EFAULT;
		goto out;
	}
	len = *lenp;
	if (copy_from_user(buf, buffer, len > sizeof(buf) ? sizeof(buf) : len)) {
		return -EFAULT;
	}
	interval = 0;
	sscanf(buf, "%i", &interval);
	if (interval <= 0) {
		P_ERROR("Timer CPU interval has to be > 0!\n");
		return -EINVAL;
	}

	spin_lock(&appldata_timer_lock);
	appldata_interval = interval;
	__appldata_vtimer_setup(APPLDATA_MOD_TIMER);
	spin_unlock(&appldata_timer_lock);

	P_INFO("Monitoring CPU interval set to %u milliseconds.\n",
		 interval);
out:
	*lenp = len;
	*ppos += len;
	return 0;
}

/*
 * appldata_generic_handler()
 *
 * Generic start/stop monitoring and DIAG, show status of
 * monitoring (0 = not in process, 1 = in process)
 */
static int
appldata_generic_handler(ctl_table *ctl, int write, struct file *filp,
			   void __user *buffer, size_t *lenp, loff_t *ppos)
{
	struct appldata_ops *ops = NULL, *tmp_ops;
	int rc, len, found;
	char buf[2];
	struct list_head *lh;

	found = 0;
	spin_lock(&appldata_ops_lock);
	list_for_each(lh, &appldata_ops_list) {
		tmp_ops = list_entry(lh, struct appldata_ops, list);
		if (&tmp_ops->ctl_table[2] == ctl) {
			found = 1;
		}
	}
	if (!found) {
		spin_unlock(&appldata_ops_lock);
		return -ENODEV;
	}
	ops = ctl->data;
	if (!try_module_get(ops->owner)) {	// protect this function
		spin_unlock(&appldata_ops_lock);
		return -ENODEV;
	}
	spin_unlock(&appldata_ops_lock);

	if (!*lenp || *ppos) {
		*lenp = 0;
		module_put(ops->owner);
		return 0;
	}
	if (!write) {
		len = sprintf(buf, ops->active ? "1\n" : "0\n");
		if (len > *lenp)
			len = *lenp;
		if (copy_to_user(buffer, buf, len)) {
			module_put(ops->owner);
			return -EFAULT;
		}
		goto out;
	}
	len = *lenp;
	if (copy_from_user(buf, buffer,
			   len > sizeof(buf) ? sizeof(buf) : len)) {
		module_put(ops->owner);
		return -EFAULT;
	}

	spin_lock(&appldata_ops_lock);
	if ((buf[0] == '1') && (ops->active == 0)) {
		// protect work queue callback
		if (!try_module_get(ops->owner)) {
			spin_unlock(&appldata_ops_lock);
			module_put(ops->owner);
			return -ENODEV;
		}
		ops->callback(ops->data);	// init record
		rc = appldata_diag(ops->record_nr,
					APPLDATA_START_INTERVAL_REC,
					(unsigned long) ops->data, ops->size,
					ops->mod_lvl);
		if (rc != 0) {
			P_ERROR("START DIAG 0xDC for %s failed, "
				"return code: %d\n", ops->name, rc);
			module_put(ops->owner);
		} else {
			P_INFO("Monitoring %s data enabled, "
				"DIAG 0xDC started.\n", ops->name);
			ops->active = 1;
		}
	} else if ((buf[0] == '0') && (ops->active == 1)) {
		ops->active = 0;
		rc = appldata_diag(ops->record_nr, APPLDATA_STOP_REC,
				(unsigned long) ops->data, ops->size,
				ops->mod_lvl);
		if (rc != 0) {
			P_ERROR("STOP DIAG 0xDC for %s failed, "
				"return code: %d\n", ops->name, rc);
		} else {
			P_INFO("Monitoring %s data disabled, "
				"DIAG 0xDC stopped.\n", ops->name);
		}
		module_put(ops->owner);
	}
	spin_unlock(&appldata_ops_lock);
out:
	*lenp = len;
	*ppos += len;
	module_put(ops->owner);
	return 0;
}

/*************************** /proc stuff <END> *******************************/


/************************* module-ops management *****************************/
/*
 * appldata_register_ops()
 *
 * update ops list, register /proc/sys entries
 */
int appldata_register_ops(struct appldata_ops *ops)
{
	struct list_head *lh;
	struct appldata_ops *tmp_ops;
	int i;

	i = 0;

	if ((ops->size > APPLDATA_MAX_REC_SIZE) ||
		(ops->size < 0)){
		P_ERROR("Invalid size of %s record = %i, maximum = %i!\n",
			ops->name, ops->size, APPLDATA_MAX_REC_SIZE);
		return -ENOMEM;
	}
	if ((ops->ctl_nr == CTL_APPLDATA) ||
	    (ops->ctl_nr == CTL_APPLDATA_TIMER) ||
	    (ops->ctl_nr == CTL_APPLDATA_INTERVAL)) {
		P_ERROR("ctl_nr %i already in use!\n", ops->ctl_nr);
		return -EBUSY;
	}
	ops->ctl_table = kzalloc(4*sizeof(struct ctl_table), GFP_KERNEL);
	if (ops->ctl_table == NULL) {
		P_ERROR("Not enough memory for %s ctl_table!\n", ops->name);
		return -ENOMEM;
	}

	spin_lock(&appldata_ops_lock);
	list_for_each(lh, &appldata_ops_list) {
		tmp_ops = list_entry(lh, struct appldata_ops, list);
		P_DEBUG("register_ops loop: %i) name = %s, ctl = %i\n",
			++i, tmp_ops->name, tmp_ops->ctl_nr);
		P_DEBUG("Comparing %s (ctl %i) with %s (ctl %i)\n",
			tmp_ops->name, tmp_ops->ctl_nr, ops->name,
			ops->ctl_nr);
		if (strncmp(tmp_ops->name, ops->name,
				APPLDATA_PROC_NAME_LENGTH) == 0) {
			P_ERROR("Name \"%s\" already registered!\n", ops->name);
			kfree(ops->ctl_table);
			spin_unlock(&appldata_ops_lock);
			return -EBUSY;
		}
		if (tmp_ops->ctl_nr == ops->ctl_nr) {
			P_ERROR("ctl_nr %i already registered!\n", ops->ctl_nr);
			kfree(ops->ctl_table);
			spin_unlock(&appldata_ops_lock);
			return -EBUSY;
		}
	}
	list_add(&ops->list, &appldata_ops_list);
	spin_unlock(&appldata_ops_lock);

	ops->ctl_table[0].ctl_name = CTL_APPLDATA;
	ops->ctl_table[0].procname = appldata_proc_name;
	ops->ctl_table[0].maxlen   = 0;
	ops->ctl_table[0].mode     = S_IRUGO | S_IXUGO;
	ops->ctl_table[0].child    = &ops->ctl_table[2];

	ops->ctl_table[1].ctl_name = 0;

	ops->ctl_table[2].ctl_name = ops->ctl_nr;
	ops->ctl_table[2].procname = ops->name;
	ops->ctl_table[2].mode     = S_IRUGO | S_IWUSR;
	ops->ctl_table[2].proc_handler = appldata_generic_handler;
	ops->ctl_table[2].data = ops;

	ops->ctl_table[3].ctl_name = 0;

	ops->sysctl_header = register_sysctl_table(ops->ctl_table);

	P_INFO("%s-ops registered!\n", ops->name);
	return 0;
}

/*
 * appldata_unregister_ops()
 *
 * update ops list, unregister /proc entries, stop DIAG if necessary
 */
void appldata_unregister_ops(struct appldata_ops *ops)
{
	void *table;
	spin_lock(&appldata_ops_lock);
	list_del(&ops->list);
	/* at that point any incoming access will fail */
	table = ops->ctl_table;
	ops->ctl_table = NULL;
	spin_unlock(&appldata_ops_lock);
	unregister_sysctl_table(ops->sysctl_header);
	kfree(table);
	P_INFO("%s-ops unregistered!\n", ops->name);
}
/********************** module-ops management <END> **************************/


/******************************* init / exit *********************************/

static void __cpuinit appldata_online_cpu(int cpu)
{
	init_virt_timer(&per_cpu(appldata_timer, cpu));
	per_cpu(appldata_timer, cpu).function = appldata_timer_function;
	per_cpu(appldata_timer, cpu).data = (unsigned long)
		&appldata_work;
	atomic_inc(&appldata_expire_count);
	spin_lock(&appldata_timer_lock);
	__appldata_vtimer_setup(APPLDATA_MOD_TIMER);
	spin_unlock(&appldata_timer_lock);
}

static void __cpuinit appldata_offline_cpu(int cpu)
{
	del_virt_timer(&per_cpu(appldata_timer, cpu));
	if (atomic_dec_and_test(&appldata_expire_count)) {
		atomic_set(&appldata_expire_count, num_online_cpus());
		queue_work(appldata_wq, &appldata_work);
	}
	spin_lock(&appldata_timer_lock);
	__appldata_vtimer_setup(APPLDATA_MOD_TIMER);
	spin_unlock(&appldata_timer_lock);
}

static int __cpuinit appldata_cpu_notify(struct notifier_block *self,
					 unsigned long action,
					 void *hcpu)
{
	switch (action) {
	case CPU_ONLINE:
	case CPU_ONLINE_FROZEN:
		appldata_online_cpu((long) hcpu);
		break;
	case CPU_DEAD:
	case CPU_DEAD_FROZEN:
		appldata_offline_cpu((long) hcpu);
		break;
	default:
		break;
	}
	return NOTIFY_OK;
}

static struct notifier_block __cpuinitdata appldata_nb = {
	.notifier_call = appldata_cpu_notify,
};

/*
 * appldata_init()
 *
 * init timer, register /proc entries
 */
static int __init appldata_init(void)
{
	int i;

	P_DEBUG("sizeof(parameter_list) = %lu\n",
		sizeof(struct appldata_parameter_list));

	appldata_wq = create_singlethread_workqueue("appldata");
	if (!appldata_wq) {
		P_ERROR("Could not create work queue\n");
		return -ENOMEM;
	}

	for_each_online_cpu(i)
		appldata_online_cpu(i);

	/* Register cpu hotplug notifier */
	register_hotcpu_notifier(&appldata_nb);

	appldata_sysctl_header = register_sysctl_table(appldata_dir_table);

	P_DEBUG("Base interface initialized.\n");
	return 0;
}

__initcall(appldata_init);

/**************************** init / exit <END> ******************************/

EXPORT_SYMBOL_GPL(appldata_register_ops);
EXPORT_SYMBOL_GPL(appldata_unregister_ops);
EXPORT_SYMBOL_GPL(appldata_diag);

EXPORT_SYMBOL_GPL(si_swapinfo);
EXPORT_SYMBOL_GPL(nr_threads);
EXPORT_SYMBOL_GPL(nr_running);
EXPORT_SYMBOL_GPL(nr_iowait);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* arch/s390/appldata/appldata_base.c
	3	*
	4	* Base infrastructure for Linux-z/VM Monitor Stream, Stage 1.
	5	* Exports appldata_register_ops() and appldata_unregister_ops() for the
	6	* data gathering modules.
	7	*
5b5dd21a	8	* Copyright (C) 2003,2006 IBM Corporation, IBM Deutschland Entwicklung GmbH.
1da177e4	9	*
5b5dd21a	10	* Author: Gerald Schaefer <gerald.schaefer@de.ibm.com>
1da177e4 LT	11	*/
1da177e4 LT	12
1da177e4 LT	13	#include <linux/module.h>
	14	#include <linux/init.h>
	15	#include <linux/slab.h>
	16	#include <linux/errno.h>
1da177e4 LT	17	#include <linux/interrupt.h>
1da177e4 LT	18	#include <linux/proc_fs.h>
2dcea57a	19	#include <linux/mm.h>
1da177e4 LT	20	#include <linux/swap.h>
	21	#include <linux/pagemap.h>
	22	#include <linux/sysctl.h>
1da177e4 LT	23	#include <linux/notifier.h>
1da177e4 LT	24	#include <linux/cpu.h>
f26d583e	25	#include <linux/workqueue.h>
1f38d613 GS	26	#include <asm/appldata.h>
	27	#include <asm/timer.h>
	28	#include <asm/uaccess.h>
	29	#include <asm/io.h>
	30	#include <asm/smp.h>
1da177e4 LT	31
	32	#include "appldata.h"
	33
	34
	35	#define MY_PRINT_NAME "appldata" /* for debug messages, etc. */
	36	#define APPLDATA_CPU_INTERVAL 10000 /* default (CPU) time for
	37	sampling interval in
	38	milliseconds */
	39
	40	#define TOD_MICRO 0x01000 /* nr. of TOD clock units
	41	for 1 microsecond */
1da177e4 LT	42	/*
	43	* /proc entries (sysctl)
	44	*/
	45	static const char appldata_proc_name[APPLDATA_PROC_NAME_LENGTH] = "appldata";
	46	static int appldata_timer_handler(ctl_table ctl, int write, struct file filp,
	47	void __user buffer, size_t lenp, loff_t *ppos);
	48	static int appldata_interval_handler(ctl_table *ctl, int write,
	49	struct file *filp,
	50	void __user *buffer,
	51	size_t lenp, loff_t ppos);
	52
	53	static struct ctl_table_header *appldata_sysctl_header;
	54	static struct ctl_table appldata_table[] = {
	55	{
	56	.ctl_name = CTL_APPLDATA_TIMER,
	57	.procname = "timer",
	58	.mode = S_IRUGO \| S_IWUSR,
	59	.proc_handler = &appldata_timer_handler,
	60	},
	61	{
	62	.ctl_name = CTL_APPLDATA_INTERVAL,
	63	.procname = "interval",
	64	.mode = S_IRUGO \| S_IWUSR,
	65	.proc_handler = &appldata_interval_handler,
	66	},
	67	{ .ctl_name = 0 }
	68	};
	69
	70	static struct ctl_table appldata_dir_table[] = {
	71	{
	72	.ctl_name = CTL_APPLDATA,
	73	.procname = appldata_proc_name,
	74	.maxlen = 0,
	75	.mode = S_IRUGO \| S_IXUGO,
	76	.child = appldata_table,
	77	},
	78	{ .ctl_name = 0 }
	79	};
	80
	81	/*
	82	* Timer
	83	*/
2b67fc46	84	static DEFINE_PER_CPU(struct vtimer_list, appldata_timer);
1da177e4 LT	85	static atomic_t appldata_expire_count = ATOMIC_INIT(0);
	86
	87	static DEFINE_SPINLOCK(appldata_timer_lock);
	88	static int appldata_interval = APPLDATA_CPU_INTERVAL;
	89	static int appldata_timer_active;
	90
	91	/*
f26d583e	92	* Work queue
1da177e4	93	*/
f26d583e	94	static struct workqueue_struct *appldata_wq;
6d5aefb8 DH	95	static void appldata_work_fn(struct work_struct *work);
6d5aefb8 DH	96	static DECLARE_WORK(appldata_work, appldata_work_fn);
f26d583e	97
1da177e4 LT	98
	99	/*
	100	* Ops list
	101	*/
	102	static DEFINE_SPINLOCK(appldata_ops_lock);
	103	static LIST_HEAD(appldata_ops_list);
	104
	105
f26d583e	106	/************************* timer, work, DIAG *****************************/
1da177e4 LT	107	/*
	108	* appldata_timer_function()
	109	*
f26d583e	110	* schedule work and reschedule timer
1da177e4	111	*/
9d0a57cb	112	static void appldata_timer_function(unsigned long data)
1da177e4 LT	113	{
	114	P_DEBUG(" -= Timer =-\n");
	115	P_DEBUG("CPU: %i, expire_count: %i\n", smp_processor_id(),
	116	atomic_read(&appldata_expire_count));
	117	if (atomic_dec_and_test(&appldata_expire_count)) {
	118	atomic_set(&appldata_expire_count, num_online_cpus());
f26d583e	119	queue_work(appldata_wq, (struct work_struct *) data);
1da177e4 LT	120	}
	121	}
	122
	123	/*
f26d583e	124	* appldata_work_fn()
1da177e4 LT	125	*
	126	* call data gathering function for each (active) module
	127	*/
6d5aefb8	128	static void appldata_work_fn(struct work_struct *work)
1da177e4 LT	129	{
	130	struct list_head *lh;
	131	struct appldata_ops *ops;
	132	int i;
	133
f26d583e	134	P_DEBUG(" -= Work Queue =-\n");
1da177e4 LT	135	i = 0;
	136	spin_lock(&appldata_ops_lock);
	137	list_for_each(lh, &appldata_ops_list) {
	138	ops = list_entry(lh, struct appldata_ops, list);
	139	P_DEBUG("list_for_each loop: %i) active = %u, name = %s\n",
	140	++i, ops->active, ops->name);
	141	if (ops->active == 1) {
	142	ops->callback(ops->data);
	143	}
	144	}
	145	spin_unlock(&appldata_ops_lock);
	146	}
	147
	148	/*
	149	* appldata_diag()
	150	*
	151	* prepare parameter list, issue DIAG 0xDC
	152	*/
5b5dd21a GS	153	int appldata_diag(char record_nr, u16 function, unsigned long buffer,
5b5dd21a GS	154	u16 length, char *mod_lvl)
1da177e4	155	{
1f38d613	156	struct appldata_product_id id = {
1da177e4	157	.prod_nr = {0xD3, 0xC9, 0xD5, 0xE4,
1f38d613 GS	158	0xE7, 0xD2, 0xD9}, /* "LINUXKR" */
1f38d613 GS	159	.prod_fn = 0xD5D3, /* "NL" */
1f38d613 GS	160	.version_nr = 0xF2F6, /* "26" */
1f38d613 GS	161	.release_nr = 0xF0F1, /* "01" */
1da177e4 LT	162	};
1da177e4 LT	163
925afbd6 GS	164	id.record_nr = record_nr;
925afbd6 GS	165	id.mod_lvl = (mod_lvl[0]) << 8 \| mod_lvl[1];
1f38d613	166	return appldata_asm(&id, function, (void *) buffer, length);
1da177e4	167	}
f26d583e	168	/********************** timer, work, DIAG <END> **************************/
1da177e4 LT	169
	170
	171	/**************************** /proc stuff ********************************/
	172
	173	/*
	174	* appldata_mod_vtimer_wrap()
	175	*
3bb447fc	176	* wrapper function for mod_virt_timer(), because smp_call_function_single()
1da177e4 LT	177	* accepts only one parameter.
	178	*/
	179	static void __appldata_mod_vtimer_wrap(void *p) {
	180	struct {
	181	struct vtimer_list *timer;
	182	u64 expires;
	183	} *args = p;
	184	mod_virt_timer(args->timer, args->expires);
	185	}
	186
	187	#define APPLDATA_ADD_TIMER 0
	188	#define APPLDATA_DEL_TIMER 1
	189	#define APPLDATA_MOD_TIMER 2
	190
	191	/*
	192	* __appldata_vtimer_setup()
	193	*
	194	* Add, delete or modify virtual timers on all online cpus.
	195	* The caller needs to get the appldata_timer_lock spinlock.
	196	*/
	197	static void
	198	__appldata_vtimer_setup(int cmd)
	199	{
	200	u64 per_cpu_interval;
	201	int i;
	202
	203	switch (cmd) {
	204	case APPLDATA_ADD_TIMER:
	205	if (appldata_timer_active)
	206	break;
	207	per_cpu_interval = (u64) (appldata_interval*1000 /
	208	num_online_cpus()) * TOD_MICRO;
	209	for_each_online_cpu(i) {
	210	per_cpu(appldata_timer, i).expires = per_cpu_interval;
3bb447fc HC	211	smp_call_function_single(i, add_virt_timer_periodic,
	212	&per_cpu(appldata_timer, i),
	213	0, 1);
1da177e4 LT	214	}
	215	appldata_timer_active = 1;
	216	P_INFO("Monitoring timer started.\n");
	217	break;
	218	case APPLDATA_DEL_TIMER:
	219	for_each_online_cpu(i)
	220	del_virt_timer(&per_cpu(appldata_timer, i));
	221	if (!appldata_timer_active)
	222	break;
	223	appldata_timer_active = 0;
	224	atomic_set(&appldata_expire_count, num_online_cpus());
	225	P_INFO("Monitoring timer stopped.\n");
	226	break;
	227	case APPLDATA_MOD_TIMER:
	228	per_cpu_interval = (u64) (appldata_interval*1000 /
	229	num_online_cpus()) * TOD_MICRO;
	230	if (!appldata_timer_active)
	231	break;
	232	for_each_online_cpu(i) {
	233	struct {
	234	struct vtimer_list *timer;
	235	u64 expires;
	236	} args;
	237	args.timer = &per_cpu(appldata_timer, i);
	238	args.expires = per_cpu_interval;
3bb447fc HC	239	smp_call_function_single(i, __appldata_mod_vtimer_wrap,
3bb447fc HC	240	&args, 0, 1);
1da177e4 LT	241	}
	242	}
	243	}
	244
	245	/*
	246	* appldata_timer_handler()
	247	*
	248	* Start/Stop timer, show status of timer (0 = not active, 1 = active)
	249	*/
	250	static int
	251	appldata_timer_handler(ctl_table ctl, int write, struct file filp,
	252	void __user buffer, size_t lenp, loff_t *ppos)
	253	{
	254	int len;
	255	char buf[2];
	256
	257	if (!lenp \|\| ppos) {
	258	*lenp = 0;
	259	return 0;
	260	}
	261	if (!write) {
	262	len = sprintf(buf, appldata_timer_active ? "1\n" : "0\n");
	263	if (len > *lenp)
	264	len = *lenp;
	265	if (copy_to_user(buffer, buf, len))
	266	return -EFAULT;
	267	goto out;
	268	}
	269	len = *lenp;
	270	if (copy_from_user(buf, buffer, len > sizeof(buf) ? sizeof(buf) : len))
	271	return -EFAULT;
	272	spin_lock(&appldata_timer_lock);
	273	if (buf[0] == '1')
	274	__appldata_vtimer_setup(APPLDATA_ADD_TIMER);
	275	else if (buf[0] == '0')
	276	__appldata_vtimer_setup(APPLDATA_DEL_TIMER);
	277	spin_unlock(&appldata_timer_lock);
	278	out:
	279	*lenp = len;
	280	*ppos += len;
	281	return 0;
	282	}
	283
	284	/*
	285	* appldata_interval_handler()
	286	*
	287	* Set (CPU) timer interval for collection of data (in milliseconds), show
	288	* current timer interval.
	289	*/
	290	static int
	291	appldata_interval_handler(ctl_table ctl, int write, struct file filp,
	292	void __user buffer, size_t lenp, loff_t *ppos)
	293	{
	294	int len, interval;
	295	char buf[16];
	296
	297	if (!lenp \|\| ppos) {
	298	*lenp = 0;
	299	return 0;
	300	}
	301	if (!write) {
	302	len = sprintf(buf, "%i\n", appldata_interval);
	303	if (len > *lenp)
	304	len = *lenp;
305	if (copy_to_user(buffer, buf, len))
306	return -EFAULT;
307	goto out;
308	}
309	len = *lenp;
310	if (copy_from_user(buf, buffer, len > sizeof(buf) ? sizeof(buf) : len)) {
311	return -EFAULT;
312	}
95425f19	313	interval = 0;
1da177e4 LT	314	sscanf(buf, "%i", &interval);
	315	if (interval <= 0) {
	316	P_ERROR("Timer CPU interval has to be > 0!\n");
	317	return -EINVAL;
	318	}
	319
	320	spin_lock(&appldata_timer_lock);
	321	appldata_interval = interval;
	322	__appldata_vtimer_setup(APPLDATA_MOD_TIMER);
	323	spin_unlock(&appldata_timer_lock);
	324
	325	P_INFO("Monitoring CPU interval set to %u milliseconds.\n",
	326	interval);
	327	out:
	328	*lenp = len;
	329	*ppos += len;
	330	return 0;
	331	}
	332
	333	/*
	334	* appldata_generic_handler()
	335	*
	336	* Generic start/stop monitoring and DIAG, show status of
	337	* monitoring (0 = not in process, 1 = in process)
	338	*/
	339	static int
	340	appldata_generic_handler(ctl_table ctl, int write, struct file filp,
	341	void __user buffer, size_t lenp, loff_t *ppos)
	342	{
	343	struct appldata_ops ops = NULL, tmp_ops;
	344	int rc, len, found;
	345	char buf[2];
	346	struct list_head *lh;
	347
	348	found = 0;
f26d583e	349	spin_lock(&appldata_ops_lock);
1da177e4 LT	350	list_for_each(lh, &appldata_ops_list) {
	351	tmp_ops = list_entry(lh, struct appldata_ops, list);
	352	if (&tmp_ops->ctl_table[2] == ctl) {
	353	found = 1;
	354	}
	355	}
	356	if (!found) {
f26d583e	357	spin_unlock(&appldata_ops_lock);
1da177e4 LT	358	return -ENODEV;
	359	}
	360	ops = ctl->data;
	361	if (!try_module_get(ops->owner)) { // protect this function
f26d583e	362	spin_unlock(&appldata_ops_lock);
1da177e4 LT	363	return -ENODEV;
1da177e4 LT	364	}
f26d583e	365	spin_unlock(&appldata_ops_lock);
1da177e4 LT	366
	367	if (!lenp \|\| ppos) {
	368	*lenp = 0;
	369	module_put(ops->owner);
	370	return 0;
	371	}
	372	if (!write) {
	373	len = sprintf(buf, ops->active ? "1\n" : "0\n");
	374	if (len > *lenp)
	375	len = *lenp;
	376	if (copy_to_user(buffer, buf, len)) {
	377	module_put(ops->owner);
	378	return -EFAULT;
	379	}
	380	goto out;
	381	}
	382	len = *lenp;
	383	if (copy_from_user(buf, buffer,
	384	len > sizeof(buf) ? sizeof(buf) : len)) {
	385	module_put(ops->owner);
	386	return -EFAULT;
	387	}
	388
f26d583e	389	spin_lock(&appldata_ops_lock);
1da177e4	390	if ((buf[0] == '1') && (ops->active == 0)) {
f26d583e GS	391	// protect work queue callback
	392	if (!try_module_get(ops->owner)) {
	393	spin_unlock(&appldata_ops_lock);
1da177e4 LT	394	module_put(ops->owner);
	395	return -ENODEV;
	396	}
1da177e4 LT	397	ops->callback(ops->data); // init record
	398	rc = appldata_diag(ops->record_nr,
	399	APPLDATA_START_INTERVAL_REC,
5b5dd21a GS	400	(unsigned long) ops->data, ops->size,
5b5dd21a GS	401	ops->mod_lvl);
1da177e4 LT	402	if (rc != 0) {
	403	P_ERROR("START DIAG 0xDC for %s failed, "
	404	"return code: %d\n", ops->name, rc);
	405	module_put(ops->owner);
1da177e4 LT	406	} else {
	407	P_INFO("Monitoring %s data enabled, "
	408	"DIAG 0xDC started.\n", ops->name);
5b5dd21a	409	ops->active = 1;
1da177e4 LT	410	}
	411	} else if ((buf[0] == '0') && (ops->active == 1)) {
	412	ops->active = 0;
	413	rc = appldata_diag(ops->record_nr, APPLDATA_STOP_REC,
5b5dd21a GS	414	(unsigned long) ops->data, ops->size,
5b5dd21a GS	415	ops->mod_lvl);
1da177e4 LT	416	if (rc != 0) {
	417	P_ERROR("STOP DIAG 0xDC for %s failed, "
	418	"return code: %d\n", ops->name, rc);
	419	} else {
	420	P_INFO("Monitoring %s data disabled, "
	421	"DIAG 0xDC stopped.\n", ops->name);
	422	}
	423	module_put(ops->owner);
	424	}
f26d583e	425	spin_unlock(&appldata_ops_lock);
1da177e4 LT	426	out:
	427	*lenp = len;
	428	*ppos += len;
	429	module_put(ops->owner);
	430	return 0;
	431	}
	432
	433	/************************* /proc stuff <END> *****************************/
	434
	435
	436	/*********************** module-ops management ***************************/
	437	/*
	438	* appldata_register_ops()
	439	*
	440	* update ops list, register /proc/sys entries
	441	*/
	442	int appldata_register_ops(struct appldata_ops *ops)
	443	{
	444	struct list_head *lh;
	445	struct appldata_ops *tmp_ops;
	446	int i;
	447
	448	i = 0;
	449
	450	if ((ops->size > APPLDATA_MAX_REC_SIZE) \|\|
	451	(ops->size < 0)){
	452	P_ERROR("Invalid size of %s record = %i, maximum = %i!\n",
	453	ops->name, ops->size, APPLDATA_MAX_REC_SIZE);
	454	return -ENOMEM;
	455	}
	456	if ((ops->ctl_nr == CTL_APPLDATA) \|\|
	457	(ops->ctl_nr == CTL_APPLDATA_TIMER) \|\|
	458	(ops->ctl_nr == CTL_APPLDATA_INTERVAL)) {
	459	P_ERROR("ctl_nr %i already in use!\n", ops->ctl_nr);
	460	return -EBUSY;
	461	}
fb630517	462	ops->ctl_table = kzalloc(4*sizeof(struct ctl_table), GFP_KERNEL);
1da177e4 LT	463	if (ops->ctl_table == NULL) {
	464	P_ERROR("Not enough memory for %s ctl_table!\n", ops->name);
	465	return -ENOMEM;
	466	}
1da177e4	467
f26d583e	468	spin_lock(&appldata_ops_lock);
1da177e4 LT	469	list_for_each(lh, &appldata_ops_list) {
	470	tmp_ops = list_entry(lh, struct appldata_ops, list);
	471	P_DEBUG("register_ops loop: %i) name = %s, ctl = %i\n",
	472	++i, tmp_ops->name, tmp_ops->ctl_nr);
	473	P_DEBUG("Comparing %s (ctl %i) with %s (ctl %i)\n",
	474	tmp_ops->name, tmp_ops->ctl_nr, ops->name,
	475	ops->ctl_nr);
	476	if (strncmp(tmp_ops->name, ops->name,
	477	APPLDATA_PROC_NAME_LENGTH) == 0) {
	478	P_ERROR("Name \"%s\" already registered!\n", ops->name);
	479	kfree(ops->ctl_table);
f26d583e	480	spin_unlock(&appldata_ops_lock);
1da177e4 LT	481	return -EBUSY;
	482	}
	483	if (tmp_ops->ctl_nr == ops->ctl_nr) {
	484	P_ERROR("ctl_nr %i already registered!\n", ops->ctl_nr);
	485	kfree(ops->ctl_table);
f26d583e	486	spin_unlock(&appldata_ops_lock);
1da177e4 LT	487	return -EBUSY;
	488	}
	489	}
	490	list_add(&ops->list, &appldata_ops_list);
f26d583e	491	spin_unlock(&appldata_ops_lock);
1da177e4 LT	492
	493	ops->ctl_table[0].ctl_name = CTL_APPLDATA;
	494	ops->ctl_table[0].procname = appldata_proc_name;
	495	ops->ctl_table[0].maxlen = 0;
	496	ops->ctl_table[0].mode = S_IRUGO \| S_IXUGO;
	497	ops->ctl_table[0].child = &ops->ctl_table[2];
	498
	499	ops->ctl_table[1].ctl_name = 0;
	500
	501	ops->ctl_table[2].ctl_name = ops->ctl_nr;
	502	ops->ctl_table[2].procname = ops->name;
	503	ops->ctl_table[2].mode = S_IRUGO \| S_IWUSR;
	504	ops->ctl_table[2].proc_handler = appldata_generic_handler;
	505	ops->ctl_table[2].data = ops;
	506
	507	ops->ctl_table[3].ctl_name = 0;
	508
0b4d4147	509	ops->sysctl_header = register_sysctl_table(ops->ctl_table);
1da177e4 LT	510
	511	P_INFO("%s-ops registered!\n", ops->name);
	512	return 0;
	513	}
	514
	515	/*
	516	* appldata_unregister_ops()
	517	*
	518	* update ops list, unregister /proc entries, stop DIAG if necessary
	519	*/
	520	void appldata_unregister_ops(struct appldata_ops *ops)
	521	{
330d57fb	522	void *table;
f26d583e	523	spin_lock(&appldata_ops_lock);
1da177e4	524	list_del(&ops->list);
330d57fb AV	525	/* at that point any incoming access will fail */
330d57fb AV	526	table = ops->ctl_table;
1da177e4	527	ops->ctl_table = NULL;
f26d583e	528	spin_unlock(&appldata_ops_lock);
330d57fb AV	529	unregister_sysctl_table(ops->sysctl_header);
330d57fb AV	530	kfree(table);
1da177e4 LT	531	P_INFO("%s-ops unregistered!\n", ops->name);
	532	}
	533	/******************** module-ops management <END> ************************/
	534
	535
	536	/***************************** init / exit *******************************/
	537
84b36a8e	538	static void __cpuinit appldata_online_cpu(int cpu)
1da177e4 LT	539	{
	540	init_virt_timer(&per_cpu(appldata_timer, cpu));
	541	per_cpu(appldata_timer, cpu).function = appldata_timer_function;
	542	per_cpu(appldata_timer, cpu).data = (unsigned long)
f26d583e	543	&appldata_work;
1da177e4 LT	544	atomic_inc(&appldata_expire_count);
	545	spin_lock(&appldata_timer_lock);
	546	__appldata_vtimer_setup(APPLDATA_MOD_TIMER);
	547	spin_unlock(&appldata_timer_lock);
	548	}
	549
076fc808	550	static void __cpuinit appldata_offline_cpu(int cpu)
1da177e4 LT	551	{
	552	del_virt_timer(&per_cpu(appldata_timer, cpu));
	553	if (atomic_dec_and_test(&appldata_expire_count)) {
	554	atomic_set(&appldata_expire_count, num_online_cpus());
f26d583e	555	queue_work(appldata_wq, &appldata_work);
1da177e4 LT	556	}
	557	spin_lock(&appldata_timer_lock);
	558	__appldata_vtimer_setup(APPLDATA_MOD_TIMER);
	559	spin_unlock(&appldata_timer_lock);
	560	}
	561
11b8bf01 SS	562	static int __cpuinit appldata_cpu_notify(struct notifier_block *self,
	563	unsigned long action,
	564	void *hcpu)
1da177e4 LT	565	{
	566	switch (action) {
	567	case CPU_ONLINE:
8bb78442	568	case CPU_ONLINE_FROZEN:
1da177e4 LT	569	appldata_online_cpu((long) hcpu);
1da177e4 LT	570	break;
1da177e4	571	case CPU_DEAD:
8bb78442	572	case CPU_DEAD_FROZEN:
1da177e4 LT	573	appldata_offline_cpu((long) hcpu);
1da177e4 LT	574	break;
1da177e4 LT	575	default:
	576	break;
	577	}
	578	return NOTIFY_OK;
	579	}
	580
84b36a8e	581	static struct notifier_block __cpuinitdata appldata_nb = {
1da177e4 LT	582	.notifier_call = appldata_cpu_notify,
	583	};
	584
	585	/*
	586	* appldata_init()
	587	*
f26d583e	588	* init timer, register /proc entries
1da177e4 LT	589	*/
	590	static int __init appldata_init(void)
	591	{
	592	int i;
	593
	594	P_DEBUG("sizeof(parameter_list) = %lu\n",
	595	sizeof(struct appldata_parameter_list));
	596
f26d583e GS	597	appldata_wq = create_singlethread_workqueue("appldata");
	598	if (!appldata_wq) {
	599	P_ERROR("Could not create work queue\n");
	600	return -ENOMEM;
	601	}
	602
1da177e4 LT	603	for_each_online_cpu(i)
	604	appldata_online_cpu(i);
	605
	606	/* Register cpu hotplug notifier */
be6b5a35	607	register_hotcpu_notifier(&appldata_nb);
1da177e4	608
0b4d4147	609	appldata_sysctl_header = register_sysctl_table(appldata_dir_table);
1da177e4	610
1da177e4 LT	611	P_DEBUG("Base interface initialized.\n");
	612	return 0;
	613	}
	614
076fc808	615	__initcall(appldata_init);
1da177e4	616
1da177e4 LT	617	/************************** init / exit <END> ****************************/
1da177e4 LT	618
1da177e4 LT	619	EXPORT_SYMBOL_GPL(appldata_register_ops);
1da177e4 LT	620	EXPORT_SYMBOL_GPL(appldata_unregister_ops);
5b5dd21a	621	EXPORT_SYMBOL_GPL(appldata_diag);
1da177e4	622
1da177e4 LT	623	EXPORT_SYMBOL_GPL(si_swapinfo);
1da177e4 LT	624	EXPORT_SYMBOL_GPL(nr_threads);
1da177e4 LT	625	EXPORT_SYMBOL_GPL(nr_running);
1da177e4 LT	626	EXPORT_SYMBOL_GPL(nr_iowait);