Linux Audio

Check our new training course

Loading...
v6.9.4
   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, acq_writer_lim, 0, "Write_acquisition time limit (jiffies).");
  37torture_param(int, call_rcu_chains, 0, "Self-propagate call_rcu() chains during test (0=disable).");
  38torture_param(int, long_hold, 100, "Do occasional long hold of lock (ms), 0=disable");
  39torture_param(int, nested_locks, 0, "Number of nested locks (max = 8)");
  40torture_param(int, nreaders_stress, -1, "Number of read-locking stress-test threads");
  41torture_param(int, nwriters_stress, -1, "Number of write-locking stress-test threads");
  42torture_param(int, onoff_holdoff, 0, "Time after boot before CPU hotplugs (s)");
  43torture_param(int, onoff_interval, 0, "Time between CPU hotplugs (s), 0=disable");
  44torture_param(int, rt_boost, 2,
  45		   "Do periodic rt-boost. 0=Disable, 1=Only for rt_mutex, 2=For all lock types.");
  46torture_param(int, rt_boost_factor, 50, "A factor determining how often rt-boost happens.");
  47torture_param(int, shuffle_interval, 3, "Number of jiffies between shuffles, 0=disable");
  48torture_param(int, shutdown_secs, 0, "Shutdown time (j), <= zero to disable.");
  49torture_param(int, stat_interval, 60, "Number of seconds between stats printk()s");
 
  50torture_param(int, stutter, 5, "Number of jiffies to run/halt test, 0=disable");
  51torture_param(int, verbose, 1, "Enable verbose debugging printk()s");
  52torture_param(int, writer_fifo, 0, "Run writers at sched_set_fifo() priority");
  53/* Going much higher trips "BUG: MAX_LOCKDEP_CHAIN_HLOCKS too low!" errors */
  54#define MAX_NESTED_LOCKS 8
  55
  56static char *torture_type = IS_ENABLED(CONFIG_PREEMPT_RT) ? "raw_spin_lock" : "spin_lock";
  57module_param(torture_type, charp, 0444);
  58MODULE_PARM_DESC(torture_type,
  59		 "Type of lock to torture (spin_lock, spin_lock_irq, mutex_lock, ...)");
  60
  61static cpumask_var_t bind_readers; // Bind the readers to the specified set of CPUs.
  62static cpumask_var_t bind_writers; // Bind the writers to the specified set of CPUs.
  63
  64// Parse a cpumask kernel parameter.  If there are more users later on,
  65// this might need to got to a more central location.
  66static int param_set_cpumask(const char *val, const struct kernel_param *kp)
  67{
  68	cpumask_var_t *cm_bind = kp->arg;
  69	int ret;
  70	char *s;
  71
  72	if (!alloc_cpumask_var(cm_bind, GFP_KERNEL)) {
  73		s = "Out of memory";
  74		ret = -ENOMEM;
  75		goto out_err;
  76	}
  77	ret = cpulist_parse(val, *cm_bind);
  78	if (!ret)
  79		return ret;
  80	s = "Bad CPU range";
  81out_err:
  82	pr_warn("%s: %s, all CPUs set\n", kp->name, s);
  83	cpumask_setall(*cm_bind);
  84	return ret;
  85}
  86
  87// Output a cpumask kernel parameter.
  88static int param_get_cpumask(char *buffer, const struct kernel_param *kp)
  89{
  90	cpumask_var_t *cm_bind = kp->arg;
  91
  92	return sprintf(buffer, "%*pbl", cpumask_pr_args(*cm_bind));
  93}
  94
  95static bool cpumask_nonempty(cpumask_var_t mask)
  96{
  97	return cpumask_available(mask) && !cpumask_empty(mask);
  98}
  99
 100static const struct kernel_param_ops lt_bind_ops = {
 101	.set = param_set_cpumask,
 102	.get = param_get_cpumask,
 103};
 104
 105module_param_cb(bind_readers, &lt_bind_ops, &bind_readers, 0644);
 106module_param_cb(bind_writers, &lt_bind_ops, &bind_writers, 0644);
 107
 108long torture_sched_setaffinity(pid_t pid, const struct cpumask *in_mask);
 109
 110static struct task_struct *stats_task;
 111static struct task_struct **writer_tasks;
 112static struct task_struct **reader_tasks;
 113
 114static bool lock_is_write_held;
 115static atomic_t lock_is_read_held;
 116static unsigned long last_lock_release;
 117
 118struct lock_stress_stats {
 119	long n_lock_fail;
 120	long n_lock_acquired;
 121};
 122
 123struct call_rcu_chain {
 124	struct rcu_head crc_rh;
 125	bool crc_stop;
 126};
 127struct call_rcu_chain *call_rcu_chain_list;
 
 
 
 128
 129/* Forward reference. */
 130static void lock_torture_cleanup(void);
 131
 132/*
 133 * Operations vector for selecting different types of tests.
 134 */
 135struct lock_torture_ops {
 136	void (*init)(void);
 137	void (*exit)(void);
 138	int (*nested_lock)(int tid, u32 lockset);
 139	int (*writelock)(int tid);
 140	void (*write_delay)(struct torture_random_state *trsp);
 141	void (*task_boost)(struct torture_random_state *trsp);
 142	void (*writeunlock)(int tid);
 143	void (*nested_unlock)(int tid, u32 lockset);
 144	int (*readlock)(int tid);
 145	void (*read_delay)(struct torture_random_state *trsp);
 146	void (*readunlock)(int tid);
 147
 148	unsigned long flags; /* for irq spinlocks */
 149	const char *name;
 150};
 151
 152struct lock_torture_cxt {
 153	int nrealwriters_stress;
 154	int nrealreaders_stress;
 155	bool debug_lock;
 156	bool init_called;
 157	atomic_t n_lock_torture_errors;
 158	struct lock_torture_ops *cur_ops;
 159	struct lock_stress_stats *lwsa; /* writer statistics */
 160	struct lock_stress_stats *lrsa; /* reader statistics */
 161};
 162static struct lock_torture_cxt cxt = { 0, 0, false, false,
 163				       ATOMIC_INIT(0),
 164				       NULL, NULL};
 165/*
 166 * Definitions for lock torture testing.
 167 */
 168
 169static int torture_lock_busted_write_lock(int tid __maybe_unused)
 170{
 171	return 0;  /* BUGGY, do not use in real life!!! */
 172}
 173
 174static void torture_lock_busted_write_delay(struct torture_random_state *trsp)
 175{
 
 
 176	/* We want a long delay occasionally to force massive contention.  */
 177	if (long_hold && !(torture_random(trsp) % (cxt.nrealwriters_stress * 2000 * long_hold)))
 178		mdelay(long_hold);
 
 
 179	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
 180		torture_preempt_schedule();  /* Allow test to be preempted. */
 
 181}
 182
 183static void torture_lock_busted_write_unlock(int tid __maybe_unused)
 184{
 185	  /* BUGGY, do not use in real life!!! */
 186}
 187
 188static void __torture_rt_boost(struct torture_random_state *trsp)
 189{
 190	const unsigned int factor = rt_boost_factor;
 191
 192	if (!rt_task(current)) {
 193		/*
 194		 * Boost priority once every rt_boost_factor operations. When
 195		 * the task tries to take the lock, the rtmutex it will account
 196		 * for the new priority, and do any corresponding pi-dance.
 197		 */
 198		if (trsp && !(torture_random(trsp) %
 199			      (cxt.nrealwriters_stress * factor))) {
 200			sched_set_fifo(current);
 201		} else /* common case, do nothing */
 202			return;
 203	} else {
 204		/*
 205		 * The task will remain boosted for another 10 * rt_boost_factor
 206		 * operations, then restored back to its original prio, and so
 207		 * forth.
 208		 *
 209		 * When @trsp is nil, we want to force-reset the task for
 210		 * stopping the kthread.
 211		 */
 212		if (!trsp || !(torture_random(trsp) %
 213			       (cxt.nrealwriters_stress * factor * 2))) {
 214			sched_set_normal(current, 0);
 215		} else /* common case, do nothing */
 216			return;
 217	}
 218}
 219
 220static void torture_rt_boost(struct torture_random_state *trsp)
 221{
 222	if (rt_boost != 2)
 223		return;
 224
 225	__torture_rt_boost(trsp);
 226}
 227
 228static struct lock_torture_ops lock_busted_ops = {
 229	.writelock	= torture_lock_busted_write_lock,
 230	.write_delay	= torture_lock_busted_write_delay,
 231	.task_boost     = torture_rt_boost,
 232	.writeunlock	= torture_lock_busted_write_unlock,
 233	.readlock       = NULL,
 234	.read_delay     = NULL,
 235	.readunlock     = NULL,
 236	.name		= "lock_busted"
 237};
 238
 239static DEFINE_SPINLOCK(torture_spinlock);
 240
 241static int torture_spin_lock_write_lock(int tid __maybe_unused)
 242__acquires(torture_spinlock)
 243{
 244	spin_lock(&torture_spinlock);
 245	return 0;
 246}
 247
 248static void torture_spin_lock_write_delay(struct torture_random_state *trsp)
 249{
 250	const unsigned long shortdelay_us = 2;
 251	unsigned long j;
 252
 253	/* We want a short delay mostly to emulate likely code, and
 254	 * we want a long delay occasionally to force massive contention.
 255	 */
 256	if (long_hold && !(torture_random(trsp) % (cxt.nrealwriters_stress * 2000 * long_hold))) {
 257		j = jiffies;
 258		mdelay(long_hold);
 259		pr_alert("%s: delay = %lu jiffies.\n", __func__, jiffies - j);
 260	}
 261	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 200 * shortdelay_us)))
 262		udelay(shortdelay_us);
 
 263	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
 264		torture_preempt_schedule();  /* Allow test to be preempted. */
 
 265}
 266
 267static void torture_spin_lock_write_unlock(int tid __maybe_unused)
 268__releases(torture_spinlock)
 269{
 270	spin_unlock(&torture_spinlock);
 271}
 272
 273static struct lock_torture_ops spin_lock_ops = {
 274	.writelock	= torture_spin_lock_write_lock,
 275	.write_delay	= torture_spin_lock_write_delay,
 276	.task_boost     = torture_rt_boost,
 277	.writeunlock	= torture_spin_lock_write_unlock,
 278	.readlock       = NULL,
 279	.read_delay     = NULL,
 280	.readunlock     = NULL,
 281	.name		= "spin_lock"
 282};
 283
 284static int torture_spin_lock_write_lock_irq(int tid __maybe_unused)
 285__acquires(torture_spinlock)
 286{
 287	unsigned long flags;
 288
 289	spin_lock_irqsave(&torture_spinlock, flags);
 290	cxt.cur_ops->flags = flags;
 291	return 0;
 292}
 293
 294static void torture_lock_spin_write_unlock_irq(int tid __maybe_unused)
 295__releases(torture_spinlock)
 296{
 297	spin_unlock_irqrestore(&torture_spinlock, cxt.cur_ops->flags);
 298}
 299
 300static struct lock_torture_ops spin_lock_irq_ops = {
 301	.writelock	= torture_spin_lock_write_lock_irq,
 302	.write_delay	= torture_spin_lock_write_delay,
 303	.task_boost     = torture_rt_boost,
 304	.writeunlock	= torture_lock_spin_write_unlock_irq,
 305	.readlock       = NULL,
 306	.read_delay     = NULL,
 307	.readunlock     = NULL,
 308	.name		= "spin_lock_irq"
 309};
 310
 311static DEFINE_RAW_SPINLOCK(torture_raw_spinlock);
 312
 313static int torture_raw_spin_lock_write_lock(int tid __maybe_unused)
 314__acquires(torture_raw_spinlock)
 315{
 316	raw_spin_lock(&torture_raw_spinlock);
 317	return 0;
 318}
 319
 320static void torture_raw_spin_lock_write_unlock(int tid __maybe_unused)
 321__releases(torture_raw_spinlock)
 322{
 323	raw_spin_unlock(&torture_raw_spinlock);
 324}
 325
 326static struct lock_torture_ops raw_spin_lock_ops = {
 327	.writelock	= torture_raw_spin_lock_write_lock,
 328	.write_delay	= torture_spin_lock_write_delay,
 329	.task_boost	= torture_rt_boost,
 330	.writeunlock	= torture_raw_spin_lock_write_unlock,
 331	.readlock	= NULL,
 332	.read_delay	= NULL,
 333	.readunlock	= NULL,
 334	.name		= "raw_spin_lock"
 335};
 336
 337static int torture_raw_spin_lock_write_lock_irq(int tid __maybe_unused)
 338__acquires(torture_raw_spinlock)
 339{
 340	unsigned long flags;
 341
 342	raw_spin_lock_irqsave(&torture_raw_spinlock, flags);
 343	cxt.cur_ops->flags = flags;
 344	return 0;
 345}
 346
 347static void torture_raw_spin_lock_write_unlock_irq(int tid __maybe_unused)
 348__releases(torture_raw_spinlock)
 349{
 350	raw_spin_unlock_irqrestore(&torture_raw_spinlock, cxt.cur_ops->flags);
 351}
 352
 353static struct lock_torture_ops raw_spin_lock_irq_ops = {
 354	.writelock	= torture_raw_spin_lock_write_lock_irq,
 355	.write_delay	= torture_spin_lock_write_delay,
 356	.task_boost	= torture_rt_boost,
 357	.writeunlock	= torture_raw_spin_lock_write_unlock_irq,
 358	.readlock	= NULL,
 359	.read_delay	= NULL,
 360	.readunlock	= NULL,
 361	.name		= "raw_spin_lock_irq"
 362};
 363
 364static DEFINE_RWLOCK(torture_rwlock);
 365
 366static int torture_rwlock_write_lock(int tid __maybe_unused)
 367__acquires(torture_rwlock)
 368{
 369	write_lock(&torture_rwlock);
 370	return 0;
 371}
 372
 373static void torture_rwlock_write_delay(struct torture_random_state *trsp)
 374{
 375	const unsigned long shortdelay_us = 2;
 
 376
 377	/* We want a short delay mostly to emulate likely code, and
 378	 * we want a long delay occasionally to force massive contention.
 379	 */
 380	if (long_hold && !(torture_random(trsp) % (cxt.nrealwriters_stress * 2000 * long_hold)))
 381		mdelay(long_hold);
 
 382	else
 383		udelay(shortdelay_us);
 384}
 385
 386static void torture_rwlock_write_unlock(int tid __maybe_unused)
 387__releases(torture_rwlock)
 388{
 389	write_unlock(&torture_rwlock);
 390}
 391
 392static int torture_rwlock_read_lock(int tid __maybe_unused)
 393__acquires(torture_rwlock)
 394{
 395	read_lock(&torture_rwlock);
 396	return 0;
 397}
 398
 399static void torture_rwlock_read_delay(struct torture_random_state *trsp)
 400{
 401	const unsigned long shortdelay_us = 10;
 
 402
 403	/* We want a short delay mostly to emulate likely code, and
 404	 * we want a long delay occasionally to force massive contention.
 405	 */
 406	if (long_hold && !(torture_random(trsp) % (cxt.nrealreaders_stress * 2000 * long_hold)))
 407		mdelay(long_hold);
 
 408	else
 409		udelay(shortdelay_us);
 410}
 411
 412static void torture_rwlock_read_unlock(int tid __maybe_unused)
 413__releases(torture_rwlock)
 414{
 415	read_unlock(&torture_rwlock);
 416}
 417
 418static struct lock_torture_ops rw_lock_ops = {
 419	.writelock	= torture_rwlock_write_lock,
 420	.write_delay	= torture_rwlock_write_delay,
 421	.task_boost     = torture_rt_boost,
 422	.writeunlock	= torture_rwlock_write_unlock,
 423	.readlock       = torture_rwlock_read_lock,
 424	.read_delay     = torture_rwlock_read_delay,
 425	.readunlock     = torture_rwlock_read_unlock,
 426	.name		= "rw_lock"
 427};
 428
 429static int torture_rwlock_write_lock_irq(int tid __maybe_unused)
 430__acquires(torture_rwlock)
 431{
 432	unsigned long flags;
 433
 434	write_lock_irqsave(&torture_rwlock, flags);
 435	cxt.cur_ops->flags = flags;
 436	return 0;
 437}
 438
 439static void torture_rwlock_write_unlock_irq(int tid __maybe_unused)
 440__releases(torture_rwlock)
 441{
 442	write_unlock_irqrestore(&torture_rwlock, cxt.cur_ops->flags);
 443}
 444
 445static int torture_rwlock_read_lock_irq(int tid __maybe_unused)
 446__acquires(torture_rwlock)
 447{
 448	unsigned long flags;
 449
 450	read_lock_irqsave(&torture_rwlock, flags);
 451	cxt.cur_ops->flags = flags;
 452	return 0;
 453}
 454
 455static void torture_rwlock_read_unlock_irq(int tid __maybe_unused)
 456__releases(torture_rwlock)
 457{
 458	read_unlock_irqrestore(&torture_rwlock, cxt.cur_ops->flags);
 459}
 460
 461static struct lock_torture_ops rw_lock_irq_ops = {
 462	.writelock	= torture_rwlock_write_lock_irq,
 463	.write_delay	= torture_rwlock_write_delay,
 464	.task_boost     = torture_rt_boost,
 465	.writeunlock	= torture_rwlock_write_unlock_irq,
 466	.readlock       = torture_rwlock_read_lock_irq,
 467	.read_delay     = torture_rwlock_read_delay,
 468	.readunlock     = torture_rwlock_read_unlock_irq,
 469	.name		= "rw_lock_irq"
 470};
 471
 472static DEFINE_MUTEX(torture_mutex);
 473static struct mutex torture_nested_mutexes[MAX_NESTED_LOCKS];
 474static struct lock_class_key nested_mutex_keys[MAX_NESTED_LOCKS];
 475
 476static void torture_mutex_init(void)
 477{
 478	int i;
 479
 480	for (i = 0; i < MAX_NESTED_LOCKS; i++)
 481		__mutex_init(&torture_nested_mutexes[i], __func__,
 482			     &nested_mutex_keys[i]);
 483}
 484
 485static int torture_mutex_nested_lock(int tid __maybe_unused,
 486				     u32 lockset)
 487{
 488	int i;
 489
 490	for (i = 0; i < nested_locks; i++)
 491		if (lockset & (1 << i))
 492			mutex_lock(&torture_nested_mutexes[i]);
 493	return 0;
 494}
 495
 496static int torture_mutex_lock(int tid __maybe_unused)
 497__acquires(torture_mutex)
 498{
 499	mutex_lock(&torture_mutex);
 500	return 0;
 501}
 502
 503static void torture_mutex_delay(struct torture_random_state *trsp)
 504{
 
 
 505	/* We want a long delay occasionally to force massive contention.  */
 506	if (long_hold && !(torture_random(trsp) % (cxt.nrealwriters_stress * 2000 * long_hold)))
 507		mdelay(long_hold * 5);
 
 
 
 
 508	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
 509		torture_preempt_schedule();  /* Allow test to be preempted. */
 
 510}
 511
 512static void torture_mutex_unlock(int tid __maybe_unused)
 513__releases(torture_mutex)
 514{
 515	mutex_unlock(&torture_mutex);
 516}
 517
 518static void torture_mutex_nested_unlock(int tid __maybe_unused,
 519					u32 lockset)
 520{
 521	int i;
 522
 523	for (i = nested_locks - 1; i >= 0; i--)
 524		if (lockset & (1 << i))
 525			mutex_unlock(&torture_nested_mutexes[i]);
 526}
 527
 528static struct lock_torture_ops mutex_lock_ops = {
 529	.init		= torture_mutex_init,
 530	.nested_lock	= torture_mutex_nested_lock,
 531	.writelock	= torture_mutex_lock,
 532	.write_delay	= torture_mutex_delay,
 533	.task_boost     = torture_rt_boost,
 534	.writeunlock	= torture_mutex_unlock,
 535	.nested_unlock	= torture_mutex_nested_unlock,
 536	.readlock       = NULL,
 537	.read_delay     = NULL,
 538	.readunlock     = NULL,
 539	.name		= "mutex_lock"
 540};
 541
 542#include <linux/ww_mutex.h>
 543/*
 544 * The torture ww_mutexes should belong to the same lock class as
 545 * torture_ww_class to avoid lockdep problem. The ww_mutex_init()
 546 * function is called for initialization to ensure that.
 547 */
 548static DEFINE_WD_CLASS(torture_ww_class);
 549static struct ww_mutex torture_ww_mutex_0, torture_ww_mutex_1, torture_ww_mutex_2;
 550static struct ww_acquire_ctx *ww_acquire_ctxs;
 551
 552static void torture_ww_mutex_init(void)
 553{
 554	ww_mutex_init(&torture_ww_mutex_0, &torture_ww_class);
 555	ww_mutex_init(&torture_ww_mutex_1, &torture_ww_class);
 556	ww_mutex_init(&torture_ww_mutex_2, &torture_ww_class);
 557
 558	ww_acquire_ctxs = kmalloc_array(cxt.nrealwriters_stress,
 559					sizeof(*ww_acquire_ctxs),
 560					GFP_KERNEL);
 561	if (!ww_acquire_ctxs)
 562		VERBOSE_TOROUT_STRING("ww_acquire_ctx: Out of memory");
 563}
 564
 565static void torture_ww_mutex_exit(void)
 566{
 567	kfree(ww_acquire_ctxs);
 568}
 569
 570static int torture_ww_mutex_lock(int tid)
 571__acquires(torture_ww_mutex_0)
 572__acquires(torture_ww_mutex_1)
 573__acquires(torture_ww_mutex_2)
 574{
 575	LIST_HEAD(list);
 576	struct reorder_lock {
 577		struct list_head link;
 578		struct ww_mutex *lock;
 579	} locks[3], *ll, *ln;
 580	struct ww_acquire_ctx *ctx = &ww_acquire_ctxs[tid];
 581
 582	locks[0].lock = &torture_ww_mutex_0;
 583	list_add(&locks[0].link, &list);
 584
 585	locks[1].lock = &torture_ww_mutex_1;
 586	list_add(&locks[1].link, &list);
 587
 588	locks[2].lock = &torture_ww_mutex_2;
 589	list_add(&locks[2].link, &list);
 590
 591	ww_acquire_init(ctx, &torture_ww_class);
 592
 593	list_for_each_entry(ll, &list, link) {
 594		int err;
 595
 596		err = ww_mutex_lock(ll->lock, ctx);
 597		if (!err)
 598			continue;
 599
 600		ln = ll;
 601		list_for_each_entry_continue_reverse(ln, &list, link)
 602			ww_mutex_unlock(ln->lock);
 603
 604		if (err != -EDEADLK)
 605			return err;
 606
 607		ww_mutex_lock_slow(ll->lock, ctx);
 608		list_move(&ll->link, &list);
 609	}
 610
 611	return 0;
 612}
 613
 614static void torture_ww_mutex_unlock(int tid)
 615__releases(torture_ww_mutex_0)
 616__releases(torture_ww_mutex_1)
 617__releases(torture_ww_mutex_2)
 618{
 619	struct ww_acquire_ctx *ctx = &ww_acquire_ctxs[tid];
 620
 621	ww_mutex_unlock(&torture_ww_mutex_0);
 622	ww_mutex_unlock(&torture_ww_mutex_1);
 623	ww_mutex_unlock(&torture_ww_mutex_2);
 624	ww_acquire_fini(ctx);
 625}
 626
 627static struct lock_torture_ops ww_mutex_lock_ops = {
 628	.init		= torture_ww_mutex_init,
 629	.exit		= torture_ww_mutex_exit,
 630	.writelock	= torture_ww_mutex_lock,
 631	.write_delay	= torture_mutex_delay,
 632	.task_boost     = torture_rt_boost,
 633	.writeunlock	= torture_ww_mutex_unlock,
 634	.readlock       = NULL,
 635	.read_delay     = NULL,
 636	.readunlock     = NULL,
 637	.name		= "ww_mutex_lock"
 638};
 639
 640#ifdef CONFIG_RT_MUTEXES
 641static DEFINE_RT_MUTEX(torture_rtmutex);
 642static struct rt_mutex torture_nested_rtmutexes[MAX_NESTED_LOCKS];
 643static struct lock_class_key nested_rtmutex_keys[MAX_NESTED_LOCKS];
 644
 645static void torture_rtmutex_init(void)
 646{
 647	int i;
 648
 649	for (i = 0; i < MAX_NESTED_LOCKS; i++)
 650		__rt_mutex_init(&torture_nested_rtmutexes[i], __func__,
 651				&nested_rtmutex_keys[i]);
 652}
 653
 654static int torture_rtmutex_nested_lock(int tid __maybe_unused,
 655				       u32 lockset)
 656{
 657	int i;
 
 
 658
 659	for (i = 0; i < nested_locks; i++)
 660		if (lockset & (1 << i))
 661			rt_mutex_lock(&torture_nested_rtmutexes[i]);
 662	return 0;
 663}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 664
 665static int torture_rtmutex_lock(int tid __maybe_unused)
 666__acquires(torture_rtmutex)
 667{
 668	rt_mutex_lock(&torture_rtmutex);
 669	return 0;
 670}
 671
 672static void torture_rtmutex_delay(struct torture_random_state *trsp)
 673{
 674	const unsigned long shortdelay_us = 2;
 
 675
 676	/*
 677	 * We want a short delay mostly to emulate likely code, and
 678	 * we want a long delay occasionally to force massive contention.
 679	 */
 680	if (long_hold && !(torture_random(trsp) % (cxt.nrealwriters_stress * 2000 * long_hold)))
 681		mdelay(long_hold);
 682	if (!(torture_random(trsp) %
 683	      (cxt.nrealwriters_stress * 200 * shortdelay_us)))
 
 
 
 684		udelay(shortdelay_us);
 
 685	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
 686		torture_preempt_schedule();  /* Allow test to be preempted. */
 
 687}
 688
 689static void torture_rtmutex_unlock(int tid __maybe_unused)
 690__releases(torture_rtmutex)
 691{
 692	rt_mutex_unlock(&torture_rtmutex);
 693}
 694
 695static void torture_rt_boost_rtmutex(struct torture_random_state *trsp)
 696{
 697	if (!rt_boost)
 698		return;
 699
 700	__torture_rt_boost(trsp);
 701}
 702
 703static void torture_rtmutex_nested_unlock(int tid __maybe_unused,
 704					  u32 lockset)
 705{
 706	int i;
 707
 708	for (i = nested_locks - 1; i >= 0; i--)
 709		if (lockset & (1 << i))
 710			rt_mutex_unlock(&torture_nested_rtmutexes[i]);
 711}
 712
 713static struct lock_torture_ops rtmutex_lock_ops = {
 714	.init		= torture_rtmutex_init,
 715	.nested_lock	= torture_rtmutex_nested_lock,
 716	.writelock	= torture_rtmutex_lock,
 717	.write_delay	= torture_rtmutex_delay,
 718	.task_boost     = torture_rt_boost_rtmutex,
 719	.writeunlock	= torture_rtmutex_unlock,
 720	.nested_unlock	= torture_rtmutex_nested_unlock,
 721	.readlock       = NULL,
 722	.read_delay     = NULL,
 723	.readunlock     = NULL,
 724	.name		= "rtmutex_lock"
 725};
 726#endif
 727
 728static DECLARE_RWSEM(torture_rwsem);
 729static int torture_rwsem_down_write(int tid __maybe_unused)
 730__acquires(torture_rwsem)
 731{
 732	down_write(&torture_rwsem);
 733	return 0;
 734}
 735
 736static void torture_rwsem_write_delay(struct torture_random_state *trsp)
 737{
 
 
 738	/* We want a long delay occasionally to force massive contention.  */
 739	if (long_hold && !(torture_random(trsp) % (cxt.nrealwriters_stress * 2000 * long_hold)))
 740		mdelay(long_hold * 10);
 
 
 
 
 741	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
 742		torture_preempt_schedule();  /* Allow test to be preempted. */
 
 743}
 744
 745static void torture_rwsem_up_write(int tid __maybe_unused)
 746__releases(torture_rwsem)
 747{
 748	up_write(&torture_rwsem);
 749}
 750
 751static int torture_rwsem_down_read(int tid __maybe_unused)
 752__acquires(torture_rwsem)
 753{
 754	down_read(&torture_rwsem);
 755	return 0;
 756}
 757
 758static void torture_rwsem_read_delay(struct torture_random_state *trsp)
 759{
 
 
 760	/* We want a long delay occasionally to force massive contention.  */
 761	if (long_hold && !(torture_random(trsp) % (cxt.nrealreaders_stress * 2000 * long_hold)))
 762		mdelay(long_hold * 2);
 
 763	else
 764		mdelay(long_hold / 2);
 
 765	if (!(torture_random(trsp) % (cxt.nrealreaders_stress * 20000)))
 766		torture_preempt_schedule();  /* Allow test to be preempted. */
 
 767}
 768
 769static void torture_rwsem_up_read(int tid __maybe_unused)
 770__releases(torture_rwsem)
 771{
 772	up_read(&torture_rwsem);
 773}
 774
 775static struct lock_torture_ops rwsem_lock_ops = {
 776	.writelock	= torture_rwsem_down_write,
 777	.write_delay	= torture_rwsem_write_delay,
 778	.task_boost     = torture_rt_boost,
 779	.writeunlock	= torture_rwsem_up_write,
 780	.readlock       = torture_rwsem_down_read,
 781	.read_delay     = torture_rwsem_read_delay,
 782	.readunlock     = torture_rwsem_up_read,
 783	.name		= "rwsem_lock"
 784};
 785
 786#include <linux/percpu-rwsem.h>
 787static struct percpu_rw_semaphore pcpu_rwsem;
 788
 789static void torture_percpu_rwsem_init(void)
 790{
 791	BUG_ON(percpu_init_rwsem(&pcpu_rwsem));
 792}
 793
 794static void torture_percpu_rwsem_exit(void)
 795{
 796	percpu_free_rwsem(&pcpu_rwsem);
 797}
 798
 799static int torture_percpu_rwsem_down_write(int tid __maybe_unused)
 800__acquires(pcpu_rwsem)
 801{
 802	percpu_down_write(&pcpu_rwsem);
 803	return 0;
 804}
 805
 806static void torture_percpu_rwsem_up_write(int tid __maybe_unused)
 807__releases(pcpu_rwsem)
 808{
 809	percpu_up_write(&pcpu_rwsem);
 810}
 811
 812static int torture_percpu_rwsem_down_read(int tid __maybe_unused)
 813__acquires(pcpu_rwsem)
 814{
 815	percpu_down_read(&pcpu_rwsem);
 816	return 0;
 817}
 818
 819static void torture_percpu_rwsem_up_read(int tid __maybe_unused)
 820__releases(pcpu_rwsem)
 821{
 822	percpu_up_read(&pcpu_rwsem);
 823}
 824
 825static struct lock_torture_ops percpu_rwsem_lock_ops = {
 826	.init		= torture_percpu_rwsem_init,
 827	.exit		= torture_percpu_rwsem_exit,
 828	.writelock	= torture_percpu_rwsem_down_write,
 829	.write_delay	= torture_rwsem_write_delay,
 830	.task_boost     = torture_rt_boost,
 831	.writeunlock	= torture_percpu_rwsem_up_write,
 832	.readlock       = torture_percpu_rwsem_down_read,
 833	.read_delay     = torture_rwsem_read_delay,
 834	.readunlock     = torture_percpu_rwsem_up_read,
 835	.name		= "percpu_rwsem_lock"
 836};
 837
 838/*
 839 * Lock torture writer kthread.  Repeatedly acquires and releases
 840 * the lock, checking for duplicate acquisitions.
 841 */
 842static int lock_torture_writer(void *arg)
 843{
 844	unsigned long j;
 845	unsigned long j1;
 846	u32 lockset_mask;
 847	struct lock_stress_stats *lwsp = arg;
 848	DEFINE_TORTURE_RANDOM(rand);
 849	bool skip_main_lock;
 850	int tid = lwsp - cxt.lwsa;
 851
 852	VERBOSE_TOROUT_STRING("lock_torture_writer task started");
 853	if (!rt_task(current))
 854		set_user_nice(current, MAX_NICE);
 855
 856	do {
 857		if ((torture_random(&rand) & 0xfffff) == 0)
 858			schedule_timeout_uninterruptible(1);
 859
 860		lockset_mask = torture_random(&rand);
 861		/*
 862		 * When using nested_locks, we want to occasionally
 863		 * skip the main lock so we can avoid always serializing
 864		 * the lock chains on that central lock. By skipping the
 865		 * main lock occasionally, we can create different
 866		 * contention patterns (allowing for multiple disjoint
 867		 * blocked trees)
 868		 */
 869		skip_main_lock = (nested_locks &&
 870				 !(torture_random(&rand) % 100));
 871
 872		cxt.cur_ops->task_boost(&rand);
 873		if (cxt.cur_ops->nested_lock)
 874			cxt.cur_ops->nested_lock(tid, lockset_mask);
 875
 876		if (!skip_main_lock) {
 877			if (acq_writer_lim > 0)
 878				j = jiffies;
 879			cxt.cur_ops->writelock(tid);
 880			if (WARN_ON_ONCE(lock_is_write_held))
 881				lwsp->n_lock_fail++;
 882			lock_is_write_held = true;
 883			if (WARN_ON_ONCE(atomic_read(&lock_is_read_held)))
 884				lwsp->n_lock_fail++; /* rare, but... */
 885			if (acq_writer_lim > 0) {
 886				j1 = jiffies;
 887				WARN_ONCE(time_after(j1, j + acq_writer_lim),
 888					  "%s: Lock acquisition took %lu jiffies.\n",
 889					  __func__, j1 - j);
 890			}
 891			lwsp->n_lock_acquired++;
 892
 893			cxt.cur_ops->write_delay(&rand);
 894
 895			lock_is_write_held = false;
 896			WRITE_ONCE(last_lock_release, jiffies);
 897			cxt.cur_ops->writeunlock(tid);
 898		}
 899		if (cxt.cur_ops->nested_unlock)
 900			cxt.cur_ops->nested_unlock(tid, lockset_mask);
 901
 902		stutter_wait("lock_torture_writer");
 903	} while (!torture_must_stop());
 904
 905	cxt.cur_ops->task_boost(NULL); /* reset prio */
 906	torture_kthread_stopping("lock_torture_writer");
 907	return 0;
 908}
 909
 910/*
 911 * Lock torture reader kthread.  Repeatedly acquires and releases
 912 * the reader lock.
 913 */
 914static int lock_torture_reader(void *arg)
 915{
 916	struct lock_stress_stats *lrsp = arg;
 917	int tid = lrsp - cxt.lrsa;
 918	DEFINE_TORTURE_RANDOM(rand);
 919
 920	VERBOSE_TOROUT_STRING("lock_torture_reader task started");
 921	set_user_nice(current, MAX_NICE);
 922
 923	do {
 924		if ((torture_random(&rand) & 0xfffff) == 0)
 925			schedule_timeout_uninterruptible(1);
 926
 927		cxt.cur_ops->readlock(tid);
 928		atomic_inc(&lock_is_read_held);
 929		if (WARN_ON_ONCE(lock_is_write_held))
 930			lrsp->n_lock_fail++; /* rare, but... */
 931
 932		lrsp->n_lock_acquired++;
 933		cxt.cur_ops->read_delay(&rand);
 934		atomic_dec(&lock_is_read_held);
 935		cxt.cur_ops->readunlock(tid);
 936
 937		stutter_wait("lock_torture_reader");
 938	} while (!torture_must_stop());
 939	torture_kthread_stopping("lock_torture_reader");
 940	return 0;
 941}
 942
 943/*
 944 * Create an lock-torture-statistics message in the specified buffer.
 945 */
 946static void __torture_print_stats(char *page,
 947				  struct lock_stress_stats *statp, bool write)
 948{
 949	long cur;
 950	bool fail = false;
 951	int i, n_stress;
 952	long max = 0, min = statp ? data_race(statp[0].n_lock_acquired) : 0;
 
 953	long long sum = 0;
 954
 955	n_stress = write ? cxt.nrealwriters_stress : cxt.nrealreaders_stress;
 956	for (i = 0; i < n_stress; i++) {
 957		if (data_race(statp[i].n_lock_fail))
 958			fail = true;
 959		cur = data_race(statp[i].n_lock_acquired);
 960		sum += cur;
 961		if (max < cur)
 962			max = cur;
 963		if (min > cur)
 964			min = cur;
 965	}
 966	page += sprintf(page,
 967			"%s:  Total: %lld  Max/Min: %ld/%ld %s  Fail: %d %s\n",
 968			write ? "Writes" : "Reads ",
 969			sum, max, min,
 970			!onoff_interval && max / 2 > min ? "???" : "",
 971			fail, fail ? "!!!" : "");
 972	if (fail)
 973		atomic_inc(&cxt.n_lock_torture_errors);
 974}
 975
 976/*
 977 * Print torture statistics.  Caller must ensure that there is only one
 978 * call to this function at a given time!!!  This is normally accomplished
 979 * by relying on the module system to only have one copy of the module
 980 * loaded, and then by giving the lock_torture_stats kthread full control
 981 * (or the init/cleanup functions when lock_torture_stats thread is not
 982 * running).
 983 */
 984static void lock_torture_stats_print(void)
 985{
 986	int size = cxt.nrealwriters_stress * 200 + 8192;
 987	char *buf;
 988
 989	if (cxt.cur_ops->readlock)
 990		size += cxt.nrealreaders_stress * 200 + 8192;
 991
 992	buf = kmalloc(size, GFP_KERNEL);
 993	if (!buf) {
 994		pr_err("lock_torture_stats_print: Out of memory, need: %d",
 995		       size);
 996		return;
 997	}
 998
 999	__torture_print_stats(buf, cxt.lwsa, true);
1000	pr_alert("%s", buf);
1001	kfree(buf);
1002
1003	if (cxt.cur_ops->readlock) {
1004		buf = kmalloc(size, GFP_KERNEL);
1005		if (!buf) {
1006			pr_err("lock_torture_stats_print: Out of memory, need: %d",
1007			       size);
1008			return;
1009		}
1010
1011		__torture_print_stats(buf, cxt.lrsa, false);
1012		pr_alert("%s", buf);
1013		kfree(buf);
1014	}
1015}
1016
1017/*
1018 * Periodically prints torture statistics, if periodic statistics printing
1019 * was specified via the stat_interval module parameter.
1020 *
1021 * No need to worry about fullstop here, since this one doesn't reference
1022 * volatile state or register callbacks.
1023 */
1024static int lock_torture_stats(void *arg)
1025{
1026	VERBOSE_TOROUT_STRING("lock_torture_stats task started");
1027	do {
1028		schedule_timeout_interruptible(stat_interval * HZ);
1029		lock_torture_stats_print();
1030		torture_shutdown_absorb("lock_torture_stats");
1031	} while (!torture_must_stop());
1032	torture_kthread_stopping("lock_torture_stats");
1033	return 0;
1034}
1035
1036
1037static inline void
1038lock_torture_print_module_parms(struct lock_torture_ops *cur_ops,
1039				const char *tag)
1040{
1041	static cpumask_t cpumask_all;
1042	cpumask_t *rcmp = cpumask_nonempty(bind_readers) ? bind_readers : &cpumask_all;
1043	cpumask_t *wcmp = cpumask_nonempty(bind_writers) ? bind_writers : &cpumask_all;
1044
1045	cpumask_setall(&cpumask_all);
1046	pr_alert("%s" TORTURE_FLAG
1047		 "--- %s%s: acq_writer_lim=%d bind_readers=%*pbl bind_writers=%*pbl call_rcu_chains=%d long_hold=%d nested_locks=%d nreaders_stress=%d nwriters_stress=%d onoff_holdoff=%d onoff_interval=%d rt_boost=%d rt_boost_factor=%d shuffle_interval=%d shutdown_secs=%d stat_interval=%d stutter=%d verbose=%d writer_fifo=%d\n",
1048		 torture_type, tag, cxt.debug_lock ? " [debug]": "",
1049		 acq_writer_lim, cpumask_pr_args(rcmp), cpumask_pr_args(wcmp),
1050		 call_rcu_chains, long_hold, nested_locks, cxt.nrealreaders_stress,
1051		 cxt.nrealwriters_stress, onoff_holdoff, onoff_interval, rt_boost,
1052		 rt_boost_factor, shuffle_interval, shutdown_secs, stat_interval, stutter,
1053		 verbose, writer_fifo);
1054}
1055
1056// If requested, maintain call_rcu() chains to keep a grace period always
1057// in flight.  These increase the probability of getting an RCU CPU stall
1058// warning and associated diagnostics when a locking primitive stalls.
1059
1060static void call_rcu_chain_cb(struct rcu_head *rhp)
1061{
1062	struct call_rcu_chain *crcp = container_of(rhp, struct call_rcu_chain, crc_rh);
1063
1064	if (!smp_load_acquire(&crcp->crc_stop)) {
1065		(void)start_poll_synchronize_rcu(); // Start one grace period...
1066		call_rcu(&crcp->crc_rh, call_rcu_chain_cb); // ... and later start another.
1067	}
1068}
1069
1070// Start the requested number of call_rcu() chains.
1071static int call_rcu_chain_init(void)
1072{
1073	int i;
1074
1075	if (call_rcu_chains <= 0)
1076		return 0;
1077	call_rcu_chain_list = kcalloc(call_rcu_chains, sizeof(*call_rcu_chain_list), GFP_KERNEL);
1078	if (!call_rcu_chain_list)
1079		return -ENOMEM;
1080	for (i = 0; i < call_rcu_chains; i++) {
1081		call_rcu_chain_list[i].crc_stop = false;
1082		call_rcu(&call_rcu_chain_list[i].crc_rh, call_rcu_chain_cb);
1083	}
1084	return 0;
1085}
1086
1087// Stop all of the call_rcu() chains.
1088static void call_rcu_chain_cleanup(void)
1089{
1090	int i;
1091
1092	if (!call_rcu_chain_list)
1093		return;
1094	for (i = 0; i < call_rcu_chains; i++)
1095		smp_store_release(&call_rcu_chain_list[i].crc_stop, true);
1096	rcu_barrier();
1097	kfree(call_rcu_chain_list);
1098	call_rcu_chain_list = NULL;
1099}
1100
1101static void lock_torture_cleanup(void)
1102{
1103	int i;
1104
1105	if (torture_cleanup_begin())
1106		return;
1107
1108	/*
1109	 * Indicates early cleanup, meaning that the test has not run,
1110	 * such as when passing bogus args when loading the module.
1111	 * However cxt->cur_ops.init() may have been invoked, so beside
1112	 * perform the underlying torture-specific cleanups, cur_ops.exit()
1113	 * will be invoked if needed.
1114	 */
1115	if (!cxt.lwsa && !cxt.lrsa)
1116		goto end;
1117
1118	if (writer_tasks) {
1119		for (i = 0; i < cxt.nrealwriters_stress; i++)
1120			torture_stop_kthread(lock_torture_writer, writer_tasks[i]);
 
1121		kfree(writer_tasks);
1122		writer_tasks = NULL;
1123	}
1124
1125	if (reader_tasks) {
1126		for (i = 0; i < cxt.nrealreaders_stress; i++)
1127			torture_stop_kthread(lock_torture_reader,
1128					     reader_tasks[i]);
1129		kfree(reader_tasks);
1130		reader_tasks = NULL;
1131	}
1132
1133	torture_stop_kthread(lock_torture_stats, stats_task);
1134	lock_torture_stats_print();  /* -After- the stats thread is stopped! */
1135
1136	if (atomic_read(&cxt.n_lock_torture_errors))
1137		lock_torture_print_module_parms(cxt.cur_ops,
1138						"End of test: FAILURE");
1139	else if (torture_onoff_failures())
1140		lock_torture_print_module_parms(cxt.cur_ops,
1141						"End of test: LOCK_HOTPLUG");
1142	else
1143		lock_torture_print_module_parms(cxt.cur_ops,
1144						"End of test: SUCCESS");
1145
1146	kfree(cxt.lwsa);
1147	cxt.lwsa = NULL;
1148	kfree(cxt.lrsa);
1149	cxt.lrsa = NULL;
1150
1151	call_rcu_chain_cleanup();
1152
1153end:
1154	if (cxt.init_called) {
1155		if (cxt.cur_ops->exit)
1156			cxt.cur_ops->exit();
1157		cxt.init_called = false;
1158	}
1159	torture_cleanup_end();
1160}
1161
1162static int __init lock_torture_init(void)
1163{
1164	int i, j;
1165	int firsterr = 0;
1166	static struct lock_torture_ops *torture_ops[] = {
1167		&lock_busted_ops,
1168		&spin_lock_ops, &spin_lock_irq_ops,
1169		&raw_spin_lock_ops, &raw_spin_lock_irq_ops,
1170		&rw_lock_ops, &rw_lock_irq_ops,
1171		&mutex_lock_ops,
1172		&ww_mutex_lock_ops,
1173#ifdef CONFIG_RT_MUTEXES
1174		&rtmutex_lock_ops,
1175#endif
1176		&rwsem_lock_ops,
1177		&percpu_rwsem_lock_ops,
1178	};
1179
1180	if (!torture_init_begin(torture_type, verbose))
1181		return -EBUSY;
1182
1183	/* Process args and tell the world that the torturer is on the job. */
1184	for (i = 0; i < ARRAY_SIZE(torture_ops); i++) {
1185		cxt.cur_ops = torture_ops[i];
1186		if (strcmp(torture_type, cxt.cur_ops->name) == 0)
1187			break;
1188	}
1189	if (i == ARRAY_SIZE(torture_ops)) {
1190		pr_alert("lock-torture: invalid torture type: \"%s\"\n",
1191			 torture_type);
1192		pr_alert("lock-torture types:");
1193		for (i = 0; i < ARRAY_SIZE(torture_ops); i++)
1194			pr_alert(" %s", torture_ops[i]->name);
1195		pr_alert("\n");
1196		firsterr = -EINVAL;
1197		goto unwind;
1198	}
1199
1200	if (nwriters_stress == 0 &&
1201	    (!cxt.cur_ops->readlock || nreaders_stress == 0)) {
1202		pr_alert("lock-torture: must run at least one locking thread\n");
1203		firsterr = -EINVAL;
1204		goto unwind;
1205	}
1206
1207	if (nwriters_stress >= 0)
1208		cxt.nrealwriters_stress = nwriters_stress;
1209	else
1210		cxt.nrealwriters_stress = 2 * num_online_cpus();
1211
1212	if (cxt.cur_ops->init) {
1213		cxt.cur_ops->init();
1214		cxt.init_called = true;
1215	}
1216
1217#ifdef CONFIG_DEBUG_MUTEXES
1218	if (str_has_prefix(torture_type, "mutex"))
1219		cxt.debug_lock = true;
1220#endif
1221#ifdef CONFIG_DEBUG_RT_MUTEXES
1222	if (str_has_prefix(torture_type, "rtmutex"))
1223		cxt.debug_lock = true;
1224#endif
1225#ifdef CONFIG_DEBUG_SPINLOCK
1226	if ((str_has_prefix(torture_type, "spin")) ||
1227	    (str_has_prefix(torture_type, "rw_lock")))
1228		cxt.debug_lock = true;
1229#endif
1230
1231	/* Initialize the statistics so that each run gets its own numbers. */
1232	if (nwriters_stress) {
1233		lock_is_write_held = false;
1234		cxt.lwsa = kmalloc_array(cxt.nrealwriters_stress,
1235					 sizeof(*cxt.lwsa),
1236					 GFP_KERNEL);
1237		if (cxt.lwsa == NULL) {
1238			VERBOSE_TOROUT_STRING("cxt.lwsa: Out of memory");
1239			firsterr = -ENOMEM;
1240			goto unwind;
1241		}
1242
1243		for (i = 0; i < cxt.nrealwriters_stress; i++) {
1244			cxt.lwsa[i].n_lock_fail = 0;
1245			cxt.lwsa[i].n_lock_acquired = 0;
1246		}
 
 
 
 
 
 
1247	}
1248
1249	if (cxt.cur_ops->readlock) {
1250		if (nreaders_stress >= 0)
1251			cxt.nrealreaders_stress = nreaders_stress;
1252		else {
1253			/*
1254			 * By default distribute evenly the number of
1255			 * readers and writers. We still run the same number
1256			 * of threads as the writer-only locks default.
1257			 */
1258			if (nwriters_stress < 0) /* user doesn't care */
1259				cxt.nrealwriters_stress = num_online_cpus();
1260			cxt.nrealreaders_stress = cxt.nrealwriters_stress;
1261		}
1262
1263		if (nreaders_stress) {
1264			cxt.lrsa = kmalloc_array(cxt.nrealreaders_stress,
1265						 sizeof(*cxt.lrsa),
1266						 GFP_KERNEL);
1267			if (cxt.lrsa == NULL) {
1268				VERBOSE_TOROUT_STRING("cxt.lrsa: Out of memory");
1269				firsterr = -ENOMEM;
1270				kfree(cxt.lwsa);
1271				cxt.lwsa = NULL;
1272				goto unwind;
1273			}
1274
1275			for (i = 0; i < cxt.nrealreaders_stress; i++) {
1276				cxt.lrsa[i].n_lock_fail = 0;
1277				cxt.lrsa[i].n_lock_acquired = 0;
1278			}
1279		}
1280	}
1281
1282	firsterr = call_rcu_chain_init();
1283	if (torture_init_error(firsterr))
1284		goto unwind;
1285
 
 
 
 
 
1286	lock_torture_print_module_parms(cxt.cur_ops, "Start of test");
1287
1288	/* Prepare torture context. */
1289	if (onoff_interval > 0) {
1290		firsterr = torture_onoff_init(onoff_holdoff * HZ,
1291					      onoff_interval * HZ, NULL);
1292		if (torture_init_error(firsterr))
1293			goto unwind;
1294	}
1295	if (shuffle_interval > 0) {
1296		firsterr = torture_shuffle_init(shuffle_interval);
1297		if (torture_init_error(firsterr))
1298			goto unwind;
1299	}
1300	if (shutdown_secs > 0) {
1301		firsterr = torture_shutdown_init(shutdown_secs,
1302						 lock_torture_cleanup);
1303		if (torture_init_error(firsterr))
1304			goto unwind;
1305	}
1306	if (stutter > 0) {
1307		firsterr = torture_stutter_init(stutter, stutter);
1308		if (torture_init_error(firsterr))
1309			goto unwind;
1310	}
1311
1312	if (nwriters_stress) {
1313		writer_tasks = kcalloc(cxt.nrealwriters_stress,
1314				       sizeof(writer_tasks[0]),
1315				       GFP_KERNEL);
1316		if (writer_tasks == NULL) {
1317			TOROUT_ERRSTRING("writer_tasks: Out of memory");
1318			firsterr = -ENOMEM;
1319			goto unwind;
1320		}
1321	}
1322
1323	/* cap nested_locks to MAX_NESTED_LOCKS */
1324	if (nested_locks > MAX_NESTED_LOCKS)
1325		nested_locks = MAX_NESTED_LOCKS;
1326
1327	if (cxt.cur_ops->readlock) {
1328		reader_tasks = kcalloc(cxt.nrealreaders_stress,
1329				       sizeof(reader_tasks[0]),
1330				       GFP_KERNEL);
1331		if (reader_tasks == NULL) {
1332			TOROUT_ERRSTRING("reader_tasks: Out of memory");
1333			kfree(writer_tasks);
1334			writer_tasks = NULL;
1335			firsterr = -ENOMEM;
1336			goto unwind;
1337		}
1338	}
1339
1340	/*
1341	 * Create the kthreads and start torturing (oh, those poor little locks).
1342	 *
1343	 * TODO: Note that we interleave writers with readers, giving writers a
1344	 * slight advantage, by creating its kthread first. This can be modified
1345	 * for very specific needs, or even let the user choose the policy, if
1346	 * ever wanted.
1347	 */
1348	for (i = 0, j = 0; i < cxt.nrealwriters_stress ||
1349		    j < cxt.nrealreaders_stress; i++, j++) {
1350		if (i >= cxt.nrealwriters_stress)
1351			goto create_reader;
1352
1353		/* Create writer. */
1354		firsterr = torture_create_kthread_cb(lock_torture_writer, &cxt.lwsa[i],
1355						     writer_tasks[i],
1356						     writer_fifo ? sched_set_fifo : NULL);
1357		if (torture_init_error(firsterr))
1358			goto unwind;
1359		if (cpumask_nonempty(bind_writers))
1360			torture_sched_setaffinity(writer_tasks[i]->pid, bind_writers);
1361
1362	create_reader:
1363		if (cxt.cur_ops->readlock == NULL || (j >= cxt.nrealreaders_stress))
1364			continue;
1365		/* Create reader. */
1366		firsterr = torture_create_kthread(lock_torture_reader, &cxt.lrsa[j],
1367						  reader_tasks[j]);
1368		if (torture_init_error(firsterr))
1369			goto unwind;
1370		if (cpumask_nonempty(bind_readers))
1371			torture_sched_setaffinity(reader_tasks[j]->pid, bind_readers);
1372	}
1373	if (stat_interval > 0) {
1374		firsterr = torture_create_kthread(lock_torture_stats, NULL,
1375						  stats_task);
1376		if (torture_init_error(firsterr))
1377			goto unwind;
1378	}
1379	torture_init_end();
1380	return 0;
1381
1382unwind:
1383	torture_init_end();
1384	lock_torture_cleanup();
1385	if (shutdown_secs) {
1386		WARN_ON(!IS_MODULE(CONFIG_LOCK_TORTURE_TEST));
1387		kernel_power_off();
1388	}
1389	return firsterr;
1390}
1391
1392module_init(lock_torture_init);
1393module_exit(lock_torture_cleanup);
v4.6
 
  1/*
  2 * Module-based torture test facility for locking
  3 *
  4 * This program is free software; you can redistribute it and/or modify
  5 * it under the terms of the GNU General Public License as published by
  6 * the Free Software Foundation; either version 2 of the License, or
  7 * (at your option) any later version.
  8 *
  9 * This program is distributed in the hope that it will be useful,
 10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 12 * GNU General Public License for more details.
 13 *
 14 * You should have received a copy of the GNU General Public License
 15 * along with this program; if not, you can access it online at
 16 * http://www.gnu.org/licenses/gpl-2.0.html.
 17 *
 18 * Copyright (C) IBM Corporation, 2014
 19 *
 20 * Authors: Paul E. McKenney <paulmck@us.ibm.com>
 21 *          Davidlohr Bueso <dave@stgolabs.net>
 22 *	Based on kernel/rcu/torture.c.
 23 */
 
 
 
 24#include <linux/kernel.h>
 25#include <linux/module.h>
 26#include <linux/kthread.h>
 27#include <linux/sched/rt.h>
 28#include <linux/spinlock.h>
 29#include <linux/rwlock.h>
 30#include <linux/mutex.h>
 31#include <linux/rwsem.h>
 32#include <linux/smp.h>
 33#include <linux/interrupt.h>
 34#include <linux/sched.h>
 
 
 35#include <linux/atomic.h>
 36#include <linux/moduleparam.h>
 37#include <linux/delay.h>
 38#include <linux/slab.h>
 39#include <linux/percpu-rwsem.h>
 40#include <linux/torture.h>
 
 41
 42MODULE_LICENSE("GPL");
 43MODULE_AUTHOR("Paul E. McKenney <paulmck@us.ibm.com>");
 44
 45torture_param(int, nwriters_stress, -1,
 46	     "Number of write-locking stress-test threads");
 47torture_param(int, nreaders_stress, -1,
 48	     "Number of read-locking stress-test threads");
 
 
 49torture_param(int, onoff_holdoff, 0, "Time after boot before CPU hotplugs (s)");
 50torture_param(int, onoff_interval, 0,
 51	     "Time between CPU hotplugs (s), 0=disable");
 52torture_param(int, shuffle_interval, 3,
 53	     "Number of jiffies between shuffles, 0=disable");
 
 54torture_param(int, shutdown_secs, 0, "Shutdown time (j), <= zero to disable.");
 55torture_param(int, stat_interval, 60,
 56	     "Number of seconds between stats printk()s");
 57torture_param(int, stutter, 5, "Number of jiffies to run/halt test, 0=disable");
 58torture_param(bool, verbose, true,
 59	     "Enable verbose debugging printk()s");
 
 
 60
 61static char *torture_type = "spin_lock";
 62module_param(torture_type, charp, 0444);
 63MODULE_PARM_DESC(torture_type,
 64		 "Type of lock to torture (spin_lock, spin_lock_irq, mutex_lock, ...)");
 65
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 66static struct task_struct *stats_task;
 67static struct task_struct **writer_tasks;
 68static struct task_struct **reader_tasks;
 69
 70static bool lock_is_write_held;
 71static bool lock_is_read_held;
 
 72
 73struct lock_stress_stats {
 74	long n_lock_fail;
 75	long n_lock_acquired;
 76};
 77
 78#if defined(MODULE)
 79#define LOCKTORTURE_RUNNABLE_INIT 1
 80#else
 81#define LOCKTORTURE_RUNNABLE_INIT 0
 82#endif
 83int torture_runnable = LOCKTORTURE_RUNNABLE_INIT;
 84module_param(torture_runnable, int, 0444);
 85MODULE_PARM_DESC(torture_runnable, "Start locktorture at module init");
 86
 87/* Forward reference. */
 88static void lock_torture_cleanup(void);
 89
 90/*
 91 * Operations vector for selecting different types of tests.
 92 */
 93struct lock_torture_ops {
 94	void (*init)(void);
 95	int (*writelock)(void);
 
 
 96	void (*write_delay)(struct torture_random_state *trsp);
 97	void (*task_boost)(struct torture_random_state *trsp);
 98	void (*writeunlock)(void);
 99	int (*readlock)(void);
 
100	void (*read_delay)(struct torture_random_state *trsp);
101	void (*readunlock)(void);
102
103	unsigned long flags; /* for irq spinlocks */
104	const char *name;
105};
106
107struct lock_torture_cxt {
108	int nrealwriters_stress;
109	int nrealreaders_stress;
110	bool debug_lock;
 
111	atomic_t n_lock_torture_errors;
112	struct lock_torture_ops *cur_ops;
113	struct lock_stress_stats *lwsa; /* writer statistics */
114	struct lock_stress_stats *lrsa; /* reader statistics */
115};
116static struct lock_torture_cxt cxt = { 0, 0, false,
117				       ATOMIC_INIT(0),
118				       NULL, NULL};
119/*
120 * Definitions for lock torture testing.
121 */
122
123static int torture_lock_busted_write_lock(void)
124{
125	return 0;  /* BUGGY, do not use in real life!!! */
126}
127
128static void torture_lock_busted_write_delay(struct torture_random_state *trsp)
129{
130	const unsigned long longdelay_ms = 100;
131
132	/* We want a long delay occasionally to force massive contention.  */
133	if (!(torture_random(trsp) %
134	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
135		mdelay(longdelay_ms);
136#ifdef CONFIG_PREEMPT
137	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
138		preempt_schedule();  /* Allow test to be preempted. */
139#endif
140}
141
142static void torture_lock_busted_write_unlock(void)
143{
144	  /* BUGGY, do not use in real life!!! */
145}
146
147static void torture_boost_dummy(struct torture_random_state *trsp)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
148{
149	/* Only rtmutexes care about priority */
 
 
 
150}
151
152static struct lock_torture_ops lock_busted_ops = {
153	.writelock	= torture_lock_busted_write_lock,
154	.write_delay	= torture_lock_busted_write_delay,
155	.task_boost     = torture_boost_dummy,
156	.writeunlock	= torture_lock_busted_write_unlock,
157	.readlock       = NULL,
158	.read_delay     = NULL,
159	.readunlock     = NULL,
160	.name		= "lock_busted"
161};
162
163static DEFINE_SPINLOCK(torture_spinlock);
164
165static int torture_spin_lock_write_lock(void) __acquires(torture_spinlock)
 
166{
167	spin_lock(&torture_spinlock);
168	return 0;
169}
170
171static void torture_spin_lock_write_delay(struct torture_random_state *trsp)
172{
173	const unsigned long shortdelay_us = 2;
174	const unsigned long longdelay_ms = 100;
175
176	/* We want a short delay mostly to emulate likely code, and
177	 * we want a long delay occasionally to force massive contention.
178	 */
179	if (!(torture_random(trsp) %
180	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
181		mdelay(longdelay_ms);
182	if (!(torture_random(trsp) %
183	      (cxt.nrealwriters_stress * 2 * shortdelay_us)))
 
184		udelay(shortdelay_us);
185#ifdef CONFIG_PREEMPT
186	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
187		preempt_schedule();  /* Allow test to be preempted. */
188#endif
189}
190
191static void torture_spin_lock_write_unlock(void) __releases(torture_spinlock)
 
192{
193	spin_unlock(&torture_spinlock);
194}
195
196static struct lock_torture_ops spin_lock_ops = {
197	.writelock	= torture_spin_lock_write_lock,
198	.write_delay	= torture_spin_lock_write_delay,
199	.task_boost     = torture_boost_dummy,
200	.writeunlock	= torture_spin_lock_write_unlock,
201	.readlock       = NULL,
202	.read_delay     = NULL,
203	.readunlock     = NULL,
204	.name		= "spin_lock"
205};
206
207static int torture_spin_lock_write_lock_irq(void)
208__acquires(torture_spinlock)
209{
210	unsigned long flags;
211
212	spin_lock_irqsave(&torture_spinlock, flags);
213	cxt.cur_ops->flags = flags;
214	return 0;
215}
216
217static void torture_lock_spin_write_unlock_irq(void)
218__releases(torture_spinlock)
219{
220	spin_unlock_irqrestore(&torture_spinlock, cxt.cur_ops->flags);
221}
222
223static struct lock_torture_ops spin_lock_irq_ops = {
224	.writelock	= torture_spin_lock_write_lock_irq,
225	.write_delay	= torture_spin_lock_write_delay,
226	.task_boost     = torture_boost_dummy,
227	.writeunlock	= torture_lock_spin_write_unlock_irq,
228	.readlock       = NULL,
229	.read_delay     = NULL,
230	.readunlock     = NULL,
231	.name		= "spin_lock_irq"
232};
233
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
234static DEFINE_RWLOCK(torture_rwlock);
235
236static int torture_rwlock_write_lock(void) __acquires(torture_rwlock)
 
237{
238	write_lock(&torture_rwlock);
239	return 0;
240}
241
242static void torture_rwlock_write_delay(struct torture_random_state *trsp)
243{
244	const unsigned long shortdelay_us = 2;
245	const unsigned long longdelay_ms = 100;
246
247	/* We want a short delay mostly to emulate likely code, and
248	 * we want a long delay occasionally to force massive contention.
249	 */
250	if (!(torture_random(trsp) %
251	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
252		mdelay(longdelay_ms);
253	else
254		udelay(shortdelay_us);
255}
256
257static void torture_rwlock_write_unlock(void) __releases(torture_rwlock)
 
258{
259	write_unlock(&torture_rwlock);
260}
261
262static int torture_rwlock_read_lock(void) __acquires(torture_rwlock)
 
263{
264	read_lock(&torture_rwlock);
265	return 0;
266}
267
268static void torture_rwlock_read_delay(struct torture_random_state *trsp)
269{
270	const unsigned long shortdelay_us = 10;
271	const unsigned long longdelay_ms = 100;
272
273	/* We want a short delay mostly to emulate likely code, and
274	 * we want a long delay occasionally to force massive contention.
275	 */
276	if (!(torture_random(trsp) %
277	      (cxt.nrealreaders_stress * 2000 * longdelay_ms)))
278		mdelay(longdelay_ms);
279	else
280		udelay(shortdelay_us);
281}
282
283static void torture_rwlock_read_unlock(void) __releases(torture_rwlock)
 
284{
285	read_unlock(&torture_rwlock);
286}
287
288static struct lock_torture_ops rw_lock_ops = {
289	.writelock	= torture_rwlock_write_lock,
290	.write_delay	= torture_rwlock_write_delay,
291	.task_boost     = torture_boost_dummy,
292	.writeunlock	= torture_rwlock_write_unlock,
293	.readlock       = torture_rwlock_read_lock,
294	.read_delay     = torture_rwlock_read_delay,
295	.readunlock     = torture_rwlock_read_unlock,
296	.name		= "rw_lock"
297};
298
299static int torture_rwlock_write_lock_irq(void) __acquires(torture_rwlock)
 
300{
301	unsigned long flags;
302
303	write_lock_irqsave(&torture_rwlock, flags);
304	cxt.cur_ops->flags = flags;
305	return 0;
306}
307
308static void torture_rwlock_write_unlock_irq(void)
309__releases(torture_rwlock)
310{
311	write_unlock_irqrestore(&torture_rwlock, cxt.cur_ops->flags);
312}
313
314static int torture_rwlock_read_lock_irq(void) __acquires(torture_rwlock)
 
315{
316	unsigned long flags;
317
318	read_lock_irqsave(&torture_rwlock, flags);
319	cxt.cur_ops->flags = flags;
320	return 0;
321}
322
323static void torture_rwlock_read_unlock_irq(void)
324__releases(torture_rwlock)
325{
326	read_unlock_irqrestore(&torture_rwlock, cxt.cur_ops->flags);
327}
328
329static struct lock_torture_ops rw_lock_irq_ops = {
330	.writelock	= torture_rwlock_write_lock_irq,
331	.write_delay	= torture_rwlock_write_delay,
332	.task_boost     = torture_boost_dummy,
333	.writeunlock	= torture_rwlock_write_unlock_irq,
334	.readlock       = torture_rwlock_read_lock_irq,
335	.read_delay     = torture_rwlock_read_delay,
336	.readunlock     = torture_rwlock_read_unlock_irq,
337	.name		= "rw_lock_irq"
338};
339
340static DEFINE_MUTEX(torture_mutex);
 
 
341
342static int torture_mutex_lock(void) __acquires(torture_mutex)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
343{
344	mutex_lock(&torture_mutex);
345	return 0;
346}
347
348static void torture_mutex_delay(struct torture_random_state *trsp)
349{
350	const unsigned long longdelay_ms = 100;
351
352	/* We want a long delay occasionally to force massive contention.  */
353	if (!(torture_random(trsp) %
354	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
355		mdelay(longdelay_ms * 5);
356	else
357		mdelay(longdelay_ms / 5);
358#ifdef CONFIG_PREEMPT
359	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
360		preempt_schedule();  /* Allow test to be preempted. */
361#endif
362}
363
364static void torture_mutex_unlock(void) __releases(torture_mutex)
 
365{
366	mutex_unlock(&torture_mutex);
367}
368
 
 
 
 
 
 
 
 
 
 
369static struct lock_torture_ops mutex_lock_ops = {
 
 
370	.writelock	= torture_mutex_lock,
371	.write_delay	= torture_mutex_delay,
372	.task_boost     = torture_boost_dummy,
373	.writeunlock	= torture_mutex_unlock,
 
374	.readlock       = NULL,
375	.read_delay     = NULL,
376	.readunlock     = NULL,
377	.name		= "mutex_lock"
378};
379
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
380#ifdef CONFIG_RT_MUTEXES
381static DEFINE_RT_MUTEX(torture_rtmutex);
 
 
382
383static int torture_rtmutex_lock(void) __acquires(torture_rtmutex)
384{
385	rt_mutex_lock(&torture_rtmutex);
386	return 0;
 
 
 
387}
388
389static void torture_rtmutex_boost(struct torture_random_state *trsp)
 
390{
391	int policy;
392	struct sched_param param;
393	const unsigned int factor = 50000; /* yes, quite arbitrary */
394
395	if (!rt_task(current)) {
396		/*
397		 * (1) Boost priority once every ~50k operations. When the
398		 * task tries to take the lock, the rtmutex it will account
399		 * for the new priority, and do any corresponding pi-dance.
400		 */
401		if (!(torture_random(trsp) %
402		      (cxt.nrealwriters_stress * factor))) {
403			policy = SCHED_FIFO;
404			param.sched_priority = MAX_RT_PRIO - 1;
405		} else /* common case, do nothing */
406			return;
407	} else {
408		/*
409		 * The task will remain boosted for another ~500k operations,
410		 * then restored back to its original prio, and so forth.
411		 *
412		 * When @trsp is nil, we want to force-reset the task for
413		 * stopping the kthread.
414		 */
415		if (!trsp || !(torture_random(trsp) %
416			       (cxt.nrealwriters_stress * factor * 2))) {
417			policy = SCHED_NORMAL;
418			param.sched_priority = 0;
419		} else /* common case, do nothing */
420			return;
421	}
422
423	sched_setscheduler_nocheck(current, policy, &param);
 
 
 
 
424}
425
426static void torture_rtmutex_delay(struct torture_random_state *trsp)
427{
428	const unsigned long shortdelay_us = 2;
429	const unsigned long longdelay_ms = 100;
430
431	/*
432	 * We want a short delay mostly to emulate likely code, and
433	 * we want a long delay occasionally to force massive contention.
434	 */
 
 
435	if (!(torture_random(trsp) %
436	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
437		mdelay(longdelay_ms);
438	if (!(torture_random(trsp) %
439	      (cxt.nrealwriters_stress * 2 * shortdelay_us)))
440		udelay(shortdelay_us);
441#ifdef CONFIG_PREEMPT
442	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
443		preempt_schedule();  /* Allow test to be preempted. */
444#endif
445}
446
447static void torture_rtmutex_unlock(void) __releases(torture_rtmutex)
 
448{
449	rt_mutex_unlock(&torture_rtmutex);
450}
451
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
452static struct lock_torture_ops rtmutex_lock_ops = {
 
 
453	.writelock	= torture_rtmutex_lock,
454	.write_delay	= torture_rtmutex_delay,
455	.task_boost     = torture_rtmutex_boost,
456	.writeunlock	= torture_rtmutex_unlock,
 
457	.readlock       = NULL,
458	.read_delay     = NULL,
459	.readunlock     = NULL,
460	.name		= "rtmutex_lock"
461};
462#endif
463
464static DECLARE_RWSEM(torture_rwsem);
465static int torture_rwsem_down_write(void) __acquires(torture_rwsem)
 
466{
467	down_write(&torture_rwsem);
468	return 0;
469}
470
471static void torture_rwsem_write_delay(struct torture_random_state *trsp)
472{
473	const unsigned long longdelay_ms = 100;
474
475	/* We want a long delay occasionally to force massive contention.  */
476	if (!(torture_random(trsp) %
477	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
478		mdelay(longdelay_ms * 10);
479	else
480		mdelay(longdelay_ms / 10);
481#ifdef CONFIG_PREEMPT
482	if (!(torture_random(trsp) % (cxt.nrealwriters_stress * 20000)))
483		preempt_schedule();  /* Allow test to be preempted. */
484#endif
485}
486
487static void torture_rwsem_up_write(void) __releases(torture_rwsem)
 
488{
489	up_write(&torture_rwsem);
490}
491
492static int torture_rwsem_down_read(void) __acquires(torture_rwsem)
 
493{
494	down_read(&torture_rwsem);
495	return 0;
496}
497
498static void torture_rwsem_read_delay(struct torture_random_state *trsp)
499{
500	const unsigned long longdelay_ms = 100;
501
502	/* We want a long delay occasionally to force massive contention.  */
503	if (!(torture_random(trsp) %
504	      (cxt.nrealwriters_stress * 2000 * longdelay_ms)))
505		mdelay(longdelay_ms * 2);
506	else
507		mdelay(longdelay_ms / 2);
508#ifdef CONFIG_PREEMPT
509	if (!(torture_random(trsp) % (cxt.nrealreaders_stress * 20000)))
510		preempt_schedule();  /* Allow test to be preempted. */
511#endif
512}
513
514static void torture_rwsem_up_read(void) __releases(torture_rwsem)
 
515{
516	up_read(&torture_rwsem);
517}
518
519static struct lock_torture_ops rwsem_lock_ops = {
520	.writelock	= torture_rwsem_down_write,
521	.write_delay	= torture_rwsem_write_delay,
522	.task_boost     = torture_boost_dummy,
523	.writeunlock	= torture_rwsem_up_write,
524	.readlock       = torture_rwsem_down_read,
525	.read_delay     = torture_rwsem_read_delay,
526	.readunlock     = torture_rwsem_up_read,
527	.name		= "rwsem_lock"
528};
529
530#include <linux/percpu-rwsem.h>
531static struct percpu_rw_semaphore pcpu_rwsem;
532
533void torture_percpu_rwsem_init(void)
534{
535	BUG_ON(percpu_init_rwsem(&pcpu_rwsem));
536}
537
538static int torture_percpu_rwsem_down_write(void) __acquires(pcpu_rwsem)
 
 
 
 
 
 
539{
540	percpu_down_write(&pcpu_rwsem);
541	return 0;
542}
543
544static void torture_percpu_rwsem_up_write(void) __releases(pcpu_rwsem)
 
545{
546	percpu_up_write(&pcpu_rwsem);
547}
548
549static int torture_percpu_rwsem_down_read(void) __acquires(pcpu_rwsem)
 
550{
551	percpu_down_read(&pcpu_rwsem);
552	return 0;
553}
554
555static void torture_percpu_rwsem_up_read(void) __releases(pcpu_rwsem)
 
556{
557	percpu_up_read(&pcpu_rwsem);
558}
559
560static struct lock_torture_ops percpu_rwsem_lock_ops = {
561	.init		= torture_percpu_rwsem_init,
 
562	.writelock	= torture_percpu_rwsem_down_write,
563	.write_delay	= torture_rwsem_write_delay,
564	.task_boost     = torture_boost_dummy,
565	.writeunlock	= torture_percpu_rwsem_up_write,
566	.readlock       = torture_percpu_rwsem_down_read,
567	.read_delay     = torture_rwsem_read_delay,
568	.readunlock     = torture_percpu_rwsem_up_read,
569	.name		= "percpu_rwsem_lock"
570};
571
572/*
573 * Lock torture writer kthread.  Repeatedly acquires and releases
574 * the lock, checking for duplicate acquisitions.
575 */
576static int lock_torture_writer(void *arg)
577{
 
 
 
578	struct lock_stress_stats *lwsp = arg;
579	static DEFINE_TORTURE_RANDOM(rand);
 
 
580
581	VERBOSE_TOROUT_STRING("lock_torture_writer task started");
582	set_user_nice(current, MAX_NICE);
 
583
584	do {
585		if ((torture_random(&rand) & 0xfffff) == 0)
586			schedule_timeout_uninterruptible(1);
587
 
 
 
 
 
 
 
 
 
 
 
 
588		cxt.cur_ops->task_boost(&rand);
589		cxt.cur_ops->writelock();
590		if (WARN_ON_ONCE(lock_is_write_held))
591			lwsp->n_lock_fail++;
592		lock_is_write_held = 1;
593		if (WARN_ON_ONCE(lock_is_read_held))
594			lwsp->n_lock_fail++; /* rare, but... */
595
596		lwsp->n_lock_acquired++;
597		cxt.cur_ops->write_delay(&rand);
598		lock_is_write_held = 0;
599		cxt.cur_ops->writeunlock();
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
600
601		stutter_wait("lock_torture_writer");
602	} while (!torture_must_stop());
603
604	cxt.cur_ops->task_boost(NULL); /* reset prio */
605	torture_kthread_stopping("lock_torture_writer");
606	return 0;
607}
608
609/*
610 * Lock torture reader kthread.  Repeatedly acquires and releases
611 * the reader lock.
612 */
613static int lock_torture_reader(void *arg)
614{
615	struct lock_stress_stats *lrsp = arg;
616	static DEFINE_TORTURE_RANDOM(rand);
 
617
618	VERBOSE_TOROUT_STRING("lock_torture_reader task started");
619	set_user_nice(current, MAX_NICE);
620
621	do {
622		if ((torture_random(&rand) & 0xfffff) == 0)
623			schedule_timeout_uninterruptible(1);
624
625		cxt.cur_ops->readlock();
626		lock_is_read_held = 1;
627		if (WARN_ON_ONCE(lock_is_write_held))
628			lrsp->n_lock_fail++; /* rare, but... */
629
630		lrsp->n_lock_acquired++;
631		cxt.cur_ops->read_delay(&rand);
632		lock_is_read_held = 0;
633		cxt.cur_ops->readunlock();
634
635		stutter_wait("lock_torture_reader");
636	} while (!torture_must_stop());
637	torture_kthread_stopping("lock_torture_reader");
638	return 0;
639}
640
641/*
642 * Create an lock-torture-statistics message in the specified buffer.
643 */
644static void __torture_print_stats(char *page,
645				  struct lock_stress_stats *statp, bool write)
646{
647	bool fail = 0;
 
648	int i, n_stress;
649	long max = 0;
650	long min = statp[0].n_lock_acquired;
651	long long sum = 0;
652
653	n_stress = write ? cxt.nrealwriters_stress : cxt.nrealreaders_stress;
654	for (i = 0; i < n_stress; i++) {
655		if (statp[i].n_lock_fail)
656			fail = true;
657		sum += statp[i].n_lock_acquired;
658		if (max < statp[i].n_lock_fail)
659			max = statp[i].n_lock_fail;
660		if (min > statp[i].n_lock_fail)
661			min = statp[i].n_lock_fail;
 
662	}
663	page += sprintf(page,
664			"%s:  Total: %lld  Max/Min: %ld/%ld %s  Fail: %d %s\n",
665			write ? "Writes" : "Reads ",
666			sum, max, min, max / 2 > min ? "???" : "",
 
667			fail, fail ? "!!!" : "");
668	if (fail)
669		atomic_inc(&cxt.n_lock_torture_errors);
670}
671
672/*
673 * Print torture statistics.  Caller must ensure that there is only one
674 * call to this function at a given time!!!  This is normally accomplished
675 * by relying on the module system to only have one copy of the module
676 * loaded, and then by giving the lock_torture_stats kthread full control
677 * (or the init/cleanup functions when lock_torture_stats thread is not
678 * running).
679 */
680static void lock_torture_stats_print(void)
681{
682	int size = cxt.nrealwriters_stress * 200 + 8192;
683	char *buf;
684
685	if (cxt.cur_ops->readlock)
686		size += cxt.nrealreaders_stress * 200 + 8192;
687
688	buf = kmalloc(size, GFP_KERNEL);
689	if (!buf) {
690		pr_err("lock_torture_stats_print: Out of memory, need: %d",
691		       size);
692		return;
693	}
694
695	__torture_print_stats(buf, cxt.lwsa, true);
696	pr_alert("%s", buf);
697	kfree(buf);
698
699	if (cxt.cur_ops->readlock) {
700		buf = kmalloc(size, GFP_KERNEL);
701		if (!buf) {
702			pr_err("lock_torture_stats_print: Out of memory, need: %d",
703			       size);
704			return;
705		}
706
707		__torture_print_stats(buf, cxt.lrsa, false);
708		pr_alert("%s", buf);
709		kfree(buf);
710	}
711}
712
713/*
714 * Periodically prints torture statistics, if periodic statistics printing
715 * was specified via the stat_interval module parameter.
716 *
717 * No need to worry about fullstop here, since this one doesn't reference
718 * volatile state or register callbacks.
719 */
720static int lock_torture_stats(void *arg)
721{
722	VERBOSE_TOROUT_STRING("lock_torture_stats task started");
723	do {
724		schedule_timeout_interruptible(stat_interval * HZ);
725		lock_torture_stats_print();
726		torture_shutdown_absorb("lock_torture_stats");
727	} while (!torture_must_stop());
728	torture_kthread_stopping("lock_torture_stats");
729	return 0;
730}
731
 
732static inline void
733lock_torture_print_module_parms(struct lock_torture_ops *cur_ops,
734				const char *tag)
735{
 
 
 
 
 
736	pr_alert("%s" TORTURE_FLAG
737		 "--- %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",
738		 torture_type, tag, cxt.debug_lock ? " [debug]": "",
739		 cxt.nrealwriters_stress, cxt.nrealreaders_stress, stat_interval,
740		 verbose, shuffle_interval, stutter, shutdown_secs,
741		 onoff_interval, onoff_holdoff);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
742}
743
744static void lock_torture_cleanup(void)
745{
746	int i;
747
748	if (torture_cleanup_begin())
749		return;
750
 
 
 
 
 
 
 
 
 
 
751	if (writer_tasks) {
752		for (i = 0; i < cxt.nrealwriters_stress; i++)
753			torture_stop_kthread(lock_torture_writer,
754					     writer_tasks[i]);
755		kfree(writer_tasks);
756		writer_tasks = NULL;
757	}
758
759	if (reader_tasks) {
760		for (i = 0; i < cxt.nrealreaders_stress; i++)
761			torture_stop_kthread(lock_torture_reader,
762					     reader_tasks[i]);
763		kfree(reader_tasks);
764		reader_tasks = NULL;
765	}
766
767	torture_stop_kthread(lock_torture_stats, stats_task);
768	lock_torture_stats_print();  /* -After- the stats thread is stopped! */
769
770	if (atomic_read(&cxt.n_lock_torture_errors))
771		lock_torture_print_module_parms(cxt.cur_ops,
772						"End of test: FAILURE");
773	else if (torture_onoff_failures())
774		lock_torture_print_module_parms(cxt.cur_ops,
775						"End of test: LOCK_HOTPLUG");
776	else
777		lock_torture_print_module_parms(cxt.cur_ops,
778						"End of test: SUCCESS");
 
 
 
 
 
 
 
 
 
 
 
 
 
 
779	torture_cleanup_end();
780}
781
782static int __init lock_torture_init(void)
783{
784	int i, j;
785	int firsterr = 0;
786	static struct lock_torture_ops *torture_ops[] = {
787		&lock_busted_ops,
788		&spin_lock_ops, &spin_lock_irq_ops,
 
789		&rw_lock_ops, &rw_lock_irq_ops,
790		&mutex_lock_ops,
 
791#ifdef CONFIG_RT_MUTEXES
792		&rtmutex_lock_ops,
793#endif
794		&rwsem_lock_ops,
795		&percpu_rwsem_lock_ops,
796	};
797
798	if (!torture_init_begin(torture_type, verbose, &torture_runnable))
799		return -EBUSY;
800
801	/* Process args and tell the world that the torturer is on the job. */
802	for (i = 0; i < ARRAY_SIZE(torture_ops); i++) {
803		cxt.cur_ops = torture_ops[i];
804		if (strcmp(torture_type, cxt.cur_ops->name) == 0)
805			break;
806	}
807	if (i == ARRAY_SIZE(torture_ops)) {
808		pr_alert("lock-torture: invalid torture type: \"%s\"\n",
809			 torture_type);
810		pr_alert("lock-torture types:");
811		for (i = 0; i < ARRAY_SIZE(torture_ops); i++)
812			pr_alert(" %s", torture_ops[i]->name);
813		pr_alert("\n");
814		firsterr = -EINVAL;
815		goto unwind;
816	}
817	if (cxt.cur_ops->init)
818		cxt.cur_ops->init();
 
 
 
 
 
819
820	if (nwriters_stress >= 0)
821		cxt.nrealwriters_stress = nwriters_stress;
822	else
823		cxt.nrealwriters_stress = 2 * num_online_cpus();
824
 
 
 
 
 
825#ifdef CONFIG_DEBUG_MUTEXES
826	if (strncmp(torture_type, "mutex", 5) == 0)
827		cxt.debug_lock = true;
828#endif
829#ifdef CONFIG_DEBUG_RT_MUTEXES
830	if (strncmp(torture_type, "rtmutex", 7) == 0)
831		cxt.debug_lock = true;
832#endif
833#ifdef CONFIG_DEBUG_SPINLOCK
834	if ((strncmp(torture_type, "spin", 4) == 0) ||
835	    (strncmp(torture_type, "rw_lock", 7) == 0))
836		cxt.debug_lock = true;
837#endif
838
839	/* Initialize the statistics so that each run gets its own numbers. */
 
 
 
 
 
 
 
 
 
 
840
841	lock_is_write_held = 0;
842	cxt.lwsa = kmalloc(sizeof(*cxt.lwsa) * cxt.nrealwriters_stress, GFP_KERNEL);
843	if (cxt.lwsa == NULL) {
844		VERBOSE_TOROUT_STRING("cxt.lwsa: Out of memory");
845		firsterr = -ENOMEM;
846		goto unwind;
847	}
848	for (i = 0; i < cxt.nrealwriters_stress; i++) {
849		cxt.lwsa[i].n_lock_fail = 0;
850		cxt.lwsa[i].n_lock_acquired = 0;
851	}
852
853	if (cxt.cur_ops->readlock) {
854		if (nreaders_stress >= 0)
855			cxt.nrealreaders_stress = nreaders_stress;
856		else {
857			/*
858			 * By default distribute evenly the number of
859			 * readers and writers. We still run the same number
860			 * of threads as the writer-only locks default.
861			 */
862			if (nwriters_stress < 0) /* user doesn't care */
863				cxt.nrealwriters_stress = num_online_cpus();
864			cxt.nrealreaders_stress = cxt.nrealwriters_stress;
865		}
866
867		lock_is_read_held = 0;
868		cxt.lrsa = kmalloc(sizeof(*cxt.lrsa) * cxt.nrealreaders_stress, GFP_KERNEL);
869		if (cxt.lrsa == NULL) {
870			VERBOSE_TOROUT_STRING("cxt.lrsa: Out of memory");
871			firsterr = -ENOMEM;
872			kfree(cxt.lwsa);
873			goto unwind;
 
 
 
 
 
 
 
 
 
874		}
 
 
 
 
 
875
876		for (i = 0; i < cxt.nrealreaders_stress; i++) {
877			cxt.lrsa[i].n_lock_fail = 0;
878			cxt.lrsa[i].n_lock_acquired = 0;
879		}
880	}
881	lock_torture_print_module_parms(cxt.cur_ops, "Start of test");
882
883	/* Prepare torture context. */
884	if (onoff_interval > 0) {
885		firsterr = torture_onoff_init(onoff_holdoff * HZ,
886					      onoff_interval * HZ);
887		if (firsterr)
888			goto unwind;
889	}
890	if (shuffle_interval > 0) {
891		firsterr = torture_shuffle_init(shuffle_interval);
892		if (firsterr)
893			goto unwind;
894	}
895	if (shutdown_secs > 0) {
896		firsterr = torture_shutdown_init(shutdown_secs,
897						 lock_torture_cleanup);
898		if (firsterr)
899			goto unwind;
900	}
901	if (stutter > 0) {
902		firsterr = torture_stutter_init(stutter);
903		if (firsterr)
904			goto unwind;
905	}
906
907	writer_tasks = kzalloc(cxt.nrealwriters_stress * sizeof(writer_tasks[0]),
908			       GFP_KERNEL);
909	if (writer_tasks == NULL) {
910		VERBOSE_TOROUT_ERRSTRING("writer_tasks: Out of memory");
911		firsterr = -ENOMEM;
912		goto unwind;
 
 
 
913	}
914
 
 
 
 
915	if (cxt.cur_ops->readlock) {
916		reader_tasks = kzalloc(cxt.nrealreaders_stress * sizeof(reader_tasks[0]),
 
917				       GFP_KERNEL);
918		if (reader_tasks == NULL) {
919			VERBOSE_TOROUT_ERRSTRING("reader_tasks: Out of memory");
 
 
920			firsterr = -ENOMEM;
921			goto unwind;
922		}
923	}
924
925	/*
926	 * Create the kthreads and start torturing (oh, those poor little locks).
927	 *
928	 * TODO: Note that we interleave writers with readers, giving writers a
929	 * slight advantage, by creating its kthread first. This can be modified
930	 * for very specific needs, or even let the user choose the policy, if
931	 * ever wanted.
932	 */
933	for (i = 0, j = 0; i < cxt.nrealwriters_stress ||
934		    j < cxt.nrealreaders_stress; i++, j++) {
935		if (i >= cxt.nrealwriters_stress)
936			goto create_reader;
937
938		/* Create writer. */
939		firsterr = torture_create_kthread(lock_torture_writer, &cxt.lwsa[i],
940						  writer_tasks[i]);
941		if (firsterr)
 
942			goto unwind;
 
 
943
944	create_reader:
945		if (cxt.cur_ops->readlock == NULL || (j >= cxt.nrealreaders_stress))
946			continue;
947		/* Create reader. */
948		firsterr = torture_create_kthread(lock_torture_reader, &cxt.lrsa[j],
949						  reader_tasks[j]);
950		if (firsterr)
951			goto unwind;
 
 
952	}
953	if (stat_interval > 0) {
954		firsterr = torture_create_kthread(lock_torture_stats, NULL,
955						  stats_task);
956		if (firsterr)
957			goto unwind;
958	}
959	torture_init_end();
960	return 0;
961
962unwind:
963	torture_init_end();
964	lock_torture_cleanup();
 
 
 
 
965	return firsterr;
966}
967
968module_init(lock_torture_init);
969module_exit(lock_torture_cleanup);