[GitHub/mt8127/android_kernel_alcatel_ttab.git] / kernel / rtmutex-tester.c

/*
 * RT-Mutex-tester: scriptable tester for rt mutexes
 *
 * started by Thomas Gleixner:
 *
 *  Copyright (C) 2006, Timesys Corp., Thomas Gleixner <tglx@timesys.com>
 *
 */
#include <linux/kthread.h>
#include <linux/export.h>
#include <linux/sched.h>
#include <linux/spinlock.h>
#include <linux/sysdev.h>
#include <linux/timer.h>
#include <linux/freezer.h>

#include "rtmutex.h"

#define MAX_RT_TEST_THREADS	8
#define MAX_RT_TEST_MUTEXES	8

static spinlock_t rttest_lock;
static atomic_t rttest_event;

struct test_thread_data {
	int			opcode;
	int			opdata;
	int			mutexes[MAX_RT_TEST_MUTEXES];
	int			event;
	struct sys_device	sysdev;
};

static struct test_thread_data thread_data[MAX_RT_TEST_THREADS];
static struct task_struct *threads[MAX_RT_TEST_THREADS];
static struct rt_mutex mutexes[MAX_RT_TEST_MUTEXES];

enum test_opcodes {
	RTTEST_NOP = 0,
	RTTEST_SCHEDOT,		/* 1 Sched other, data = nice */
	RTTEST_SCHEDRT,		/* 2 Sched fifo, data = prio */
	RTTEST_LOCK,		/* 3 Lock uninterruptible, data = lockindex */
	RTTEST_LOCKNOWAIT,	/* 4 Lock uninterruptible no wait in wakeup, data = lockindex */
	RTTEST_LOCKINT,		/* 5 Lock interruptible, data = lockindex */
	RTTEST_LOCKINTNOWAIT,	/* 6 Lock interruptible no wait in wakeup, data = lockindex */
	RTTEST_LOCKCONT,	/* 7 Continue locking after the wakeup delay */
	RTTEST_UNLOCK,		/* 8 Unlock, data = lockindex */
	/* 9, 10 - reserved for BKL commemoration */
	RTTEST_SIGNAL = 11,	/* 11 Signal other test thread, data = thread id */
	RTTEST_RESETEVENT = 98,	/* 98 Reset event counter */
	RTTEST_RESET = 99,	/* 99 Reset all pending operations */
};

static int handle_op(struct test_thread_data *td, int lockwakeup)
{
	int i, id, ret = -EINVAL;

	switch(td->opcode) {

	case RTTEST_NOP:
		return 0;

	case RTTEST_LOCKCONT:
		td->mutexes[td->opdata] = 1;
		td->event = atomic_add_return(1, &rttest_event);
		return 0;

	case RTTEST_RESET:
		for (i = 0; i < MAX_RT_TEST_MUTEXES; i++) {
			if (td->mutexes[i] == 4) {
				rt_mutex_unlock(&mutexes[i]);
				td->mutexes[i] = 0;
			}
		}
		return 0;

	case RTTEST_RESETEVENT:
		atomic_set(&rttest_event, 0);
		return 0;

	default:
		if (lockwakeup)
			return ret;
	}

	switch(td->opcode) {

	case RTTEST_LOCK:
	case RTTEST_LOCKNOWAIT:
		id = td->opdata;
		if (id < 0 || id >= MAX_RT_TEST_MUTEXES)
			return ret;

		td->mutexes[id] = 1;
		td->event = atomic_add_return(1, &rttest_event);
		rt_mutex_lock(&mutexes[id]);
		td->event = atomic_add_return(1, &rttest_event);
		td->mutexes[id] = 4;
		return 0;

	case RTTEST_LOCKINT:
	case RTTEST_LOCKINTNOWAIT:
		id = td->opdata;
		if (id < 0 || id >= MAX_RT_TEST_MUTEXES)
			return ret;

		td->mutexes[id] = 1;
		td->event = atomic_add_return(1, &rttest_event);
		ret = rt_mutex_lock_interruptible(&mutexes[id], 0);
		td->event = atomic_add_return(1, &rttest_event);
		td->mutexes[id] = ret ? 0 : 4;
		return ret ? -EINTR : 0;

	case RTTEST_UNLOCK:
		id = td->opdata;
		if (id < 0 || id >= MAX_RT_TEST_MUTEXES || td->mutexes[id] != 4)
			return ret;

		td->event = atomic_add_return(1, &rttest_event);
		rt_mutex_unlock(&mutexes[id]);
		td->event = atomic_add_return(1, &rttest_event);
		td->mutexes[id] = 0;
		return 0;

	default:
		break;
	}
	return ret;
}

