1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Hypervisor filesystem for Linux on s390
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Diag 0C implementation
6*4882a593Smuzhiyun *
7*4882a593Smuzhiyun * Copyright IBM Corp. 2014
8*4882a593Smuzhiyun */
9*4882a593Smuzhiyun
10*4882a593Smuzhiyun #include <linux/slab.h>
11*4882a593Smuzhiyun #include <linux/cpu.h>
12*4882a593Smuzhiyun #include <asm/diag.h>
13*4882a593Smuzhiyun #include <asm/hypfs.h>
14*4882a593Smuzhiyun #include "hypfs.h"
15*4882a593Smuzhiyun
16*4882a593Smuzhiyun #define DBFS_D0C_HDR_VERSION 0
17*4882a593Smuzhiyun
18*4882a593Smuzhiyun /*
19*4882a593Smuzhiyun * Get hypfs_diag0c_entry from CPU vector and store diag0c data
20*4882a593Smuzhiyun */
diag0c_fn(void * data)21*4882a593Smuzhiyun static void diag0c_fn(void *data)
22*4882a593Smuzhiyun {
23*4882a593Smuzhiyun diag_stat_inc(DIAG_STAT_X00C);
24*4882a593Smuzhiyun diag_dma_ops.diag0c(((void **) data)[smp_processor_id()]);
25*4882a593Smuzhiyun }
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun /*
28*4882a593Smuzhiyun * Allocate buffer and store diag 0c data
29*4882a593Smuzhiyun */
diag0c_store(unsigned int * count)30*4882a593Smuzhiyun static void *diag0c_store(unsigned int *count)
31*4882a593Smuzhiyun {
32*4882a593Smuzhiyun struct hypfs_diag0c_data *diag0c_data;
33*4882a593Smuzhiyun unsigned int cpu_count, cpu, i;
34*4882a593Smuzhiyun void **cpu_vec;
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun get_online_cpus();
37*4882a593Smuzhiyun cpu_count = num_online_cpus();
38*4882a593Smuzhiyun cpu_vec = kmalloc_array(num_possible_cpus(), sizeof(*cpu_vec),
39*4882a593Smuzhiyun GFP_KERNEL);
40*4882a593Smuzhiyun if (!cpu_vec)
41*4882a593Smuzhiyun goto fail_put_online_cpus;
42*4882a593Smuzhiyun /* Note: Diag 0c needs 8 byte alignment and real storage */
43*4882a593Smuzhiyun diag0c_data = kzalloc(struct_size(diag0c_data, entry, cpu_count),
44*4882a593Smuzhiyun GFP_KERNEL | GFP_DMA);
45*4882a593Smuzhiyun if (!diag0c_data)
46*4882a593Smuzhiyun goto fail_kfree_cpu_vec;
47*4882a593Smuzhiyun i = 0;
48*4882a593Smuzhiyun /* Fill CPU vector for each online CPU */
49*4882a593Smuzhiyun for_each_online_cpu(cpu) {
50*4882a593Smuzhiyun diag0c_data->entry[i].cpu = cpu;
51*4882a593Smuzhiyun cpu_vec[cpu] = &diag0c_data->entry[i++];
52*4882a593Smuzhiyun }
53*4882a593Smuzhiyun /* Collect data all CPUs */
54*4882a593Smuzhiyun on_each_cpu(diag0c_fn, cpu_vec, 1);
55*4882a593Smuzhiyun *count = cpu_count;
56*4882a593Smuzhiyun kfree(cpu_vec);
57*4882a593Smuzhiyun put_online_cpus();
58*4882a593Smuzhiyun return diag0c_data;
59*4882a593Smuzhiyun
60*4882a593Smuzhiyun fail_kfree_cpu_vec:
61*4882a593Smuzhiyun kfree(cpu_vec);
62*4882a593Smuzhiyun fail_put_online_cpus:
63*4882a593Smuzhiyun put_online_cpus();
64*4882a593Smuzhiyun return ERR_PTR(-ENOMEM);
65*4882a593Smuzhiyun }
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun /*
68*4882a593Smuzhiyun * Hypfs DBFS callback: Free diag 0c data
69*4882a593Smuzhiyun */
dbfs_diag0c_free(const void * data)70*4882a593Smuzhiyun static void dbfs_diag0c_free(const void *data)
71*4882a593Smuzhiyun {
72*4882a593Smuzhiyun kfree(data);
73*4882a593Smuzhiyun }
74*4882a593Smuzhiyun
75*4882a593Smuzhiyun /*
76*4882a593Smuzhiyun * Hypfs DBFS callback: Create diag 0c data
77*4882a593Smuzhiyun */
dbfs_diag0c_create(void ** data,void ** data_free_ptr,size_t * size)78*4882a593Smuzhiyun static int dbfs_diag0c_create(void **data, void **data_free_ptr, size_t *size)
79*4882a593Smuzhiyun {
80*4882a593Smuzhiyun struct hypfs_diag0c_data *diag0c_data;
81*4882a593Smuzhiyun unsigned int count;
82*4882a593Smuzhiyun
83*4882a593Smuzhiyun diag0c_data = diag0c_store(&count);
84*4882a593Smuzhiyun if (IS_ERR(diag0c_data))
85*4882a593Smuzhiyun return PTR_ERR(diag0c_data);
86*4882a593Smuzhiyun memset(&diag0c_data->hdr, 0, sizeof(diag0c_data->hdr));
87*4882a593Smuzhiyun get_tod_clock_ext(diag0c_data->hdr.tod_ext);
88*4882a593Smuzhiyun diag0c_data->hdr.len = count * sizeof(struct hypfs_diag0c_entry);
89*4882a593Smuzhiyun diag0c_data->hdr.version = DBFS_D0C_HDR_VERSION;
90*4882a593Smuzhiyun diag0c_data->hdr.count = count;
91*4882a593Smuzhiyun *data = diag0c_data;
92*4882a593Smuzhiyun *data_free_ptr = diag0c_data;
93*4882a593Smuzhiyun *size = diag0c_data->hdr.len + sizeof(struct hypfs_diag0c_hdr);
94*4882a593Smuzhiyun return 0;
95*4882a593Smuzhiyun }
96*4882a593Smuzhiyun
97*4882a593Smuzhiyun /*
98*4882a593Smuzhiyun * Hypfs DBFS file structure
99*4882a593Smuzhiyun */
100*4882a593Smuzhiyun static struct hypfs_dbfs_file dbfs_file_0c = {
101*4882a593Smuzhiyun .name = "diag_0c",
102*4882a593Smuzhiyun .data_create = dbfs_diag0c_create,
103*4882a593Smuzhiyun .data_free = dbfs_diag0c_free,
104*4882a593Smuzhiyun };
105*4882a593Smuzhiyun
106*4882a593Smuzhiyun /*
107*4882a593Smuzhiyun * Initialize diag 0c interface for z/VM
108*4882a593Smuzhiyun */
hypfs_diag0c_init(void)109*4882a593Smuzhiyun int __init hypfs_diag0c_init(void)
110*4882a593Smuzhiyun {
111*4882a593Smuzhiyun if (!MACHINE_IS_VM)
112*4882a593Smuzhiyun return 0;
113*4882a593Smuzhiyun hypfs_dbfs_create_file(&dbfs_file_0c);
114*4882a593Smuzhiyun return 0;
115*4882a593Smuzhiyun }
116*4882a593Smuzhiyun
117*4882a593Smuzhiyun /*
118*4882a593Smuzhiyun * Shutdown diag 0c interface for z/VM
119*4882a593Smuzhiyun */
hypfs_diag0c_exit(void)120*4882a593Smuzhiyun void hypfs_diag0c_exit(void)
121*4882a593Smuzhiyun {
122*4882a593Smuzhiyun if (!MACHINE_IS_VM)
123*4882a593Smuzhiyun return;
124*4882a593Smuzhiyun hypfs_dbfs_remove_file(&dbfs_file_0c);
125*4882a593Smuzhiyun }
126