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> 181ec2772eSMartin Schwidefsky #include <asm/diag.h> 1924bbb1faSMichael Holzheu #include <asm/ebcdic.h> 2024bbb1faSMichael Holzheu #include "hypfs.h" 2124bbb1faSMichael Holzheu 2224bbb1faSMichael Holzheu #define TMP_SIZE 64 /* size of temporary buffers */ 2324bbb1faSMichael Holzheu 2457b28f66SMichael Holzheu #define DBFS_D204_HDR_VERSION 0 2557b28f66SMichael Holzheu 2624bbb1faSMichael Holzheu static char *diag224_cpu_names; /* diag 224 name table */ 2724bbb1faSMichael Holzheu static enum diag204_sc diag204_store_sc; /* used subcode for store */ 2824bbb1faSMichael Holzheu static enum diag204_format diag204_info_type; /* used diag 204 data format */ 2924bbb1faSMichael Holzheu 3024bbb1faSMichael Holzheu static void *diag204_buf; /* 4K aligned buffer for diag204 data */ 3124bbb1faSMichael Holzheu static void *diag204_buf_vmalloc; /* vmalloc pointer 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 static inline __u16 info_blk_hdr__pcpus(enum diag204_format type, void *hdr) 7124bbb1faSMichael Holzheu { 72e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 73e65f30e0SJanosch Frank return ((struct diag204_info_blk_hdr *)hdr)->phys_cpus; 74e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 75e65f30e0SJanosch Frank return ((struct diag204_x_info_blk_hdr *)hdr)->phys_cpus; 7624bbb1faSMichael Holzheu } 7724bbb1faSMichael Holzheu 7824bbb1faSMichael Holzheu /* Partition header */ 7924bbb1faSMichael Holzheu 8024bbb1faSMichael Holzheu static inline int part_hdr__size(enum diag204_format type) 8124bbb1faSMichael Holzheu { 82e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 83e65f30e0SJanosch Frank return sizeof(struct diag204_part_hdr); 84e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 85e65f30e0SJanosch Frank return sizeof(struct diag204_x_part_hdr); 8624bbb1faSMichael Holzheu } 8724bbb1faSMichael Holzheu 8824bbb1faSMichael Holzheu static inline __u8 part_hdr__rcpus(enum diag204_format type, void *hdr) 8924bbb1faSMichael Holzheu { 90e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 91e65f30e0SJanosch Frank return ((struct diag204_part_hdr *)hdr)->cpus; 92e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 93e65f30e0SJanosch Frank return ((struct diag204_x_part_hdr *)hdr)->rcpus; 9424bbb1faSMichael Holzheu } 9524bbb1faSMichael Holzheu 9624bbb1faSMichael Holzheu static inline void part_hdr__part_name(enum diag204_format type, void *hdr, 9724bbb1faSMichael Holzheu char *name) 9824bbb1faSMichael Holzheu { 99e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 100e65f30e0SJanosch Frank memcpy(name, ((struct diag204_part_hdr *)hdr)->part_name, 101e65f30e0SJanosch Frank DIAG204_LPAR_NAME_LEN); 102e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 103e65f30e0SJanosch Frank memcpy(name, ((struct diag204_x_part_hdr *)hdr)->part_name, 104e65f30e0SJanosch Frank DIAG204_LPAR_NAME_LEN); 105e65f30e0SJanosch Frank EBCASC(name, DIAG204_LPAR_NAME_LEN); 106e65f30e0SJanosch Frank name[DIAG204_LPAR_NAME_LEN] = 0; 1071d802e24SHeiko Carstens strim(name); 10824bbb1faSMichael Holzheu } 10924bbb1faSMichael Holzheu 11024bbb1faSMichael Holzheu /* CPU info block */ 11124bbb1faSMichael Holzheu 11224bbb1faSMichael Holzheu static inline int cpu_info__size(enum diag204_format type) 11324bbb1faSMichael Holzheu { 114e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 115e65f30e0SJanosch Frank return sizeof(struct diag204_cpu_info); 116e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 117e65f30e0SJanosch Frank return sizeof(struct diag204_x_cpu_info); 11824bbb1faSMichael Holzheu } 11924bbb1faSMichael Holzheu 12024bbb1faSMichael Holzheu static inline __u8 cpu_info__ctidx(enum diag204_format type, void *hdr) 12124bbb1faSMichael Holzheu { 122e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 123e65f30e0SJanosch Frank return ((struct diag204_cpu_info *)hdr)->ctidx; 124e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 125e65f30e0SJanosch Frank return ((struct diag204_x_cpu_info *)hdr)->ctidx; 12624bbb1faSMichael Holzheu } 12724bbb1faSMichael Holzheu 12824bbb1faSMichael Holzheu static inline __u16 cpu_info__cpu_addr(enum diag204_format type, void *hdr) 12924bbb1faSMichael Holzheu { 130e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 131e65f30e0SJanosch Frank return ((struct diag204_cpu_info *)hdr)->cpu_addr; 132e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 133e65f30e0SJanosch Frank return ((struct diag204_x_cpu_info *)hdr)->cpu_addr; 13424bbb1faSMichael Holzheu } 13524bbb1faSMichael Holzheu 13624bbb1faSMichael Holzheu static inline __u64 cpu_info__acc_time(enum diag204_format type, void *hdr) 13724bbb1faSMichael Holzheu { 138e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 139e65f30e0SJanosch Frank return ((struct diag204_cpu_info *)hdr)->acc_time; 140e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 141e65f30e0SJanosch Frank return ((struct diag204_x_cpu_info *)hdr)->acc_time; 14224bbb1faSMichael Holzheu } 14324bbb1faSMichael Holzheu 14424bbb1faSMichael Holzheu static inline __u64 cpu_info__lp_time(enum diag204_format type, void *hdr) 14524bbb1faSMichael Holzheu { 146e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 147e65f30e0SJanosch Frank return ((struct diag204_cpu_info *)hdr)->lp_time; 148e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 149e65f30e0SJanosch Frank return ((struct diag204_x_cpu_info *)hdr)->lp_time; 15024bbb1faSMichael Holzheu } 15124bbb1faSMichael Holzheu 15224bbb1faSMichael Holzheu static inline __u64 cpu_info__online_time(enum diag204_format type, void *hdr) 15324bbb1faSMichael Holzheu { 154e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 15524bbb1faSMichael Holzheu return 0; /* online_time not available in simple info */ 156e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 157e65f30e0SJanosch Frank return ((struct diag204_x_cpu_info *)hdr)->online_time; 15824bbb1faSMichael Holzheu } 15924bbb1faSMichael Holzheu 16024bbb1faSMichael Holzheu /* Physical header */ 16124bbb1faSMichael Holzheu 16224bbb1faSMichael Holzheu static inline int phys_hdr__size(enum diag204_format type) 16324bbb1faSMichael Holzheu { 164e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 165e65f30e0SJanosch Frank return sizeof(struct diag204_phys_hdr); 166e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 167e65f30e0SJanosch Frank return sizeof(struct diag204_x_phys_hdr); 16824bbb1faSMichael Holzheu } 16924bbb1faSMichael Holzheu 17024bbb1faSMichael Holzheu static inline __u8 phys_hdr__cpus(enum diag204_format type, void *hdr) 17124bbb1faSMichael Holzheu { 172e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 173e65f30e0SJanosch Frank return ((struct diag204_phys_hdr *)hdr)->cpus; 174e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 175e65f30e0SJanosch Frank return ((struct diag204_x_phys_hdr *)hdr)->cpus; 17624bbb1faSMichael Holzheu } 17724bbb1faSMichael Holzheu 17824bbb1faSMichael Holzheu /* Physical CPU info block */ 17924bbb1faSMichael Holzheu 18024bbb1faSMichael Holzheu static inline int phys_cpu__size(enum diag204_format type) 18124bbb1faSMichael Holzheu { 182e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 183e65f30e0SJanosch Frank return sizeof(struct diag204_phys_cpu); 184e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 185e65f30e0SJanosch Frank return sizeof(struct diag204_x_phys_cpu); 18624bbb1faSMichael Holzheu } 18724bbb1faSMichael Holzheu 18824bbb1faSMichael Holzheu static inline __u16 phys_cpu__cpu_addr(enum diag204_format type, void *hdr) 18924bbb1faSMichael Holzheu { 190e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 191e65f30e0SJanosch Frank return ((struct diag204_phys_cpu *)hdr)->cpu_addr; 192e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 193e65f30e0SJanosch Frank return ((struct diag204_x_phys_cpu *)hdr)->cpu_addr; 19424bbb1faSMichael Holzheu } 19524bbb1faSMichael Holzheu 19624bbb1faSMichael Holzheu static inline __u64 phys_cpu__mgm_time(enum diag204_format type, void *hdr) 19724bbb1faSMichael Holzheu { 198e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 199e65f30e0SJanosch Frank return ((struct diag204_phys_cpu *)hdr)->mgm_time; 200e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 201e65f30e0SJanosch Frank return ((struct diag204_x_phys_cpu *)hdr)->mgm_time; 20224bbb1faSMichael Holzheu } 20324bbb1faSMichael Holzheu 20424bbb1faSMichael Holzheu static inline __u64 phys_cpu__ctidx(enum diag204_format type, void *hdr) 20524bbb1faSMichael Holzheu { 206e65f30e0SJanosch Frank if (type == DIAG204_INFO_SIMPLE) 207e65f30e0SJanosch Frank return ((struct diag204_phys_cpu *)hdr)->ctidx; 208e65f30e0SJanosch Frank else /* DIAG204_INFO_EXT */ 209e65f30e0SJanosch Frank return ((struct diag204_x_phys_cpu *)hdr)->ctidx; 21024bbb1faSMichael Holzheu } 21124bbb1faSMichael Holzheu 21224bbb1faSMichael Holzheu /* Diagnose 204 functions */ 21324bbb1faSMichael Holzheu /* 21424bbb1faSMichael Holzheu * For the old diag subcode 4 with simple data format we have to use real 21524bbb1faSMichael Holzheu * memory. If we use subcode 6 or 7 with extended data format, we can (and 21624bbb1faSMichael Holzheu * should) use vmalloc, since we need a lot of memory in that case. Currently 21724bbb1faSMichael Holzheu * up to 93 pages! 21824bbb1faSMichael Holzheu */ 21924bbb1faSMichael Holzheu 22024bbb1faSMichael Holzheu static void diag204_free_buffer(void) 22124bbb1faSMichael Holzheu { 22224bbb1faSMichael Holzheu if (!diag204_buf) 22324bbb1faSMichael Holzheu return; 22424bbb1faSMichael Holzheu if (diag204_buf_vmalloc) { 22524bbb1faSMichael Holzheu vfree(diag204_buf_vmalloc); 22624bbb1faSMichael Holzheu diag204_buf_vmalloc = NULL; 22724bbb1faSMichael Holzheu } else { 22824bbb1faSMichael Holzheu free_pages((unsigned long) diag204_buf, 0); 22924bbb1faSMichael Holzheu } 23024bbb1faSMichael Holzheu diag204_buf = NULL; 23124bbb1faSMichael Holzheu } 23224bbb1faSMichael Holzheu 23357b28f66SMichael Holzheu static void *page_align_ptr(void *ptr) 23457b28f66SMichael Holzheu { 23557b28f66SMichael Holzheu return (void *) PAGE_ALIGN((unsigned long) ptr); 23657b28f66SMichael Holzheu } 23757b28f66SMichael Holzheu 23824bbb1faSMichael Holzheu static void *diag204_alloc_vbuf(int pages) 23924bbb1faSMichael Holzheu { 24024bbb1faSMichael Holzheu /* The buffer has to be page aligned! */ 24124bbb1faSMichael Holzheu diag204_buf_vmalloc = vmalloc(PAGE_SIZE * (pages + 1)); 24224bbb1faSMichael Holzheu if (!diag204_buf_vmalloc) 24324bbb1faSMichael Holzheu return ERR_PTR(-ENOMEM); 24457b28f66SMichael Holzheu diag204_buf = page_align_ptr(diag204_buf_vmalloc); 24524bbb1faSMichael Holzheu diag204_buf_pages = pages; 24624bbb1faSMichael Holzheu return diag204_buf; 24724bbb1faSMichael Holzheu } 24824bbb1faSMichael Holzheu 24924bbb1faSMichael Holzheu static void *diag204_alloc_rbuf(void) 25024bbb1faSMichael Holzheu { 25124bbb1faSMichael Holzheu diag204_buf = (void*)__get_free_pages(GFP_KERNEL,0); 25286b22470SChristian Borntraeger if (!diag204_buf) 25324bbb1faSMichael Holzheu return ERR_PTR(-ENOMEM); 25424bbb1faSMichael Holzheu diag204_buf_pages = 1; 25524bbb1faSMichael Holzheu return diag204_buf; 25624bbb1faSMichael Holzheu } 25724bbb1faSMichael Holzheu 25824bbb1faSMichael Holzheu static void *diag204_get_buffer(enum diag204_format fmt, int *pages) 25924bbb1faSMichael Holzheu { 26024bbb1faSMichael Holzheu if (diag204_buf) { 26124bbb1faSMichael Holzheu *pages = diag204_buf_pages; 26224bbb1faSMichael Holzheu return diag204_buf; 26324bbb1faSMichael Holzheu } 264e65f30e0SJanosch Frank if (fmt == DIAG204_INFO_SIMPLE) { 26524bbb1faSMichael Holzheu *pages = 1; 26624bbb1faSMichael Holzheu return diag204_alloc_rbuf(); 267e65f30e0SJanosch Frank } else {/* DIAG204_INFO_EXT */ 268e65f30e0SJanosch Frank *pages = diag204((unsigned long)DIAG204_SUBC_RSI | 269e65f30e0SJanosch Frank (unsigned long)DIAG204_INFO_EXT, 0, NULL); 27024bbb1faSMichael Holzheu if (*pages <= 0) 27124bbb1faSMichael Holzheu return ERR_PTR(-ENOSYS); 27224bbb1faSMichael Holzheu else 27324bbb1faSMichael Holzheu return diag204_alloc_vbuf(*pages); 27424bbb1faSMichael Holzheu } 27524bbb1faSMichael Holzheu } 27624bbb1faSMichael Holzheu 27724bbb1faSMichael Holzheu /* 27824bbb1faSMichael Holzheu * diag204_probe() has to find out, which type of diagnose 204 implementation 27924bbb1faSMichael Holzheu * we have on our machine. Currently there are three possible scanarios: 28024bbb1faSMichael Holzheu * - subcode 4 + simple data format (only one page) 28124bbb1faSMichael Holzheu * - subcode 4-6 + extended data format 28224bbb1faSMichael Holzheu * - subcode 4-7 + extended data format 28324bbb1faSMichael Holzheu * 28424bbb1faSMichael Holzheu * Subcode 5 is used to retrieve the size of the data, provided by subcodes 28524bbb1faSMichael Holzheu * 6 and 7. Subcode 7 basically has the same function as subcode 6. In addition 28624bbb1faSMichael Holzheu * to subcode 6 it provides also information about secondary cpus. 28724bbb1faSMichael Holzheu * In order to get as much information as possible, we first try 28824bbb1faSMichael Holzheu * subcode 7, then 6 and if both fail, we use subcode 4. 28924bbb1faSMichael Holzheu */ 29024bbb1faSMichael Holzheu 29124bbb1faSMichael Holzheu static int diag204_probe(void) 29224bbb1faSMichael Holzheu { 29324bbb1faSMichael Holzheu void *buf; 29424bbb1faSMichael Holzheu int pages, rc; 29524bbb1faSMichael Holzheu 296e65f30e0SJanosch Frank buf = diag204_get_buffer(DIAG204_INFO_EXT, &pages); 29724bbb1faSMichael Holzheu if (!IS_ERR(buf)) { 298e65f30e0SJanosch Frank if (diag204((unsigned long)DIAG204_SUBC_STIB7 | 299e65f30e0SJanosch Frank (unsigned long)DIAG204_INFO_EXT, pages, buf) >= 0) { 300e65f30e0SJanosch Frank diag204_store_sc = DIAG204_SUBC_STIB7; 301e65f30e0SJanosch Frank diag204_info_type = DIAG204_INFO_EXT; 30224bbb1faSMichael Holzheu goto out; 30324bbb1faSMichael Holzheu } 304e65f30e0SJanosch Frank if (diag204((unsigned long)DIAG204_SUBC_STIB6 | 305e65f30e0SJanosch Frank (unsigned long)DIAG204_INFO_EXT, pages, buf) >= 0) { 306e65f30e0SJanosch Frank diag204_store_sc = DIAG204_SUBC_STIB6; 307e65f30e0SJanosch Frank diag204_info_type = DIAG204_INFO_EXT; 30824bbb1faSMichael Holzheu goto out; 30924bbb1faSMichael Holzheu } 31024bbb1faSMichael Holzheu diag204_free_buffer(); 31124bbb1faSMichael Holzheu } 31224bbb1faSMichael Holzheu 31324bbb1faSMichael Holzheu /* subcodes 6 and 7 failed, now try subcode 4 */ 31424bbb1faSMichael Holzheu 315e65f30e0SJanosch Frank buf = diag204_get_buffer(DIAG204_INFO_SIMPLE, &pages); 31624bbb1faSMichael Holzheu if (IS_ERR(buf)) { 31724bbb1faSMichael Holzheu rc = PTR_ERR(buf); 31824bbb1faSMichael Holzheu goto fail_alloc; 31924bbb1faSMichael Holzheu } 320e65f30e0SJanosch Frank if (diag204((unsigned long)DIAG204_SUBC_STIB4 | 321e65f30e0SJanosch Frank (unsigned long)DIAG204_INFO_SIMPLE, pages, buf) >= 0) { 322e65f30e0SJanosch Frank diag204_store_sc = DIAG204_SUBC_STIB4; 323e65f30e0SJanosch Frank diag204_info_type = DIAG204_INFO_SIMPLE; 32424bbb1faSMichael Holzheu goto out; 32524bbb1faSMichael Holzheu } else { 32624bbb1faSMichael Holzheu rc = -ENOSYS; 32724bbb1faSMichael Holzheu goto fail_store; 32824bbb1faSMichael Holzheu } 32924bbb1faSMichael Holzheu out: 33024bbb1faSMichael Holzheu rc = 0; 33124bbb1faSMichael Holzheu fail_store: 33224bbb1faSMichael Holzheu diag204_free_buffer(); 33324bbb1faSMichael Holzheu fail_alloc: 33424bbb1faSMichael Holzheu return rc; 33524bbb1faSMichael Holzheu } 33624bbb1faSMichael Holzheu 33757b28f66SMichael Holzheu static int diag204_do_store(void *buf, int pages) 33857b28f66SMichael Holzheu { 33957b28f66SMichael Holzheu int rc; 34057b28f66SMichael Holzheu 34157b28f66SMichael Holzheu rc = diag204((unsigned long) diag204_store_sc | 34257b28f66SMichael Holzheu (unsigned long) diag204_info_type, pages, buf); 34357b28f66SMichael Holzheu return rc < 0 ? -ENOSYS : 0; 34457b28f66SMichael Holzheu } 34557b28f66SMichael Holzheu 34624bbb1faSMichael Holzheu static void *diag204_store(void) 34724bbb1faSMichael Holzheu { 34824bbb1faSMichael Holzheu void *buf; 34957b28f66SMichael Holzheu int pages, rc; 35024bbb1faSMichael Holzheu 35124bbb1faSMichael Holzheu buf = diag204_get_buffer(diag204_info_type, &pages); 35224bbb1faSMichael Holzheu if (IS_ERR(buf)) 35324bbb1faSMichael Holzheu goto out; 35457b28f66SMichael Holzheu rc = diag204_do_store(buf, pages); 35557b28f66SMichael Holzheu if (rc) 35657b28f66SMichael Holzheu return ERR_PTR(rc); 35724bbb1faSMichael Holzheu out: 35824bbb1faSMichael Holzheu return buf; 35924bbb1faSMichael Holzheu } 36024bbb1faSMichael Holzheu 36124bbb1faSMichael Holzheu /* Diagnose 224 functions */ 36224bbb1faSMichael Holzheu 36324bbb1faSMichael Holzheu static int diag224_get_name_table(void) 36424bbb1faSMichael Holzheu { 36524bbb1faSMichael Holzheu /* memory must be below 2GB */ 366237d6e68SMichael Holzheu diag224_cpu_names = (char *) __get_free_page(GFP_KERNEL | GFP_DMA); 36724bbb1faSMichael Holzheu if (!diag224_cpu_names) 36824bbb1faSMichael Holzheu return -ENOMEM; 369c41d4e3eSMichael Holzheu if (diag224(diag224_cpu_names)) { 370237d6e68SMichael Holzheu free_page((unsigned long) diag224_cpu_names); 371b8e660b8SHeiko Carstens return -EOPNOTSUPP; 372c41d4e3eSMichael Holzheu } 37324bbb1faSMichael Holzheu EBCASC(diag224_cpu_names + 16, (*diag224_cpu_names + 1) * 16); 37424bbb1faSMichael Holzheu return 0; 37524bbb1faSMichael Holzheu } 37624bbb1faSMichael Holzheu 37724bbb1faSMichael Holzheu static void diag224_delete_name_table(void) 37824bbb1faSMichael Holzheu { 379237d6e68SMichael Holzheu free_page((unsigned long) diag224_cpu_names); 38024bbb1faSMichael Holzheu } 38124bbb1faSMichael Holzheu 38224bbb1faSMichael Holzheu static int diag224_idx2name(int index, char *name) 38324bbb1faSMichael Holzheu { 384e65f30e0SJanosch Frank memcpy(name, diag224_cpu_names + ((index + 1) * DIAG204_CPU_NAME_LEN), 385e65f30e0SJanosch Frank DIAG204_CPU_NAME_LEN); 386e65f30e0SJanosch Frank name[DIAG204_CPU_NAME_LEN] = 0; 3871d802e24SHeiko Carstens strim(name); 38824bbb1faSMichael Holzheu return 0; 38924bbb1faSMichael Holzheu } 39024bbb1faSMichael Holzheu 39157b28f66SMichael Holzheu struct dbfs_d204_hdr { 39257b28f66SMichael Holzheu u64 len; /* Length of d204 buffer without header */ 39357b28f66SMichael Holzheu u16 version; /* Version of header */ 39457b28f66SMichael Holzheu u8 sc; /* Used subcode */ 39557b28f66SMichael Holzheu char reserved[53]; 39657b28f66SMichael Holzheu } __attribute__ ((packed)); 39757b28f66SMichael Holzheu 39857b28f66SMichael Holzheu struct dbfs_d204 { 39957b28f66SMichael Holzheu struct dbfs_d204_hdr hdr; /* 64 byte header */ 40057b28f66SMichael Holzheu char buf[]; /* d204 buffer */ 40157b28f66SMichael Holzheu } __attribute__ ((packed)); 40257b28f66SMichael Holzheu 4032fcb3686SMichael Holzheu static int dbfs_d204_create(void **data, void **data_free_ptr, size_t *size) 40457b28f66SMichael Holzheu { 40557b28f66SMichael Holzheu struct dbfs_d204 *d204; 40657b28f66SMichael Holzheu int rc, buf_size; 4072fcb3686SMichael Holzheu void *base; 40857b28f66SMichael Holzheu 40957b28f66SMichael Holzheu buf_size = PAGE_SIZE * (diag204_buf_pages + 1) + sizeof(d204->hdr); 410dc8a5c99SJoe Perches base = vzalloc(buf_size); 4112fcb3686SMichael Holzheu if (!base) 4122fcb3686SMichael Holzheu return -ENOMEM; 4132fcb3686SMichael Holzheu d204 = page_align_ptr(base + sizeof(d204->hdr)) - sizeof(d204->hdr); 4142fcb3686SMichael Holzheu rc = diag204_do_store(d204->buf, diag204_buf_pages); 4152fcb3686SMichael Holzheu if (rc) { 4162fcb3686SMichael Holzheu vfree(base); 4172fcb3686SMichael Holzheu return rc; 41857b28f66SMichael Holzheu } 41957b28f66SMichael Holzheu d204->hdr.version = DBFS_D204_HDR_VERSION; 42057b28f66SMichael Holzheu d204->hdr.len = PAGE_SIZE * diag204_buf_pages; 42157b28f66SMichael Holzheu d204->hdr.sc = diag204_store_sc; 4222fcb3686SMichael Holzheu *data = d204; 4232fcb3686SMichael Holzheu *data_free_ptr = base; 4242fcb3686SMichael Holzheu *size = d204->hdr.len + sizeof(struct dbfs_d204_hdr); 42557b28f66SMichael Holzheu return 0; 42657b28f66SMichael Holzheu } 42757b28f66SMichael Holzheu 4282fcb3686SMichael Holzheu static struct hypfs_dbfs_file dbfs_file_d204 = { 4292fcb3686SMichael Holzheu .name = "diag_204", 4302fcb3686SMichael Holzheu .data_create = dbfs_d204_create, 4312fcb3686SMichael Holzheu .data_free = vfree, 43257b28f66SMichael Holzheu }; 43357b28f66SMichael Holzheu 43424bbb1faSMichael Holzheu __init int hypfs_diag_init(void) 43524bbb1faSMichael Holzheu { 43624bbb1faSMichael Holzheu int rc; 43724bbb1faSMichael Holzheu 43824bbb1faSMichael Holzheu if (diag204_probe()) { 439f55495baSMichael Holzheu pr_err("The hardware system does not support hypfs\n"); 44024bbb1faSMichael Holzheu return -ENODATA; 44124bbb1faSMichael Holzheu } 442e65f30e0SJanosch Frank if (diag204_info_type == DIAG204_INFO_EXT) { 4432fcb3686SMichael Holzheu rc = hypfs_dbfs_create_file(&dbfs_file_d204); 44457b28f66SMichael Holzheu if (rc) 44524bbb1faSMichael Holzheu return rc; 44624bbb1faSMichael Holzheu } 4473c8ebca0SMichael Holzheu if (MACHINE_IS_LPAR) { 4483c8ebca0SMichael Holzheu rc = diag224_get_name_table(); 4493c8ebca0SMichael Holzheu if (rc) { 4503c8ebca0SMichael Holzheu pr_err("The hardware system does not provide all " 4513c8ebca0SMichael Holzheu "functions required by hypfs\n"); 4523c8ebca0SMichael Holzheu debugfs_remove(dbfs_d204_file); 4533c8ebca0SMichael Holzheu return rc; 4543c8ebca0SMichael Holzheu } 4553c8ebca0SMichael Holzheu } 4563c8ebca0SMichael Holzheu return 0; 4573c8ebca0SMichael Holzheu } 45824bbb1faSMichael Holzheu 4591375fc1fSHeiko Carstens void hypfs_diag_exit(void) 46024bbb1faSMichael Holzheu { 46157b28f66SMichael Holzheu debugfs_remove(dbfs_d204_file); 46224bbb1faSMichael Holzheu diag224_delete_name_table(); 46324bbb1faSMichael Holzheu diag204_free_buffer(); 4642fcb3686SMichael Holzheu hypfs_dbfs_remove_file(&dbfs_file_d204); 46524bbb1faSMichael Holzheu } 46624bbb1faSMichael Holzheu 46724bbb1faSMichael Holzheu /* 46824bbb1faSMichael Holzheu * Functions to create the directory structure 46924bbb1faSMichael Holzheu * ******************************************* 47024bbb1faSMichael Holzheu */ 47124bbb1faSMichael Holzheu 472e334cf4fSAl Viro static int hypfs_create_cpu_files(struct dentry *cpus_dir, void *cpu_info) 47324bbb1faSMichael Holzheu { 47424bbb1faSMichael Holzheu struct dentry *cpu_dir; 47524bbb1faSMichael Holzheu char buffer[TMP_SIZE]; 47624bbb1faSMichael Holzheu void *rc; 47724bbb1faSMichael Holzheu 47824bbb1faSMichael Holzheu snprintf(buffer, TMP_SIZE, "%d", cpu_info__cpu_addr(diag204_info_type, 47924bbb1faSMichael Holzheu cpu_info)); 480a118cfdfSAl Viro cpu_dir = hypfs_mkdir(cpus_dir, buffer); 481a118cfdfSAl Viro rc = hypfs_create_u64(cpu_dir, "mgmtime", 48224bbb1faSMichael Holzheu cpu_info__acc_time(diag204_info_type, cpu_info) - 48324bbb1faSMichael Holzheu cpu_info__lp_time(diag204_info_type, cpu_info)); 48424bbb1faSMichael Holzheu if (IS_ERR(rc)) 48524bbb1faSMichael Holzheu return PTR_ERR(rc); 486a118cfdfSAl Viro rc = hypfs_create_u64(cpu_dir, "cputime", 48724bbb1faSMichael Holzheu cpu_info__lp_time(diag204_info_type, cpu_info)); 48824bbb1faSMichael Holzheu if (IS_ERR(rc)) 48924bbb1faSMichael Holzheu return PTR_ERR(rc); 490e65f30e0SJanosch Frank if (diag204_info_type == DIAG204_INFO_EXT) { 491a118cfdfSAl Viro rc = hypfs_create_u64(cpu_dir, "onlinetime", 49224bbb1faSMichael Holzheu cpu_info__online_time(diag204_info_type, 49324bbb1faSMichael Holzheu cpu_info)); 49424bbb1faSMichael Holzheu if (IS_ERR(rc)) 49524bbb1faSMichael Holzheu return PTR_ERR(rc); 49624bbb1faSMichael Holzheu } 49724bbb1faSMichael Holzheu diag224_idx2name(cpu_info__ctidx(diag204_info_type, cpu_info), buffer); 498a118cfdfSAl Viro rc = hypfs_create_str(cpu_dir, "type", buffer); 4995eba9bb8SThomas Meyer return PTR_RET(rc); 50024bbb1faSMichael Holzheu } 50124bbb1faSMichael Holzheu 502e334cf4fSAl Viro static void *hypfs_create_lpar_files(struct dentry *systems_dir, void *part_hdr) 50324bbb1faSMichael Holzheu { 50424bbb1faSMichael Holzheu struct dentry *cpus_dir; 50524bbb1faSMichael Holzheu struct dentry *lpar_dir; 506e65f30e0SJanosch Frank char lpar_name[DIAG204_LPAR_NAME_LEN + 1]; 50724bbb1faSMichael Holzheu void *cpu_info; 50824bbb1faSMichael Holzheu int i; 50924bbb1faSMichael Holzheu 51024bbb1faSMichael Holzheu part_hdr__part_name(diag204_info_type, part_hdr, lpar_name); 511e65f30e0SJanosch Frank lpar_name[DIAG204_LPAR_NAME_LEN] = 0; 512a118cfdfSAl Viro lpar_dir = hypfs_mkdir(systems_dir, lpar_name); 51324bbb1faSMichael Holzheu if (IS_ERR(lpar_dir)) 51424bbb1faSMichael Holzheu return lpar_dir; 515a118cfdfSAl Viro cpus_dir = hypfs_mkdir(lpar_dir, "cpus"); 51624bbb1faSMichael Holzheu if (IS_ERR(cpus_dir)) 51724bbb1faSMichael Holzheu return cpus_dir; 51824bbb1faSMichael Holzheu cpu_info = part_hdr + part_hdr__size(diag204_info_type); 51924bbb1faSMichael Holzheu for (i = 0; i < part_hdr__rcpus(diag204_info_type, part_hdr); i++) { 52024bbb1faSMichael Holzheu int rc; 521e334cf4fSAl Viro rc = hypfs_create_cpu_files(cpus_dir, cpu_info); 52224bbb1faSMichael Holzheu if (rc) 52324bbb1faSMichael Holzheu return ERR_PTR(rc); 52424bbb1faSMichael Holzheu cpu_info += cpu_info__size(diag204_info_type); 52524bbb1faSMichael Holzheu } 52624bbb1faSMichael Holzheu return cpu_info; 52724bbb1faSMichael Holzheu } 52824bbb1faSMichael Holzheu 529e334cf4fSAl Viro static int hypfs_create_phys_cpu_files(struct dentry *cpus_dir, void *cpu_info) 53024bbb1faSMichael Holzheu { 53124bbb1faSMichael Holzheu struct dentry *cpu_dir; 53224bbb1faSMichael Holzheu char buffer[TMP_SIZE]; 53324bbb1faSMichael Holzheu void *rc; 53424bbb1faSMichael Holzheu 53524bbb1faSMichael Holzheu snprintf(buffer, TMP_SIZE, "%i", phys_cpu__cpu_addr(diag204_info_type, 53624bbb1faSMichael Holzheu cpu_info)); 537a118cfdfSAl Viro cpu_dir = hypfs_mkdir(cpus_dir, buffer); 53824bbb1faSMichael Holzheu if (IS_ERR(cpu_dir)) 53924bbb1faSMichael Holzheu return PTR_ERR(cpu_dir); 540a118cfdfSAl Viro rc = hypfs_create_u64(cpu_dir, "mgmtime", 54124bbb1faSMichael Holzheu phys_cpu__mgm_time(diag204_info_type, cpu_info)); 54224bbb1faSMichael Holzheu if (IS_ERR(rc)) 54324bbb1faSMichael Holzheu return PTR_ERR(rc); 54424bbb1faSMichael Holzheu diag224_idx2name(phys_cpu__ctidx(diag204_info_type, cpu_info), buffer); 545a118cfdfSAl Viro rc = hypfs_create_str(cpu_dir, "type", buffer); 5465eba9bb8SThomas Meyer return PTR_RET(rc); 54724bbb1faSMichael Holzheu } 54824bbb1faSMichael Holzheu 549e334cf4fSAl Viro static void *hypfs_create_phys_files(struct dentry *parent_dir, void *phys_hdr) 55024bbb1faSMichael Holzheu { 55124bbb1faSMichael Holzheu int i; 55224bbb1faSMichael Holzheu void *cpu_info; 55324bbb1faSMichael Holzheu struct dentry *cpus_dir; 55424bbb1faSMichael Holzheu 555a118cfdfSAl Viro cpus_dir = hypfs_mkdir(parent_dir, "cpus"); 55624bbb1faSMichael Holzheu if (IS_ERR(cpus_dir)) 55724bbb1faSMichael Holzheu return cpus_dir; 55824bbb1faSMichael Holzheu cpu_info = phys_hdr + phys_hdr__size(diag204_info_type); 55924bbb1faSMichael Holzheu for (i = 0; i < phys_hdr__cpus(diag204_info_type, phys_hdr); i++) { 56024bbb1faSMichael Holzheu int rc; 561e334cf4fSAl Viro rc = hypfs_create_phys_cpu_files(cpus_dir, cpu_info); 56224bbb1faSMichael Holzheu if (rc) 56324bbb1faSMichael Holzheu return ERR_PTR(rc); 56424bbb1faSMichael Holzheu cpu_info += phys_cpu__size(diag204_info_type); 56524bbb1faSMichael Holzheu } 56624bbb1faSMichael Holzheu return cpu_info; 56724bbb1faSMichael Holzheu } 56824bbb1faSMichael Holzheu 569e334cf4fSAl Viro int hypfs_diag_create_files(struct dentry *root) 57024bbb1faSMichael Holzheu { 57124bbb1faSMichael Holzheu struct dentry *systems_dir, *hyp_dir; 57224bbb1faSMichael Holzheu void *time_hdr, *part_hdr; 57324bbb1faSMichael Holzheu int i, rc; 57424bbb1faSMichael Holzheu void *buffer, *ptr; 57524bbb1faSMichael Holzheu 57624bbb1faSMichael Holzheu buffer = diag204_store(); 57724bbb1faSMichael Holzheu if (IS_ERR(buffer)) 57824bbb1faSMichael Holzheu return PTR_ERR(buffer); 57924bbb1faSMichael Holzheu 580a118cfdfSAl Viro systems_dir = hypfs_mkdir(root, "systems"); 58124bbb1faSMichael Holzheu if (IS_ERR(systems_dir)) { 58224bbb1faSMichael Holzheu rc = PTR_ERR(systems_dir); 58324bbb1faSMichael Holzheu goto err_out; 58424bbb1faSMichael Holzheu } 58524bbb1faSMichael Holzheu time_hdr = (struct x_info_blk_hdr *)buffer; 58624bbb1faSMichael Holzheu part_hdr = time_hdr + info_blk_hdr__size(diag204_info_type); 58724bbb1faSMichael Holzheu for (i = 0; i < info_blk_hdr__npar(diag204_info_type, time_hdr); i++) { 588e334cf4fSAl Viro part_hdr = hypfs_create_lpar_files(systems_dir, part_hdr); 58924bbb1faSMichael Holzheu if (IS_ERR(part_hdr)) { 59024bbb1faSMichael Holzheu rc = PTR_ERR(part_hdr); 59124bbb1faSMichael Holzheu goto err_out; 59224bbb1faSMichael Holzheu } 59324bbb1faSMichael Holzheu } 594e65f30e0SJanosch Frank if (info_blk_hdr__flags(diag204_info_type, time_hdr) & 595e65f30e0SJanosch Frank DIAG204_LPAR_PHYS_FLG) { 596e334cf4fSAl Viro ptr = hypfs_create_phys_files(root, part_hdr); 59724bbb1faSMichael Holzheu if (IS_ERR(ptr)) { 59824bbb1faSMichael Holzheu rc = PTR_ERR(ptr); 59924bbb1faSMichael Holzheu goto err_out; 60024bbb1faSMichael Holzheu } 60124bbb1faSMichael Holzheu } 602a118cfdfSAl Viro hyp_dir = hypfs_mkdir(root, "hyp"); 60324bbb1faSMichael Holzheu if (IS_ERR(hyp_dir)) { 60424bbb1faSMichael Holzheu rc = PTR_ERR(hyp_dir); 60524bbb1faSMichael Holzheu goto err_out; 60624bbb1faSMichael Holzheu } 607a118cfdfSAl Viro ptr = hypfs_create_str(hyp_dir, "type", "LPAR Hypervisor"); 60824bbb1faSMichael Holzheu if (IS_ERR(ptr)) { 60924bbb1faSMichael Holzheu rc = PTR_ERR(ptr); 61024bbb1faSMichael Holzheu goto err_out; 61124bbb1faSMichael Holzheu } 61224bbb1faSMichael Holzheu rc = 0; 61324bbb1faSMichael Holzheu 61424bbb1faSMichael Holzheu err_out: 61524bbb1faSMichael Holzheu return rc; 61624bbb1faSMichael Holzheu } 617