/*
 * Schedule replacement for rtsem_down(). Only called for threads with
 * PF_MUTEX_TESTER set.
 *
 * This allows us to have finegrained control over the event flow.
 *
 */
void schedule_rt_mutex_test(struct rt_mutex *mutex)
{
	int tid, op, dat;
	struct test_thread_data *td;

	/* We have to lookup the task */
	for (tid = 0; tid < MAX_RT_TEST_THREADS; tid++) {
		if (threads[tid] == current)
			break;
	}

	BUG_ON(tid == MAX_RT_TEST_THREADS);

	td = &thread_data[tid];

	op = td->opcode;
	dat = td->opdata;

	switch (op) {
	case RTTEST_LOCK:
	case RTTEST_LOCKINT:
	case RTTEST_LOCKNOWAIT:
	case RTTEST_LOCKINTNOWAIT:
		if (mutex != &mutexes[dat])
			break;

		if (td->mutexes[dat] != 1)
			break;

		td->mutexes[dat] = 2;
		td->event = atomic_add_return(1, &rttest_event);
		break;

	default:
		break;
	}

	schedule();


	switch (op) {
	case RTTEST_LOCK:
	case RTTEST_LOCKINT:
		if (mutex != &mutexes[dat])
			return;

		if (td->mutexes[dat] != 2)
			return;

		td->mutexes[dat] = 3;
		td->event = atomic_add_return(1, &rttest_event);
		break;

	case RTTEST_LOCKNOWAIT:
	case RTTEST_LOCKINTNOWAIT:
		if (mutex != &mutexes[dat])
			return;

		if (td->mutexes[dat] != 2)
			return;

		td->mutexes[dat] = 1;
		td->event = atomic_add_return(1, &rttest_event);
		return;

	default:
		return;
	}

	td->opcode = 0;

	for (;;) {
		set_current_state(TASK_INTERRUPTIBLE);

		if (td->opcode > 0) {
			int ret;

			set_current_state(TASK_RUNNING);
			ret = handle_op(td, 1);
			set_current_state(TASK_INTERRUPTIBLE);
			if (td->opcode == RTTEST_LOCKCONT)
				break;
			td->opcode = ret;
		}

		/* Wait for the next command to be executed */
		schedule();
	}

	/* Restore previous command and data */
	td->opcode = op;
	td->opdata = dat;
}

static int test_func(void *data)
{
	struct test_thread_data *td = data;
	int ret;

	current->flags |= PF_MUTEX_TESTER;
	set_freezable();
	allow_signal(SIGHUP);

	for(;;) {

		set_current_state(TASK_INTERRUPTIBLE);

		if (td->opcode > 0) {
			set_current_state(TASK_RUNNING);
			ret = handle_op(td, 0);
			set_current_state(TASK_INTERRUPTIBLE);
			td->opcode = ret;
		}

		/* Wait for the next command to be executed */
		schedule();
		try_to_freeze();

		if (signal_pending(current))
			flush_signals(current);

		if(kthread_should_stop())
			break;
	}
	return 0;
}

/**
 * sysfs_test_command - interface for test commands
 * @dev:	thread reference
 * @buf:	command for actual step
 * @count:	length of buffer
 *
 * command syntax:
 *
 * opcode:data
 */
