4 * Copyright IBM Corp. 2013
7 #define KMSG_COMPONENT "sclp_early"
8 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
10 #include <asm/ctl_reg.h>
13 #include "sclp_sdias.h"
16 #define SCLP_CMDW_READ_SCP_INFO 0x00020001
17 #define SCLP_CMDW_READ_SCP_INFO_FORCED 0x00120001
19 struct read_info_sccb {
20 struct sccb_header header; /* 0-7 */
23 u8 _reserved0[24 - 11]; /* 11-15 */
24 u8 loadparm[8]; /* 24-31 */
25 u8 _reserved1[48 - 32]; /* 32-47 */
26 u64 facilities; /* 48-55 */
27 u8 _reserved2[84 - 56]; /* 56-83 */
30 u8 _reserved3[91 - 86]; /* 86-90 */
32 u8 _reserved4[100 - 92]; /* 92-99 */
33 u32 rnsize2; /* 100-103 */
34 u64 rnmax2; /* 104-111 */
35 u8 _reserved5[4096 - 112]; /* 112-4095 */
36 } __packed __aligned(PAGE_SIZE);
38 static __initdata struct init_sccb early_event_mask_sccb __aligned(PAGE_SIZE);
39 static __initdata struct read_info_sccb early_read_info_sccb;
40 static __initdata char sccb_early[PAGE_SIZE] __aligned(PAGE_SIZE);
41 static unsigned long sclp_hsa_size;
43 __initdata int sclp_early_read_info_sccb_valid;
46 unsigned long long sclp_rzm;
47 unsigned long long sclp_rnmax;
49 static int __init sclp_cmd_sync_early(sclp_cmdw_t cmd, void *sccb)
54 rc = sclp_service_call(cmd, sccb);
57 __load_psw_mask(PSW_DEFAULT_KEY | PSW_MASK_BASE | PSW_MASK_EA |
58 PSW_MASK_BA | PSW_MASK_EXT | PSW_MASK_WAIT);
61 /* Contents of the sccb might have changed. */
63 __ctl_clear_bit(0, 9);
67 static void __init sclp_read_info_early(void)
71 struct read_info_sccb *sccb;
72 sclp_cmdw_t commands[] = {SCLP_CMDW_READ_SCP_INFO_FORCED,
73 SCLP_CMDW_READ_SCP_INFO};
75 sccb = &early_read_info_sccb;
76 for (i = 0; i < ARRAY_SIZE(commands); i++) {
78 memset(sccb, 0, sizeof(*sccb));
79 sccb->header.length = sizeof(*sccb);
80 sccb->header.function_code = 0x80;
81 sccb->header.control_mask[2] = 0x80;
82 rc = sclp_cmd_sync_early(commands[i], sccb);
83 } while (rc == -EBUSY);
87 if (sccb->header.response_code == 0x10) {
88 sclp_early_read_info_sccb_valid = 1;
91 if (sccb->header.response_code != 0x1f0)
96 static void __init sclp_event_mask_early(void)
98 struct init_sccb *sccb = &early_event_mask_sccb;
102 memset(sccb, 0, sizeof(*sccb));
103 sccb->header.length = sizeof(*sccb);
104 sccb->mask_length = sizeof(sccb_mask_t);
105 rc = sclp_cmd_sync_early(SCLP_CMDW_WRITE_EVENT_MASK, sccb);
106 } while (rc == -EBUSY);
109 void __init sclp_facilities_detect(void)
111 struct read_info_sccb *sccb;
113 sclp_read_info_early();
114 if (!sclp_early_read_info_sccb_valid)
117 sccb = &early_read_info_sccb;
118 sclp_facilities = sccb->facilities;
119 sclp_fac84 = sccb->fac84;
120 if (sccb->fac85 & 0x02)
121 S390_lowcore.machine_flags |= MACHINE_FLAG_ESOP;
122 sclp_rnmax = sccb->rnmax ? sccb->rnmax : sccb->rnmax2;
123 sclp_rzm = sccb->rnsize ? sccb->rnsize : sccb->rnsize2;
126 sclp_event_mask_early();
129 bool __init sclp_has_linemode(void)
131 struct init_sccb *sccb = &early_event_mask_sccb;
133 if (sccb->header.response_code != 0x20)
135 if (!(sccb->sclp_send_mask & (EVTYP_OPCMD_MASK | EVTYP_PMSGCMD_MASK)))
137 if (!(sccb->sclp_receive_mask & (EVTYP_MSG_MASK | EVTYP_PMSGCMD_MASK)))
142 bool __init sclp_has_vt220(void)
144 struct init_sccb *sccb = &early_event_mask_sccb;
146 if (sccb->header.response_code != 0x20)
148 if (sccb->sclp_send_mask & EVTYP_VT220MSG_MASK)
153 unsigned long long sclp_get_rnmax(void)
158 unsigned long long sclp_get_rzm(void)
164 * This function will be called after sclp_facilities_detect(), which gets
165 * called from early.c code. Therefore the sccb should have valid contents.
167 void __init sclp_get_ipl_info(struct sclp_ipl_info *info)
169 struct read_info_sccb *sccb;
171 if (!sclp_early_read_info_sccb_valid)
173 sccb = &early_read_info_sccb;
175 if (sccb->flags & 0x2)
177 memcpy(&info->loadparm, &sccb->loadparm, LOADPARM_LEN);
180 static int __init sclp_cmd_early(sclp_cmdw_t cmd, void *sccb)
185 rc = sclp_cmd_sync_early(cmd, sccb);
186 } while (rc == -EBUSY);
190 if (((struct sccb_header *) sccb)->response_code != 0x0020)
195 static void __init sccb_init_eq_size(struct sdias_sccb *sccb)
197 memset(sccb, 0, sizeof(*sccb));
199 sccb->hdr.length = sizeof(*sccb);
200 sccb->evbuf.hdr.length = sizeof(struct sdias_evbuf);
201 sccb->evbuf.hdr.type = EVTYP_SDIAS;
202 sccb->evbuf.event_qual = SDIAS_EQ_SIZE;
203 sccb->evbuf.data_id = SDIAS_DI_FCP_DUMP;
204 sccb->evbuf.event_id = 4712;
208 static int __init sclp_set_event_mask(unsigned long receive_mask,
209 unsigned long send_mask)
211 struct init_sccb *sccb = (void *) &sccb_early;
213 memset(sccb, 0, sizeof(*sccb));
214 sccb->header.length = sizeof(*sccb);
215 sccb->mask_length = sizeof(sccb_mask_t);
216 sccb->receive_mask = receive_mask;
217 sccb->send_mask = send_mask;
218 return sclp_cmd_early(SCLP_CMDW_WRITE_EVENT_MASK, sccb);
221 static long __init sclp_hsa_size_init(void)
223 struct sdias_sccb *sccb = (void *) &sccb_early;
225 sccb_init_eq_size(sccb);
226 if (sclp_cmd_early(SCLP_CMDW_WRITE_EVENT_DATA, sccb))
228 if (sccb->evbuf.blk_cnt != 0)
229 return (sccb->evbuf.blk_cnt - 1) * PAGE_SIZE;
233 static long __init sclp_hsa_copy_wait(void)
235 struct sccb_header *sccb = (void *) &sccb_early;
237 memset(sccb, 0, PAGE_SIZE);
238 sccb->length = PAGE_SIZE;
239 if (sclp_cmd_early(SCLP_CMDW_READ_EVENT_DATA, sccb))
241 return (((struct sdias_sccb *) sccb)->evbuf.blk_cnt - 1) * PAGE_SIZE;
244 unsigned long sclp_get_hsa_size(void)
246 return sclp_hsa_size;
249 void __init sclp_hsa_size_detect(void)
253 /* First try synchronous interface (LPAR) */
254 if (sclp_set_event_mask(0, 0x40000010))
256 size = sclp_hsa_size_init();
261 /* Then try asynchronous interface (z/VM) */
262 if (sclp_set_event_mask(0x00000010, 0x40000010))
264 size = sclp_hsa_size_init();
267 size = sclp_hsa_copy_wait();
271 sclp_set_event_mask(0, 0);
272 sclp_hsa_size = size;