xref: /openbmc/linux/arch/s390/hypfs/hypfs_diag.c (revision 5eba9bb8)
124bbb1faSMichael Holzheu /*
224bbb1faSMichael Holzheu  *    Hypervisor filesystem for Linux on s390. Diag 204 and 224
324bbb1faSMichael Holzheu  *    implementation.
424bbb1faSMichael Holzheu  *
5f55495baSMichael Holzheu  *    Copyright IBM Corp. 2006, 2008
624bbb1faSMichael Holzheu  *    Author(s): Michael Holzheu <holzheu@de.ibm.com>
724bbb1faSMichael Holzheu  */
824bbb1faSMichael Holzheu 
9f55495baSMichael Holzheu #define KMSG_COMPONENT "hypfs"
10f55495baSMichael Holzheu #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
11f55495baSMichael Holzheu 
1224bbb1faSMichael Holzheu #include <linux/types.h>
1324bbb1faSMichael Holzheu #include <linux/errno.h>
1433b26d79SHeiko Carstens #include <linux/slab.h>
1524bbb1faSMichael Holzheu #include <linux/string.h>
1624bbb1faSMichael Holzheu #include <linux/vmalloc.h>
1757b28f66SMichael Holzheu #include <linux/mm.h>
1824bbb1faSMichael Holzheu #include <asm/ebcdic.h>
1924bbb1faSMichael Holzheu #include "hypfs.h"
2024bbb1faSMichael Holzheu 
2124bbb1faSMichael Holzheu #define LPAR_NAME_LEN 8		/* lpar name len in diag 204 data */
2224bbb1faSMichael Holzheu #define CPU_NAME_LEN 16		/* type name len of cpus in diag224 name table */
2324bbb1faSMichael Holzheu #define TMP_SIZE 64		/* size of temporary buffers */
2424bbb1faSMichael Holzheu 
2557b28f66SMichael Holzheu #define DBFS_D204_HDR_VERSION	0
2657b28f66SMichael Holzheu 
2724bbb1faSMichael Holzheu /* diag 204 subcodes */
2824bbb1faSMichael Holzheu enum diag204_sc {
2924bbb1faSMichael Holzheu 	SUBC_STIB4 = 4,
3024bbb1faSMichael Holzheu 	SUBC_RSI = 5,
3124bbb1faSMichael Holzheu 	SUBC_STIB6 = 6,
3224bbb1faSMichael Holzheu 	SUBC_STIB7 = 7
3324bbb1faSMichael Holzheu };
3424bbb1faSMichael Holzheu 
3524bbb1faSMichael Holzheu /* The two available diag 204 data formats */
3624bbb1faSMichael Holzheu enum diag204_format {
3724bbb1faSMichael Holzheu 	INFO_SIMPLE = 0,
3824bbb1faSMichael Holzheu 	INFO_EXT = 0x00010000
3924bbb1faSMichael Holzheu };
4024bbb1faSMichael Holzheu 
4124bbb1faSMichael Holzheu /* bit is set in flags, when physical cpu info is included in diag 204 data */
4224bbb1faSMichael Holzheu #define LPAR_PHYS_FLG  0x80
4324bbb1faSMichael Holzheu 
4424bbb1faSMichael Holzheu static char *diag224_cpu_names;			/* diag 224 name table */
4524bbb1faSMichael Holzheu static enum diag204_sc diag204_store_sc;	/* used subcode for store */
4624bbb1faSMichael Holzheu static enum diag204_format diag204_info_type;	/* used diag 204 data format */
4724bbb1faSMichael Holzheu 
4824bbb1faSMichael Holzheu static void *diag204_buf;		/* 4K aligned buffer for diag204 data */
4924bbb1faSMichael Holzheu static void *diag204_buf_vmalloc;	/* vmalloc pointer for diag204 data */
5024bbb1faSMichael Holzheu static int diag204_buf_pages;		/* number of pages for diag204 data */
5124bbb1faSMichael Holzheu 
5257b28f66SMichael Holzheu static struct dentry *dbfs_d204_file;
5357b28f66SMichael Holzheu 
5424bbb1faSMichael Holzheu /*
5524bbb1faSMichael Holzheu  * DIAG 204 data structures and member access functions.
5624bbb1faSMichael Holzheu  *
5724bbb1faSMichael Holzheu  * Since we have two different diag 204 data formats for old and new s390
5824bbb1faSMichael Holzheu  * machines, we do not access the structs directly, but use getter functions for
5924bbb1faSMichael Holzheu  * each struct member instead. This should make the code more readable.
6024bbb1faSMichael Holzheu  */
6124bbb1faSMichael Holzheu 
6224bbb1faSMichael Holzheu /* Time information block */
6324bbb1faSMichael Holzheu 
6424bbb1faSMichael Holzheu struct info_blk_hdr {
6524bbb1faSMichael Holzheu 	__u8  npar;
6624bbb1faSMichael Holzheu 	__u8  flags;
6724bbb1faSMichael Holzheu 	__u16 tslice;
6824bbb1faSMichael Holzheu 	__u16 phys_cpus;
6924bbb1faSMichael Holzheu 	__u16 this_part;
7024bbb1faSMichael Holzheu 	__u64 curtod;
7124bbb1faSMichael Holzheu } __attribute__ ((packed));
7224bbb1faSMichael Holzheu 
7324bbb1faSMichael Holzheu struct x_info_blk_hdr {
7424bbb1faSMichael Holzheu 	__u8  npar;
7524bbb1faSMichael Holzheu 	__u8  flags;
7624bbb1faSMichael Holzheu 	__u16 tslice;
7724bbb1faSMichael Holzheu 	__u16 phys_cpus;
7824bbb1faSMichael Holzheu 	__u16 this_part;
7924bbb1faSMichael Holzheu 	__u64 curtod1;
8024bbb1faSMichael Holzheu 	__u64 curtod2;
8124bbb1faSMichael Holzheu 	char reserved[40];
8224bbb1faSMichael Holzheu } __attribute__ ((packed));
8324bbb1faSMichael Holzheu 
8424bbb1faSMichael Holzheu static inline int info_blk_hdr__size(enum diag204_format type)
8524bbb1faSMichael Holzheu {
8624bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
8724bbb1faSMichael Holzheu 		return sizeof(struct info_blk_hdr);
8824bbb1faSMichael Holzheu 	else /* INFO_EXT */
8924bbb1faSMichael Holzheu 		return sizeof(struct x_info_blk_hdr);
9024bbb1faSMichael Holzheu }
9124bbb1faSMichael Holzheu 
9224bbb1faSMichael Holzheu static inline __u8 info_blk_hdr__npar(enum diag204_format type, void *hdr)
9324bbb1faSMichael Holzheu {
9424bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
9524bbb1faSMichael Holzheu 		return ((struct info_blk_hdr *)hdr)->npar;
9624bbb1faSMichael Holzheu 	else /* INFO_EXT */
9724bbb1faSMichael Holzheu 		return ((struct x_info_blk_hdr *)hdr)->npar;
9824bbb1faSMichael Holzheu }
9924bbb1faSMichael Holzheu 
10024bbb1faSMichael Holzheu static inline __u8 info_blk_hdr__flags(enum diag204_format type, void *hdr)
10124bbb1faSMichael Holzheu {
10224bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
10324bbb1faSMichael Holzheu 		return ((struct info_blk_hdr *)hdr)->flags;
10424bbb1faSMichael Holzheu 	else /* INFO_EXT */
10524bbb1faSMichael Holzheu 		return ((struct x_info_blk_hdr *)hdr)->flags;
10624bbb1faSMichael Holzheu }
10724bbb1faSMichael Holzheu 
10824bbb1faSMichael Holzheu static inline __u16 info_blk_hdr__pcpus(enum diag204_format type, void *hdr)
10924bbb1faSMichael Holzheu {
11024bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
11124bbb1faSMichael Holzheu 		return ((struct info_blk_hdr *)hdr)->phys_cpus;
11224bbb1faSMichael Holzheu 	else /* INFO_EXT */
11324bbb1faSMichael Holzheu 		return ((struct x_info_blk_hdr *)hdr)->phys_cpus;
11424bbb1faSMichael Holzheu }
11524bbb1faSMichael Holzheu 
11624bbb1faSMichael Holzheu /* Partition header */
11724bbb1faSMichael Holzheu 
11824bbb1faSMichael Holzheu struct part_hdr {
11924bbb1faSMichael Holzheu 	__u8 pn;
12024bbb1faSMichael Holzheu 	__u8 cpus;
12124bbb1faSMichael Holzheu 	char reserved[6];
12224bbb1faSMichael Holzheu 	char part_name[LPAR_NAME_LEN];
12324bbb1faSMichael Holzheu } __attribute__ ((packed));
12424bbb1faSMichael Holzheu 
12524bbb1faSMichael Holzheu struct x_part_hdr {
12624bbb1faSMichael Holzheu 	__u8  pn;
12724bbb1faSMichael Holzheu 	__u8  cpus;
12824bbb1faSMichael Holzheu 	__u8  rcpus;
12924bbb1faSMichael Holzheu 	__u8  pflag;
13024bbb1faSMichael Holzheu 	__u32 mlu;
13124bbb1faSMichael Holzheu 	char  part_name[LPAR_NAME_LEN];
13224bbb1faSMichael Holzheu 	char  lpc_name[8];
13324bbb1faSMichael Holzheu 	char  os_name[8];
13424bbb1faSMichael Holzheu 	__u64 online_cs;
13524bbb1faSMichael Holzheu 	__u64 online_es;
13624bbb1faSMichael Holzheu 	__u8  upid;
13724bbb1faSMichael Holzheu 	char  reserved1[3];
13824bbb1faSMichael Holzheu 	__u32 group_mlu;
13924bbb1faSMichael Holzheu 	char  group_name[8];
14024bbb1faSMichael Holzheu 	char  reserved2[32];
14124bbb1faSMichael Holzheu } __attribute__ ((packed));
14224bbb1faSMichael Holzheu 
14324bbb1faSMichael Holzheu static inline int part_hdr__size(enum diag204_format type)
14424bbb1faSMichael Holzheu {
14524bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
14624bbb1faSMichael Holzheu 		return sizeof(struct part_hdr);
14724bbb1faSMichael Holzheu 	else /* INFO_EXT */
14824bbb1faSMichael Holzheu 		return sizeof(struct x_part_hdr);
14924bbb1faSMichael Holzheu }
15024bbb1faSMichael Holzheu 
15124bbb1faSMichael Holzheu static inline __u8 part_hdr__rcpus(enum diag204_format type, void *hdr)
15224bbb1faSMichael Holzheu {
15324bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
15424bbb1faSMichael Holzheu 		return ((struct part_hdr *)hdr)->cpus;
15524bbb1faSMichael Holzheu 	else /* INFO_EXT */
15624bbb1faSMichael Holzheu 		return ((struct x_part_hdr *)hdr)->rcpus;
15724bbb1faSMichael Holzheu }
15824bbb1faSMichael Holzheu 
15924bbb1faSMichael Holzheu static inline void part_hdr__part_name(enum diag204_format type, void *hdr,
16024bbb1faSMichael Holzheu 				       char *name)
16124bbb1faSMichael Holzheu {
16224bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
16324bbb1faSMichael Holzheu 		memcpy(name, ((struct part_hdr *)hdr)->part_name,
16424bbb1faSMichael Holzheu 		       LPAR_NAME_LEN);
16524bbb1faSMichael Holzheu 	else /* INFO_EXT */
16624bbb1faSMichael Holzheu 		memcpy(name, ((struct x_part_hdr *)hdr)->part_name,
16724bbb1faSMichael Holzheu 		       LPAR_NAME_LEN);
16824bbb1faSMichael Holzheu 	EBCASC(name, LPAR_NAME_LEN);
16924bbb1faSMichael Holzheu 	name[LPAR_NAME_LEN] = 0;
1701d802e24SHeiko Carstens 	strim(name);
17124bbb1faSMichael Holzheu }
17224bbb1faSMichael Holzheu 
17324bbb1faSMichael Holzheu struct cpu_info {
17424bbb1faSMichael Holzheu 	__u16 cpu_addr;
17524bbb1faSMichael Holzheu 	char  reserved1[2];
17624bbb1faSMichael Holzheu 	__u8  ctidx;
17724bbb1faSMichael Holzheu 	__u8  cflag;
17824bbb1faSMichael Holzheu 	__u16 weight;
17924bbb1faSMichael Holzheu 	__u64 acc_time;
18024bbb1faSMichael Holzheu 	__u64 lp_time;
18124bbb1faSMichael Holzheu } __attribute__ ((packed));
18224bbb1faSMichael Holzheu 
18324bbb1faSMichael Holzheu struct x_cpu_info {
18424bbb1faSMichael Holzheu 	__u16 cpu_addr;
18524bbb1faSMichael Holzheu 	char  reserved1[2];
18624bbb1faSMichael Holzheu 	__u8  ctidx;
18724bbb1faSMichael Holzheu 	__u8  cflag;
18824bbb1faSMichael Holzheu 	__u16 weight;
18924bbb1faSMichael Holzheu 	__u64 acc_time;
19024bbb1faSMichael Holzheu 	__u64 lp_time;
19124bbb1faSMichael Holzheu 	__u16 min_weight;
19224bbb1faSMichael Holzheu 	__u16 cur_weight;
19324bbb1faSMichael Holzheu 	__u16 max_weight;
19424bbb1faSMichael Holzheu 	char  reseved2[2];
19524bbb1faSMichael Holzheu 	__u64 online_time;
19624bbb1faSMichael Holzheu 	__u64 wait_time;
19724bbb1faSMichael Holzheu 	__u32 pma_weight;
19824bbb1faSMichael Holzheu 	__u32 polar_weight;
19924bbb1faSMichael Holzheu 	char  reserved3[40];
20024bbb1faSMichael Holzheu } __attribute__ ((packed));
20124bbb1faSMichael Holzheu 
20224bbb1faSMichael Holzheu /* CPU info block */
20324bbb1faSMichael Holzheu 
20424bbb1faSMichael Holzheu static inline int cpu_info__size(enum diag204_format type)
20524bbb1faSMichael Holzheu {
20624bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
20724bbb1faSMichael Holzheu 		return sizeof(struct cpu_info);
20824bbb1faSMichael Holzheu 	else /* INFO_EXT */
20924bbb1faSMichael Holzheu 		return sizeof(struct x_cpu_info);
21024bbb1faSMichael Holzheu }
21124bbb1faSMichael Holzheu 
21224bbb1faSMichael Holzheu static inline __u8 cpu_info__ctidx(enum diag204_format type, void *hdr)
21324bbb1faSMichael Holzheu {
21424bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
21524bbb1faSMichael Holzheu 		return ((struct cpu_info *)hdr)->ctidx;
21624bbb1faSMichael Holzheu 	else /* INFO_EXT */
21724bbb1faSMichael Holzheu 		return ((struct x_cpu_info *)hdr)->ctidx;
21824bbb1faSMichael Holzheu }
21924bbb1faSMichael Holzheu 
22024bbb1faSMichael Holzheu static inline __u16 cpu_info__cpu_addr(enum diag204_format type, void *hdr)
22124bbb1faSMichael Holzheu {
22224bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
22324bbb1faSMichael Holzheu 		return ((struct cpu_info *)hdr)->cpu_addr;
22424bbb1faSMichael Holzheu 	else /* INFO_EXT */
22524bbb1faSMichael Holzheu 		return ((struct x_cpu_info *)hdr)->cpu_addr;
22624bbb1faSMichael Holzheu }
22724bbb1faSMichael Holzheu 
22824bbb1faSMichael Holzheu static inline __u64 cpu_info__acc_time(enum diag204_format type, void *hdr)
22924bbb1faSMichael Holzheu {
23024bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
23124bbb1faSMichael Holzheu 		return ((struct cpu_info *)hdr)->acc_time;
23224bbb1faSMichael Holzheu 	else /* INFO_EXT */
23324bbb1faSMichael Holzheu 		return ((struct x_cpu_info *)hdr)->acc_time;
23424bbb1faSMichael Holzheu }
23524bbb1faSMichael Holzheu 
23624bbb1faSMichael Holzheu static inline __u64 cpu_info__lp_time(enum diag204_format type, void *hdr)
23724bbb1faSMichael Holzheu {
23824bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
23924bbb1faSMichael Holzheu 		return ((struct cpu_info *)hdr)->lp_time;
24024bbb1faSMichael Holzheu 	else /* INFO_EXT */
24124bbb1faSMichael Holzheu 		return ((struct x_cpu_info *)hdr)->lp_time;
24224bbb1faSMichael Holzheu }
24324bbb1faSMichael Holzheu 
24424bbb1faSMichael Holzheu static inline __u64 cpu_info__online_time(enum diag204_format type, void *hdr)
24524bbb1faSMichael Holzheu {
24624bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
24724bbb1faSMichael Holzheu 		return 0;	/* online_time not available in simple info */
24824bbb1faSMichael Holzheu 	else /* INFO_EXT */
24924bbb1faSMichael Holzheu 		return ((struct x_cpu_info *)hdr)->online_time;
25024bbb1faSMichael Holzheu }
25124bbb1faSMichael Holzheu 
25224bbb1faSMichael Holzheu /* Physical header */
25324bbb1faSMichael Holzheu 
25424bbb1faSMichael Holzheu struct phys_hdr {
25524bbb1faSMichael Holzheu 	char reserved1[1];
25624bbb1faSMichael Holzheu 	__u8 cpus;
25724bbb1faSMichael Holzheu 	char reserved2[6];
25824bbb1faSMichael Holzheu 	char mgm_name[8];
25924bbb1faSMichael Holzheu } __attribute__ ((packed));
26024bbb1faSMichael Holzheu 
26124bbb1faSMichael Holzheu struct x_phys_hdr {
26224bbb1faSMichael Holzheu 	char reserved1[1];
26324bbb1faSMichael Holzheu 	__u8 cpus;
26424bbb1faSMichael Holzheu 	char reserved2[6];
26524bbb1faSMichael Holzheu 	char mgm_name[8];
26624bbb1faSMichael Holzheu 	char reserved3[80];
26724bbb1faSMichael Holzheu } __attribute__ ((packed));
26824bbb1faSMichael Holzheu 
26924bbb1faSMichael Holzheu static inline int phys_hdr__size(enum diag204_format type)
27024bbb1faSMichael Holzheu {
27124bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
27224bbb1faSMichael Holzheu 		return sizeof(struct phys_hdr);
27324bbb1faSMichael Holzheu 	else /* INFO_EXT */
27424bbb1faSMichael Holzheu 		return sizeof(struct x_phys_hdr);
27524bbb1faSMichael Holzheu }
27624bbb1faSMichael Holzheu 
27724bbb1faSMichael Holzheu static inline __u8 phys_hdr__cpus(enum diag204_format type, void *hdr)
27824bbb1faSMichael Holzheu {
27924bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
28024bbb1faSMichael Holzheu 		return ((struct phys_hdr *)hdr)->cpus;
28124bbb1faSMichael Holzheu 	else /* INFO_EXT */
28224bbb1faSMichael Holzheu 		return ((struct x_phys_hdr *)hdr)->cpus;
28324bbb1faSMichael Holzheu }
28424bbb1faSMichael Holzheu 
28524bbb1faSMichael Holzheu /* Physical CPU info block */
28624bbb1faSMichael Holzheu 
28724bbb1faSMichael Holzheu struct phys_cpu {
28824bbb1faSMichael Holzheu 	__u16 cpu_addr;
28924bbb1faSMichael Holzheu 	char  reserved1[2];
29024bbb1faSMichael Holzheu 	__u8  ctidx;
29124bbb1faSMichael Holzheu 	char  reserved2[3];
29224bbb1faSMichael Holzheu 	__u64 mgm_time;
29324bbb1faSMichael Holzheu 	char  reserved3[8];
29424bbb1faSMichael Holzheu } __attribute__ ((packed));
29524bbb1faSMichael Holzheu 
29624bbb1faSMichael Holzheu struct x_phys_cpu {
29724bbb1faSMichael Holzheu 	__u16 cpu_addr;
29824bbb1faSMichael Holzheu 	char  reserved1[2];
29924bbb1faSMichael Holzheu 	__u8  ctidx;
30024bbb1faSMichael Holzheu 	char  reserved2[3];
30124bbb1faSMichael Holzheu 	__u64 mgm_time;
30224bbb1faSMichael Holzheu 	char  reserved3[80];
30324bbb1faSMichael Holzheu } __attribute__ ((packed));
30424bbb1faSMichael Holzheu 
30524bbb1faSMichael Holzheu static inline int phys_cpu__size(enum diag204_format type)
30624bbb1faSMichael Holzheu {
30724bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
30824bbb1faSMichael Holzheu 		return sizeof(struct phys_cpu);
30924bbb1faSMichael Holzheu 	else /* INFO_EXT */
31024bbb1faSMichael Holzheu 		return sizeof(struct x_phys_cpu);
31124bbb1faSMichael Holzheu }
31224bbb1faSMichael Holzheu 
31324bbb1faSMichael Holzheu static inline __u16 phys_cpu__cpu_addr(enum diag204_format type, void *hdr)
31424bbb1faSMichael Holzheu {
31524bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
31624bbb1faSMichael Holzheu 		return ((struct phys_cpu *)hdr)->cpu_addr;
31724bbb1faSMichael Holzheu 	else /* INFO_EXT */
31824bbb1faSMichael Holzheu 		return ((struct x_phys_cpu *)hdr)->cpu_addr;
31924bbb1faSMichael Holzheu }
32024bbb1faSMichael Holzheu 
32124bbb1faSMichael Holzheu static inline __u64 phys_cpu__mgm_time(enum diag204_format type, void *hdr)
32224bbb1faSMichael Holzheu {
32324bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
32424bbb1faSMichael Holzheu 		return ((struct phys_cpu *)hdr)->mgm_time;
32524bbb1faSMichael Holzheu 	else /* INFO_EXT */
32624bbb1faSMichael Holzheu 		return ((struct x_phys_cpu *)hdr)->mgm_time;
32724bbb1faSMichael Holzheu }
32824bbb1faSMichael Holzheu 
32924bbb1faSMichael Holzheu static inline __u64 phys_cpu__ctidx(enum diag204_format type, void *hdr)
33024bbb1faSMichael Holzheu {
33124bbb1faSMichael Holzheu 	if (type == INFO_SIMPLE)
33224bbb1faSMichael Holzheu 		return ((struct phys_cpu *)hdr)->ctidx;
33324bbb1faSMichael Holzheu 	else /* INFO_EXT */
33424bbb1faSMichael Holzheu 		return ((struct x_phys_cpu *)hdr)->ctidx;
33524bbb1faSMichael Holzheu }
33624bbb1faSMichael Holzheu 
33724bbb1faSMichael Holzheu /* Diagnose 204 functions */
33824bbb1faSMichael Holzheu 
33924bbb1faSMichael Holzheu static int diag204(unsigned long subcode, unsigned long size, void *addr)
34024bbb1faSMichael Holzheu {
34124bbb1faSMichael Holzheu 	register unsigned long _subcode asm("0") = subcode;
34224bbb1faSMichael Holzheu 	register unsigned long _size asm("1") = size;
34324bbb1faSMichael Holzheu 
34494c12cc7SMartin Schwidefsky 	asm volatile(
34594c12cc7SMartin Schwidefsky 		"	diag	%2,%0,0x204\n"
34694c12cc7SMartin Schwidefsky 		"0:\n"
34794c12cc7SMartin Schwidefsky 		EX_TABLE(0b,0b)
34894c12cc7SMartin Schwidefsky 		: "+d" (_subcode), "+d" (_size) : "d" (addr) : "memory");
34924bbb1faSMichael Holzheu 	if (_subcode)
35024bbb1faSMichael Holzheu 		return -1;
35124bbb1faSMichael Holzheu 	return _size;
35224bbb1faSMichael Holzheu }
35324bbb1faSMichael Holzheu 
35424bbb1faSMichael Holzheu /*
35524bbb1faSMichael Holzheu  * For the old diag subcode 4 with simple data format we have to use real
35624bbb1faSMichael Holzheu  * memory. If we use subcode 6 or 7 with extended data format, we can (and
35724bbb1faSMichael Holzheu  * should) use vmalloc, since we need a lot of memory in that case. Currently
35824bbb1faSMichael Holzheu  * up to 93 pages!
35924bbb1faSMichael Holzheu  */
36024bbb1faSMichael Holzheu 
36124bbb1faSMichael Holzheu static void diag204_free_buffer(void)
36224bbb1faSMichael Holzheu {
36324bbb1faSMichael Holzheu 	if (!diag204_buf)
36424bbb1faSMichael Holzheu 		return;
36524bbb1faSMichael Holzheu 	if (diag204_buf_vmalloc) {
36624bbb1faSMichael Holzheu 		vfree(diag204_buf_vmalloc);
36724bbb1faSMichael Holzheu 		diag204_buf_vmalloc = NULL;
36824bbb1faSMichael Holzheu 	} else {
36924bbb1faSMichael Holzheu 		free_pages((unsigned long) diag204_buf, 0);
37024bbb1faSMichael Holzheu 	}
37124bbb1faSMichael Holzheu 	diag204_buf = NULL;
37224bbb1faSMichael Holzheu }
37324bbb1faSMichael Holzheu 
37457b28f66SMichael Holzheu static void *page_align_ptr(void *ptr)
37557b28f66SMichael Holzheu {
37657b28f66SMichael Holzheu 	return (void *) PAGE_ALIGN((unsigned long) ptr);
37757b28f66SMichael Holzheu }
37857b28f66SMichael Holzheu 
37924bbb1faSMichael Holzheu static void *diag204_alloc_vbuf(int pages)
38024bbb1faSMichael Holzheu {
38124bbb1faSMichael Holzheu 	/* The buffer has to be page aligned! */
38224bbb1faSMichael Holzheu 	diag204_buf_vmalloc = vmalloc(PAGE_SIZE * (pages + 1));
38324bbb1faSMichael Holzheu 	if (!diag204_buf_vmalloc)
38424bbb1faSMichael Holzheu 		return ERR_PTR(-ENOMEM);
38557b28f66SMichael Holzheu 	diag204_buf = page_align_ptr(diag204_buf_vmalloc);
38624bbb1faSMichael Holzheu 	diag204_buf_pages = pages;
38724bbb1faSMichael Holzheu 	return diag204_buf;
38824bbb1faSMichael Holzheu }
38924bbb1faSMichael Holzheu 
39024bbb1faSMichael Holzheu static void *diag204_alloc_rbuf(void)
39124bbb1faSMichael Holzheu {
39224bbb1faSMichael Holzheu 	diag204_buf = (void*)__get_free_pages(GFP_KERNEL,0);
39386b22470SChristian Borntraeger 	if (!diag204_buf)
39424bbb1faSMichael Holzheu 		return ERR_PTR(-ENOMEM);
39524bbb1faSMichael Holzheu 	diag204_buf_pages = 1;
39624bbb1faSMichael Holzheu 	return diag204_buf;
39724bbb1faSMichael Holzheu }
39824bbb1faSMichael Holzheu 
39924bbb1faSMichael Holzheu static void *diag204_get_buffer(enum diag204_format fmt, int *pages)
40024bbb1faSMichael Holzheu {
40124bbb1faSMichael Holzheu 	if (diag204_buf) {
40224bbb1faSMichael Holzheu 		*pages = diag204_buf_pages;
40324bbb1faSMichael Holzheu 		return diag204_buf;
40424bbb1faSMichael Holzheu 	}
40524bbb1faSMichael Holzheu 	if (fmt == INFO_SIMPLE) {
40624bbb1faSMichael Holzheu 		*pages = 1;
40724bbb1faSMichael Holzheu 		return diag204_alloc_rbuf();
40824bbb1faSMichael Holzheu 	} else {/* INFO_EXT */
40923c100d9SMichael Holzheu 		*pages = diag204((unsigned long)SUBC_RSI |
41023c100d9SMichael Holzheu 				 (unsigned long)INFO_EXT, 0, NULL);
41124bbb1faSMichael Holzheu 		if (*pages <= 0)
41224bbb1faSMichael Holzheu 			return ERR_PTR(-ENOSYS);
41324bbb1faSMichael Holzheu 		else
41424bbb1faSMichael Holzheu 			return diag204_alloc_vbuf(*pages);
41524bbb1faSMichael Holzheu 	}
41624bbb1faSMichael Holzheu }
41724bbb1faSMichael Holzheu 
41824bbb1faSMichael Holzheu /*
41924bbb1faSMichael Holzheu  * diag204_probe() has to find out, which type of diagnose 204 implementation
42024bbb1faSMichael Holzheu  * we have on our machine. Currently there are three possible scanarios:
42124bbb1faSMichael Holzheu  *   - subcode 4   + simple data format (only one page)
42224bbb1faSMichael Holzheu  *   - subcode 4-6 + extended data format
42324bbb1faSMichael Holzheu  *   - subcode 4-7 + extended data format
42424bbb1faSMichael Holzheu  *
42524bbb1faSMichael Holzheu  * Subcode 5 is used to retrieve the size of the data, provided by subcodes
42624bbb1faSMichael Holzheu  * 6 and 7. Subcode 7 basically has the same function as subcode 6. In addition
42724bbb1faSMichael Holzheu  * to subcode 6 it provides also information about secondary cpus.
42824bbb1faSMichael Holzheu  * In order to get as much information as possible, we first try
42924bbb1faSMichael Holzheu  * subcode 7, then 6 and if both fail, we use subcode 4.
43024bbb1faSMichael Holzheu  */
43124bbb1faSMichael Holzheu 
43224bbb1faSMichael Holzheu static int diag204_probe(void)
43324bbb1faSMichael Holzheu {
43424bbb1faSMichael Holzheu 	void *buf;
43524bbb1faSMichael Holzheu 	int pages, rc;
43624bbb1faSMichael Holzheu 
43724bbb1faSMichael Holzheu 	buf = diag204_get_buffer(INFO_EXT, &pages);
43824bbb1faSMichael Holzheu 	if (!IS_ERR(buf)) {
439331c982dSMichael Holzheu 		if (diag204((unsigned long)SUBC_STIB7 |
440331c982dSMichael Holzheu 			    (unsigned long)INFO_EXT, pages, buf) >= 0) {
44124bbb1faSMichael Holzheu 			diag204_store_sc = SUBC_STIB7;
44224bbb1faSMichael Holzheu 			diag204_info_type = INFO_EXT;
44324bbb1faSMichael Holzheu 			goto out;
44424bbb1faSMichael Holzheu 		}
445331c982dSMichael Holzheu 		if (diag204((unsigned long)SUBC_STIB6 |
446331c982dSMichael Holzheu 			    (unsigned long)INFO_EXT, pages, buf) >= 0) {
4477874b1b6SMichael Holzheu 			diag204_store_sc = SUBC_STIB6;
44824bbb1faSMichael Holzheu 			diag204_info_type = INFO_EXT;
44924bbb1faSMichael Holzheu 			goto out;
45024bbb1faSMichael Holzheu 		}
45124bbb1faSMichael Holzheu 		diag204_free_buffer();
45224bbb1faSMichael Holzheu 	}
45324bbb1faSMichael Holzheu 
45424bbb1faSMichael Holzheu 	/* subcodes 6 and 7 failed, now try subcode 4 */
45524bbb1faSMichael Holzheu 
45624bbb1faSMichael Holzheu 	buf = diag204_get_buffer(INFO_SIMPLE, &pages);
45724bbb1faSMichael Holzheu 	if (IS_ERR(buf)) {
45824bbb1faSMichael Holzheu 		rc = PTR_ERR(buf);
45924bbb1faSMichael Holzheu 		goto fail_alloc;
46024bbb1faSMichael Holzheu 	}
461331c982dSMichael Holzheu 	if (diag204((unsigned long)SUBC_STIB4 |
462331c982dSMichael Holzheu 		    (unsigned long)INFO_SIMPLE, pages, buf) >= 0) {
46324bbb1faSMichael Holzheu 		diag204_store_sc = SUBC_STIB4;
46424bbb1faSMichael Holzheu 		diag204_info_type = INFO_SIMPLE;
46524bbb1faSMichael Holzheu 		goto out;
46624bbb1faSMichael Holzheu 	} else {
46724bbb1faSMichael Holzheu 		rc = -ENOSYS;
46824bbb1faSMichael Holzheu 		goto fail_store;
46924bbb1faSMichael Holzheu 	}
47024bbb1faSMichael Holzheu out:
47124bbb1faSMichael Holzheu 	rc = 0;
47224bbb1faSMichael Holzheu fail_store:
47324bbb1faSMichael Holzheu 	diag204_free_buffer();
47424bbb1faSMichael Holzheu fail_alloc:
47524bbb1faSMichael Holzheu 	return rc;
47624bbb1faSMichael Holzheu }
47724bbb1faSMichael Holzheu 
47857b28f66SMichael Holzheu static int diag204_do_store(void *buf, int pages)
47957b28f66SMichael Holzheu {
48057b28f66SMichael Holzheu 	int rc;
48157b28f66SMichael Holzheu 
48257b28f66SMichael Holzheu 	rc = diag204((unsigned long) diag204_store_sc |
48357b28f66SMichael Holzheu 		     (unsigned long) diag204_info_type, pages, buf);
48457b28f66SMichael Holzheu 	return rc < 0 ? -ENOSYS : 0;
48557b28f66SMichael Holzheu }
48657b28f66SMichael Holzheu 
48724bbb1faSMichael Holzheu static void *diag204_store(void)
48824bbb1faSMichael Holzheu {
48924bbb1faSMichael Holzheu 	void *buf;
49057b28f66SMichael Holzheu 	int pages, rc;
49124bbb1faSMichael Holzheu 
49224bbb1faSMichael Holzheu 	buf = diag204_get_buffer(diag204_info_type, &pages);
49324bbb1faSMichael Holzheu 	if (IS_ERR(buf))
49424bbb1faSMichael Holzheu 		goto out;
49557b28f66SMichael Holzheu 	rc = diag204_do_store(buf, pages);
49657b28f66SMichael Holzheu 	if (rc)
49757b28f66SMichael Holzheu 		return ERR_PTR(rc);
49824bbb1faSMichael Holzheu out:
49924bbb1faSMichael Holzheu 	return buf;
50024bbb1faSMichael Holzheu }
50124bbb1faSMichael Holzheu 
50224bbb1faSMichael Holzheu /* Diagnose 224 functions */
50324bbb1faSMichael Holzheu 
504c41d4e3eSMichael Holzheu static int diag224(void *ptr)
50524bbb1faSMichael Holzheu {
506b8e660b8SHeiko Carstens 	int rc = -EOPNOTSUPP;
507c41d4e3eSMichael Holzheu 
508c41d4e3eSMichael Holzheu 	asm volatile(
509c41d4e3eSMichael Holzheu 		"	diag	%1,%2,0x224\n"
510c41d4e3eSMichael Holzheu 		"0:	lhi	%0,0x0\n"
511c41d4e3eSMichael Holzheu 		"1:\n"
512c41d4e3eSMichael Holzheu 		EX_TABLE(0b,1b)
513c41d4e3eSMichael Holzheu 		: "+d" (rc) :"d" (0), "d" (ptr) : "memory");
514c41d4e3eSMichael Holzheu 	return rc;
51524bbb1faSMichael Holzheu }
51624bbb1faSMichael Holzheu 
51724bbb1faSMichael Holzheu static int diag224_get_name_table(void)
51824bbb1faSMichael Holzheu {
51924bbb1faSMichael Holzheu 	/* memory must be below 2GB */
52024bbb1faSMichael Holzheu 	diag224_cpu_names = kmalloc(PAGE_SIZE, GFP_KERNEL | GFP_DMA);
52124bbb1faSMichael Holzheu 	if (!diag224_cpu_names)
52224bbb1faSMichael Holzheu 		return -ENOMEM;
523c41d4e3eSMichael Holzheu 	if (diag224(diag224_cpu_names)) {
524c41d4e3eSMichael Holzheu 		kfree(diag224_cpu_names);
525b8e660b8SHeiko Carstens 		return -EOPNOTSUPP;
526c41d4e3eSMichael Holzheu 	}
52724bbb1faSMichael Holzheu 	EBCASC(diag224_cpu_names + 16, (*diag224_cpu_names + 1) * 16);
52824bbb1faSMichael Holzheu 	return 0;
52924bbb1faSMichael Holzheu }
53024bbb1faSMichael Holzheu 
53124bbb1faSMichael Holzheu static void diag224_delete_name_table(void)
53224bbb1faSMichael Holzheu {
53324bbb1faSMichael Holzheu 	kfree(diag224_cpu_names);
53424bbb1faSMichael Holzheu }
53524bbb1faSMichael Holzheu 
53624bbb1faSMichael Holzheu static int diag224_idx2name(int index, char *name)
53724bbb1faSMichael Holzheu {
53824bbb1faSMichael Holzheu 	memcpy(name, diag224_cpu_names + ((index + 1) * CPU_NAME_LEN),
53924bbb1faSMichael Holzheu 		CPU_NAME_LEN);
54024bbb1faSMichael Holzheu 	name[CPU_NAME_LEN] = 0;
5411d802e24SHeiko Carstens 	strim(name);
54224bbb1faSMichael Holzheu 	return 0;
54324bbb1faSMichael Holzheu }
54424bbb1faSMichael Holzheu 
54557b28f66SMichael Holzheu struct dbfs_d204_hdr {
54657b28f66SMichael Holzheu 	u64	len;		/* Length of d204 buffer without header */
54757b28f66SMichael Holzheu 	u16	version;	/* Version of header */
54857b28f66SMichael Holzheu 	u8	sc;		/* Used subcode */
54957b28f66SMichael Holzheu 	char	reserved[53];
55057b28f66SMichael Holzheu } __attribute__ ((packed));
55157b28f66SMichael Holzheu 
55257b28f66SMichael Holzheu struct dbfs_d204 {
55357b28f66SMichael Holzheu 	struct dbfs_d204_hdr	hdr;	/* 64 byte header */
55457b28f66SMichael Holzheu 	char			buf[];	/* d204 buffer */
55557b28f66SMichael Holzheu } __attribute__ ((packed));
55657b28f66SMichael Holzheu 
5572fcb3686SMichael Holzheu static int dbfs_d204_create(void **data, void **data_free_ptr, size_t *size)
55857b28f66SMichael Holzheu {
55957b28f66SMichael Holzheu 	struct dbfs_d204 *d204;
56057b28f66SMichael Holzheu 	int rc, buf_size;
5612fcb3686SMichael Holzheu 	void *base;
56257b28f66SMichael Holzheu 
56357b28f66SMichael Holzheu 	buf_size = PAGE_SIZE * (diag204_buf_pages + 1) + sizeof(d204->hdr);
564dc8a5c99SJoe Perches 	base = vzalloc(buf_size);
5652fcb3686SMichael Holzheu 	if (!base)
5662fcb3686SMichael Holzheu 		return -ENOMEM;
5672fcb3686SMichael Holzheu 	d204 = page_align_ptr(base + sizeof(d204->hdr)) - sizeof(d204->hdr);
5682fcb3686SMichael Holzheu 	rc = diag204_do_store(d204->buf, diag204_buf_pages);
5692fcb3686SMichael Holzheu 	if (rc) {
5702fcb3686SMichael Holzheu 		vfree(base);
5712fcb3686SMichael Holzheu 		return rc;
57257b28f66SMichael Holzheu 	}
57357b28f66SMichael Holzheu 	d204->hdr.version = DBFS_D204_HDR_VERSION;
57457b28f66SMichael Holzheu 	d204->hdr.len = PAGE_SIZE * diag204_buf_pages;
57557b28f66SMichael Holzheu 	d204->hdr.sc = diag204_store_sc;
5762fcb3686SMichael Holzheu 	*data = d204;
5772fcb3686SMichael Holzheu 	*data_free_ptr = base;
5782fcb3686SMichael Holzheu 	*size = d204->hdr.len + sizeof(struct dbfs_d204_hdr);
57957b28f66SMichael Holzheu 	return 0;
58057b28f66SMichael Holzheu }
58157b28f66SMichael Holzheu 
5822fcb3686SMichael Holzheu static struct hypfs_dbfs_file dbfs_file_d204 = {
5832fcb3686SMichael Holzheu 	.name		= "diag_204",
5842fcb3686SMichael Holzheu 	.data_create	= dbfs_d204_create,
5852fcb3686SMichael Holzheu 	.data_free	= vfree,
58657b28f66SMichael Holzheu };
58757b28f66SMichael Holzheu 
58824bbb1faSMichael Holzheu __init int hypfs_diag_init(void)
58924bbb1faSMichael Holzheu {
59024bbb1faSMichael Holzheu 	int rc;
59124bbb1faSMichael Holzheu 
59224bbb1faSMichael Holzheu 	if (diag204_probe()) {
593f55495baSMichael Holzheu 		pr_err("The hardware system does not support hypfs\n");
59424bbb1faSMichael Holzheu 		return -ENODATA;
59524bbb1faSMichael Holzheu 	}
59657b28f66SMichael Holzheu 	if (diag204_info_type == INFO_EXT) {
5972fcb3686SMichael Holzheu 		rc = hypfs_dbfs_create_file(&dbfs_file_d204);
59857b28f66SMichael Holzheu 		if (rc)
59924bbb1faSMichael Holzheu 			return rc;
60024bbb1faSMichael Holzheu 	}
6013c8ebca0SMichael Holzheu 	if (MACHINE_IS_LPAR) {
6023c8ebca0SMichael Holzheu 		rc = diag224_get_name_table();
6033c8ebca0SMichael Holzheu 		if (rc) {
6043c8ebca0SMichael Holzheu 			pr_err("The hardware system does not provide all "
6053c8ebca0SMichael Holzheu 			       "functions required by hypfs\n");
6063c8ebca0SMichael Holzheu 			debugfs_remove(dbfs_d204_file);
6073c8ebca0SMichael Holzheu 			return rc;
6083c8ebca0SMichael Holzheu 		}
6093c8ebca0SMichael Holzheu 	}
6103c8ebca0SMichael Holzheu 	return 0;
6113c8ebca0SMichael Holzheu }
61224bbb1faSMichael Holzheu 
6131375fc1fSHeiko Carstens void hypfs_diag_exit(void)
61424bbb1faSMichael Holzheu {
61557b28f66SMichael Holzheu 	debugfs_remove(dbfs_d204_file);
61624bbb1faSMichael Holzheu 	diag224_delete_name_table();
61724bbb1faSMichael Holzheu 	diag204_free_buffer();
6182fcb3686SMichael Holzheu 	hypfs_dbfs_remove_file(&dbfs_file_d204);
61924bbb1faSMichael Holzheu }
62024bbb1faSMichael Holzheu 
62124bbb1faSMichael Holzheu /*
62224bbb1faSMichael Holzheu  * Functions to create the directory structure
62324bbb1faSMichael Holzheu  * *******************************************
62424bbb1faSMichael Holzheu  */
62524bbb1faSMichael Holzheu 
62624bbb1faSMichael Holzheu static int hypfs_create_cpu_files(struct super_block *sb,
62724bbb1faSMichael Holzheu 				  struct dentry *cpus_dir, void *cpu_info)
62824bbb1faSMichael Holzheu {
62924bbb1faSMichael Holzheu 	struct dentry *cpu_dir;
63024bbb1faSMichael Holzheu 	char buffer[TMP_SIZE];
63124bbb1faSMichael Holzheu 	void *rc;
63224bbb1faSMichael Holzheu 
63324bbb1faSMichael Holzheu 	snprintf(buffer, TMP_SIZE, "%d", cpu_info__cpu_addr(diag204_info_type,
63424bbb1faSMichael Holzheu 							    cpu_info));
63524bbb1faSMichael Holzheu 	cpu_dir = hypfs_mkdir(sb, cpus_dir, buffer);
63624bbb1faSMichael Holzheu 	rc = hypfs_create_u64(sb, cpu_dir, "mgmtime",
63724bbb1faSMichael Holzheu 			      cpu_info__acc_time(diag204_info_type, cpu_info) -
63824bbb1faSMichael Holzheu 			      cpu_info__lp_time(diag204_info_type, cpu_info));
63924bbb1faSMichael Holzheu 	if (IS_ERR(rc))
64024bbb1faSMichael Holzheu 		return PTR_ERR(rc);
64124bbb1faSMichael Holzheu 	rc = hypfs_create_u64(sb, cpu_dir, "cputime",
64224bbb1faSMichael Holzheu 			      cpu_info__lp_time(diag204_info_type, cpu_info));
64324bbb1faSMichael Holzheu 	if (IS_ERR(rc))
64424bbb1faSMichael Holzheu 		return PTR_ERR(rc);
64524bbb1faSMichael Holzheu 	if (diag204_info_type == INFO_EXT) {
64624bbb1faSMichael Holzheu 		rc = hypfs_create_u64(sb, cpu_dir, "onlinetime",
64724bbb1faSMichael Holzheu 				      cpu_info__online_time(diag204_info_type,
64824bbb1faSMichael Holzheu 							    cpu_info));
64924bbb1faSMichael Holzheu 		if (IS_ERR(rc))
65024bbb1faSMichael Holzheu 			return PTR_ERR(rc);
65124bbb1faSMichael Holzheu 	}
65224bbb1faSMichael Holzheu 	diag224_idx2name(cpu_info__ctidx(diag204_info_type, cpu_info), buffer);
65324bbb1faSMichael Holzheu 	rc = hypfs_create_str(sb, cpu_dir, "type", buffer);
6545eba9bb8SThomas Meyer 	return PTR_RET(rc);
65524bbb1faSMichael Holzheu }
65624bbb1faSMichael Holzheu 
65724bbb1faSMichael Holzheu static void *hypfs_create_lpar_files(struct super_block *sb,
65824bbb1faSMichael Holzheu 				     struct dentry *systems_dir, void *part_hdr)
65924bbb1faSMichael Holzheu {
66024bbb1faSMichael Holzheu 	struct dentry *cpus_dir;
66124bbb1faSMichael Holzheu 	struct dentry *lpar_dir;
66224bbb1faSMichael Holzheu 	char lpar_name[LPAR_NAME_LEN + 1];
66324bbb1faSMichael Holzheu 	void *cpu_info;
66424bbb1faSMichael Holzheu 	int i;
66524bbb1faSMichael Holzheu 
66624bbb1faSMichael Holzheu 	part_hdr__part_name(diag204_info_type, part_hdr, lpar_name);
66724bbb1faSMichael Holzheu 	lpar_name[LPAR_NAME_LEN] = 0;
66824bbb1faSMichael Holzheu 	lpar_dir = hypfs_mkdir(sb, systems_dir, lpar_name);
66924bbb1faSMichael Holzheu 	if (IS_ERR(lpar_dir))
67024bbb1faSMichael Holzheu 		return lpar_dir;
67124bbb1faSMichael Holzheu 	cpus_dir = hypfs_mkdir(sb, lpar_dir, "cpus");
67224bbb1faSMichael Holzheu 	if (IS_ERR(cpus_dir))
67324bbb1faSMichael Holzheu 		return cpus_dir;
67424bbb1faSMichael Holzheu 	cpu_info = part_hdr + part_hdr__size(diag204_info_type);
67524bbb1faSMichael Holzheu 	for (i = 0; i < part_hdr__rcpus(diag204_info_type, part_hdr); i++) {
67624bbb1faSMichael Holzheu 		int rc;
67724bbb1faSMichael Holzheu 		rc = hypfs_create_cpu_files(sb, cpus_dir, cpu_info);
67824bbb1faSMichael Holzheu 		if (rc)
67924bbb1faSMichael Holzheu 			return ERR_PTR(rc);
68024bbb1faSMichael Holzheu 		cpu_info += cpu_info__size(diag204_info_type);
68124bbb1faSMichael Holzheu 	}
68224bbb1faSMichael Holzheu 	return cpu_info;
68324bbb1faSMichael Holzheu }
68424bbb1faSMichael Holzheu 
68524bbb1faSMichael Holzheu static int hypfs_create_phys_cpu_files(struct super_block *sb,
68624bbb1faSMichael Holzheu 				       struct dentry *cpus_dir, void *cpu_info)
68724bbb1faSMichael Holzheu {
68824bbb1faSMichael Holzheu 	struct dentry *cpu_dir;
68924bbb1faSMichael Holzheu 	char buffer[TMP_SIZE];
69024bbb1faSMichael Holzheu 	void *rc;
69124bbb1faSMichael Holzheu 
69224bbb1faSMichael Holzheu 	snprintf(buffer, TMP_SIZE, "%i", phys_cpu__cpu_addr(diag204_info_type,
69324bbb1faSMichael Holzheu 							    cpu_info));
69424bbb1faSMichael Holzheu 	cpu_dir = hypfs_mkdir(sb, cpus_dir, buffer);
69524bbb1faSMichael Holzheu 	if (IS_ERR(cpu_dir))
69624bbb1faSMichael Holzheu 		return PTR_ERR(cpu_dir);
69724bbb1faSMichael Holzheu 	rc = hypfs_create_u64(sb, cpu_dir, "mgmtime",
69824bbb1faSMichael Holzheu 			      phys_cpu__mgm_time(diag204_info_type, cpu_info));
69924bbb1faSMichael Holzheu 	if (IS_ERR(rc))
70024bbb1faSMichael Holzheu 		return PTR_ERR(rc);
70124bbb1faSMichael Holzheu 	diag224_idx2name(phys_cpu__ctidx(diag204_info_type, cpu_info), buffer);
70224bbb1faSMichael Holzheu 	rc = hypfs_create_str(sb, cpu_dir, "type", buffer);
7035eba9bb8SThomas Meyer 	return PTR_RET(rc);
70424bbb1faSMichael Holzheu }
70524bbb1faSMichael Holzheu 
70624bbb1faSMichael Holzheu static void *hypfs_create_phys_files(struct super_block *sb,
70724bbb1faSMichael Holzheu 				     struct dentry *parent_dir, void *phys_hdr)
70824bbb1faSMichael Holzheu {
70924bbb1faSMichael Holzheu 	int i;
71024bbb1faSMichael Holzheu 	void *cpu_info;
71124bbb1faSMichael Holzheu 	struct dentry *cpus_dir;
71224bbb1faSMichael Holzheu 
71324bbb1faSMichael Holzheu 	cpus_dir = hypfs_mkdir(sb, parent_dir, "cpus");
71424bbb1faSMichael Holzheu 	if (IS_ERR(cpus_dir))
71524bbb1faSMichael Holzheu 		return cpus_dir;
71624bbb1faSMichael Holzheu 	cpu_info = phys_hdr + phys_hdr__size(diag204_info_type);
71724bbb1faSMichael Holzheu 	for (i = 0; i < phys_hdr__cpus(diag204_info_type, phys_hdr); i++) {
71824bbb1faSMichael Holzheu 		int rc;
71924bbb1faSMichael Holzheu 		rc = hypfs_create_phys_cpu_files(sb, cpus_dir, cpu_info);
72024bbb1faSMichael Holzheu 		if (rc)
72124bbb1faSMichael Holzheu 			return ERR_PTR(rc);
72224bbb1faSMichael Holzheu 		cpu_info += phys_cpu__size(diag204_info_type);
72324bbb1faSMichael Holzheu 	}
72424bbb1faSMichael Holzheu 	return cpu_info;
72524bbb1faSMichael Holzheu }
72624bbb1faSMichael Holzheu 
72724bbb1faSMichael Holzheu int hypfs_diag_create_files(struct super_block *sb, struct dentry *root)
72824bbb1faSMichael Holzheu {
72924bbb1faSMichael Holzheu 	struct dentry *systems_dir, *hyp_dir;
73024bbb1faSMichael Holzheu 	void *time_hdr, *part_hdr;
73124bbb1faSMichael Holzheu 	int i, rc;
73224bbb1faSMichael Holzheu 	void *buffer, *ptr;
73324bbb1faSMichael Holzheu 
73424bbb1faSMichael Holzheu 	buffer = diag204_store();
73524bbb1faSMichael Holzheu 	if (IS_ERR(buffer))
73624bbb1faSMichael Holzheu 		return PTR_ERR(buffer);
73724bbb1faSMichael Holzheu 
73824bbb1faSMichael Holzheu 	systems_dir = hypfs_mkdir(sb, root, "systems");
73924bbb1faSMichael Holzheu 	if (IS_ERR(systems_dir)) {
74024bbb1faSMichael Holzheu 		rc = PTR_ERR(systems_dir);
74124bbb1faSMichael Holzheu 		goto err_out;
74224bbb1faSMichael Holzheu 	}
74324bbb1faSMichael Holzheu 	time_hdr = (struct x_info_blk_hdr *)buffer;
74424bbb1faSMichael Holzheu 	part_hdr = time_hdr + info_blk_hdr__size(diag204_info_type);
74524bbb1faSMichael Holzheu 	for (i = 0; i < info_blk_hdr__npar(diag204_info_type, time_hdr); i++) {
74624bbb1faSMichael Holzheu 		part_hdr = hypfs_create_lpar_files(sb, systems_dir, part_hdr);
74724bbb1faSMichael Holzheu 		if (IS_ERR(part_hdr)) {
74824bbb1faSMichael Holzheu 			rc = PTR_ERR(part_hdr);
74924bbb1faSMichael Holzheu 			goto err_out;
75024bbb1faSMichael Holzheu 		}
75124bbb1faSMichael Holzheu 	}
75224bbb1faSMichael Holzheu 	if (info_blk_hdr__flags(diag204_info_type, time_hdr) & LPAR_PHYS_FLG) {
75324bbb1faSMichael Holzheu 		ptr = hypfs_create_phys_files(sb, root, part_hdr);
75424bbb1faSMichael Holzheu 		if (IS_ERR(ptr)) {
75524bbb1faSMichael Holzheu 			rc = PTR_ERR(ptr);
75624bbb1faSMichael Holzheu 			goto err_out;
75724bbb1faSMichael Holzheu 		}
75824bbb1faSMichael Holzheu 	}
75924bbb1faSMichael Holzheu 	hyp_dir = hypfs_mkdir(sb, root, "hyp");
76024bbb1faSMichael Holzheu 	if (IS_ERR(hyp_dir)) {
76124bbb1faSMichael Holzheu 		rc = PTR_ERR(hyp_dir);
76224bbb1faSMichael Holzheu 		goto err_out;
76324bbb1faSMichael Holzheu 	}
76424bbb1faSMichael Holzheu 	ptr = hypfs_create_str(sb, hyp_dir, "type", "LPAR Hypervisor");
76524bbb1faSMichael Holzheu 	if (IS_ERR(ptr)) {
76624bbb1faSMichael Holzheu 		rc = PTR_ERR(ptr);
76724bbb1faSMichael Holzheu 		goto err_out;
76824bbb1faSMichael Holzheu 	}
76924bbb1faSMichael Holzheu 	rc = 0;
77024bbb1faSMichael Holzheu 
77124bbb1faSMichael Holzheu err_out:
77224bbb1faSMichael Holzheu 	return rc;
77324bbb1faSMichael Holzheu }
774