static ssize_t sysfs_test_command(struct sys_device *dev, struct sysdev_attribute *attr,
				  const char *buf, size_t count)
{
	struct sched_param schedpar;
	struct test_thread_data *td;
	char cmdbuf[32];
	int op, dat, tid, ret;

	td = container_of(dev, struct test_thread_data, sysdev);
	tid = td->sysdev.id;

	/* strings from sysfs write are not 0 terminated! */
	if (count >= sizeof(cmdbuf))
		return -EINVAL;

	/* strip of \n: */
	if (buf[count-1] == '\n')
		count--;
	if (count < 1)
		return -EINVAL;

	memcpy(cmdbuf, buf, count);
	cmdbuf[count] = 0;

	if (sscanf(cmdbuf, "%d:%d", &op, &dat) != 2)
		return -EINVAL;

	switch (op) {
	case RTTEST_SCHEDOT:
		schedpar.sched_priority = 0;
		ret = sched_setscheduler(threads[tid], SCHED_NORMAL, &schedpar);
		if (ret)
			return ret;
		set_user_nice(current, 0);
		break;

	case RTTEST_SCHEDRT:
		schedpar.sched_priority = dat;
		ret = sched_setscheduler(threads[tid], SCHED_FIFO, &schedpar);
		if (ret)
			return ret;
		break;

	case RTTEST_SIGNAL:
		send_sig(SIGHUP, threads[tid], 0);
		break;

	default:
		if (td->opcode > 0)
			return -EBUSY;
		td->opdata = dat;
		td->opcode = op;
		wake_up_process(threads[tid]);
	}

	return count;
}

/**
 * sysfs_test_status - sysfs interface for rt tester
 * @dev:	thread to query
 * @buf:	char buffer to be filled with thread status info
 */
static ssize_t sysfs_test_status(struct sys_device *dev, struct sysdev_attribute *attr,
				 char *buf)
{
	struct test_thread_data *td;
	struct task_struct *tsk;
	char *curr = buf;
	int i;

	td = container_of(dev, struct test_thread_data, sysdev);
	tsk = threads[td->sysdev.id];

	spin_lock(&rttest_lock);

	curr += sprintf(curr,
		"O: %4d, E:%8d, S: 0x%08lx, P: %4d, N: %4d, B: %p, M:",
		td->opcode, td->event, tsk->state,
			(MAX_RT_PRIO - 1) - tsk->prio,
			(MAX_RT_PRIO - 1) - tsk->normal_prio,
		tsk->pi_blocked_on);

	for (i = MAX_RT_TEST_MUTEXES - 1; i >=0 ; i--)
		curr += sprintf(curr, "%d", td->mutexes[i]);

	spin_unlock(&rttest_lock);

	curr += sprintf(curr, ", T: %p, R: %p\n", tsk,
			mutexes[td->sysdev.id].owner);

	return curr - buf;
}

static SYSDEV_ATTR(status, 0600, sysfs_test_status, NULL);
static SYSDEV_ATTR(command, 0600, NULL, sysfs_test_command);

static struct sysdev_class rttest_sysclass = {
	.name = "rttest",
};

static int init_test_thread(int id)
{
	thread_data[id].sysdev.cls = &rttest_sysclass;
	thread_data[id].sysdev.id = id;

	threads[id] = kthread_run(test_func, &thread_data[id], "rt-test-%d", id);
	if (IS_ERR(threads[id]))
		return PTR_ERR(threads[id]);

	return sysdev_register(&thread_data[id].sysdev);
}

static int init_rttest(void)
{
	int ret, i;

	spin_lock_init(&rttest_lock);

	for (i = 0; i < MAX_RT_TEST_MUTEXES; i++)
		rt_mutex_init(&mutexes[i]);

	ret = sysdev_class_register(&rttest_sysclass);
	if (ret)
		return ret;

	for (i = 0; i < MAX_RT_TEST_THREADS; i++) {
		ret = init_test_thread(i);
		if (ret)
			break;
		ret = sysdev_create_file(&thread_data[i].sysdev, &attr_status);
		if (ret)
			break;
		ret = sysdev_create_file(&thread_data[i].sysdev, &attr_command);
		if (ret)
			break;
	}

	printk("Initializing RT-Tester: %s\n", ret ? "Failed" : "OK" );

	return ret;
}

