1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2ebd5858cSAnshuman Khandual /*
3ebd5858cSAnshuman Khandual  * POWER Data Stream Control Register (DSCR) sysfs interface test
4ebd5858cSAnshuman Khandual  *
5ebd5858cSAnshuman Khandual  * This test updates to system wide DSCR default through the sysfs interface
6ebd5858cSAnshuman Khandual  * and then verifies that all the CPU specific DSCR defaults are updated as
7ebd5858cSAnshuman Khandual  * well verified from their sysfs interfaces.
8ebd5858cSAnshuman Khandual  *
9ebd5858cSAnshuman Khandual  * Copyright 2015, Anshuman Khandual, IBM Corporation.
10ebd5858cSAnshuman Khandual  */
11ebd5858cSAnshuman Khandual #include "dscr.h"
12ebd5858cSAnshuman Khandual 
13ebd5858cSAnshuman Khandual static int check_cpu_dscr_default(char *file, unsigned long val)
14ebd5858cSAnshuman Khandual {
15ebd5858cSAnshuman Khandual 	char buf[10];
16ebd5858cSAnshuman Khandual 	int fd, rc;
17ebd5858cSAnshuman Khandual 
18ebd5858cSAnshuman Khandual 	fd = open(file, O_RDWR);
19ebd5858cSAnshuman Khandual 	if (fd == -1) {
20ebd5858cSAnshuman Khandual 		perror("open() failed");
21ebd5858cSAnshuman Khandual 		return 1;
22ebd5858cSAnshuman Khandual 	}
23ebd5858cSAnshuman Khandual 
24ebd5858cSAnshuman Khandual 	rc = read(fd, buf, sizeof(buf));
25ebd5858cSAnshuman Khandual 	if (rc == -1) {
26ebd5858cSAnshuman Khandual 		perror("read() failed");
27*8f4ab7daSMiaoqian Lin 		close(fd);
28ebd5858cSAnshuman Khandual 		return 1;
29ebd5858cSAnshuman Khandual 	}
30ebd5858cSAnshuman Khandual 	close(fd);
31ebd5858cSAnshuman Khandual 
32ebd5858cSAnshuman Khandual 	buf[rc] = '\0';
33ebd5858cSAnshuman Khandual 	if (strtol(buf, NULL, 16) != val) {
34ebd5858cSAnshuman Khandual 		printf("DSCR match failed: %ld (system) %ld (cpu)\n",
35ebd5858cSAnshuman Khandual 					val, strtol(buf, NULL, 16));
36ebd5858cSAnshuman Khandual 		return 1;
37ebd5858cSAnshuman Khandual 	}
38ebd5858cSAnshuman Khandual 	return 0;
39ebd5858cSAnshuman Khandual }
40ebd5858cSAnshuman Khandual 
41ebd5858cSAnshuman Khandual static int check_all_cpu_dscr_defaults(unsigned long val)
42ebd5858cSAnshuman Khandual {
43ebd5858cSAnshuman Khandual 	DIR *sysfs;
44ebd5858cSAnshuman Khandual 	struct dirent *dp;
45ebd5858cSAnshuman Khandual 	char file[LEN_MAX];
46ebd5858cSAnshuman Khandual 
47ebd5858cSAnshuman Khandual 	sysfs = opendir(CPU_PATH);
48ebd5858cSAnshuman Khandual 	if (!sysfs) {
49ebd5858cSAnshuman Khandual 		perror("opendir() failed");
50ebd5858cSAnshuman Khandual 		return 1;
51ebd5858cSAnshuman Khandual 	}
52ebd5858cSAnshuman Khandual 
53ebd5858cSAnshuman Khandual 	while ((dp = readdir(sysfs))) {
5406755a87SSeth Forshee 		int len;
5506755a87SSeth Forshee 
56ebd5858cSAnshuman Khandual 		if (!(dp->d_type & DT_DIR))
57ebd5858cSAnshuman Khandual 			continue;
58ebd5858cSAnshuman Khandual 		if (!strcmp(dp->d_name, "cpuidle"))
59ebd5858cSAnshuman Khandual 			continue;
60ebd5858cSAnshuman Khandual 		if (!strstr(dp->d_name, "cpu"))
61ebd5858cSAnshuman Khandual 			continue;
62ebd5858cSAnshuman Khandual 
6306755a87SSeth Forshee 		len = snprintf(file, LEN_MAX, "%s%s/dscr", CPU_PATH, dp->d_name);
6406755a87SSeth Forshee 		if (len >= LEN_MAX)
6506755a87SSeth Forshee 			continue;
66ebd5858cSAnshuman Khandual 		if (access(file, F_OK))
67ebd5858cSAnshuman Khandual 			continue;
68ebd5858cSAnshuman Khandual 
69*8f4ab7daSMiaoqian Lin 		if (check_cpu_dscr_default(file, val)) {
70*8f4ab7daSMiaoqian Lin 			closedir(sysfs);
71ebd5858cSAnshuman Khandual 			return 1;
72ebd5858cSAnshuman Khandual 		}
73*8f4ab7daSMiaoqian Lin 	}
74ebd5858cSAnshuman Khandual 	closedir(sysfs);
75ebd5858cSAnshuman Khandual 	return 0;
76ebd5858cSAnshuman Khandual }
77ebd5858cSAnshuman Khandual 
78ebd5858cSAnshuman Khandual int dscr_sysfs(void)
79ebd5858cSAnshuman Khandual {
80ebd5858cSAnshuman Khandual 	unsigned long orig_dscr_default;
81ebd5858cSAnshuman Khandual 	int i, j;
82ebd5858cSAnshuman Khandual 
834c3c3c50SMichael Ellerman 	SKIP_IF(!have_hwcap2(PPC_FEATURE2_DSCR));
844c3c3c50SMichael Ellerman 
85ebd5858cSAnshuman Khandual 	orig_dscr_default = get_default_dscr();
86ebd5858cSAnshuman Khandual 	for (i = 0; i < COUNT; i++) {
87ebd5858cSAnshuman Khandual 		for (j = 0; j < DSCR_MAX; j++) {
88ebd5858cSAnshuman Khandual 			set_default_dscr(j);
89ebd5858cSAnshuman Khandual 			if (check_all_cpu_dscr_defaults(j))
90ebd5858cSAnshuman Khandual 				goto fail;
91ebd5858cSAnshuman Khandual 		}
92ebd5858cSAnshuman Khandual 	}
93ebd5858cSAnshuman Khandual 	set_default_dscr(orig_dscr_default);
94ebd5858cSAnshuman Khandual 	return 0;
95ebd5858cSAnshuman Khandual fail:
96ebd5858cSAnshuman Khandual 	set_default_dscr(orig_dscr_default);
97ebd5858cSAnshuman Khandual 	return 1;
98ebd5858cSAnshuman Khandual }
99ebd5858cSAnshuman Khandual 
100ebd5858cSAnshuman Khandual int main(int argc, char *argv[])
101ebd5858cSAnshuman Khandual {
102ebd5858cSAnshuman Khandual 	return test_harness(dscr_sysfs, "dscr_sysfs_test");
103ebd5858cSAnshuman Khandual }
104