Linux Audio

Check our new training course

Embedded Linux training

Mar 10-20, 2025, special US time zones
Register
Loading...
Note: File does not exist in v3.5.6.
   1// SPDX-License-Identifier: GPL-2.0+
   2/*
   3 * Module-based torture test facility for locking
   4 *
   5 * Copyright (C) IBM Corporation, 2014
   6 *
   7 * Authors: Paul E. McKenney <paulmck@linux.ibm.com>
   8 *          Davidlohr Bueso <dave@stgolabs.net>
   9 *	Based on kernel/rcu/torture.c.
  10 */
  11
  12#define pr_fmt(fmt) fmt
  13
  14#include <linux/kernel.h>
  15#include <linux/module.h>
  16#include <linux/kthread.h>
  17#include <linux/sched/rt.h>
  18#include <linux/spinlock.h>
  19#include <linux/mutex.h>
  20#include <linux/rwsem.h>
  21#include <linux/smp.h>
  22#include <linux/interrupt.h>
  23#include <linux/sched.h>
  24#include <uapi/linux/sched/types.h>
  25#include <linux/rtmutex.h>
  26#include <linux/atomic.h>
  27#include <linux/moduleparam.h>
  28#include <linux/delay.h>
  29#include <linux/slab.h>
  30#include <linux/torture.h>
  31#include <linux/reboot.h>
  32
  33MODULE_LICENSE("GPL");
  34MODULE_AUTHOR("Paul E. McKenney <paulmck@linux.ibm.com>");
  35
  36torture_param(int, nwriters_stress, -1,
  37	     "Number of write-locking stress-test threads");
  38torture_param(int, nreaders_stress, -1,
  39	     "Number of read-locking stress-test threads");
  40torture_param(int, onoff_holdoff, 0, "Time after boot before CPU hotplugs (s)");
  41torture_param(int, onoff_interval, 0,
  42	     "Time between CPU hotplugs (s), 0=disable");
  43torture_param(int, shuffle_interval, 3,
  44	     "Number of jiffies between shuffles, 0=disable");
  45torture_param(int, shutdown_secs, 0, "Shutdown time (j), <= zero to disable.");
  46torture_param(int, stat_interval, 60,
  47	     "Number of seconds between stats printk()s");
  48torture_param(int, stutter, 5, "Number of jiffies to run/halt test, 0=disable");
  49torture_param(int, verbose, 1,
  50	     "Enable verbose debugging printk()s");
  51
  52static char *torture_type = "spin_lock";
  53module_param(torture_type, charp, 0444);
  54MODULE_PARM_DESC(torture_type,
  55		 "Type of lock to torture (spin_lock, spin_lock_irq, mutex_lock, ...)");
  56
  57static struct task_struct *stats_task;
  58static struct task_struct **writer_tasks;
  59static struct task_struct **reader_tasks;
  60
  61static bool lock_is_write_held;
  62static atomic_t lock_is_read_held;
  63static unsigned long last_lock_release;
  64
  65struct lock_stress_stats {
  66	long n_lock_fail;
  67	long n_lock_acquired;
  68};
  69
  70/* Forward reference. */
  71static void lock_torture_cleanup(void);
  72
  73/*
  74 * Operations vector for selecting different types of tests.
  75 */
  76struct lock_torture_ops {
  77	void (*init)(void);
  78	void (*exit)(void);
  79	int (*writelock)(int tid);
  80	void (*write_delay)(struct torture_random_state *trsp);
  81	void (*task_boost)(struct torture_random_state *trsp);
  82	void (*writeunlock)(int tid);
  83	int (*readlock)(int tid);
  84	void (*read_delay)(struct torture_random_state *trsp);
  85	void (*readunlock)(int tid);
  86
  87	unsigned long flags; /* for irq spinlocks */
  88	const char *name;
  89};
  90
  91struct lock_torture_cxt {
  92	int nrealwriters_stress;
  93	int nrealreaders_stress;
  94	bool debug_lock;
  95	bool init_called;
  96	atomic_t n_lock_torture_errors;
  97	struct lock_torture_ops *cur_ops;
  98	struct lock_stress_stats *lwsa; /* writer statistics */
  99	struct lock_stress_stats *lrsa; /* reader statistics */
 100};
 101static struct lock_torture_cxt cxt = { 0, 0, false, false,
 102				       ATOMIC_INIT(0),
 103				       NULL, NULL};
 104/*
 105 * Definitions for lock torture testing.
 106 */
 107
 108static int torture_lock_busted_write_lock(int tid __maybe_unused)
 109{
 110	return 0;  /* BUGGY, do not use in real life!!! */
 111}
 112
 113static void torture_lock_busted_write_delay(struct torture_random_state *trsp)
 114{
 115	const unsigned long longdelay_ms = 100;
 116
 117	/* We want a long delay occasionally to force massive contention.  */
 118	if (!(torture_random(trsp) %
 119	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
 120		mdelay(longdelay_ms);
 121	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
 122		torture_preempt_schedule();  /* Allow test to be preempted. */
 123}
 124
 125static void torture_lock_busted_write_unlock(int tid __maybe_unused)
 126{
 127	  /* BUGGY, do not use in real life!!! */
 128}
 129
 130static void torture_boost_dummy(struct torture_random_state *trsp)
 131{
 132	/* Only rtmutexes care about priority */
 133}
 134
 135static struct lock_torture_ops lock_busted_ops = {
 136	.writelock	= torture_lock_busted_write_lock,
 137	.write_delay	= torture_lock_busted_write_delay,
 138	.task_boost     = torture_boost_dummy,
 139	.writeunlock	= torture_lock_busted_write_unlock,
 140	.readlock       = NULL,
 141	.read_delay     = NULL,
 142	.readunlock     = NULL,
 143	.name		= "lock_busted"
 144};
 145
 146static DEFINE_SPINLOCK(torture_spinlock);
 147
 148static int torture_spin_lock_write_lock(int tid __maybe_unused)
 149__acquires(torture_spinlock)
 150{
 151	spin_lock(&torture_spinlock);
 152	return 0;
 153}
 154
 155static void torture_spin_lock_write_delay(struct torture_random_state *trsp)
 156{
 157	const unsigned long shortdelay_us = 2;
 158	const unsigned long longdelay_ms = 100;
 159
 160	/* We want a short delay mostly to emulate likely code, and
 161	 * we want a long delay occasionally to force massive contention.
 162	 */
 163	if (!(torture_random(trsp) %
 164	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
 165		mdelay(longdelay_ms);
 166	if (!(torture_random(trsp) %
 167	      (cxt.nrealwriters_stress * 2 * shortdelay_us)))
 168		udelay(shortdelay_us);
 169	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
 170		torture_preempt_schedule();  /* Allow test to be preempted. */
 171}
 172
 173static void torture_spin_lock_write_unlock(int tid __maybe_unused)
 174__releases(torture_spinlock)
 175{
 176	spin_unlock(&torture_spinlock);
 177}
 178
 179static struct lock_torture_ops spin_lock_ops = {
 180	.writelock	= torture_spin_lock_write_lock,
 181	.write_delay	= torture_spin_lock_write_delay,
 182	.task_boost     = torture_boost_dummy,
 183	.writeunlock	= torture_spin_lock_write_unlock,
 184	.readlock       = NULL,
 185	.read_delay     = NULL,
 186	.readunlock     = NULL,
 187	.name		= "spin_lock"
 188};
 189
 190static int torture_spin_lock_write_lock_irq(int tid __maybe_unused)
 191__acquires(torture_spinlock)
 192{
 193	unsigned long flags;
 194
 195	spin_lock_irqsave(&torture_spinlock, flags);
 196	cxt.cur_ops->flags = flags;
 197	return 0;
 198}
 199
 200static void torture_lock_spin_write_unlock_irq(int tid __maybe_unused)
 201__releases(torture_spinlock)
 202{
 203	spin_unlock_irqrestore(&torture_spinlock, cxt.cur_ops->flags);
 204}
 205
 206static struct lock_torture_ops spin_lock_irq_ops = {
 207	.writelock	= torture_spin_lock_write_lock_irq,
 208	.write_delay	= torture_spin_lock_write_delay,
 209	.task_boost     = torture_boost_dummy,
 210	.writeunlock	= torture_lock_spin_write_unlock_irq,
 211	.readlock       = NULL,
 212	.read_delay     = NULL,
 213	.readunlock     = NULL,
 214	.name		= "spin_lock_irq"
 215};
 216
 217static DEFINE_RWLOCK(torture_rwlock);
 218
 219static int torture_rwlock_write_lock(int tid __maybe_unused)
 220__acquires(torture_rwlock)
 221{
 222	write_lock(&torture_rwlock);
 223	return 0;
 224}
 225
 226static void torture_rwlock_write_delay(struct torture_random_state *trsp)
 227{
 228	const unsigned long shortdelay_us = 2;
 229	const unsigned long longdelay_ms = 100;
 230
 231	/* We want a short delay mostly to emulate likely code, and
 232	 * we want a long delay occasionally to force massive contention.
 233	 */
 234	if (!(torture_random(trsp) %
 235	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
 236		mdelay(longdelay_ms);
 237	else
 238		udelay(shortdelay_us);
 239}
 240
 241static void torture_rwlock_write_unlock(int tid __maybe_unused)
 242__releases(torture_rwlock)
 243{
 244	write_unlock(&torture_rwlock);
 245}
 246
 247static int torture_rwlock_read_lock(int tid __maybe_unused)
 248__acquires(torture_rwlock)
 249{
 250	read_lock(&torture_rwlock);
 251	return 0;
 252}
 253
 254static void torture_rwlock_read_delay(struct torture_random_state *trsp)
 255{
 256	const unsigned long shortdelay_us = 10;
 257	const unsigned long longdelay_ms = 100;
 258
 259	/* We want a short delay mostly to emulate likely code, and
 260	 * we want a long delay occasionally to force massive contention.
 261	 */
 262	if (!(torture_random(trsp) %
 263	      (cxt.nrealreaders_stress * 2000 * longdelay_ms)))
 264		mdelay(longdelay_ms);
 265	else
 266		udelay(shortdelay_us);
 267}
 268
 269static void torture_rwlock_read_unlock(int tid __maybe_unused)
 270__releases(torture_rwlock)
 271{
 272	read_unlock(&torture_rwlock);
 273}
 274
 275static struct lock_torture_ops rw_lock_ops = {
 276	.writelock	= torture_rwlock_write_lock,
 277	.write_delay	= torture_rwlock_write_delay,
 278	.task_boost     = torture_boost_dummy,
 279	.writeunlock	= torture_rwlock_write_unlock,
 280	.readlock       = torture_rwlock_read_lock,
 281	.read_delay     = torture_rwlock_read_delay,
 282	.readunlock     = torture_rwlock_read_unlock,
 283	.name		= "rw_lock"
 284};
 285
 286static int torture_rwlock_write_lock_irq(int tid __maybe_unused)
 287__acquires(torture_rwlock)
 288{
 289	unsigned long flags;
 290
 291	write_lock_irqsave(&torture_rwlock, flags);
 292	cxt.cur_ops->flags = flags;
 293	return 0;
 294}
 295
 296static void torture_rwlock_write_unlock_irq(int tid __maybe_unused)
 297__releases(torture_rwlock)
 298{
 299	write_unlock_irqrestore(&torture_rwlock, cxt.cur_ops->flags);
 300}
 301
 302static int torture_rwlock_read_lock_irq(int tid __maybe_unused)
 303__acquires(torture_rwlock)
 304{
 305	unsigned long flags;
 306
 307	read_lock_irqsave(&torture_rwlock, flags);
 308	cxt.cur_ops->flags = flags;
 309	return 0;
 310}
 311
 312static void torture_rwlock_read_unlock_irq(int tid __maybe_unused)
 313__releases(torture_rwlock)
 314{
 315	read_unlock_irqrestore(&torture_rwlock, cxt.cur_ops->flags);
 316}
 317
 318static struct lock_torture_ops rw_lock_irq_ops = {
 319	.writelock	= torture_rwlock_write_lock_irq,
 320	.write_delay	= torture_rwlock_write_delay,
 321	.task_boost     = torture_boost_dummy,
 322	.writeunlock	= torture_rwlock_write_unlock_irq,
 323	.readlock       = torture_rwlock_read_lock_irq,
 324	.read_delay     = torture_rwlock_read_delay,
 325	.readunlock     = torture_rwlock_read_unlock_irq,
 326	.name		= "rw_lock_irq"
 327};
 328
 329static DEFINE_MUTEX(torture_mutex);
 330
 331static int torture_mutex_lock(int tid __maybe_unused)
 332__acquires(torture_mutex)
 333{
 334	mutex_lock(&torture_mutex);
 335	return 0;
 336}
 337
 338static void torture_mutex_delay(struct torture_random_state *trsp)
 339{
 340	const unsigned long longdelay_ms = 100;
 341
 342	/* We want a long delay occasionally to force massive contention.  */
 343	if (!(torture_random(trsp) %
 344	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
 345		mdelay(longdelay_ms * 5);
 346	else
 347		mdelay(longdelay_ms / 5);
 348	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
 349		torture_preempt_schedule();  /* Allow test to be preempted. */
 350}
 351
 352static void torture_mutex_unlock(int tid __maybe_unused)
 353__releases(torture_mutex)
 354{
 355	mutex_unlock(&torture_mutex);
 356}
 357
 358static struct lock_torture_ops mutex_lock_ops = {
 359	.writelock	= torture_mutex_lock,
 360	.write_delay	= torture_mutex_delay,
 361	.task_boost     = torture_boost_dummy,
 362	.writeunlock	= torture_mutex_unlock,
 363	.readlock       = NULL,
 364	.read_delay     = NULL,
 365	.readunlock     = NULL,
 366	.name		= "mutex_lock"
 367};
 368
 369#include <linux/ww_mutex.h>
 370/*
 371 * The torture ww_mutexes should belong to the same lock class as
 372 * torture_ww_class to avoid lockdep problem. The ww_mutex_init()
 373 * function is called for initialization to ensure that.
 374 */
 375static DEFINE_WD_CLASS(torture_ww_class);
 376static struct ww_mutex torture_ww_mutex_0, torture_ww_mutex_1, torture_ww_mutex_2;
 377static struct ww_acquire_ctx *ww_acquire_ctxs;
 378
 379static void torture_ww_mutex_init(void)
 380{
 381	ww_mutex_init(&torture_ww_mutex_0, &torture_ww_class);
 382	ww_mutex_init(&torture_ww_mutex_1, &torture_ww_class);
 383	ww_mutex_init(&torture_ww_mutex_2, &torture_ww_class);
 384
 385	ww_acquire_ctxs = kmalloc_array(cxt.nrealwriters_stress,
 386					sizeof(*ww_acquire_ctxs),
 387					GFP_KERNEL);
 388	if (!ww_acquire_ctxs)
 389		VERBOSE_TOROUT_STRING("ww_acquire_ctx: Out of memory");
 390}
 391
 392static void torture_ww_mutex_exit(void)
 393{
 394	kfree(ww_acquire_ctxs);
 395}
 396
 397static int torture_ww_mutex_lock(int tid)
 398__acquires(torture_ww_mutex_0)
 399__acquires(torture_ww_mutex_1)
 400__acquires(torture_ww_mutex_2)
 401{
 402	LIST_HEAD(list);
 403	struct reorder_lock {
 404		struct list_head link;
 405		struct ww_mutex *lock;
 406	} locks[3], *ll, *ln;
 407	struct ww_acquire_ctx *ctx = &ww_acquire_ctxs[tid];
 408
 409	locks[0].lock = &torture_ww_mutex_0;
 410	list_add(&locks[0].link, &list);
 411
 412	locks[1].lock = &torture_ww_mutex_1;
 413	list_add(&locks[1].link, &list);
 414
 415	locks[2].lock = &torture_ww_mutex_2;
 416	list_add(&locks[2].link, &list);
 417
 418	ww_acquire_init(ctx, &torture_ww_class);
 419
 420	list_for_each_entry(ll, &list, link) {
 421		int err;
 422
 423		err = ww_mutex_lock(ll->lock, ctx);
 424		if (!err)
 425			continue;
 426
 427		ln = ll;
 428		list_for_each_entry_continue_reverse(ln, &list, link)
 429			ww_mutex_unlock(ln->lock);
 430
 431		if (err != -EDEADLK)
 432			return err;
 433
 434		ww_mutex_lock_slow(ll->lock, ctx);
 435		list_move(&ll->link, &list);
 436	}
 437
 438	return 0;
 439}
 440
 441static void torture_ww_mutex_unlock(int tid)
 442__releases(torture_ww_mutex_0)
 443__releases(torture_ww_mutex_1)
 444__releases(torture_ww_mutex_2)
 445{
 446	struct ww_acquire_ctx *ctx = &ww_acquire_ctxs[tid];
 447
 448	ww_mutex_unlock(&torture_ww_mutex_0);
 449	ww_mutex_unlock(&torture_ww_mutex_1);
 450	ww_mutex_unlock(&torture_ww_mutex_2);
 451	ww_acquire_fini(ctx);
 452}
 453
 454static struct lock_torture_ops ww_mutex_lock_ops = {
 455	.init		= torture_ww_mutex_init,
 456	.exit		= torture_ww_mutex_exit,
 457	.writelock	= torture_ww_mutex_lock,
 458	.write_delay	= torture_mutex_delay,
 459	.task_boost     = torture_boost_dummy,
 460	.writeunlock	= torture_ww_mutex_unlock,
 461	.readlock       = NULL,
 462	.read_delay     = NULL,
 463	.readunlock     = NULL,
 464	.name		= "ww_mutex_lock"
 465};
 466
 467#ifdef CONFIG_RT_MUTEXES
 468static DEFINE_RT_MUTEX(torture_rtmutex);
 469
 470static int torture_rtmutex_lock(int tid __maybe_unused)
 471__acquires(torture_rtmutex)
 472{
 473	rt_mutex_lock(&torture_rtmutex);
 474	return 0;
 475}
 476
 477static void torture_rtmutex_boost(struct torture_random_state *trsp)
 478{
 479	const unsigned int factor = 50000; /* yes, quite arbitrary */
 480
 481	if (!rt_task(current)) {
 482		/*
 483		 * Boost priority once every ~50k operations. When the
 484		 * task tries to take the lock, the rtmutex it will account
 485		 * for the new priority, and do any corresponding pi-dance.
 486		 */
 487		if (trsp && !(torture_random(trsp) %
 488			      (cxt.nrealwriters_stress * factor))) {
 489			sched_set_fifo(current);
 490		} else /* common case, do nothing */
 491			return;
 492	} else {
 493		/*
 494		 * The task will remain boosted for another ~500k operations,
 495		 * then restored back to its original prio, and so forth.
 496		 *
 497		 * When @trsp is nil, we want to force-reset the task for
 498		 * stopping the kthread.
 499		 */
 500		if (!trsp || !(torture_random(trsp) %
 501			       (cxt.nrealwriters_stress * factor * 2))) {
 502			sched_set_normal(current, 0);
 503		} else /* common case, do nothing */
 504			return;
 505	}
 506}
 507
 508static void torture_rtmutex_delay(struct torture_random_state *trsp)
 509{
 510	const unsigned long shortdelay_us = 2;
 511	const unsigned long longdelay_ms = 100;
 512
 513	/*
 514	 * We want a short delay mostly to emulate likely code, and
 515	 * we want a long delay occasionally to force massive contention.
 516	 */
 517	if (!(torture_random(trsp) %
 518	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
 519		mdelay(longdelay_ms);
 520	if (!(torture_random(trsp) %
 521	      (cxt.nrealwriters_stress * 2 * shortdelay_us)))
 522		udelay(shortdelay_us);
 523	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
 524		torture_preempt_schedule();  /* Allow test to be preempted. */
 525}
 526
 527static void torture_rtmutex_unlock(int tid __maybe_unused)
 528__releases(torture_rtmutex)
 529{
 530	rt_mutex_unlock(&torture_rtmutex);
 531}
 532
 533static struct lock_torture_ops rtmutex_lock_ops = {
 534	.writelock	= torture_rtmutex_lock,
 535	.write_delay	= torture_rtmutex_delay,
 536	.task_boost     = torture_rtmutex_boost,
 537	.writeunlock	= torture_rtmutex_unlock,
 538	.readlock       = NULL,
 539	.read_delay     = NULL,
 540	.readunlock     = NULL,
 541	.name		= "rtmutex_lock"
 542};
 543#endif
 544
 545static DECLARE_RWSEM(torture_rwsem);
 546static int torture_rwsem_down_write(int tid __maybe_unused)
 547__acquires(torture_rwsem)
 548{
 549	down_write(&torture_rwsem);
 550	return 0;
 551}
 552
 553static void torture_rwsem_write_delay(struct torture_random_state *trsp)
 554{
 555	const unsigned long longdelay_ms = 100;
 556
 557	/* We want a long delay occasionally to force massive contention.  */
 558	if (!(torture_random(trsp) %
 559	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
 560		mdelay(longdelay_ms * 10);
 561	else
 562		mdelay(longdelay_ms / 10);
 563	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
 564		torture_preempt_schedule();  /* Allow test to be preempted. */
 565}
 566
 567static void torture_rwsem_up_write(int tid __maybe_unused)
 568__releases(torture_rwsem)
 569{
 570	up_write(&torture_rwsem);
 571}
 572
 573static int torture_rwsem_down_read(int tid __maybe_unused)
 574__acquires(torture_rwsem)
 575{
 576	down_read(&torture_rwsem);
 577	return 0;
 578}
 579
 580static void torture_rwsem_read_delay(struct torture_random_state *trsp)
 581{
 582	const unsigned long longdelay_ms = 100;
 583
 584	/* We want a long delay occasionally to force massive contention.  */
 585	if (!(torture_random(trsp) %
 586	      (cxt.nrealreaders_stress * 2000 * longdelay_ms)))
 587		mdelay(longdelay_ms * 2);
 588	else
 589		mdelay(longdelay_ms / 2);
 590	if (!(torture_random(trsp) % (cxt.nrealreaders_stress * 20000)))
 591		torture_preempt_schedule();  /* Allow test to be preempted. */
 592}
 593
 594static void torture_rwsem_up_read(int tid __maybe_unused)
 595__releases(torture_rwsem)
 596{
 597	up_read(&torture_rwsem);
 598}
 599
 600static struct lock_torture_ops rwsem_lock_ops = {
 601	.writelock	= torture_rwsem_down_write,
 602	.write_delay	= torture_rwsem_write_delay,
 603	.task_boost     = torture_boost_dummy,
 604	.writeunlock	= torture_rwsem_up_write,
 605	.readlock       = torture_rwsem_down_read,
 606	.read_delay     = torture_rwsem_read_delay,
 607	.readunlock     = torture_rwsem_up_read,
 608	.name		= "rwsem_lock"
 609};
 610
 611#include <linux/percpu-rwsem.h>
 612static struct percpu_rw_semaphore pcpu_rwsem;
 613
 614static void torture_percpu_rwsem_init(void)
 615{
 616	BUG_ON(percpu_init_rwsem(&pcpu_rwsem));
 617}
 618
 619static void torture_percpu_rwsem_exit(void)
 620{
 621	percpu_free_rwsem(&pcpu_rwsem);
 622}
 623
 624static int torture_percpu_rwsem_down_write(int tid __maybe_unused)
 625__acquires(pcpu_rwsem)
 626{
 627	percpu_down_write(&pcpu_rwsem);
 628	return 0;
 629}
 630
 631static void torture_percpu_rwsem_up_write(int tid __maybe_unused)
 632__releases(pcpu_rwsem)
 633{
 634	percpu_up_write(&pcpu_rwsem);
 635}
 636
 637static int torture_percpu_rwsem_down_read(int tid __maybe_unused)
 638__acquires(pcpu_rwsem)
 639{
 640	percpu_down_read(&pcpu_rwsem);
 641	return 0;
 642}
 643
 644static void torture_percpu_rwsem_up_read(int tid __maybe_unused)
 645__releases(pcpu_rwsem)
 646{
 647	percpu_up_read(&pcpu_rwsem);
 648}
 649
 650static struct lock_torture_ops percpu_rwsem_lock_ops = {
 651	.init		= torture_percpu_rwsem_init,
 652	.exit		= torture_percpu_rwsem_exit,
 653	.writelock	= torture_percpu_rwsem_down_write,
 654	.write_delay	= torture_rwsem_write_delay,
 655	.task_boost     = torture_boost_dummy,
 656	.writeunlock	= torture_percpu_rwsem_up_write,
 657	.readlock       = torture_percpu_rwsem_down_read,
 658	.read_delay     = torture_rwsem_read_delay,
 659	.readunlock     = torture_percpu_rwsem_up_read,
 660	.name		= "percpu_rwsem_lock"
 661};
 662
 663/*
 664 * Lock torture writer kthread.  Repeatedly acquires and releases
 665 * the lock, checking for duplicate acquisitions.
 666 */
 667static int lock_torture_writer(void *arg)
 668{
 669	struct lock_stress_stats *lwsp = arg;
 670	int tid = lwsp - cxt.lwsa;
 671	DEFINE_TORTURE_RANDOM(rand);
 672
 673	VERBOSE_TOROUT_STRING("lock_torture_writer task started");
 674	set_user_nice(current, MAX_NICE);
 675
 676	do {
 677		if ((torture_random(&rand) & 0xfffff) == 0)
 678			schedule_timeout_uninterruptible(1);
 679
 680		cxt.cur_ops->task_boost(&rand);
 681		cxt.cur_ops->writelock(tid);
 682		if (WARN_ON_ONCE(lock_is_write_held))
 683			lwsp->n_lock_fail++;
 684		lock_is_write_held = true;
 685		if (WARN_ON_ONCE(atomic_read(&lock_is_read_held)))
 686			lwsp->n_lock_fail++; /* rare, but... */
 687
 688		lwsp->n_lock_acquired++;
 689		cxt.cur_ops->write_delay(&rand);
 690		lock_is_write_held = false;
 691		WRITE_ONCE(last_lock_release, jiffies);
 692		cxt.cur_ops->writeunlock(tid);
 693
 694		stutter_wait("lock_torture_writer");
 695	} while (!torture_must_stop());
 696
 697	cxt.cur_ops->task_boost(NULL); /* reset prio */
 698	torture_kthread_stopping("lock_torture_writer");
 699	return 0;
 700}
 701
 702/*
 703 * Lock torture reader kthread.  Repeatedly acquires and releases
 704 * the reader lock.
 705 */
 706static int lock_torture_reader(void *arg)
 707{
 708	struct lock_stress_stats *lrsp = arg;
 709	int tid = lrsp - cxt.lrsa;
 710	DEFINE_TORTURE_RANDOM(rand);
 711
 712	VERBOSE_TOROUT_STRING("lock_torture_reader task started");
 713	set_user_nice(current, MAX_NICE);
 714
 715	do {
 716		if ((torture_random(&rand) & 0xfffff) == 0)
 717			schedule_timeout_uninterruptible(1);
 718
 719		cxt.cur_ops->readlock(tid);
 720		atomic_inc(&lock_is_read_held);
 721		if (WARN_ON_ONCE(lock_is_write_held))
 722			lrsp->n_lock_fail++; /* rare, but... */
 723
 724		lrsp->n_lock_acquired++;
 725		cxt.cur_ops->read_delay(&rand);
 726		atomic_dec(&lock_is_read_held);
 727		cxt.cur_ops->readunlock(tid);
 728
 729		stutter_wait("lock_torture_reader");
 730	} while (!torture_must_stop());
 731	torture_kthread_stopping("lock_torture_reader");
 732	return 0;
 733}
 734
 735/*
 736 * Create an lock-torture-statistics message in the specified buffer.
 737 */
 738static void __torture_print_stats(char *page,
 739				  struct lock_stress_stats *statp, bool write)
 740{
 741	long cur;
 742	bool fail = false;
 743	int i, n_stress;
 744	long max = 0, min = statp ? data_race(statp[0].n_lock_acquired) : 0;
 745	long long sum = 0;
 746
 747	n_stress = write ? cxt.nrealwriters_stress : cxt.nrealreaders_stress;
 748	for (i = 0; i < n_stress; i++) {
 749		if (data_race(statp[i].n_lock_fail))
 750			fail = true;
 751		cur = data_race(statp[i].n_lock_acquired);
 752		sum += cur;
 753		if (max < cur)
 754			max = cur;
 755		if (min > cur)
 756			min = cur;
 757	}
 758	page += sprintf(page,
 759			"%s:  Total: %lld  Max/Min: %ld/%ld %s  Fail: %d %s\n",
 760			write ? "Writes" : "Reads ",
 761			sum, max, min,
 762			!onoff_interval && max / 2 > min ? "???" : "",
 763			fail, fail ? "!!!" : "");
 764	if (fail)
 765		atomic_inc(&cxt.n_lock_torture_errors);
 766}
 767
 768/*
 769 * Print torture statistics.  Caller must ensure that there is only one
 770 * call to this function at a given time!!!  This is normally accomplished
 771 * by relying on the module system to only have one copy of the module
 772 * loaded, and then by giving the lock_torture_stats kthread full control
 773 * (or the init/cleanup functions when lock_torture_stats thread is not
 774 * running).
 775 */
 776static void lock_torture_stats_print(void)
 777{
 778	int size = cxt.nrealwriters_stress * 200 + 8192;
 779	char *buf;
 780
 781	if (cxt.cur_ops->readlock)
 782		size += cxt.nrealreaders_stress * 200 + 8192;
 783
 784	buf = kmalloc(size, GFP_KERNEL);
 785	if (!buf) {
 786		pr_err("lock_torture_stats_print: Out of memory, need: %d",
 787		       size);
 788		return;
 789	}
 790
 791	__torture_print_stats(buf, cxt.lwsa, true);
 792	pr_alert("%s", buf);
 793	kfree(buf);
 794
 795	if (cxt.cur_ops->readlock) {
 796		buf = kmalloc(size, GFP_KERNEL);
 797		if (!buf) {
 798			pr_err("lock_torture_stats_print: Out of memory, need: %d",
 799			       size);
 800			return;
 801		}
 802
 803		__torture_print_stats(buf, cxt.lrsa, false);
 804		pr_alert("%s", buf);
 805		kfree(buf);
 806	}
 807}
 808
 809/*
 810 * Periodically prints torture statistics, if periodic statistics printing
 811 * was specified via the stat_interval module parameter.
 812 *
 813 * No need to worry about fullstop here, since this one doesn't reference
 814 * volatile state or register callbacks.
 815 */
 816static int lock_torture_stats(void *arg)
 817{
 818	VERBOSE_TOROUT_STRING("lock_torture_stats task started");
 819	do {
 820		schedule_timeout_interruptible(stat_interval * HZ);
 821		lock_torture_stats_print();
 822		torture_shutdown_absorb("lock_torture_stats");
 823	} while (!torture_must_stop());
 824	torture_kthread_stopping("lock_torture_stats");
 825	return 0;
 826}
 827
 828static inline void
 829lock_torture_print_module_parms(struct lock_torture_ops *cur_ops,
 830				const char *tag)
 831{
 832	pr_alert("%s" TORTURE_FLAG
 833		 "--- %s%s: nwriters_stress=%d nreaders_stress=%d stat_interval=%d verbose=%d shuffle_interval=%d stutter=%d shutdown_secs=%d onoff_interval=%d onoff_holdoff=%d\n",
 834		 torture_type, tag, cxt.debug_lock ? " [debug]": "",
 835		 cxt.nrealwriters_stress, cxt.nrealreaders_stress, stat_interval,
 836		 verbose, shuffle_interval, stutter, shutdown_secs,
 837		 onoff_interval, onoff_holdoff);
 838}
 839
 840static void lock_torture_cleanup(void)
 841{
 842	int i;
 843
 844	if (torture_cleanup_begin())
 845		return;
 846
 847	/*
 848	 * Indicates early cleanup, meaning that the test has not run,
 849	 * such as when passing bogus args when loading the module.
 850	 * However cxt->cur_ops.init() may have been invoked, so beside
 851	 * perform the underlying torture-specific cleanups, cur_ops.exit()
 852	 * will be invoked if needed.
 853	 */
 854	if (!cxt.lwsa && !cxt.lrsa)
 855		goto end;
 856
 857	if (writer_tasks) {
 858		for (i = 0; i < cxt.nrealwriters_stress; i++)
 859			torture_stop_kthread(lock_torture_writer,
 860					     writer_tasks[i]);
 861		kfree(writer_tasks);
 862		writer_tasks = NULL;
 863	}
 864
 865	if (reader_tasks) {
 866		for (i = 0; i < cxt.nrealreaders_stress; i++)
 867			torture_stop_kthread(lock_torture_reader,
 868					     reader_tasks[i]);
 869		kfree(reader_tasks);
 870		reader_tasks = NULL;
 871	}
 872
 873	torture_stop_kthread(lock_torture_stats, stats_task);
 874	lock_torture_stats_print();  /* -After- the stats thread is stopped! */
 875
 876	if (atomic_read(&cxt.n_lock_torture_errors))
 877		lock_torture_print_module_parms(cxt.cur_ops,
 878						"End of test: FAILURE");
 879	else if (torture_onoff_failures())
 880		lock_torture_print_module_parms(cxt.cur_ops,
 881						"End of test: LOCK_HOTPLUG");
 882	else
 883		lock_torture_print_module_parms(cxt.cur_ops,
 884						"End of test: SUCCESS");
 885
 886	kfree(cxt.lwsa);
 887	cxt.lwsa = NULL;
 888	kfree(cxt.lrsa);
 889	cxt.lrsa = NULL;
 890
 891end:
 892	if (cxt.init_called) {
 893		if (cxt.cur_ops->exit)
 894			cxt.cur_ops->exit();
 895		cxt.init_called = false;
 896	}
 897	torture_cleanup_end();
 898}
 899
 900static int __init lock_torture_init(void)
 901{
 902	int i, j;
 903	int firsterr = 0;
 904	static struct lock_torture_ops *torture_ops[] = {
 905		&lock_busted_ops,
 906		&spin_lock_ops, &spin_lock_irq_ops,
 907		&rw_lock_ops, &rw_lock_irq_ops,
 908		&mutex_lock_ops,
 909		&ww_mutex_lock_ops,
 910#ifdef CONFIG_RT_MUTEXES
 911		&rtmutex_lock_ops,
 912#endif
 913		&rwsem_lock_ops,
 914		&percpu_rwsem_lock_ops,
 915	};
 916
 917	if (!torture_init_begin(torture_type, verbose))
 918		return -EBUSY;
 919
 920	/* Process args and tell the world that the torturer is on the job. */
 921	for (i = 0; i < ARRAY_SIZE(torture_ops); i++) {
 922		cxt.cur_ops = torture_ops[i];
 923		if (strcmp(torture_type, cxt.cur_ops->name) == 0)
 924			break;
 925	}
 926	if (i == ARRAY_SIZE(torture_ops)) {
 927		pr_alert("lock-torture: invalid torture type: \"%s\"\n",
 928			 torture_type);
 929		pr_alert("lock-torture types:");
 930		for (i = 0; i < ARRAY_SIZE(torture_ops); i++)
 931			pr_alert(" %s", torture_ops[i]->name);
 932		pr_alert("\n");
 933		firsterr = -EINVAL;
 934		goto unwind;
 935	}
 936
 937	if (nwriters_stress == 0 &&
 938	    (!cxt.cur_ops->readlock || nreaders_stress == 0)) {
 939		pr_alert("lock-torture: must run at least one locking thread\n");
 940		firsterr = -EINVAL;
 941		goto unwind;
 942	}
 943
 944	if (nwriters_stress >= 0)
 945		cxt.nrealwriters_stress = nwriters_stress;
 946	else
 947		cxt.nrealwriters_stress = 2 * num_online_cpus();
 948
 949	if (cxt.cur_ops->init) {
 950		cxt.cur_ops->init();
 951		cxt.init_called = true;
 952	}
 953
 954#ifdef CONFIG_DEBUG_MUTEXES
 955	if (str_has_prefix(torture_type, "mutex"))
 956		cxt.debug_lock = true;
 957#endif
 958#ifdef CONFIG_DEBUG_RT_MUTEXES
 959	if (str_has_prefix(torture_type, "rtmutex"))
 960		cxt.debug_lock = true;
 961#endif
 962#ifdef CONFIG_DEBUG_SPINLOCK
 963	if ((str_has_prefix(torture_type, "spin")) ||
 964	    (str_has_prefix(torture_type, "rw_lock")))
 965		cxt.debug_lock = true;
 966#endif
 967
 968	/* Initialize the statistics so that each run gets its own numbers. */
 969	if (nwriters_stress) {
 970		lock_is_write_held = false;
 971		cxt.lwsa = kmalloc_array(cxt.nrealwriters_stress,
 972					 sizeof(*cxt.lwsa),
 973					 GFP_KERNEL);
 974		if (cxt.lwsa == NULL) {
 975			VERBOSE_TOROUT_STRING("cxt.lwsa: Out of memory");
 976			firsterr = -ENOMEM;
 977			goto unwind;
 978		}
 979
 980		for (i = 0; i < cxt.nrealwriters_stress; i++) {
 981			cxt.lwsa[i].n_lock_fail = 0;
 982			cxt.lwsa[i].n_lock_acquired = 0;
 983		}
 984	}
 985
 986	if (cxt.cur_ops->readlock) {
 987		if (nreaders_stress >= 0)
 988			cxt.nrealreaders_stress = nreaders_stress;
 989		else {
 990			/*
 991			 * By default distribute evenly the number of
 992			 * readers and writers. We still run the same number
 993			 * of threads as the writer-only locks default.
 994			 */
 995			if (nwriters_stress < 0) /* user doesn't care */
 996				cxt.nrealwriters_stress = num_online_cpus();
 997			cxt.nrealreaders_stress = cxt.nrealwriters_stress;
 998		}
 999
1000		if (nreaders_stress) {
1001			cxt.lrsa = kmalloc_array(cxt.nrealreaders_stress,
1002						 sizeof(*cxt.lrsa),
1003						 GFP_KERNEL);
1004			if (cxt.lrsa == NULL) {
1005				VERBOSE_TOROUT_STRING("cxt.lrsa: Out of memory");
1006				firsterr = -ENOMEM;
1007				kfree(cxt.lwsa);
1008				cxt.lwsa = NULL;
1009				goto unwind;
1010			}
1011
1012			for (i = 0; i < cxt.nrealreaders_stress; i++) {
1013				cxt.lrsa[i].n_lock_fail = 0;
1014				cxt.lrsa[i].n_lock_acquired = 0;
1015			}
1016		}
1017	}
1018
1019	lock_torture_print_module_parms(cxt.cur_ops, "Start of test");
1020
1021	/* Prepare torture context. */
1022	if (onoff_interval > 0) {
1023		firsterr = torture_onoff_init(onoff_holdoff * HZ,
1024					      onoff_interval * HZ, NULL);
1025		if (torture_init_error(firsterr))
1026			goto unwind;
1027	}
1028	if (shuffle_interval > 0) {
1029		firsterr = torture_shuffle_init(shuffle_interval);
1030		if (torture_init_error(firsterr))
1031			goto unwind;
1032	}
1033	if (shutdown_secs > 0) {
1034		firsterr = torture_shutdown_init(shutdown_secs,
1035						 lock_torture_cleanup);
1036		if (torture_init_error(firsterr))
1037			goto unwind;
1038	}
1039	if (stutter > 0) {
1040		firsterr = torture_stutter_init(stutter, stutter);
1041		if (torture_init_error(firsterr))
1042			goto unwind;
1043	}
1044
1045	if (nwriters_stress) {
1046		writer_tasks = kcalloc(cxt.nrealwriters_stress,
1047				       sizeof(writer_tasks[0]),
1048				       GFP_KERNEL);
1049		if (writer_tasks == NULL) {
1050			TOROUT_ERRSTRING("writer_tasks: Out of memory");
1051			firsterr = -ENOMEM;
1052			goto unwind;
1053		}
1054	}
1055
1056	if (cxt.cur_ops->readlock) {
1057		reader_tasks = kcalloc(cxt.nrealreaders_stress,
1058				       sizeof(reader_tasks[0]),
1059				       GFP_KERNEL);
1060		if (reader_tasks == NULL) {
1061			TOROUT_ERRSTRING("reader_tasks: Out of memory");
1062			kfree(writer_tasks);
1063			writer_tasks = NULL;
1064			firsterr = -ENOMEM;
1065			goto unwind;
1066		}
1067	}
1068
1069	/*
1070	 * Create the kthreads and start torturing (oh, those poor little locks).
1071	 *
1072	 * TODO: Note that we interleave writers with readers, giving writers a
1073	 * slight advantage, by creating its kthread first. This can be modified
1074	 * for very specific needs, or even let the user choose the policy, if
1075	 * ever wanted.
1076	 */
1077	for (i = 0, j = 0; i < cxt.nrealwriters_stress ||
1078		    j < cxt.nrealreaders_stress; i++, j++) {
1079		if (i >= cxt.nrealwriters_stress)
1080			goto create_reader;
1081
1082		/* Create writer. */
1083		firsterr = torture_create_kthread(lock_torture_writer, &cxt.lwsa[i],
1084						  writer_tasks[i]);
1085		if (torture_init_error(firsterr))
1086			goto unwind;
1087
1088	create_reader:
1089		if (cxt.cur_ops->readlock == NULL || (j >= cxt.nrealreaders_stress))
1090			continue;
1091		/* Create reader. */
1092		firsterr = torture_create_kthread(lock_torture_reader, &cxt.lrsa[j],
1093						  reader_tasks[j]);
1094		if (torture_init_error(firsterr))
1095			goto unwind;
1096	}
1097	if (stat_interval > 0) {
1098		firsterr = torture_create_kthread(lock_torture_stats, NULL,
1099						  stats_task);
1100		if (torture_init_error(firsterr))
1101			goto unwind;
1102	}
1103	torture_init_end();
1104	return 0;
1105
1106unwind:
1107	torture_init_end();
1108	lock_torture_cleanup();
1109	if (shutdown_secs) {
1110		WARN_ON(!IS_MODULE(CONFIG_LOCK_TORTURE_TEST));
1111		kernel_power_off();
1112	}
1113	return firsterr;
1114}
1115
1116module_init(lock_torture_init);
1117module_exit(lock_torture_cleanup);