device_initcall(init_rttest);
Commit	Line	Data
61a87122 TG	1	/*
	2	* RT-Mutex-tester: scriptable tester for rt mutexes
	3	*
	4	* started by Thomas Gleixner:
	5	*
	6	* Copyright (C) 2006, Timesys Corp., Thomas Gleixner <tglx@timesys.com>
	7	*
	8	*/
61a87122	9	#include <linux/kthread.h>
9984de1a	10	#include <linux/export.h>
61a87122	11	#include <linux/sched.h>
61a87122 TG	12	#include <linux/spinlock.h>
	13	#include <linux/sysdev.h>
	14	#include <linux/timer.h>
7dfb7103	15	#include <linux/freezer.h>
61a87122 TG	16
	17	#include "rtmutex.h"
	18
	19	#define MAX_RT_TEST_THREADS 8
	20	#define MAX_RT_TEST_MUTEXES 8
	21
	22	static spinlock_t rttest_lock;
	23	static atomic_t rttest_event;
	24
	25	struct test_thread_data {
	26	int opcode;
	27	int opdata;
	28	int mutexes[MAX_RT_TEST_MUTEXES];
61a87122 TG	29	int event;
	30	struct sys_device sysdev;
	31	};
	32
	33	static struct test_thread_data thread_data[MAX_RT_TEST_THREADS];
