drivers/s390/char/sclp_cmd.c - kernel/msm-4.9 - Gitiles

 /*
  *  drivers/s390/char/sclp_cmd.c
  *
  *    Copyright IBM Corp. 2007
  *    Author(s): Heiko Carstens <heiko.carstens@de.ibm.com>,
  *		 Peter Oberparleiter <peter.oberparleiter@de.ibm.com>
  */

 #include <linux/completion.h>
 #include <linux/init.h>
 #include <linux/errno.h>
 #include <linux/slab.h>
 #include <linux/string.h>
 #include <linux/mm.h>
 #include <linux/mmzone.h>
 #include <linux/memory.h>
 #include <asm/chpid.h>
 #include <asm/sclp.h>
 #include "sclp.h"

 #define TAG	"sclp_cmd: "

 #define SCLP_CMDW_READ_SCP_INFO		0x00020001
 #define SCLP_CMDW_READ_SCP_INFO_FORCED	0x00120001

 struct read_info_sccb {
 	struct	sccb_header header;	/* 0-7 */
 	u16	rnmax;			/* 8-9 */
 	u8	rnsize;			/* 10 */
 	u8	_reserved0[24 - 11];	/* 11-15 */
 	u8	loadparm[8];		/* 24-31 */
 	u8	_reserved1[48 - 32];	/* 32-47 */
 	u64	facilities;		/* 48-55 */
 	u8	_reserved2[84 - 56];	/* 56-83 */
 	u8	fac84;			/* 84 */
 	u8	_reserved3[91 - 85];	/* 85-90 */
 	u8	flags;			/* 91 */
 	u8	_reserved4[100 - 92];	/* 92-99 */
 	u32	rnsize2;		/* 100-103 */
 	u64	rnmax2;			/* 104-111 */
 	u8	_reserved5[4096 - 112];	/* 112-4095 */
 } __attribute__((packed, aligned(PAGE_SIZE)));

 static struct read_info_sccb __initdata early_read_info_sccb;
 static int __initdata early_read_info_sccb_valid;

 u64 sclp_facilities;
 static u8 sclp_fac84;
 static unsigned long long rzm;
 static unsigned long long rnmax;

 static int __init sclp_cmd_sync_early(sclp_cmdw_t cmd, void *sccb)
 {
 	int rc;

 	__ctl_set_bit(0, 9);
 	rc = sclp_service_call(cmd, sccb);
 	if (rc)
 		goto out;
 	__load_psw_mask(PSW_BASE_BITS | PSW_MASK_EXT |
 			PSW_MASK_WAIT | PSW_DEFAULT_KEY);
 	local_irq_disable();
 out:
 	/* Contents of the sccb might have changed. */
 	barrier();
 	__ctl_clear_bit(0, 9);
 	return rc;
 }

 void __init sclp_read_info_early(void)
 {
 	int rc;
 	int i;
 	struct read_info_sccb *sccb;
 	sclp_cmdw_t commands[] = {SCLP_CMDW_READ_SCP_INFO_FORCED,
 				  SCLP_CMDW_READ_SCP_INFO};

 	sccb = &early_read_info_sccb;
 	for (i = 0; i < ARRAY_SIZE(commands); i++) {
 		do {
 			memset(sccb, 0, sizeof(*sccb));
 			sccb->header.length = sizeof(*sccb);
 			sccb->header.control_mask[2] = 0x80;
 			rc = sclp_cmd_sync_early(commands[i], sccb);
 		} while (rc == -EBUSY);

 		if (rc)
 			break;
 		if (sccb->header.response_code == 0x10) {
 			early_read_info_sccb_valid = 1;
 			break;
 		}
 		if (sccb->header.response_code != 0x1f0)
 			break;
 	}
 }

 void __init sclp_facilities_detect(void)
 {
 	if (!early_read_info_sccb_valid)
 		return;
 	sclp_facilities = early_read_info_sccb.facilities;
 	sclp_fac84 = early_read_info_sccb.fac84;
 }

 unsigned long long __init sclp_memory_detect(void)
 {
 	unsigned long long memsize;
 	struct read_info_sccb *sccb;

 	if (!early_read_info_sccb_valid)
 		return 0;
 	sccb = &early_read_info_sccb;
 	rnmax = sccb->rnmax ? sccb->rnmax : sccb->rnmax2;
 	rzm = sccb->rnsize ? sccb->rnsize : sccb->rnsize2;
 	rzm <<= 20;
 	memsize = rzm * rnmax;
 	return memsize;
 }

 /*
  * This function will be called after sclp_memory_detect(), which gets called
  * early from early.c code. Therefore the sccb should have valid contents.
  */
 void __init sclp_get_ipl_info(struct sclp_ipl_info *info)
 {
 	struct read_info_sccb *sccb;

 	if (!early_read_info_sccb_valid)
 		return;
 	sccb = &early_read_info_sccb;
 	info->is_valid = 1;
 	if (sccb->flags & 0x2)
 		info->has_dump = 1;
 	memcpy(&info->loadparm, &sccb->loadparm, LOADPARM_LEN);
 }

 static void sclp_sync_callback(struct sclp_req *req, void *data)
 {
 	struct completion *completion = data;

 	complete(completion);
 }

 static int do_sync_request(sclp_cmdw_t cmd, void *sccb)
 {
 	struct completion completion;
 	struct sclp_req *request;
 	int rc;

 	request = kzalloc(sizeof(*request), GFP_KERNEL);
 	if (!request)
 		return -ENOMEM;
 	request->command = cmd;
 	request->sccb = sccb;
 	request->status = SCLP_REQ_FILLED;
 	request->callback = sclp_sync_callback;
 	request->callback_data = &completion;
 	init_completion(&completion);

 	/* Perform sclp request. */
 	rc = sclp_add_request(request);
 	if (rc)
 		goto out;
 	wait_for_completion(&completion);

 	/* Check response. */
 	if (request->status != SCLP_REQ_DONE) {
 		printk(KERN_WARNING TAG "sync request failed "
 		       "(cmd=0x%08x, status=0x%02x)\n", cmd, request->status);
 		rc = -EIO;
 	}
 out:
 	kfree(request);
 	return rc;
 }

 /*
  * CPU configuration related functions.
  */

 #define SCLP_CMDW_READ_CPU_INFO		0x00010001
 #define SCLP_CMDW_CONFIGURE_CPU		0x00110001
 #define SCLP_CMDW_DECONFIGURE_CPU	0x00100001

 struct read_cpu_info_sccb {
 	struct	sccb_header header;
 	u16	nr_configured;
 	u16	offset_configured;
 	u16	nr_standby;
 	u16	offset_standby;
 	u8	reserved[4096 - 16];
 } __attribute__((packed, aligned(PAGE_SIZE)));

 static void sclp_fill_cpu_info(struct sclp_cpu_info *info,
 			       struct read_cpu_info_sccb *sccb)
 {
 	char *page = (char *) sccb;

 	memset(info, 0, sizeof(*info));
 	info->configured = sccb->nr_configured;
 	info->standby = sccb->nr_standby;
 	info->combined = sccb->nr_configured + sccb->nr_standby;
 	info->has_cpu_type = sclp_fac84 & 0x1;
 	memcpy(&info->cpu, page + sccb->offset_configured,
 	       info->combined * sizeof(struct sclp_cpu_entry));
 }

 int sclp_get_cpu_info(struct sclp_cpu_info *info)
 {
 	int rc;
 	struct read_cpu_info_sccb *sccb;

 	if (!SCLP_HAS_CPU_INFO)
 		return -EOPNOTSUPP;
 	sccb = (void *) get_zeroed_page(GFP_KERNEL | GFP_DMA);
 	if (!sccb)
 		return -ENOMEM;
 	sccb->header.length = sizeof(*sccb);
 	rc = do_sync_request(SCLP_CMDW_READ_CPU_INFO, sccb);
 	if (rc)
 		goto out;
 	if (sccb->header.response_code != 0x0010) {
 		printk(KERN_WARNING TAG "readcpuinfo failed "
 		       "(response=0x%04x)\n", sccb->header.response_code);
 		rc = -EIO;
 		goto out;
 	}
 	sclp_fill_cpu_info(info, sccb);
 out:
 	free_page((unsigned long) sccb);
 	return rc;
 }

 struct cpu_configure_sccb {
 	struct sccb_header header;
 } __attribute__((packed, aligned(8)));

 static int do_cpu_configure(sclp_cmdw_t cmd)
 {
 	struct cpu_configure_sccb *sccb;
 	int rc;

 	if (!SCLP_HAS_CPU_RECONFIG)
 		return -EOPNOTSUPP;
 	/*
 	 * This is not going to cross a page boundary since we force
 	 * kmalloc to have a minimum alignment of 8 bytes on s390.
 	 */
 	sccb = kzalloc(sizeof(*sccb), GFP_KERNEL | GFP_DMA);
 	if (!sccb)
 		return -ENOMEM;
 	sccb->header.length = sizeof(*sccb);
 	rc = do_sync_request(cmd, sccb);
 	if (rc)
 		goto out;
 	switch (sccb->header.response_code) {
 	case 0x0020:
 	case 0x0120:
 		break;
 	default:
 		printk(KERN_WARNING TAG "configure cpu failed (cmd=0x%08x, "
 		       "response=0x%04x)\n", cmd, sccb->header.response_code);
 		rc = -EIO;
 		break;
 	}
 out:
 	kfree(sccb);
 	return rc;
 }

 int sclp_cpu_configure(u8 cpu)
 {
 	return do_cpu_configure(SCLP_CMDW_CONFIGURE_CPU | cpu << 8);
 }

 int sclp_cpu_deconfigure(u8 cpu)
 {
 	return do_cpu_configure(SCLP_CMDW_DECONFIGURE_CPU | cpu << 8);
 }

 #ifdef CONFIG_MEMORY_HOTPLUG

 static DEFINE_MUTEX(sclp_mem_mutex);
 static LIST_HEAD(sclp_mem_list);
 static u8 sclp_max_storage_id;
 static unsigned long sclp_storage_ids[256 / BITS_PER_LONG];

 struct memory_increment {
 	struct list_head list;
 	u16 rn;
 	int standby;
 	int usecount;
 };

 struct assign_storage_sccb {
 	struct sccb_header header;
 	u16 rn;
 } __packed;

 static unsigned long long rn2addr(u16 rn)
 {
 	return (unsigned long long) (rn - 1) * rzm;
 }

 static int do_assign_storage(sclp_cmdw_t cmd, u16 rn)
 {
 	struct assign_storage_sccb *sccb;
 	int rc;

 	sccb = (void *) get_zeroed_page(GFP_KERNEL | GFP_DMA);
 	if (!sccb)
 		return -ENOMEM;
 	sccb->header.length = PAGE_SIZE;
 	sccb->rn = rn;
 	rc = do_sync_request(cmd, sccb);
 	if (rc)
 		goto out;
 	switch (sccb->header.response_code) {
 	case 0x0020:
 	case 0x0120:
 		break;
 	default:
 		rc = -EIO;
 		break;
 	}
 out:
 	free_page((unsigned long) sccb);
 	return rc;
 }

 static int sclp_assign_storage(u16 rn)
 {
 	return do_assign_storage(0x000d0001, rn);
 }

 static int sclp_unassign_storage(u16 rn)
 {
 	return do_assign_storage(0x000c0001, rn);
 }

 struct attach_storage_sccb {
 	struct sccb_header header;
 	u16 :16;
 	u16 assigned;
 	u32 :32;
 	u32 entries[0];
 } __packed;

 static int sclp_attach_storage(u8 id)
 {
 	struct attach_storage_sccb *sccb;
 	int rc;
 	int i;

 	sccb = (void *) get_zeroed_page(GFP_KERNEL | GFP_DMA);
 	if (!sccb)
 		return -ENOMEM;
 	sccb->header.length = PAGE_SIZE;
 	rc = do_sync_request(0x00080001 | id << 8, sccb);
 	if (rc)
 		goto out;
 	switch (sccb->header.response_code) {
 	case 0x0020:
 		set_bit(id, sclp_storage_ids);
 		for (i = 0; i < sccb->assigned; i++)
 			sclp_unassign_storage(sccb->entries[i] >> 16);
 		break;
 	default:
 		rc = -EIO;
 		break;
 	}
 out:
 	free_page((unsigned long) sccb);
 	return rc;
 }

 static int sclp_mem_change_state(unsigned long start, unsigned long size,
 				 int online)
 {
 	struct memory_increment *incr;
 	unsigned long long istart;
 	int rc = 0;

 	list_for_each_entry(incr, &sclp_mem_list, list) {
 		istart = rn2addr(incr->rn);
 		if (start + size - 1 < istart)
 			break;
 		if (start > istart + rzm - 1)
 			continue;
 		if (online) {
 			if (incr->usecount++)
 				continue;
 			/*
 			 * Don't break the loop if one assign fails. Loop may
 			 * be walked again on CANCEL and we can't save
 			 * information if state changed before or not.
 			 * So continue and increase usecount for all increments.
 			 */
 			rc |= sclp_assign_storage(incr->rn);
 		} else {
 			if (--incr->usecount)
 				continue;
 			sclp_unassign_storage(incr->rn);
 		}
 	}
 	return rc ? -EIO : 0;
 }

 static int sclp_mem_notifier(struct notifier_block *nb,
 			     unsigned long action, void *data)
 {
 	unsigned long start, size;
 	struct memory_notify *arg;
 	unsigned char id;
 	int rc = 0;

 	arg = data;
 	start = arg->start_pfn << PAGE_SHIFT;
 	size = arg->nr_pages << PAGE_SHIFT;
 	mutex_lock(&sclp_mem_mutex);
 	for (id = 0; id <= sclp_max_storage_id; id++)
 		if (!test_bit(id, sclp_storage_ids))
 			sclp_attach_storage(id);
 	switch (action) {
 	case MEM_ONLINE:
 		break;
 	case MEM_GOING_ONLINE:
 		rc = sclp_mem_change_state(start, size, 1);
 		break;
 	case MEM_CANCEL_ONLINE:
 		sclp_mem_change_state(start, size, 0);
 		break;
 	default:
 		rc = -EINVAL;
 		break;
 	}
 	mutex_unlock(&sclp_mem_mutex);
 	return rc ? NOTIFY_BAD : NOTIFY_OK;
 }

 static struct notifier_block sclp_mem_nb = {
 	.notifier_call = sclp_mem_notifier,
 };

 static void __init add_memory_merged(u16 rn)
 {
 	static u16 first_rn, num;
 	unsigned long long start, size;

 	if (rn && first_rn && (first_rn + num == rn)) {
 		num++;
 		return;
 	}
 	if (!first_rn)
 		goto skip_add;
 	start = rn2addr(first_rn);
 	size = (unsigned long long ) num * rzm;
 	if (start >= VMEM_MAX_PHYS)
 		goto skip_add;
 	if (start + size > VMEM_MAX_PHYS)
 		size = VMEM_MAX_PHYS - start;
 	add_memory(0, start, size);
 skip_add:
 	first_rn = rn;
 	num = 1;
 }

 static void __init sclp_add_standby_memory(void)
 {
 	struct memory_increment *incr;

 	list_for_each_entry(incr, &sclp_mem_list, list)
 		if (incr->standby)
 			add_memory_merged(incr->rn);
 	add_memory_merged(0);
 }

 static void __init insert_increment(u16 rn, int standby, int assigned)
 {
 	struct memory_increment *incr, *new_incr;
 	struct list_head *prev;
 	u16 last_rn;

 	new_incr = kzalloc(sizeof(*new_incr), GFP_KERNEL);
 	if (!new_incr)
 		return;
 	new_incr->rn = rn;
 	new_incr->standby = standby;
 	last_rn = 0;
 	prev = &sclp_mem_list;
 	list_for_each_entry(incr, &sclp_mem_list, list) {
 		if (assigned && incr->rn > rn)
 			break;
 		if (!assigned && incr->rn - last_rn > 1)
 			break;
 		last_rn = incr->rn;
 		prev = &incr->list;
 	}
 	if (!assigned)
 		new_incr->rn = last_rn + 1;
 	if (new_incr->rn > rnmax) {
 		kfree(new_incr);
 		return;
 	}
 	list_add(&new_incr->list, prev);
 }

 struct read_storage_sccb {
 	struct sccb_header header;
 	u16 max_id;
 	u16 assigned;
 	u16 standby;
 	u16 :16;
 	u32 entries[0];
 } __packed;

 static int __init sclp_detect_standby_memory(void)
 {
 	struct read_storage_sccb *sccb;
 	int i, id, assigned, rc;

 	if (!early_read_info_sccb_valid)
 		return 0;
 	if ((sclp_facilities & 0xe00000000000ULL) != 0xe00000000000ULL)
 		return 0;
 	rc = -ENOMEM;
 	sccb = (void *) __get_free_page(GFP_KERNEL | GFP_DMA);
 	if (!sccb)
 		goto out;
 	assigned = 0;
 	for (id = 0; id <= sclp_max_storage_id; id++) {
 		memset(sccb, 0, PAGE_SIZE);
 		sccb->header.length = PAGE_SIZE;
 		rc = do_sync_request(0x00040001 | id << 8, sccb);
 		if (rc)
 			goto out;
 		switch (sccb->header.response_code) {
 		case 0x0010:
 			set_bit(id, sclp_storage_ids);
 			for (i = 0; i < sccb->assigned; i++) {
 				if (!sccb->entries[i])
 					continue;
 				assigned++;
 				insert_increment(sccb->entries[i] >> 16, 0, 1);
 			}
 			break;
 		case 0x0310:
 			break;
 		case 0x0410:
 			for (i = 0; i < sccb->assigned; i++) {
 				if (!sccb->entries[i])
 					continue;
 				assigned++;
 				insert_increment(sccb->entries[i] >> 16, 1, 1);
 			}
 			break;
 		default:
 			rc = -EIO;
 			break;
 		}
 		if (!rc)
 			sclp_max_storage_id = sccb->max_id;
 	}
 	if (rc || list_empty(&sclp_mem_list))
 		goto out;
 	for (i = 1; i <= rnmax - assigned; i++)
 		insert_increment(0, 1, 0);
 	rc = register_memory_notifier(&sclp_mem_nb);
 	if (rc)
 		goto out;
 	sclp_add_standby_memory();
 out:
 	free_page((unsigned long) sccb);
 	return rc;
 }
 __initcall(sclp_detect_standby_memory);

 #endif /* CONFIG_MEMORY_HOTPLUG */

 /*
  * Channel path configuration related functions.
  */

 #define SCLP_CMDW_CONFIGURE_CHPATH		0x000f0001
 #define SCLP_CMDW_DECONFIGURE_CHPATH		0x000e0001
 #define SCLP_CMDW_READ_CHPATH_INFORMATION	0x00030001

 struct chp_cfg_sccb {
 	struct sccb_header header;
 	u8 ccm;
 	u8 reserved[6];
 	u8 cssid;
 } __attribute__((packed));

 static int do_chp_configure(sclp_cmdw_t cmd)
 {
 	struct chp_cfg_sccb *sccb;
 	int rc;

 	if (!SCLP_HAS_CHP_RECONFIG)
 		return -EOPNOTSUPP;
 	/* Prepare sccb. */
 	sccb = (struct chp_cfg_sccb *) get_zeroed_page(GFP_KERNEL | GFP_DMA);
 	if (!sccb)
 		return -ENOMEM;
 	sccb->header.length = sizeof(*sccb);
 	rc = do_sync_request(cmd, sccb);
 	if (rc)
 		goto out;
 	switch (sccb->header.response_code) {
 	case 0x0020:
 	case 0x0120:
 	case 0x0440:
 	case 0x0450:
 		break;
 	default:
 		printk(KERN_WARNING TAG "configure channel-path failed "
 		       "(cmd=0x%08x, response=0x%04x)\n", cmd,
 		       sccb->header.response_code);
 		rc = -EIO;
 		break;
 	}
 out:
 	free_page((unsigned long) sccb);
 	return rc;
 }

 /**
  * sclp_chp_configure - perform configure channel-path sclp command
  * @chpid: channel-path ID
  *
  * Perform configure channel-path command sclp command for specified chpid.
  * Return 0 after command successfully finished, non-zero otherwise.
  */
 int sclp_chp_configure(struct chp_id chpid)
 {
 	return do_chp_configure(SCLP_CMDW_CONFIGURE_CHPATH | chpid.id << 8);
 }

 /**
  * sclp_chp_deconfigure - perform deconfigure channel-path sclp command
  * @chpid: channel-path ID
  *
  * Perform deconfigure channel-path command sclp command for specified chpid
  * and wait for completion. On success return 0. Return non-zero otherwise.
  */
 int sclp_chp_deconfigure(struct chp_id chpid)
 {
 	return do_chp_configure(SCLP_CMDW_DECONFIGURE_CHPATH | chpid.id << 8);
 }

 struct chp_info_sccb {
 	struct sccb_header header;
 	u8 recognized[SCLP_CHP_INFO_MASK_SIZE];
 	u8 standby[SCLP_CHP_INFO_MASK_SIZE];
 	u8 configured[SCLP_CHP_INFO_MASK_SIZE];
 	u8 ccm;
 	u8 reserved[6];
 	u8 cssid;
 } __attribute__((packed));

 /**
  * sclp_chp_read_info - perform read channel-path information sclp command
  * @info: resulting channel-path information data
  *
  * Perform read channel-path information sclp command and wait for completion.
  * On success, store channel-path information in @info and return 0. Return
  * non-zero otherwise.
  */
 int sclp_chp_read_info(struct sclp_chp_info *info)
 {
 	struct chp_info_sccb *sccb;
 	int rc;

 	if (!SCLP_HAS_CHP_INFO)
 		return -EOPNOTSUPP;
 	/* Prepare sccb. */
 	sccb = (struct chp_info_sccb *) get_zeroed_page(GFP_KERNEL | GFP_DMA);
 	if (!sccb)
 		return -ENOMEM;
 	sccb->header.length = sizeof(*sccb);
 	rc = do_sync_request(SCLP_CMDW_READ_CHPATH_INFORMATION, sccb);
 	if (rc)
 		goto out;
 	if (sccb->header.response_code != 0x0010) {
 		printk(KERN_WARNING TAG "read channel-path info failed "
 		       "(response=0x%04x)\n", sccb->header.response_code);
 		rc = -EIO;
 		goto out;
 	}
 	memcpy(info->recognized, sccb->recognized, SCLP_CHP_INFO_MASK_SIZE);
 	memcpy(info->standby, sccb->standby, SCLP_CHP_INFO_MASK_SIZE);
 	memcpy(info->configured, sccb->configured, SCLP_CHP_INFO_MASK_SIZE);
 out:
 	free_page((unsigned long) sccb);
 	return rc;
 }
	/*
	* drivers/s390/char/sclp_cmd.c
	*
	* Copyright IBM Corp. 2007
	* Author(s): Heiko Carstens <heiko.carstens@de.ibm.com>,
	* Peter Oberparleiter <peter.oberparleiter@de.ibm.com>
	*/

	#include <linux/completion.h>
	#include <linux/init.h>
	#include <linux/errno.h>
	#include <linux/slab.h>
	#include <linux/string.h>
	#include <linux/mm.h>
	#include <linux/mmzone.h>
	#include <linux/memory.h>
	#include <asm/chpid.h>
	#include <asm/sclp.h>
	#include "sclp.h"

	#define TAG "sclp_cmd: "

	#define SCLP_CMDW_READ_SCP_INFO 0x00020001
	#define SCLP_CMDW_READ_SCP_INFO_FORCED 0x00120001

	struct read_info_sccb {
	struct sccb_header header; /* 0-7 */
	u16 rnmax; /* 8-9 */
	u8 rnsize; /* 10 */
	u8 _reserved0[24 - 11]; /* 11-15 */
	u8 loadparm[8]; /* 24-31 */
	u8 _reserved1[48 - 32]; /* 32-47 */
	u64 facilities; /* 48-55 */
	u8 _reserved2[84 - 56]; /* 56-83 */
	u8 fac84; /* 84 */
	u8 _reserved3[91 - 85]; /* 85-90 */
	u8 flags; /* 91 */
	u8 _reserved4[100 - 92]; /* 92-99 */
	u32 rnsize2; /* 100-103 */
	u64 rnmax2; /* 104-111 */
	u8 _reserved5[4096 - 112]; /* 112-4095 */
	} __attribute__((packed, aligned(PAGE_SIZE)));

	static struct read_info_sccb __initdata early_read_info_sccb;
	static int __initdata early_read_info_sccb_valid;

	u64 sclp_facilities;
	static u8 sclp_fac84;
	static unsigned long long rzm;
	static unsigned long long rnmax;

	static int __init sclp_cmd_sync_early(sclp_cmdw_t cmd, void *sccb)
	{
	int rc;

	__ctl_set_bit(0, 9);
	rc = sclp_service_call(cmd, sccb);
	if (rc)
	goto out;
	__load_psw_mask(PSW_BASE_BITS \| PSW_MASK_EXT \|
	PSW_MASK_WAIT \| PSW_DEFAULT_KEY);
	local_irq_disable();
	out:
	/* Contents of the sccb might have changed. */
	barrier();
	__ctl_clear_bit(0, 9);
	return rc;
	}

	void __init sclp_read_info_early(void)
	{
	int rc;
	int i;
	struct read_info_sccb *sccb;
	sclp_cmdw_t commands[] = {SCLP_CMDW_READ_SCP_INFO_FORCED,
	SCLP_CMDW_READ_SCP_INFO};

	sccb = &early_read_info_sccb;
	for (i = 0; i < ARRAY_SIZE(commands); i++) {
	do {
	memset(sccb, 0, sizeof(*sccb));
	sccb->header.length = sizeof(*sccb);
	sccb->header.control_mask[2] = 0x80;
	rc = sclp_cmd_sync_early(commands[i], sccb);
	} while (rc == -EBUSY);

	if (rc)
	break;
	if (sccb->header.response_code == 0x10) {
	early_read_info_sccb_valid = 1;
	break;
	}
	if (sccb->header.response_code != 0x1f0)
	break;
	}
	}

	void __init sclp_facilities_detect(void)
	{
	if (!early_read_info_sccb_valid)
	return;
	sclp_facilities = early_read_info_sccb.facilities;
	sclp_fac84 = early_read_info_sccb.fac84;
	}

	unsigned long long __init sclp_memory_detect(void)
	{
	unsigned long long memsize;
	struct read_info_sccb *sccb;

	if (!early_read_info_sccb_valid)
	return 0;
	sccb = &early_read_info_sccb;
	rnmax = sccb->rnmax ? sccb->rnmax : sccb->rnmax2;
	rzm = sccb->rnsize ? sccb->rnsize : sccb->rnsize2;
	rzm <<= 20;
	memsize = rzm * rnmax;
	return memsize;
	}

	/*
	* This function will be called after sclp_memory_detect(), which gets called
	* early from early.c code. Therefore the sccb should have valid contents.
	*/
	void __init sclp_get_ipl_info(struct sclp_ipl_info *info)
	{
	struct read_info_sccb *sccb;

	if (!early_read_info_sccb_valid)
	return;
	sccb = &early_read_info_sccb;
	info->is_valid = 1;
	if (sccb->flags & 0x2)
	info->has_dump = 1;
	memcpy(&info->loadparm, &sccb->loadparm, LOADPARM_LEN);
	}

	static void sclp_sync_callback(struct sclp_req req, void data)
	{
	struct completion *completion = data;

	complete(completion);
	}

	static int do_sync_request(sclp_cmdw_t cmd, void *sccb)
	{
	struct completion completion;
	struct sclp_req *request;
	int rc;

	request = kzalloc(sizeof(*request), GFP_KERNEL);
	if (!request)
	return -ENOMEM;
	request->command = cmd;
	request->sccb = sccb;
	request->status = SCLP_REQ_FILLED;
	request->callback = sclp_sync_callback;
	request->callback_data = &completion;
	init_completion(&completion);

	/* Perform sclp request. */
	rc = sclp_add_request(request);
	if (rc)
	goto out;
	wait_for_completion(&completion);

	/* Check response. */
	if (request->status != SCLP_REQ_DONE) {
	printk(KERN_WARNING TAG "sync request failed "
	"(cmd=0x%08x, status=0x%02x)\n", cmd, request->status);
	rc = -EIO;
	}
	out:
	kfree(request);
	return rc;
	}

	/*
	* CPU configuration related functions.
	*/

	#define SCLP_CMDW_READ_CPU_INFO 0x00010001
	#define SCLP_CMDW_CONFIGURE_CPU 0x00110001
	#define SCLP_CMDW_DECONFIGURE_CPU 0x00100001

	struct read_cpu_info_sccb {
	struct sccb_header header;
	u16 nr_configured;
	u16 offset_configured;
	u16 nr_standby;
	u16 offset_standby;
	u8 reserved[4096 - 16];
	} __attribute__((packed, aligned(PAGE_SIZE)));

	static void sclp_fill_cpu_info(struct sclp_cpu_info *info,
	struct read_cpu_info_sccb *sccb)
	{
	char page = (char ) sccb;

	memset(info, 0, sizeof(*info));
	info->configured = sccb->nr_configured;
	info->standby = sccb->nr_standby;
	info->combined = sccb->nr_configured + sccb->nr_standby;
	info->has_cpu_type = sclp_fac84 & 0x1;
	memcpy(&info->cpu, page + sccb->offset_configured,
	info->combined * sizeof(struct sclp_cpu_entry));
	}

	int sclp_get_cpu_info(struct sclp_cpu_info *info)
	{
	int rc;
	struct read_cpu_info_sccb *sccb;

	if (!SCLP_HAS_CPU_INFO)
	return -EOPNOTSUPP;
	sccb = (void *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
	if (!sccb)
	return -ENOMEM;
	sccb->header.length = sizeof(*sccb);
	rc = do_sync_request(SCLP_CMDW_READ_CPU_INFO, sccb);
	if (rc)
	goto out;
	if (sccb->header.response_code != 0x0010) {
	printk(KERN_WARNING TAG "readcpuinfo failed "
	"(response=0x%04x)\n", sccb->header.response_code);
	rc = -EIO;
	goto out;
	}
	sclp_fill_cpu_info(info, sccb);
	out:
	free_page((unsigned long) sccb);
	return rc;
	}

	struct cpu_configure_sccb {
	struct sccb_header header;
	} __attribute__((packed, aligned(8)));

	static int do_cpu_configure(sclp_cmdw_t cmd)
	{
	struct cpu_configure_sccb *sccb;
	int rc;

	if (!SCLP_HAS_CPU_RECONFIG)
	return -EOPNOTSUPP;
	/*
	* This is not going to cross a page boundary since we force
	* kmalloc to have a minimum alignment of 8 bytes on s390.
	*/
	sccb = kzalloc(sizeof(*sccb), GFP_KERNEL \| GFP_DMA);
	if (!sccb)
	return -ENOMEM;
	sccb->header.length = sizeof(*sccb);
	rc = do_sync_request(cmd, sccb);
	if (rc)
	goto out;
	switch (sccb->header.response_code) {
	case 0x0020:
	case 0x0120:
	break;
	default:
	printk(KERN_WARNING TAG "configure cpu failed (cmd=0x%08x, "
	"response=0x%04x)\n", cmd, sccb->header.response_code);
	rc = -EIO;
	break;
	}
	out:
	kfree(sccb);
	return rc;
	}

	int sclp_cpu_configure(u8 cpu)
	{
	return do_cpu_configure(SCLP_CMDW_CONFIGURE_CPU \| cpu << 8);
	}

	int sclp_cpu_deconfigure(u8 cpu)
	{
	return do_cpu_configure(SCLP_CMDW_DECONFIGURE_CPU \| cpu << 8);
	}

	#ifdef CONFIG_MEMORY_HOTPLUG

	static DEFINE_MUTEX(sclp_mem_mutex);
	static LIST_HEAD(sclp_mem_list);
	static u8 sclp_max_storage_id;
	static unsigned long sclp_storage_ids[256 / BITS_PER_LONG];

	struct memory_increment {
	struct list_head list;
	u16 rn;
	int standby;
	int usecount;
	};

	struct assign_storage_sccb {
	struct sccb_header header;
	u16 rn;
	} __packed;

	static unsigned long long rn2addr(u16 rn)
	{
	return (unsigned long long) (rn - 1) * rzm;
	}

	static int do_assign_storage(sclp_cmdw_t cmd, u16 rn)
	{
	struct assign_storage_sccb *sccb;
	int rc;

	sccb = (void *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
	if (!sccb)
	return -ENOMEM;
	sccb->header.length = PAGE_SIZE;
	sccb->rn = rn;
	rc = do_sync_request(cmd, sccb);
	if (rc)
	goto out;
	switch (sccb->header.response_code) {
	case 0x0020:
	case 0x0120:
	break;
	default:
	rc = -EIO;
	break;
	}
	out:
	free_page((unsigned long) sccb);
	return rc;
	}

	static int sclp_assign_storage(u16 rn)
	{
	return do_assign_storage(0x000d0001, rn);
	}

	static int sclp_unassign_storage(u16 rn)
	{
	return do_assign_storage(0x000c0001, rn);
	}

	struct attach_storage_sccb {
	struct sccb_header header;
	u16 :16;
	u16 assigned;
	u32 :32;
	u32 entries[0];
	} __packed;

	static int sclp_attach_storage(u8 id)
	{
	struct attach_storage_sccb *sccb;
	int rc;
	int i;

	sccb = (void *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
	if (!sccb)
	return -ENOMEM;
	sccb->header.length = PAGE_SIZE;
	rc = do_sync_request(0x00080001 \| id << 8, sccb);
	if (rc)
	goto out;
	switch (sccb->header.response_code) {
	case 0x0020:
	set_bit(id, sclp_storage_ids);
	for (i = 0; i < sccb->assigned; i++)
	sclp_unassign_storage(sccb->entries[i] >> 16);
	break;
	default:
	rc = -EIO;
	break;
	}
	out:
	free_page((unsigned long) sccb);
	return rc;
	}

	static int sclp_mem_change_state(unsigned long start, unsigned long size,
	int online)
	{
	struct memory_increment *incr;
	unsigned long long istart;
	int rc = 0;

	list_for_each_entry(incr, &sclp_mem_list, list) {
	istart = rn2addr(incr->rn);
	if (start + size - 1 < istart)
	break;
	if (start > istart + rzm - 1)
	continue;
	if (online) {
	if (incr->usecount++)
	continue;
	/*
	* Don't break the loop if one assign fails. Loop may
	* be walked again on CANCEL and we can't save
	* information if state changed before or not.
	* So continue and increase usecount for all increments.
	*/
	rc \|= sclp_assign_storage(incr->rn);
	} else {
	if (--incr->usecount)
	continue;
	sclp_unassign_storage(incr->rn);
	}
	}
	return rc ? -EIO : 0;
	}

	static int sclp_mem_notifier(struct notifier_block *nb,
	unsigned long action, void *data)
	{
	unsigned long start, size;
	struct memory_notify *arg;
	unsigned char id;
	int rc = 0;

	arg = data;
	start = arg->start_pfn << PAGE_SHIFT;
	size = arg->nr_pages << PAGE_SHIFT;
	mutex_lock(&sclp_mem_mutex);
	for (id = 0; id <= sclp_max_storage_id; id++)
	if (!test_bit(id, sclp_storage_ids))
	sclp_attach_storage(id);
	switch (action) {
	case MEM_ONLINE:
	break;
	case MEM_GOING_ONLINE:
	rc = sclp_mem_change_state(start, size, 1);
	break;
	case MEM_CANCEL_ONLINE:
	sclp_mem_change_state(start, size, 0);
	break;
	default:
	rc = -EINVAL;
	break;
	}
	mutex_unlock(&sclp_mem_mutex);
	return rc ? NOTIFY_BAD : NOTIFY_OK;
	}

	static struct notifier_block sclp_mem_nb = {
	.notifier_call = sclp_mem_notifier,
	};

	static void __init add_memory_merged(u16 rn)
	{
	static u16 first_rn, num;
	unsigned long long start, size;

	if (rn && first_rn && (first_rn + num == rn)) {
	num++;
	return;
	}
	if (!first_rn)
	goto skip_add;
	start = rn2addr(first_rn);
	size = (unsigned long long ) num * rzm;
	if (start >= VMEM_MAX_PHYS)
	goto skip_add;
	if (start + size > VMEM_MAX_PHYS)
	size = VMEM_MAX_PHYS - start;
	add_memory(0, start, size);
	skip_add:
	first_rn = rn;
	num = 1;
	}

	static void __init sclp_add_standby_memory(void)
	{
	struct memory_increment *incr;

	list_for_each_entry(incr, &sclp_mem_list, list)
	if (incr->standby)
	add_memory_merged(incr->rn);
	add_memory_merged(0);
	}

	static void __init insert_increment(u16 rn, int standby, int assigned)
	{
	struct memory_increment incr, new_incr;
	struct list_head *prev;
	u16 last_rn;

	new_incr = kzalloc(sizeof(*new_incr), GFP_KERNEL);
	if (!new_incr)
	return;
	new_incr->rn = rn;
	new_incr->standby = standby;
	last_rn = 0;
	prev = &sclp_mem_list;
	list_for_each_entry(incr, &sclp_mem_list, list) {
	if (assigned && incr->rn > rn)
	break;
	if (!assigned && incr->rn - last_rn > 1)
	break;
	last_rn = incr->rn;
	prev = &incr->list;
	}
	if (!assigned)
	new_incr->rn = last_rn + 1;
	if (new_incr->rn > rnmax) {
	kfree(new_incr);
	return;
	}
	list_add(&new_incr->list, prev);
	}

	struct read_storage_sccb {
	struct sccb_header header;
	u16 max_id;
	u16 assigned;
	u16 standby;
	u16 :16;
	u32 entries[0];
	} __packed;

	static int __init sclp_detect_standby_memory(void)
	{
	struct read_storage_sccb *sccb;
	int i, id, assigned, rc;

	if (!early_read_info_sccb_valid)
	return 0;
	if ((sclp_facilities & 0xe00000000000ULL) != 0xe00000000000ULL)
	return 0;
	rc = -ENOMEM;
	sccb = (void *) __get_free_page(GFP_KERNEL \| GFP_DMA);
	if (!sccb)
	goto out;
	assigned = 0;
	for (id = 0; id <= sclp_max_storage_id; id++) {
	memset(sccb, 0, PAGE_SIZE);
	sccb->header.length = PAGE_SIZE;
	rc = do_sync_request(0x00040001 \| id << 8, sccb);
	if (rc)
	goto out;
	switch (sccb->header.response_code) {
	case 0x0010:
	set_bit(id, sclp_storage_ids);
	for (i = 0; i < sccb->assigned; i++) {
	if (!sccb->entries[i])
	continue;
	assigned++;
	insert_increment(sccb->entries[i] >> 16, 0, 1);
	}
	break;
	case 0x0310:
	break;
	case 0x0410:
	for (i = 0; i < sccb->assigned; i++) {
	if (!sccb->entries[i])
	continue;
	assigned++;
	insert_increment(sccb->entries[i] >> 16, 1, 1);
	}
	break;
	default:
	rc = -EIO;
	break;
	}
	if (!rc)
	sclp_max_storage_id = sccb->max_id;
	}
	if (rc \|\| list_empty(&sclp_mem_list))
	goto out;
	for (i = 1; i <= rnmax - assigned; i++)
	insert_increment(0, 1, 0);
	rc = register_memory_notifier(&sclp_mem_nb);
	if (rc)
	goto out;
	sclp_add_standby_memory();
	out:
	free_page((unsigned long) sccb);
	return rc;
	}
	__initcall(sclp_detect_standby_memory);

	#endif /* CONFIG_MEMORY_HOTPLUG */

	/*
	* Channel path configuration related functions.
	*/

	#define SCLP_CMDW_CONFIGURE_CHPATH 0x000f0001
	#define SCLP_CMDW_DECONFIGURE_CHPATH 0x000e0001
	#define SCLP_CMDW_READ_CHPATH_INFORMATION 0x00030001

	struct chp_cfg_sccb {
	struct sccb_header header;
	u8 ccm;
	u8 reserved[6];
	u8 cssid;
	} __attribute__((packed));

	static int do_chp_configure(sclp_cmdw_t cmd)
	{
	struct chp_cfg_sccb *sccb;
	int rc;

	if (!SCLP_HAS_CHP_RECONFIG)
	return -EOPNOTSUPP;
	/* Prepare sccb. */
	sccb = (struct chp_cfg_sccb *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
	if (!sccb)
	return -ENOMEM;
	sccb->header.length = sizeof(*sccb);
	rc = do_sync_request(cmd, sccb);
	if (rc)
	goto out;
	switch (sccb->header.response_code) {
	case 0x0020:
	case 0x0120:
	case 0x0440:
	case 0x0450:
	break;
	default:
	printk(KERN_WARNING TAG "configure channel-path failed "
	"(cmd=0x%08x, response=0x%04x)\n", cmd,
	sccb->header.response_code);
	rc = -EIO;
	break;
	}
	out:
	free_page((unsigned long) sccb);
	return rc;
	}

	/**
	* sclp_chp_configure - perform configure channel-path sclp command
	* @chpid: channel-path ID
	*
	* Perform configure channel-path command sclp command for specified chpid.
	* Return 0 after command successfully finished, non-zero otherwise.
	*/
	int sclp_chp_configure(struct chp_id chpid)
	{
	return do_chp_configure(SCLP_CMDW_CONFIGURE_CHPATH \| chpid.id << 8);
	}

	/**
	* sclp_chp_deconfigure - perform deconfigure channel-path sclp command
	* @chpid: channel-path ID
	*
	* Perform deconfigure channel-path command sclp command for specified chpid
	* and wait for completion. On success return 0. Return non-zero otherwise.
	*/
	int sclp_chp_deconfigure(struct chp_id chpid)
	{
	return do_chp_configure(SCLP_CMDW_DECONFIGURE_CHPATH \| chpid.id << 8);
	}

	struct chp_info_sccb {
	struct sccb_header header;
	u8 recognized[SCLP_CHP_INFO_MASK_SIZE];
	u8 standby[SCLP_CHP_INFO_MASK_SIZE];
	u8 configured[SCLP_CHP_INFO_MASK_SIZE];
	u8 ccm;
	u8 reserved[6];
	u8 cssid;
	} __attribute__((packed));

	/**
	* sclp_chp_read_info - perform read channel-path information sclp command
	* @info: resulting channel-path information data
	*
	* Perform read channel-path information sclp command and wait for completion.
	* On success, store channel-path information in @info and return 0. Return
	* non-zero otherwise.
	*/
	int sclp_chp_read_info(struct sclp_chp_info *info)
	{
	struct chp_info_sccb *sccb;
	int rc;

	if (!SCLP_HAS_CHP_INFO)
	return -EOPNOTSUPP;
	/* Prepare sccb. */
	sccb = (struct chp_info_sccb *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
	if (!sccb)
	return -ENOMEM;
	sccb->header.length = sizeof(*sccb);
	rc = do_sync_request(SCLP_CMDW_READ_CHPATH_INFORMATION, sccb);
	if (rc)
	goto out;
	if (sccb->header.response_code != 0x0010) {
	printk(KERN_WARNING TAG "read channel-path info failed "
	"(response=0x%04x)\n", sccb->header.response_code);
	rc = -EIO;
	goto out;
	}
	memcpy(info->recognized, sccb->recognized, SCLP_CHP_INFO_MASK_SIZE);
	memcpy(info->standby, sccb->standby, SCLP_CHP_INFO_MASK_SIZE);
	memcpy(info->configured, sccb->configured, SCLP_CHP_INFO_MASK_SIZE);
	out:
	free_page((unsigned long) sccb);
	return rc;
	}