1b2441318SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0 224bbb1faSMichael Holzheu /* 324bbb1faSMichael Holzheu * Hypervisor filesystem for Linux on s390. Diag 204 and 224 424bbb1faSMichael Holzheu * implementation. 524bbb1faSMichael Holzheu * 6f55495baSMichael Holzheu * Copyright IBM Corp. 2006, 2008 724bbb1faSMichael Holzheu * Author(s): Michael Holzheu <holzheu@de.ibm.com> 824bbb1faSMichael Holzheu */ 924bbb1faSMichael Holzheu 10f55495baSMichael Holzheu #define KMSG_COMPONENT "hypfs" 11f55495baSMichael Holzheu #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt 12f55495baSMichael Holzheu 1324bbb1faSMichael Holzheu #include <linux/types.h> 1424bbb1faSMichael Holzheu #include <linux/errno.h> 1533b26d79SHeiko Carstens #include <linux/slab.h> 1624bbb1faSMichael Holzheu #include <linux/string.h> 1724bbb1faSMichael Holzheu #include <linux/vmalloc.h> 1857b28f66SMichael Holzheu #include <linux/mm.h> 191ec2772eSMartin Schwidefsky #include <asm/diag.h> 2024bbb1faSMichael Holzheu #include <asm/ebcdic.h> 2124bbb1faSMichael Holzheu #include "hypfs.h" 2224bbb1faSMichael Holzheu 2324bbb1faSMichael Holzheu #define TMP_SIZE 64 /* size of temporary buffers */ 2424bbb1faSMichael Holzheu 2557b28f66SMichael Holzheu #define DBFS_D204_HDR_VERSION 0 2657b28f66SMichael Holzheu 2724bbb1faSMichael Holzheu static char *diag224_cpu_names; /* diag 224 name table */ 2824bbb1faSMichael Holzheu static enum diag204_sc diag204_store_sc; /* used subcode for store */ 2924bbb1faSMichael Holzheu static enum diag204_format diag204_info_type; /* used diag 204 data format */ 3024bbb1faSMichael Holzheu 3124bbb1faSMichael Holzheu static void *diag204_buf; /* 4K aligned buffer for diag204 data */ 3224bbb1faSMichael Holzheu static int diag204_buf_pages; /* number of pages for diag204 data */ 3324bbb1faSMichael Holzheu 3457b28f66SMichael Holzheu static struct dentry *dbfs_d204_file; 3557b28f66SMichael Holzheu 3624bbb1faSMichael Holzheu /* 37e65f30e0SJanosch Frank * DIAG 204 member access functions. 3824bbb1faSMichael Holzheu * 3924bbb1faSMichael Holzheu * Since we have two different diag 204 data formats for old and new s390 4024bbb1faSMichael Holzheu * machines, we do not access the structs directly, but use getter functions for 4124bbb1faSMichael Holzheu * each struct member instead. This should make the code more readable. 4224bbb1faSMichael Holzheu */ 4324bbb1faSMichael Holzheu 4424bbb1faSMichael Holzheu /* Time information block */ 4524bbb1faSMichael Holzheu 4624bbb1faSMichael Holzheu static inline int info_blk_hdr__size(enum diag204_format type) 4724bbb1faSMichael Holzheu { 48e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 49e65f30e0SJanosch Frank return sizeof(struct diag204_info_blk_hdr); 50e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 51e65f30e0SJanosch Frank return sizeof(struct diag204_x_info_blk_hdr); 5224bbb1faSMichael Holzheu } 5324bbb1faSMichael Holzheu 5424bbb1faSMichael Holzheu static inline __u8 info_blk_hdr__npar(enum diag204_format type, void *hdr) 5524bbb1faSMichael Holzheu { 56e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 57e65f30e0SJanosch Frank return ((struct diag204_info_blk_hdr *)hdr)->npar; 58e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 59e65f30e0SJanosch Frank return ((struct diag204_x_info_blk_hdr *)hdr)->npar; 6024bbb1faSMichael Holzheu } 6124bbb1faSMichael Holzheu 6224bbb1faSMichael Holzheu static inline __u8 info_blk_hdr__flags(enum diag204_format type, void *hdr) 6324bbb1faSMichael Holzheu { 64e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 65e65f30e0SJanosch Frank return ((struct diag204_info_blk_hdr *)hdr)->flags; 66e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 67e65f30e0SJanosch Frank return ((struct diag204_x_info_blk_hdr *)hdr)->flags; 6824bbb1faSMichael Holzheu } 6924bbb1faSMichael Holzheu 7024bbb1faSMichael Holzheu /* Partition header */ 7124bbb1faSMichael Holzheu 7224bbb1faSMichael Holzheu static inline int part_hdr__size(enum diag204_format type) 7324bbb1faSMichael Holzheu { 74e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 75e65f30e0SJanosch Frank return sizeof(struct diag204_part_hdr); 76e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 77e65f30e0SJanosch Frank return sizeof(struct diag204_x_part_hdr); 7824bbb1faSMichael Holzheu } 7924bbb1faSMichael Holzheu 8024bbb1faSMichael Holzheu static inline __u8 part_hdr__rcpus(enum diag204_format type, void *hdr) 8124bbb1faSMichael Holzheu { 82e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 83e65f30e0SJanosch Frank return ((struct diag204_part_hdr *)hdr)->cpus; 84e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 85e65f30e0SJanosch Frank return ((struct diag204_x_part_hdr *)hdr)->rcpus; 8624bbb1faSMichael Holzheu } 8724bbb1faSMichael Holzheu 8824bbb1faSMichael Holzheu static inline void part_hdr__part_name(enum diag204_format type, void *hdr, 8924bbb1faSMichael Holzheu char *name) 9024bbb1faSMichael Holzheu { 91e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 92e65f30e0SJanosch Frank memcpy(name, ((struct diag204_part_hdr *)hdr)->part_name, 93e65f30e0SJanosch Frank DIAG204_LPAR_NAME_LEN); 94e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 95e65f30e0SJanosch Frank memcpy(name, ((struct diag204_x_part_hdr *)hdr)->part_name, 96e65f30e0SJanosch Frank DIAG204_LPAR_NAME_LEN); 97e65f30e0SJanosch Frank EBCASC(name, DIAG204_LPAR_NAME_LEN); 98e65f30e0SJanosch Frank name[DIAG204_LPAR_NAME_LEN] = 0; 991d802e24SHeiko Carstens strim(name); 10024bbb1faSMichael Holzheu } 10124bbb1faSMichael Holzheu 10224bbb1faSMichael Holzheu /* CPU info block */ 10324bbb1faSMichael Holzheu 10424bbb1faSMichael Holzheu static inline int cpu_info__size(enum diag204_format type) 10524bbb1faSMichael Holzheu { 106e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 107e65f30e0SJanosch Frank return sizeof(struct diag204_cpu_info); 108e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 109e65f30e0SJanosch Frank return sizeof(struct diag204_x_cpu_info); 11024bbb1faSMichael Holzheu } 11124bbb1faSMichael Holzheu 11224bbb1faSMichael Holzheu static inline __u8 cpu_info__ctidx(enum diag204_format type, void *hdr) 11324bbb1faSMichael Holzheu { 114e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 115e65f30e0SJanosch Frank return ((struct diag204_cpu_info *)hdr)->ctidx; 116e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 117e65f30e0SJanosch Frank return ((struct diag204_x_cpu_info *)hdr)->ctidx; 11824bbb1faSMichael Holzheu } 11924bbb1faSMichael Holzheu 12024bbb1faSMichael Holzheu static inline __u16 cpu_info__cpu_addr(enum diag204_format type, void *hdr) 12124bbb1faSMichael Holzheu { 122e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 123e65f30e0SJanosch Frank return ((struct diag204_cpu_info *)hdr)->cpu_addr; 124e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 125e65f30e0SJanosch Frank return ((struct diag204_x_cpu_info *)hdr)->cpu_addr; 12624bbb1faSMichael Holzheu } 12724bbb1faSMichael Holzheu 12824bbb1faSMichael Holzheu static inline __u64 cpu_info__acc_time(enum diag204_format type, void *hdr) 12924bbb1faSMichael Holzheu { 130e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 131e65f30e0SJanosch Frank return ((struct diag204_cpu_info *)hdr)->acc_time; 132e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 133e65f30e0SJanosch Frank return ((struct diag204_x_cpu_info *)hdr)->acc_time; 13424bbb1faSMichael Holzheu } 13524bbb1faSMichael Holzheu 13624bbb1faSMichael Holzheu static inline __u64 cpu_info__lp_time(enum diag204_format type, void *hdr) 13724bbb1faSMichael Holzheu { 138e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 139e65f30e0SJanosch Frank return ((struct diag204_cpu_info *)hdr)->lp_time; 140e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 141e65f30e0SJanosch Frank return ((struct diag204_x_cpu_info *)hdr)->lp_time; 14224bbb1faSMichael Holzheu } 14324bbb1faSMichael Holzheu 14424bbb1faSMichael Holzheu static inline __u64 cpu_info__online_time(enum diag204_format type, void *hdr) 14524bbb1faSMichael Holzheu { 146e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 14724bbb1faSMichael Holzheu return 0; /* online_time not available in simple info */ 148e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 149e65f30e0SJanosch Frank return ((struct diag204_x_cpu_info *)hdr)->online_time; 15024bbb1faSMichael Holzheu } 15124bbb1faSMichael Holzheu 15224bbb1faSMichael Holzheu /* Physical header */ 15324bbb1faSMichael Holzheu 15424bbb1faSMichael Holzheu static inline int phys_hdr__size(enum diag204_format type) 15524bbb1faSMichael Holzheu { 156e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 157e65f30e0SJanosch Frank return sizeof(struct diag204_phys_hdr); 158e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 159e65f30e0SJanosch Frank return sizeof(struct diag204_x_phys_hdr); 16024bbb1faSMichael Holzheu } 16124bbb1faSMichael Holzheu 16224bbb1faSMichael Holzheu static inline __u8 phys_hdr__cpus(enum diag204_format type, void *hdr) 16324bbb1faSMichael Holzheu { 164e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 165e65f30e0SJanosch Frank return ((struct diag204_phys_hdr *)hdr)->cpus; 166e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 167e65f30e0SJanosch Frank return ((struct diag204_x_phys_hdr *)hdr)->cpus; 16824bbb1faSMichael Holzheu } 16924bbb1faSMichael Holzheu 17024bbb1faSMichael Holzheu /* Physical CPU info block */ 17124bbb1faSMichael Holzheu 17224bbb1faSMichael Holzheu static inline int phys_cpu__size(enum diag204_format type) 17324bbb1faSMichael Holzheu { 174e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 175e65f30e0SJanosch Frank return sizeof(struct diag204_phys_cpu); 176e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 177e65f30e0SJanosch Frank return sizeof(struct diag204_x_phys_cpu); 17824bbb1faSMichael Holzheu } 17924bbb1faSMichael Holzheu 18024bbb1faSMichael Holzheu static inline __u16 phys_cpu__cpu_addr(enum diag204_format type, void *hdr) 18124bbb1faSMichael Holzheu { 182e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 183e65f30e0SJanosch Frank return ((struct diag204_phys_cpu *)hdr)->cpu_addr; 184e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 185e65f30e0SJanosch Frank return ((struct diag204_x_phys_cpu *)hdr)->cpu_addr; 18624bbb1faSMichael Holzheu } 18724bbb1faSMichael Holzheu 18824bbb1faSMichael Holzheu static inline __u64 phys_cpu__mgm_time(enum diag204_format type, void *hdr) 18924bbb1faSMichael Holzheu { 190e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 191e65f30e0SJanosch Frank return ((struct diag204_phys_cpu *)hdr)->mgm_time; 192e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 193e65f30e0SJanosch Frank return ((struct diag204_x_phys_cpu *)hdr)->mgm_time; 19424bbb1faSMichael Holzheu } 19524bbb1faSMichael Holzheu 19624bbb1faSMichael Holzheu static inline __u64 phys_cpu__ctidx(enum diag204_format type, void *hdr) 19724bbb1faSMichael Holzheu { 198e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 199e65f30e0SJanosch Frank return ((struct diag204_phys_cpu *)hdr)->ctidx; 200e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 201e65f30e0SJanosch Frank return ((struct diag204_x_phys_cpu *)hdr)->ctidx; 20224bbb1faSMichael Holzheu } 20324bbb1faSMichael Holzheu 20424bbb1faSMichael Holzheu /* Diagnose 204 functions */ 20524bbb1faSMichael Holzheu /* 20624bbb1faSMichael Holzheu * For the old diag subcode 4 with simple data format we have to use real 20724bbb1faSMichael Holzheu * memory. If we use subcode 6 or 7 with extended data format, we can (and 20824bbb1faSMichael Holzheu * should) use vmalloc, since we need a lot of memory in that case. Currently 20924bbb1faSMichael Holzheu * up to 93 pages! 21024bbb1faSMichael Holzheu */ 21124bbb1faSMichael Holzheu 21224bbb1faSMichael Holzheu static void diag204_free_buffer(void) 21324bbb1faSMichael Holzheu { 21483f95671SHeiko Carstens vfree(diag204_buf); 21524bbb1faSMichael Holzheu diag204_buf = NULL; 21624bbb1faSMichael Holzheu } 21724bbb1faSMichael Holzheu 21824bbb1faSMichael Holzheu static void *diag204_get_buffer(enum diag204_format fmt, int *pages) 21924bbb1faSMichael Holzheu { 22024bbb1faSMichael Holzheu if (diag204_buf) { 22124bbb1faSMichael Holzheu *pages = diag204_buf_pages; 22224bbb1faSMichael Holzheu return diag204_buf; 22324bbb1faSMichael Holzheu } 224e65f30e0SJanosch Frank if (fmt == DIAG204_INFO_SIMPLE) { 22524bbb1faSMichael Holzheu *pages = 1; 226e65f30e0SJanosch Frank } else {/* DIAG204_INFO_EXT */ 227e65f30e0SJanosch Frank *pages = diag204((unsigned long)DIAG204_SUBC_RSI | 228e65f30e0SJanosch Frank (unsigned long)DIAG204_INFO_EXT, 0, NULL); 22924bbb1faSMichael Holzheu if (*pages <= 0) 23024bbb1faSMichael Holzheu return ERR_PTR(-ENOSYS); 23124bbb1faSMichael Holzheu } 23283f95671SHeiko Carstens diag204_buf = __vmalloc_node(array_size(*pages, PAGE_SIZE), 23383f95671SHeiko Carstens PAGE_SIZE, GFP_KERNEL, NUMA_NO_NODE, 23483f95671SHeiko Carstens __builtin_return_address(0)); 23583f95671SHeiko Carstens if (!diag204_buf) 23683f95671SHeiko Carstens return ERR_PTR(-ENOMEM); 23783f95671SHeiko Carstens diag204_buf_pages = *pages; 23883f95671SHeiko Carstens return diag204_buf; 23924bbb1faSMichael Holzheu } 24024bbb1faSMichael Holzheu 24124bbb1faSMichael Holzheu /* 24224bbb1faSMichael Holzheu * diag204_probe() has to find out, which type of diagnose 204 implementation 24324bbb1faSMichael Holzheu * we have on our machine. Currently there are three possible scanarios: 24424bbb1faSMichael Holzheu * - subcode 4 + simple data format (only one page) 24524bbb1faSMichael Holzheu * - subcode 4-6 + extended data format 24624bbb1faSMichael Holzheu * - subcode 4-7 + extended data format 24724bbb1faSMichael Holzheu * 24824bbb1faSMichael Holzheu * Subcode 5 is used to retrieve the size of the data, provided by subcodes 24924bbb1faSMichael Holzheu * 6 and 7. Subcode 7 basically has the same function as subcode 6. In addition 25024bbb1faSMichael Holzheu * to subcode 6 it provides also information about secondary cpus. 25124bbb1faSMichael Holzheu * In order to get as much information as possible, we first try 25224bbb1faSMichael Holzheu * subcode 7, then 6 and if both fail, we use subcode 4. 25324bbb1faSMichael Holzheu */ 25424bbb1faSMichael Holzheu 25524bbb1faSMichael Holzheu static int diag204_probe(void) 25624bbb1faSMichael Holzheu { 25724bbb1faSMichael Holzheu void *buf; 25824bbb1faSMichael Holzheu int pages, rc; 25924bbb1faSMichael Holzheu 260e65f30e0SJanosch Frank buf = diag204_get_buffer(DIAG204_INFO_EXT, &pages); 26124bbb1faSMichael Holzheu if (!IS_ERR(buf)) { 262e65f30e0SJanosch Frank if (diag204((unsigned long)DIAG204_SUBC_STIB7 | 263e65f30e0SJanosch Frank (unsigned long)DIAG204_INFO_EXT, pages, buf) >= 0) { 264e65f30e0SJanosch Frank diag204_store_sc = DIAG204_SUBC_STIB7; 265e65f30e0SJanosch Frank diag204_info_type = DIAG204_INFO_EXT; 26624bbb1faSMichael Holzheu goto out; 26724bbb1faSMichael Holzheu } 268e65f30e0SJanosch Frank if (diag204((unsigned long)DIAG204_SUBC_STIB6 | 269e65f30e0SJanosch Frank (unsigned long)DIAG204_INFO_EXT, pages, buf) >= 0) { 270e65f30e0SJanosch Frank diag204_store_sc = DIAG204_SUBC_STIB6; 271e65f30e0SJanosch Frank diag204_info_type = DIAG204_INFO_EXT; 27224bbb1faSMichael Holzheu goto out; 27324bbb1faSMichael Holzheu } 27424bbb1faSMichael Holzheu diag204_free_buffer(); 27524bbb1faSMichael Holzheu } 27624bbb1faSMichael Holzheu 27724bbb1faSMichael Holzheu /* subcodes 6 and 7 failed, now try subcode 4 */ 27824bbb1faSMichael Holzheu 279e65f30e0SJanosch Frank buf = diag204_get_buffer(DIAG204_INFO_SIMPLE, &pages); 28024bbb1faSMichael Holzheu if (IS_ERR(buf)) { 28124bbb1faSMichael Holzheu rc = PTR_ERR(buf); 28224bbb1faSMichael Holzheu goto fail_alloc; 28324bbb1faSMichael Holzheu } 284e65f30e0SJanosch Frank if (diag204((unsigned long)DIAG204_SUBC_STIB4 | 285e65f30e0SJanosch Frank (unsigned long)DIAG204_INFO_SIMPLE, pages, buf) >= 0) { 286e65f30e0SJanosch Frank diag204_store_sc = DIAG204_SUBC_STIB4; 287e65f30e0SJanosch Frank diag204_info_type = DIAG204_INFO_SIMPLE; 28824bbb1faSMichael Holzheu goto out; 28924bbb1faSMichael Holzheu } else { 29024bbb1faSMichael Holzheu rc = -ENOSYS; 29124bbb1faSMichael Holzheu goto fail_store; 29224bbb1faSMichael Holzheu } 29324bbb1faSMichael Holzheu out: 29424bbb1faSMichael Holzheu rc = 0; 29524bbb1faSMichael Holzheu fail_store: 29624bbb1faSMichael Holzheu diag204_free_buffer(); 29724bbb1faSMichael Holzheu fail_alloc: 29824bbb1faSMichael Holzheu return rc; 29924bbb1faSMichael Holzheu } 30024bbb1faSMichael Holzheu 30157b28f66SMichael Holzheu static int diag204_do_store(void *buf, int pages) 30257b28f66SMichael Holzheu { 30357b28f66SMichael Holzheu int rc; 30457b28f66SMichael Holzheu 30557b28f66SMichael Holzheu rc = diag204((unsigned long) diag204_store_sc | 30657b28f66SMichael Holzheu (unsigned long) diag204_info_type, pages, buf); 30757b28f66SMichael Holzheu return rc < 0 ? -ENOSYS : 0; 30857b28f66SMichael Holzheu } 30957b28f66SMichael Holzheu 31024bbb1faSMichael Holzheu static void *diag204_store(void) 31124bbb1faSMichael Holzheu { 31224bbb1faSMichael Holzheu void *buf; 31357b28f66SMichael Holzheu int pages, rc; 31424bbb1faSMichael Holzheu 31524bbb1faSMichael Holzheu buf = diag204_get_buffer(diag204_info_type, &pages); 31624bbb1faSMichael Holzheu if (IS_ERR(buf)) 31724bbb1faSMichael Holzheu goto out; 31857b28f66SMichael Holzheu rc = diag204_do_store(buf, pages); 31957b28f66SMichael Holzheu if (rc) 32057b28f66SMichael Holzheu return ERR_PTR(rc); 32124bbb1faSMichael Holzheu out: 32224bbb1faSMichael Holzheu return buf; 32324bbb1faSMichael Holzheu } 32424bbb1faSMichael Holzheu 32524bbb1faSMichael Holzheu /* Diagnose 224 functions */ 32624bbb1faSMichael Holzheu 32724bbb1faSMichael Holzheu static int diag224_get_name_table(void) 32824bbb1faSMichael Holzheu { 32924bbb1faSMichael Holzheu /* memory must be below 2GB */ 330237d6e68SMichael Holzheu diag224_cpu_names = (char *) __get_free_page(GFP_KERNEL | GFP_DMA); 33124bbb1faSMichael Holzheu if (!diag224_cpu_names) 33224bbb1faSMichael Holzheu return -ENOMEM; 333c41d4e3eSMichael Holzheu if (diag224(diag224_cpu_names)) { 334237d6e68SMichael Holzheu free_page((unsigned long) diag224_cpu_names); 335b8e660b8SHeiko Carstens return -EOPNOTSUPP; 336c41d4e3eSMichael Holzheu } 33724bbb1faSMichael Holzheu EBCASC(diag224_cpu_names + 16, (*diag224_cpu_names + 1) * 16); 33824bbb1faSMichael Holzheu return 0; 33924bbb1faSMichael Holzheu } 34024bbb1faSMichael Holzheu 34124bbb1faSMichael Holzheu static void diag224_delete_name_table(void) 34224bbb1faSMichael Holzheu { 343237d6e68SMichael Holzheu free_page((unsigned long) diag224_cpu_names); 34424bbb1faSMichael Holzheu } 34524bbb1faSMichael Holzheu 34624bbb1faSMichael Holzheu static int diag224_idx2name(int index, char *name) 34724bbb1faSMichael Holzheu { 348e65f30e0SJanosch Frank memcpy(name, diag224_cpu_names + ((index + 1) * DIAG204_CPU_NAME_LEN), 349e65f30e0SJanosch Frank DIAG204_CPU_NAME_LEN); 350e65f30e0SJanosch Frank name[DIAG204_CPU_NAME_LEN] = 0; 3511d802e24SHeiko Carstens strim(name); 35224bbb1faSMichael Holzheu return 0; 35324bbb1faSMichael Holzheu } 35424bbb1faSMichael Holzheu 35557b28f66SMichael Holzheu struct dbfs_d204_hdr { 35657b28f66SMichael Holzheu u64 len; /* Length of d204 buffer without header */ 35757b28f66SMichael Holzheu u16 version; /* Version of header */ 35857b28f66SMichael Holzheu u8 sc; /* Used subcode */ 35957b28f66SMichael Holzheu char reserved[53]; 36057b28f66SMichael Holzheu } __attribute__ ((packed)); 36157b28f66SMichael Holzheu 36257b28f66SMichael Holzheu struct dbfs_d204 { 36357b28f66SMichael Holzheu struct dbfs_d204_hdr hdr; /* 64 byte header */ 36457b28f66SMichael Holzheu char buf[]; /* d204 buffer */ 36557b28f66SMichael Holzheu } __attribute__ ((packed)); 36657b28f66SMichael Holzheu 3672fcb3686SMichael Holzheu static int dbfs_d204_create(void **data, void **data_free_ptr, size_t *size) 36857b28f66SMichael Holzheu { 36957b28f66SMichael Holzheu struct dbfs_d204 *d204; 37057b28f66SMichael Holzheu int rc, buf_size; 3712fcb3686SMichael Holzheu void *base; 37257b28f66SMichael Holzheu 37357b28f66SMichael Holzheu buf_size = PAGE_SIZE * (diag204_buf_pages + 1) + sizeof(d204->hdr); 374dc8a5c99SJoe Perches base = vzalloc(buf_size); 3752fcb3686SMichael Holzheu if (!base) 3762fcb3686SMichael Holzheu return -ENOMEM; 377*b7857accSHeiko Carstens d204 = PTR_ALIGN(base + sizeof(d204->hdr), PAGE_SIZE) - sizeof(d204->hdr); 3782fcb3686SMichael Holzheu rc = diag204_do_store(d204->buf, diag204_buf_pages); 3792fcb3686SMichael Holzheu if (rc) { 3802fcb3686SMichael Holzheu vfree(base); 3812fcb3686SMichael Holzheu return rc; 38257b28f66SMichael Holzheu } 38357b28f66SMichael Holzheu d204->hdr.version = DBFS_D204_HDR_VERSION; 38457b28f66SMichael Holzheu d204->hdr.len = PAGE_SIZE * diag204_buf_pages; 38557b28f66SMichael Holzheu d204->hdr.sc = diag204_store_sc; 3862fcb3686SMichael Holzheu *data = d204; 3872fcb3686SMichael Holzheu *data_free_ptr = base; 3882fcb3686SMichael Holzheu *size = d204->hdr.len + sizeof(struct dbfs_d204_hdr); 38957b28f66SMichael Holzheu return 0; 39057b28f66SMichael Holzheu } 39157b28f66SMichael Holzheu 3922fcb3686SMichael Holzheu static struct hypfs_dbfs_file dbfs_file_d204 = { 3932fcb3686SMichael Holzheu .name = "diag_204", 3942fcb3686SMichael Holzheu .data_create = dbfs_d204_create, 3952fcb3686SMichael Holzheu .data_free = vfree, 39657b28f66SMichael Holzheu }; 39757b28f66SMichael Holzheu 39824bbb1faSMichael Holzheu __init int hypfs_diag_init(void) 39924bbb1faSMichael Holzheu { 40024bbb1faSMichael Holzheu int rc; 40124bbb1faSMichael Holzheu 40224bbb1faSMichael Holzheu if (diag204_probe()) { 4037b6670b0SJuergen Gross pr_info("The hardware system does not support hypfs\n"); 40424bbb1faSMichael Holzheu return -ENODATA; 40524bbb1faSMichael Holzheu } 406f36108c4SGreg Kroah-Hartman 407f36108c4SGreg Kroah-Hartman if (diag204_info_type == DIAG204_INFO_EXT) 408f36108c4SGreg Kroah-Hartman hypfs_dbfs_create_file(&dbfs_file_d204); 409f36108c4SGreg Kroah-Hartman 4103c8ebca0SMichael Holzheu if (MACHINE_IS_LPAR) { 4113c8ebca0SMichael Holzheu rc = diag224_get_name_table(); 4123c8ebca0SMichael Holzheu if (rc) { 4133c8ebca0SMichael Holzheu pr_err("The hardware system does not provide all " 4143c8ebca0SMichael Holzheu "functions required by hypfs\n"); 4153c8ebca0SMichael Holzheu debugfs_remove(dbfs_d204_file); 4163c8ebca0SMichael Holzheu return rc; 4173c8ebca0SMichael Holzheu } 4183c8ebca0SMichael Holzheu } 4193c8ebca0SMichael Holzheu return 0; 4203c8ebca0SMichael Holzheu } 42124bbb1faSMichael Holzheu 4221375fc1fSHeiko Carstens void hypfs_diag_exit(void) 42324bbb1faSMichael Holzheu { 42457b28f66SMichael Holzheu debugfs_remove(dbfs_d204_file); 42524bbb1faSMichael Holzheu diag224_delete_name_table(); 42624bbb1faSMichael Holzheu diag204_free_buffer(); 4272fcb3686SMichael Holzheu hypfs_dbfs_remove_file(&dbfs_file_d204); 42824bbb1faSMichael Holzheu } 42924bbb1faSMichael Holzheu 43024bbb1faSMichael Holzheu /* 43124bbb1faSMichael Holzheu * Functions to create the directory structure 43224bbb1faSMichael Holzheu * ******************************************* 43324bbb1faSMichael Holzheu */ 43424bbb1faSMichael Holzheu 435e334cf4fSAl Viro static int hypfs_create_cpu_files(struct dentry *cpus_dir, void *cpu_info) 43624bbb1faSMichael Holzheu { 43724bbb1faSMichael Holzheu struct dentry *cpu_dir; 43824bbb1faSMichael Holzheu char buffer[TMP_SIZE]; 43924bbb1faSMichael Holzheu void *rc; 44024bbb1faSMichael Holzheu 44124bbb1faSMichael Holzheu snprintf(buffer, TMP_SIZE, "%d", cpu_info__cpu_addr(diag204_info_type, 44224bbb1faSMichael Holzheu cpu_info)); 443a118cfdfSAl Viro cpu_dir = hypfs_mkdir(cpus_dir, buffer); 444a118cfdfSAl Viro rc = hypfs_create_u64(cpu_dir, "mgmtime", 44524bbb1faSMichael Holzheu cpu_info__acc_time(diag204_info_type, cpu_info) - 44624bbb1faSMichael Holzheu cpu_info__lp_time(diag204_info_type, cpu_info)); 44724bbb1faSMichael Holzheu if (IS_ERR(rc)) 44824bbb1faSMichael Holzheu return PTR_ERR(rc); 449a118cfdfSAl Viro rc = hypfs_create_u64(cpu_dir, "cputime", 45024bbb1faSMichael Holzheu cpu_info__lp_time(diag204_info_type, cpu_info)); 45124bbb1faSMichael Holzheu if (IS_ERR(rc)) 45224bbb1faSMichael Holzheu return PTR_ERR(rc); 453e65f30e0SJanosch Frank if (diag204_info_type == DIAG204_INFO_EXT) { 454a118cfdfSAl Viro rc = hypfs_create_u64(cpu_dir, "onlinetime", 45524bbb1faSMichael Holzheu cpu_info__online_time(diag204_info_type, 45624bbb1faSMichael Holzheu cpu_info)); 45724bbb1faSMichael Holzheu if (IS_ERR(rc)) 45824bbb1faSMichael Holzheu return PTR_ERR(rc); 45924bbb1faSMichael Holzheu } 46024bbb1faSMichael Holzheu diag224_idx2name(cpu_info__ctidx(diag204_info_type, cpu_info), buffer); 461a118cfdfSAl Viro rc = hypfs_create_str(cpu_dir, "type", buffer); 4629fa6a659SGustavo A. R. Silva return PTR_ERR_OR_ZERO(rc); 46324bbb1faSMichael Holzheu } 46424bbb1faSMichael Holzheu 465e334cf4fSAl Viro static void *hypfs_create_lpar_files(struct dentry *systems_dir, void *part_hdr) 46624bbb1faSMichael Holzheu { 46724bbb1faSMichael Holzheu struct dentry *cpus_dir; 46824bbb1faSMichael Holzheu struct dentry *lpar_dir; 469e65f30e0SJanosch Frank char lpar_name[DIAG204_LPAR_NAME_LEN + 1]; 47024bbb1faSMichael Holzheu void *cpu_info; 47124bbb1faSMichael Holzheu int i; 47224bbb1faSMichael Holzheu 47324bbb1faSMichael Holzheu part_hdr__part_name(diag204_info_type, part_hdr, lpar_name); 474e65f30e0SJanosch Frank lpar_name[DIAG204_LPAR_NAME_LEN] = 0; 475a118cfdfSAl Viro lpar_dir = hypfs_mkdir(systems_dir, lpar_name); 47624bbb1faSMichael Holzheu if (IS_ERR(lpar_dir)) 47724bbb1faSMichael Holzheu return lpar_dir; 478a118cfdfSAl Viro cpus_dir = hypfs_mkdir(lpar_dir, "cpus"); 47924bbb1faSMichael Holzheu if (IS_ERR(cpus_dir)) 48024bbb1faSMichael Holzheu return cpus_dir; 48124bbb1faSMichael Holzheu cpu_info = part_hdr + part_hdr__size(diag204_info_type); 48224bbb1faSMichael Holzheu for (i = 0; i < part_hdr__rcpus(diag204_info_type, part_hdr); i++) { 48324bbb1faSMichael Holzheu int rc; 484e334cf4fSAl Viro rc = hypfs_create_cpu_files(cpus_dir, cpu_info); 48524bbb1faSMichael Holzheu if (rc) 48624bbb1faSMichael Holzheu return ERR_PTR(rc); 48724bbb1faSMichael Holzheu cpu_info += cpu_info__size(diag204_info_type); 48824bbb1faSMichael Holzheu } 48924bbb1faSMichael Holzheu return cpu_info; 49024bbb1faSMichael Holzheu } 49124bbb1faSMichael Holzheu 492e334cf4fSAl Viro static int hypfs_create_phys_cpu_files(struct dentry *cpus_dir, void *cpu_info) 49324bbb1faSMichael Holzheu { 49424bbb1faSMichael Holzheu struct dentry *cpu_dir; 49524bbb1faSMichael Holzheu char buffer[TMP_SIZE]; 49624bbb1faSMichael Holzheu void *rc; 49724bbb1faSMichael Holzheu 49824bbb1faSMichael Holzheu snprintf(buffer, TMP_SIZE, "%i", phys_cpu__cpu_addr(diag204_info_type, 49924bbb1faSMichael Holzheu cpu_info)); 500a118cfdfSAl Viro cpu_dir = hypfs_mkdir(cpus_dir, buffer); 50124bbb1faSMichael Holzheu if (IS_ERR(cpu_dir)) 50224bbb1faSMichael Holzheu return PTR_ERR(cpu_dir); 503a118cfdfSAl Viro rc = hypfs_create_u64(cpu_dir, "mgmtime", 50424bbb1faSMichael Holzheu phys_cpu__mgm_time(diag204_info_type, cpu_info)); 50524bbb1faSMichael Holzheu if (IS_ERR(rc)) 50624bbb1faSMichael Holzheu return PTR_ERR(rc); 50724bbb1faSMichael Holzheu diag224_idx2name(phys_cpu__ctidx(diag204_info_type, cpu_info), buffer); 508a118cfdfSAl Viro rc = hypfs_create_str(cpu_dir, "type", buffer); 5099fa6a659SGustavo A. R. Silva return PTR_ERR_OR_ZERO(rc); 51024bbb1faSMichael Holzheu } 51124bbb1faSMichael Holzheu 512e334cf4fSAl Viro static void *hypfs_create_phys_files(struct dentry *parent_dir, void *phys_hdr) 51324bbb1faSMichael Holzheu { 51424bbb1faSMichael Holzheu int i; 51524bbb1faSMichael Holzheu void *cpu_info; 51624bbb1faSMichael Holzheu struct dentry *cpus_dir; 51724bbb1faSMichael Holzheu 518a118cfdfSAl Viro cpus_dir = hypfs_mkdir(parent_dir, "cpus"); 51924bbb1faSMichael Holzheu if (IS_ERR(cpus_dir)) 52024bbb1faSMichael Holzheu return cpus_dir; 52124bbb1faSMichael Holzheu cpu_info = phys_hdr + phys_hdr__size(diag204_info_type); 52224bbb1faSMichael Holzheu for (i = 0; i < phys_hdr__cpus(diag204_info_type, phys_hdr); i++) { 52324bbb1faSMichael Holzheu int rc; 524e334cf4fSAl Viro rc = hypfs_create_phys_cpu_files(cpus_dir, cpu_info); 52524bbb1faSMichael Holzheu if (rc) 52624bbb1faSMichael Holzheu return ERR_PTR(rc); 52724bbb1faSMichael Holzheu cpu_info += phys_cpu__size(diag204_info_type); 52824bbb1faSMichael Holzheu } 52924bbb1faSMichael Holzheu return cpu_info; 53024bbb1faSMichael Holzheu } 53124bbb1faSMichael Holzheu 532e334cf4fSAl Viro int hypfs_diag_create_files(struct dentry *root) 53324bbb1faSMichael Holzheu { 53424bbb1faSMichael Holzheu struct dentry *systems_dir, *hyp_dir; 53524bbb1faSMichael Holzheu void *time_hdr, *part_hdr; 53624bbb1faSMichael Holzheu int i, rc; 53724bbb1faSMichael Holzheu void *buffer, *ptr; 53824bbb1faSMichael Holzheu 53924bbb1faSMichael Holzheu buffer = diag204_store(); 54024bbb1faSMichael Holzheu if (IS_ERR(buffer)) 54124bbb1faSMichael Holzheu return PTR_ERR(buffer); 54224bbb1faSMichael Holzheu 543a118cfdfSAl Viro systems_dir = hypfs_mkdir(root, "systems"); 54424bbb1faSMichael Holzheu if (IS_ERR(systems_dir)) { 54524bbb1faSMichael Holzheu rc = PTR_ERR(systems_dir); 54624bbb1faSMichael Holzheu goto err_out; 54724bbb1faSMichael Holzheu } 54824bbb1faSMichael Holzheu time_hdr = (struct x_info_blk_hdr *)buffer; 54924bbb1faSMichael Holzheu part_hdr = time_hdr + info_blk_hdr__size(diag204_info_type); 55024bbb1faSMichael Holzheu for (i = 0; i < info_blk_hdr__npar(diag204_info_type, time_hdr); i++) { 551e334cf4fSAl Viro part_hdr = hypfs_create_lpar_files(systems_dir, part_hdr); 55224bbb1faSMichael Holzheu if (IS_ERR(part_hdr)) { 55324bbb1faSMichael Holzheu rc = PTR_ERR(part_hdr); 55424bbb1faSMichael Holzheu goto err_out; 55524bbb1faSMichael Holzheu } 55624bbb1faSMichael Holzheu } 557e65f30e0SJanosch Frank if (info_blk_hdr__flags(diag204_info_type, time_hdr) & 558e65f30e0SJanosch Frank DIAG204_LPAR_PHYS_FLG) { 559e334cf4fSAl Viro ptr = hypfs_create_phys_files(root, part_hdr); 56024bbb1faSMichael Holzheu if (IS_ERR(ptr)) { 56124bbb1faSMichael Holzheu rc = PTR_ERR(ptr); 56224bbb1faSMichael Holzheu goto err_out; 56324bbb1faSMichael Holzheu } 56424bbb1faSMichael Holzheu } 565a118cfdfSAl Viro hyp_dir = hypfs_mkdir(root, "hyp"); 56624bbb1faSMichael Holzheu if (IS_ERR(hyp_dir)) { 56724bbb1faSMichael Holzheu rc = PTR_ERR(hyp_dir); 56824bbb1faSMichael Holzheu goto err_out; 56924bbb1faSMichael Holzheu } 570a118cfdfSAl Viro ptr = hypfs_create_str(hyp_dir, "type", "LPAR Hypervisor"); 57124bbb1faSMichael Holzheu if (IS_ERR(ptr)) { 57224bbb1faSMichael Holzheu rc = PTR_ERR(ptr); 57324bbb1faSMichael Holzheu goto err_out; 57424bbb1faSMichael Holzheu } 57524bbb1faSMichael Holzheu rc = 0; 57624bbb1faSMichael Holzheu 57724bbb1faSMichael Holzheu err_out: 57824bbb1faSMichael Holzheu return rc; 57924bbb1faSMichael Holzheu } 580