36c8b586	34	static struct task_struct *threads[MAX_RT_TEST_THREADS];
61a87122 TG	35	static struct rt_mutex mutexes[MAX_RT_TEST_MUTEXES];
	36
	37	enum test_opcodes {
	38	RTTEST_NOP = 0,
	39	RTTEST_SCHEDOT, /* 1 Sched other, data = nice */
	40	RTTEST_SCHEDRT, /* 2 Sched fifo, data = prio */
	41	RTTEST_LOCK, /* 3 Lock uninterruptible, data = lockindex */
	42	RTTEST_LOCKNOWAIT, /* 4 Lock uninterruptible no wait in wakeup, data = lockindex */
	43	RTTEST_LOCKINT, /* 5 Lock interruptible, data = lockindex */
	44	RTTEST_LOCKINTNOWAIT, /* 6 Lock interruptible no wait in wakeup, data = lockindex */
	45	RTTEST_LOCKCONT, /* 7 Continue locking after the wakeup delay */
	46	RTTEST_UNLOCK, /* 8 Unlock, data = lockindex */
dbebbfbb TG	47	/* 9, 10 - reserved for BKL commemoration */
dbebbfbb TG	48	RTTEST_SIGNAL = 11, /* 11 Signal other test thread, data = thread id */
61a87122 TG	49	RTTEST_RESETEVENT = 98, /* 98 Reset event counter */
	50	RTTEST_RESET = 99, /* 99 Reset all pending operations */
	51	};
	52
	53	static int handle_op(struct test_thread_data *td, int lockwakeup)
	54	{
61a87122 TG	55	int i, id, ret = -EINVAL;
	56
	57	switch(td->opcode) {
	58
	59	case RTTEST_NOP:
	60	return 0;
	61
61a87122 TG	62	case RTTEST_LOCKCONT:
	63	td->mutexes[td->opdata] = 1;
	64	td->event = atomic_add_return(1, &rttest_event);
	65	return 0;
	66
	67	case RTTEST_RESET:
	68	for (i = 0; i < MAX_RT_TEST_MUTEXES; i++) {
	69	if (td->mutexes[i] == 4) {
	70	rt_mutex_unlock(&mutexes[i]);
	71	td->mutexes[i] = 0;
	72	}
	73	}
61a87122 TG	74	return 0;
	75
	76	case RTTEST_RESETEVENT:
	77	atomic_set(&rttest_event, 0);
	78	return 0;
	79
	80	default:
	81	if (lockwakeup)
	82	return ret;
	83	}
	84
	85	switch(td->opcode) {
	86
	87	case RTTEST_LOCK:
	88	case RTTEST_LOCKNOWAIT:
	89	id = td->opdata;
	90	if (id < 0 \|\| id >= MAX_RT_TEST_MUTEXES)
	91	return ret;
	92
	93	td->mutexes[id] = 1;
	94	td->event = atomic_add_return(1, &rttest_event);
	95	rt_mutex_lock(&mutexes[id]);
	96	td->event = atomic_add_return(1, &rttest_event);
	97	td->mutexes[id] = 4;
	98	return 0;
	99
	100	case RTTEST_LOCKINT:
	101	case RTTEST_LOCKINTNOWAIT:
	102	id = td->opdata;
	103	if (id < 0 \|\| id >= MAX_RT_TEST_MUTEXES)
	104	return ret;
	105
	106	td->mutexes[id] = 1;
	107	td->event = atomic_add_return(1, &rttest_event);
	108	ret = rt_mutex_lock_interruptible(&mutexes[id], 0);
	109	td->event = atomic_add_return(1, &rttest_event);
	110	td->mutexes[id] = ret ? 0 : 4;
	111	return ret ? -EINTR : 0;
	112
	113	case RTTEST_UNLOCK:
	114	id = td->opdata;
	115	if (id < 0 \|\| id >= MAX_RT_TEST_MUTEXES \|\| td->mutexes[id] != 4)
	116	return ret;
	117
	118	td->event = atomic_add_return(1, &rttest_event);
	119	rt_mutex_unlock(&mutexes[id]);
	120	td->event = atomic_add_return(1, &rttest_event);
	121	td->mutexes[id] = 0;
	122	return 0;
	123
61a87122 TG	124	default:
	125	break;
	126	}
	127	return ret;
	128	}
	129
	130	/*
	131	* Schedule replacement for rtsem_down(). Only called for threads with
	132	* PF_MUTEX_TESTER set.
	133	*
	134	* This allows us to have finegrained control over the event flow.
	135	*
	136	*/
	137	void schedule_rt_mutex_test(struct rt_mutex *mutex)
	138	{
	139	int tid, op, dat;
	140	struct test_thread_data *td;
	141
	142	/* We have to lookup the task */
	143	for (tid = 0; tid < MAX_RT_TEST_THREADS; tid++) {
	144	if (threads[tid] == current)
	145	break;
	146	}
	147
	148	BUG_ON(tid == MAX_RT_TEST_THREADS);
	149
	150	td = &thread_data[tid];
	151
	152	op = td->opcode;
	153	dat = td->opdata;
	154
	155	switch (op) {
	156	case RTTEST_LOCK:
	157	case RTTEST_LOCKINT:
	158	case RTTEST_LOCKNOWAIT:
	159	case RTTEST_LOCKINTNOWAIT:
	160	if (mutex != &mutexes[dat])
	161	break;
	162
	163	if (td->mutexes[dat] != 1)
	164	break;
	165
	166	td->mutexes[dat] = 2;
	167	td->event = atomic_add_return(1, &rttest_event);
	168	break;
	169
61a87122 TG	170	default:
	171	break;
	172	}
	173
	174	schedule();
	175
	176
	177	switch (op) {
	178	case RTTEST_LOCK:
	179	case RTTEST_LOCKINT:
	180	if (mutex != &mutexes[dat])
	181	return;
	182
	183	if (td->mutexes[dat] != 2)
	184	return;
	185
	186	td->mutexes[dat] = 3;
	187	td->event = atomic_add_return(1, &rttest_event);
	188	break;
	189
	190	case RTTEST_LOCKNOWAIT:
	191	case RTTEST_LOCKINTNOWAIT:
	192	if (mutex != &mutexes[dat])
	193	return;
	194
	195	if (td->mutexes[dat] != 2)
	196	return;
	197
	198	td->mutexes[dat] = 1;
	199	td->event = atomic_add_return(1, &rttest_event);
	200	return;
	201
61a87122 TG	202	default:
	203	return;
	204	}
	205
	206	td->opcode = 0;
	207
	208	for (;;) {
	209	set_current_state(TASK_INTERRUPTIBLE);
	210
	211	if (td->opcode > 0) {
	212	int ret;
	213
	214	set_current_state(TASK_RUNNING);
	215	ret = handle_op(td, 1);
	216	set_current_state(TASK_INTERRUPTIBLE);
	217	if (td->opcode == RTTEST_LOCKCONT)
	218	break;
	219	td->opcode = ret;
	220	}
	221
	222	/* Wait for the next command to be executed */
	223	schedule();
	224	}
	225
	226	/* Restore previous command and data */
	227	td->opcode = op;
	228	td->opdata = dat;
	229	}
	230
	231	static int test_func(void *data)
	232	{
	233	struct test_thread_data *td = data;
	234	int ret;
	235
	236	current->flags \|= PF_MUTEX_TESTER;
83144186	237	set_freezable();
61a87122 TG	238	allow_signal(SIGHUP);
	239
	240	for(;;) {
	241
	242	set_current_state(TASK_INTERRUPTIBLE);
	243
	244	if (td->opcode > 0) {
	245	set_current_state(TASK_RUNNING);
	246	ret = handle_op(td, 0);
	247	set_current_state(TASK_INTERRUPTIBLE);
	248	td->opcode = ret;
	249	}
	250
	251	/* Wait for the next command to be executed */
	252	schedule();
60198f99	253	try_to_freeze();
61a87122 TG	254
	255	if (signal_pending(current))
	256	flush_signals(current);
	257
	258	if(kthread_should_stop())
	259	break;
	260	}
	261	return 0;
	262	}
	263
	264	/**
	265	* sysfs_test_command - interface for test commands
	266	* @dev: thread reference
	267	* @buf: command for actual step
	268	* @count: length of buffer
	269	*
	270	* command syntax:
	271	*
	272	* opcode:data
	273	*/
