18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci#include <linux/module.h>
38c2ecf20Sopenharmony_ci
48c2ecf20Sopenharmony_ci/* validate @native and @pcp counter values match @expected */
58c2ecf20Sopenharmony_ci#define CHECK(native, pcp, expected)                                    \
68c2ecf20Sopenharmony_ci	do {                                                            \
78c2ecf20Sopenharmony_ci		WARN((native) != (expected),                            \
88c2ecf20Sopenharmony_ci		     "raw %ld (0x%lx) != expected %lld (0x%llx)",	\
98c2ecf20Sopenharmony_ci		     (native), (native),				\
108c2ecf20Sopenharmony_ci		     (long long)(expected), (long long)(expected));	\
118c2ecf20Sopenharmony_ci		WARN(__this_cpu_read(pcp) != (expected),                \
128c2ecf20Sopenharmony_ci		     "pcp %ld (0x%lx) != expected %lld (0x%llx)",	\
138c2ecf20Sopenharmony_ci		     __this_cpu_read(pcp), __this_cpu_read(pcp),	\
148c2ecf20Sopenharmony_ci		     (long long)(expected), (long long)(expected));	\
158c2ecf20Sopenharmony_ci	} while (0)
168c2ecf20Sopenharmony_ci
178c2ecf20Sopenharmony_cistatic DEFINE_PER_CPU(long, long_counter);
188c2ecf20Sopenharmony_cistatic DEFINE_PER_CPU(unsigned long, ulong_counter);
198c2ecf20Sopenharmony_ci
208c2ecf20Sopenharmony_cistatic int __init percpu_test_init(void)
218c2ecf20Sopenharmony_ci{
228c2ecf20Sopenharmony_ci	/*
238c2ecf20Sopenharmony_ci	 * volatile prevents compiler from optimizing it uses, otherwise the
248c2ecf20Sopenharmony_ci	 * +ul_one/-ul_one below would replace with inc/dec instructions.
258c2ecf20Sopenharmony_ci	 */
268c2ecf20Sopenharmony_ci	volatile unsigned int ui_one = 1;
278c2ecf20Sopenharmony_ci	long l = 0;
288c2ecf20Sopenharmony_ci	unsigned long ul = 0;
298c2ecf20Sopenharmony_ci
308c2ecf20Sopenharmony_ci	pr_info("percpu test start\n");
318c2ecf20Sopenharmony_ci
328c2ecf20Sopenharmony_ci	preempt_disable();
338c2ecf20Sopenharmony_ci
348c2ecf20Sopenharmony_ci	l += -1;
358c2ecf20Sopenharmony_ci	__this_cpu_add(long_counter, -1);
368c2ecf20Sopenharmony_ci	CHECK(l, long_counter, -1);
378c2ecf20Sopenharmony_ci
388c2ecf20Sopenharmony_ci	l += 1;
398c2ecf20Sopenharmony_ci	__this_cpu_add(long_counter, 1);
408c2ecf20Sopenharmony_ci	CHECK(l, long_counter, 0);
418c2ecf20Sopenharmony_ci
428c2ecf20Sopenharmony_ci	ul = 0;
438c2ecf20Sopenharmony_ci	__this_cpu_write(ulong_counter, 0);
448c2ecf20Sopenharmony_ci
458c2ecf20Sopenharmony_ci	ul += 1UL;
468c2ecf20Sopenharmony_ci	__this_cpu_add(ulong_counter, 1UL);
478c2ecf20Sopenharmony_ci	CHECK(ul, ulong_counter, 1);
488c2ecf20Sopenharmony_ci
498c2ecf20Sopenharmony_ci	ul += -1UL;
508c2ecf20Sopenharmony_ci	__this_cpu_add(ulong_counter, -1UL);
518c2ecf20Sopenharmony_ci	CHECK(ul, ulong_counter, 0);
528c2ecf20Sopenharmony_ci
538c2ecf20Sopenharmony_ci	ul += -(unsigned long)1;
548c2ecf20Sopenharmony_ci	__this_cpu_add(ulong_counter, -(unsigned long)1);
558c2ecf20Sopenharmony_ci	CHECK(ul, ulong_counter, -1);
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_ci	ul = 0;
588c2ecf20Sopenharmony_ci	__this_cpu_write(ulong_counter, 0);
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_ci	ul -= 1;
618c2ecf20Sopenharmony_ci	__this_cpu_dec(ulong_counter);
628c2ecf20Sopenharmony_ci	CHECK(ul, ulong_counter, -1);
638c2ecf20Sopenharmony_ci	CHECK(ul, ulong_counter, ULONG_MAX);
648c2ecf20Sopenharmony_ci
658c2ecf20Sopenharmony_ci	l += -ui_one;
668c2ecf20Sopenharmony_ci	__this_cpu_add(long_counter, -ui_one);
678c2ecf20Sopenharmony_ci	CHECK(l, long_counter, 0xffffffff);
688c2ecf20Sopenharmony_ci
698c2ecf20Sopenharmony_ci	l += ui_one;
708c2ecf20Sopenharmony_ci	__this_cpu_add(long_counter, ui_one);
718c2ecf20Sopenharmony_ci	CHECK(l, long_counter, (long)0x100000000LL);
728c2ecf20Sopenharmony_ci
738c2ecf20Sopenharmony_ci
748c2ecf20Sopenharmony_ci	l = 0;
758c2ecf20Sopenharmony_ci	__this_cpu_write(long_counter, 0);
768c2ecf20Sopenharmony_ci
778c2ecf20Sopenharmony_ci	l -= ui_one;
788c2ecf20Sopenharmony_ci	__this_cpu_sub(long_counter, ui_one);
798c2ecf20Sopenharmony_ci	CHECK(l, long_counter, -1);
808c2ecf20Sopenharmony_ci
818c2ecf20Sopenharmony_ci	l = 0;
828c2ecf20Sopenharmony_ci	__this_cpu_write(long_counter, 0);
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_ci	l += ui_one;
858c2ecf20Sopenharmony_ci	__this_cpu_add(long_counter, ui_one);
868c2ecf20Sopenharmony_ci	CHECK(l, long_counter, 1);
878c2ecf20Sopenharmony_ci
888c2ecf20Sopenharmony_ci	l += -ui_one;
898c2ecf20Sopenharmony_ci	__this_cpu_add(long_counter, -ui_one);
908c2ecf20Sopenharmony_ci	CHECK(l, long_counter, (long)0x100000000LL);
918c2ecf20Sopenharmony_ci
928c2ecf20Sopenharmony_ci	l = 0;
938c2ecf20Sopenharmony_ci	__this_cpu_write(long_counter, 0);
948c2ecf20Sopenharmony_ci
958c2ecf20Sopenharmony_ci	l -= ui_one;
968c2ecf20Sopenharmony_ci	this_cpu_sub(long_counter, ui_one);
978c2ecf20Sopenharmony_ci	CHECK(l, long_counter, -1);
988c2ecf20Sopenharmony_ci	CHECK(l, long_counter, ULONG_MAX);
998c2ecf20Sopenharmony_ci
1008c2ecf20Sopenharmony_ci	ul = 0;
1018c2ecf20Sopenharmony_ci	__this_cpu_write(ulong_counter, 0);
1028c2ecf20Sopenharmony_ci
1038c2ecf20Sopenharmony_ci	ul += ui_one;
1048c2ecf20Sopenharmony_ci	__this_cpu_add(ulong_counter, ui_one);
1058c2ecf20Sopenharmony_ci	CHECK(ul, ulong_counter, 1);
1068c2ecf20Sopenharmony_ci
1078c2ecf20Sopenharmony_ci	ul = 0;
1088c2ecf20Sopenharmony_ci	__this_cpu_write(ulong_counter, 0);
1098c2ecf20Sopenharmony_ci
1108c2ecf20Sopenharmony_ci	ul -= ui_one;
1118c2ecf20Sopenharmony_ci	__this_cpu_sub(ulong_counter, ui_one);
1128c2ecf20Sopenharmony_ci	CHECK(ul, ulong_counter, -1);
1138c2ecf20Sopenharmony_ci	CHECK(ul, ulong_counter, ULONG_MAX);
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_ci	ul = 3;
1168c2ecf20Sopenharmony_ci	__this_cpu_write(ulong_counter, 3);
1178c2ecf20Sopenharmony_ci
1188c2ecf20Sopenharmony_ci	ul = this_cpu_sub_return(ulong_counter, ui_one);
1198c2ecf20Sopenharmony_ci	CHECK(ul, ulong_counter, 2);
1208c2ecf20Sopenharmony_ci
1218c2ecf20Sopenharmony_ci	ul = __this_cpu_sub_return(ulong_counter, ui_one);
1228c2ecf20Sopenharmony_ci	CHECK(ul, ulong_counter, 1);
1238c2ecf20Sopenharmony_ci
1248c2ecf20Sopenharmony_ci	preempt_enable();
1258c2ecf20Sopenharmony_ci
1268c2ecf20Sopenharmony_ci	pr_info("percpu test done\n");
1278c2ecf20Sopenharmony_ci	return -EAGAIN;  /* Fail will directly unload the module */
1288c2ecf20Sopenharmony_ci}
1298c2ecf20Sopenharmony_ci
1308c2ecf20Sopenharmony_cistatic void __exit percpu_test_exit(void)
1318c2ecf20Sopenharmony_ci{
1328c2ecf20Sopenharmony_ci}
1338c2ecf20Sopenharmony_ci
1348c2ecf20Sopenharmony_cimodule_init(percpu_test_init)
1358c2ecf20Sopenharmony_cimodule_exit(percpu_test_exit)
1368c2ecf20Sopenharmony_ci
1378c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
1388c2ecf20Sopenharmony_ciMODULE_AUTHOR("Greg Thelen");
1398c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("percpu operations test");
140