4a0b2b4d AK	274	static ssize_t sysfs_test_command(struct sys_device dev, struct sysdev_attribute attr,
4a0b2b4d AK	275	const char *buf, size_t count)
61a87122	276	{
0bafd214	277	struct sched_param schedpar;
61a87122 TG	278	struct test_thread_data *td;
61a87122 TG	279	char cmdbuf[32];
0bafd214	280	int op, dat, tid, ret;
61a87122 TG	281
	282	td = container_of(dev, struct test_thread_data, sysdev);
	283	tid = td->sysdev.id;
	284
	285	/* strings from sysfs write are not 0 terminated! */
	286	if (count >= sizeof(cmdbuf))
	287	return -EINVAL;
	288
	289	/* strip of \n: */
	290	if (buf[count-1] == '\n')
	291	count--;
	292	if (count < 1)
	293	return -EINVAL;
	294
	295	memcpy(cmdbuf, buf, count);
	296	cmdbuf[count] = 0;
	297
	298	if (sscanf(cmdbuf, "%d:%d", &op, &dat) != 2)
	299	return -EINVAL;
	300
	301	switch (op) {
0bafd214 TG	302	case RTTEST_SCHEDOT:
	303	schedpar.sched_priority = 0;
	304	ret = sched_setscheduler(threads[tid], SCHED_NORMAL, &schedpar);
	305	if (ret)
	306	return ret;
	307	set_user_nice(current, 0);
	308	break;
	309
	310	case RTTEST_SCHEDRT:
	311	schedpar.sched_priority = dat;
	312	ret = sched_setscheduler(threads[tid], SCHED_FIFO, &schedpar);
	313	if (ret)
	314	return ret;
	315	break;
	316
61a87122 TG	317	case RTTEST_SIGNAL:
	318	send_sig(SIGHUP, threads[tid], 0);
	319	break;
	320
	321	default:
	322	if (td->opcode > 0)
	323	return -EBUSY;
	324	td->opdata = dat;
	325	td->opcode = op;
	326	wake_up_process(threads[tid]);
	327	}
	328
	329	return count;
	330	}
	331
	332	/**
	333	* sysfs_test_status - sysfs interface for rt tester
	334	* @dev: thread to query
	335	* @buf: char buffer to be filled with thread status info
	336	*/
4a0b2b4d AK	337	static ssize_t sysfs_test_status(struct sys_device dev, struct sysdev_attribute attr,
4a0b2b4d AK	338	char *buf)
61a87122 TG	339	{
61a87122 TG	340	struct test_thread_data *td;
36c8b586	341	struct task_struct *tsk;
61a87122	342	char *curr = buf;
61a87122 TG	343	int i;
	344
	345	td = container_of(dev, struct test_thread_data, sysdev);
	346	tsk = threads[td->sysdev.id];
	347
	348	spin_lock(&rttest_lock);
	349
	350	curr += sprintf(curr,
ccaa8d65	351	"O: %4d, E:%8d, S: 0x%08lx, P: %4d, N: %4d, B: %p, M:",
61a87122 TG	352	td->opcode, td->event, tsk->state,
	353	(MAX_RT_PRIO - 1) - tsk->prio,
	354	(MAX_RT_PRIO - 1) - tsk->normal_prio,
ccaa8d65	355	tsk->pi_blocked_on);
61a87122 TG	356
	357	for (i = MAX_RT_TEST_MUTEXES - 1; i >=0 ; i--)
	358	curr += sprintf(curr, "%d", td->mutexes[i]);
	359
	360	spin_unlock(&rttest_lock);
	361
	362	curr += sprintf(curr, ", T: %p, R: %p\n", tsk,
	363	mutexes[td->sysdev.id].owner);
	364
	365	return curr - buf;
	366	}
	367
	368	static SYSDEV_ATTR(status, 0600, sysfs_test_status, NULL);
	369	static SYSDEV_ATTR(command, 0600, NULL, sysfs_test_command);
	370
	371	static struct sysdev_class rttest_sysclass = {
af5ca3f4	372	.name = "rttest",
61a87122 TG	373	};
	374
	375	static int init_test_thread(int id)
	376	{
	377	thread_data[id].sysdev.cls = &rttest_sysclass;
	378	thread_data[id].sysdev.id = id;
	379
	380	threads[id] = kthread_run(test_func, &thread_data[id], "rt-test-%d", id);
	381	if (IS_ERR(threads[id]))
	382	return PTR_ERR(threads[id]);
	383
	384	return sysdev_register(&thread_data[id].sysdev);
	385	}
	386
	387	static int init_rttest(void)
	388	{
	389	int ret, i;
	390
	391	spin_lock_init(&rttest_lock);
	392
	393	for (i = 0; i < MAX_RT_TEST_MUTEXES; i++)
	394	rt_mutex_init(&mutexes[i]);
	395
	396	ret = sysdev_class_register(&rttest_sysclass);
	397	if (ret)
	398	return ret;
	399
	400	for (i = 0; i < MAX_RT_TEST_THREADS; i++) {
	401	ret = init_test_thread(i);
	402	if (ret)
	403	break;
	404	ret = sysdev_create_file(&thread_data[i].sysdev, &attr_status);
	405	if (ret)
	406	break;
	407	ret = sysdev_create_file(&thread_data[i].sysdev, &attr_command);
	408	if (ret)
	409	break;
	410	}
	411
	412	printk("Initializing RT-Tester: %s\n", ret ? "Failed" : "OK" );
	413
	414	return ret;
	415	}
	416
	417	device_initcall(init_rttest);