[deliverable/linux.git] / drivers / s390 / char / sclp_cmd.c

/*
 *  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;
}

static 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)
{
	struct read_info_sccb *sccb;

	sclp_read_info_early();
	if (!early_read_info_sccb_valid)
		return;

	sccb = &early_read_info_sccb;
	sclp_facilities = sccb->facilities;
	sclp_fac84 = sccb->fac84;
	rnmax = sccb->rnmax ? sccb->rnmax : sccb->rnmax2;
	rzm = sccb->rnsize ? sccb->rnsize : sccb->rnsize2;
	rzm <<= 20;
}

unsigned long long sclp_get_rnmax(void)
{
	return rnmax;
}

unsigned long long sclp_get_rzm(void)
{
	return rzm;
}

/*
 * This function will be called after sclp_facilities_detect(), which gets
 * called 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:
	case MEM_GOING_OFFLINE:
	case MEM_CANCEL_OFFLINE:
		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;
	case MEM_OFFLINE:
		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;
}
Commit	Line	Data
08d07968 HC	1	/*
	2	* drivers/s390/char/sclp_cmd.c
	3	*
	4	* Copyright IBM Corp. 2007
4b28a8fe HC	5	* Author(s): Heiko Carstens <heiko.carstens@de.ibm.com>,
4b28a8fe HC	6	* Peter Oberparleiter <peter.oberparleiter@de.ibm.com>
08d07968 HC	7	*/
	8
	9	#include <linux/completion.h>
	10	#include <linux/init.h>
	11	#include <linux/errno.h>
	12	#include <linux/slab.h>
	13	#include <linux/string.h>
e0bc2495 HC	14	#include <linux/mm.h>
	15	#include <linux/mmzone.h>
	16	#include <linux/memory.h>
4b28a8fe	17	#include <asm/chpid.h>
08d07968 HC	18	#include <asm/sclp.h>
	19	#include "sclp.h"
	20
	21	#define TAG "sclp_cmd: "
	22
	23	#define SCLP_CMDW_READ_SCP_INFO 0x00020001
	24	#define SCLP_CMDW_READ_SCP_INFO_FORCED 0x00120001
	25
	26	struct read_info_sccb {
	27	struct sccb_header header; /* 0-7 */
	28	u16 rnmax; /* 8-9 */
	29	u8 rnsize; /* 10 */
	30	u8 _reserved0[24 - 11]; /* 11-15 */
	31	u8 loadparm[8]; /* 24-31 */
	32	u8 _reserved1[48 - 32]; /* 32-47 */
	33	u64 facilities; /* 48-55 */
	34	u8 _reserved2[84 - 56]; /* 56-83 */
	35	u8 fac84; /* 84 */
	36	u8 _reserved3[91 - 85]; /* 85-90 */
	37	u8 flags; /* 91 */
	38	u8 _reserved4[100 - 92]; /* 92-99 */
	39	u32 rnsize2; /* 100-103 */
	40	u64 rnmax2; /* 104-111 */
	41	u8 _reserved5[4096 - 112]; /* 112-4095 */
	42	} __attribute__((packed, aligned(PAGE_SIZE)));
	43
	44	static struct read_info_sccb __initdata early_read_info_sccb;
	45	static int __initdata early_read_info_sccb_valid;
	46
	47	u64 sclp_facilities;
	48	static u8 sclp_fac84;
e0bc2495 HC	49	static unsigned long long rzm;
e0bc2495 HC	50	static unsigned long long rnmax;
08d07968 HC	51
	52	static int __init sclp_cmd_sync_early(sclp_cmdw_t cmd, void *sccb)
	53	{
	54	int rc;
	55
	56	__ctl_set_bit(0, 9);
	57	rc = sclp_service_call(cmd, sccb);
	58	if (rc)
	59	goto out;
	60	__load_psw_mask(PSW_BASE_BITS \| PSW_MASK_EXT \|
	61	PSW_MASK_WAIT \| PSW_DEFAULT_KEY);
	62	local_irq_disable();
	63	out:
	64	/* Contents of the sccb might have changed. */
	65	barrier();
	66	__ctl_clear_bit(0, 9);
	67	return rc;
	68	}
	69
23d17421	70	static void __init sclp_read_info_early(void)
08d07968 HC	71	{
	72	int rc;
	73	int i;
	74	struct read_info_sccb *sccb;
	75	sclp_cmdw_t commands[] = {SCLP_CMDW_READ_SCP_INFO_FORCED,
	76	SCLP_CMDW_READ_SCP_INFO};
	77
	78	sccb = &early_read_info_sccb;
	79	for (i = 0; i < ARRAY_SIZE(commands); i++) {
	80	do {
	81	memset(sccb, 0, sizeof(*sccb));
	82	sccb->header.length = sizeof(*sccb);
	83	sccb->header.control_mask[2] = 0x80;
	84	rc = sclp_cmd_sync_early(commands[i], sccb);
	85	} while (rc == -EBUSY);
	86
	87	if (rc)
	88	break;
	89	if (sccb->header.response_code == 0x10) {
	90	early_read_info_sccb_valid = 1;
	91	break;
	92	}
	93	if (sccb->header.response_code != 0x1f0)
	94	break;
	95	}
	96	}
	97
	98	void __init sclp_facilities_detect(void)
	99	{
08d07968 HC	100	struct read_info_sccb *sccb;
08d07968 HC	101
23d17421	102	sclp_read_info_early();
08d07968	103	if (!early_read_info_sccb_valid)
23d17421 HC	104	return;
23d17421 HC	105
08d07968	106	sccb = &early_read_info_sccb;
23d17421 HC	107	sclp_facilities = sccb->facilities;
23d17421 HC	108	sclp_fac84 = sccb->fac84;
e0bc2495 HC	109	rnmax = sccb->rnmax ? sccb->rnmax : sccb->rnmax2;
	110	rzm = sccb->rnsize ? sccb->rnsize : sccb->rnsize2;
	111	rzm <<= 20;
23d17421 HC	112	}
	113
	114	unsigned long long sclp_get_rnmax(void)
	115	{
	116	return rnmax;
	117	}
	118
	119	unsigned long long sclp_get_rzm(void)
	120	{
	121	return rzm;
08d07968 HC	122	}
	123
	124	/*
23d17421 HC	125	* This function will be called after sclp_facilities_detect(), which gets
23d17421 HC	126	* called from early.c code. Therefore the sccb should have valid contents.
08d07968 HC	127	*/
	128	void __init sclp_get_ipl_info(struct sclp_ipl_info *info)
	129	{
	130	struct read_info_sccb *sccb;
	131
	132	if (!early_read_info_sccb_valid)
	133	return;
	134	sccb = &early_read_info_sccb;
	135	info->is_valid = 1;
	136	if (sccb->flags & 0x2)
	137	info->has_dump = 1;
	138	memcpy(&info->loadparm, &sccb->loadparm, LOADPARM_LEN);
	139	}
	140
	141	static void sclp_sync_callback(struct sclp_req req, void data)
	142	{
	143	struct completion *completion = data;
	144
	145	complete(completion);
	146	}
	147
	148	static int do_sync_request(sclp_cmdw_t cmd, void *sccb)
	149	{
	150	struct completion completion;
	151	struct sclp_req *request;
	152	int rc;
	153
	154	request = kzalloc(sizeof(*request), GFP_KERNEL);
	155	if (!request)
	156	return -ENOMEM;
	157	request->command = cmd;
	158	request->sccb = sccb;
	159	request->status = SCLP_REQ_FILLED;
	160	request->callback = sclp_sync_callback;
	161	request->callback_data = &completion;
	162	init_completion(&completion);
	163
	164	/* Perform sclp request. */
	165	rc = sclp_add_request(request);
	166	if (rc)
	167	goto out;
	168	wait_for_completion(&completion);
	169
	170	/* Check response. */
	171	if (request->status != SCLP_REQ_DONE) {
	172	printk(KERN_WARNING TAG "sync request failed "
	173	"(cmd=0x%08x, status=0x%02x)\n", cmd, request->status);
	174	rc = -EIO;
	175	}
	176	out:
	177	kfree(request);
	178	return rc;
	179	}
	180
	181	/*
	182	* CPU configuration related functions.
	183	*/
	184
	185	#define SCLP_CMDW_READ_CPU_INFO 0x00010001
	186	#define SCLP_CMDW_CONFIGURE_CPU 0x00110001
	187	#define SCLP_CMDW_DECONFIGURE_CPU 0x00100001
	188
	189	struct read_cpu_info_sccb {
	190	struct sccb_header header;
191	u16 nr_configured;
192	u16 offset_configured;
193	u16 nr_standby;
194	u16 offset_standby;
195	u8 reserved[4096 - 16];
196	} __attribute__((packed, aligned(PAGE_SIZE)));
197
08d07968 HC	198	static void sclp_fill_cpu_info(struct sclp_cpu_info *info,
	199	struct read_cpu_info_sccb *sccb)
	200	{
	201	char page = (char ) sccb;
	202
	203	memset(info, 0, sizeof(*info));
	204	info->configured = sccb->nr_configured;
	205	info->standby = sccb->nr_standby;
	206	info->combined = sccb->nr_configured + sccb->nr_standby;
	207	info->has_cpu_type = sclp_fac84 & 0x1;
	208	memcpy(&info->cpu, page + sccb->offset_configured,
	209	info->combined * sizeof(struct sclp_cpu_entry));
	210	}
	211
48483b32	212	int sclp_get_cpu_info(struct sclp_cpu_info *info)
08d07968 HC	213	{
	214	int rc;
	215	struct read_cpu_info_sccb *sccb;
	216
	217	if (!SCLP_HAS_CPU_INFO)
	218	return -EOPNOTSUPP;
48483b32	219	sccb = (void *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
08d07968 HC	220	if (!sccb)
08d07968 HC	221	return -ENOMEM;
08d07968 HC	222	sccb->header.length = sizeof(*sccb);
	223	rc = do_sync_request(SCLP_CMDW_READ_CPU_INFO, sccb);
	224	if (rc)
	225	goto out;
	226	if (sccb->header.response_code != 0x0010) {
	227	printk(KERN_WARNING TAG "readcpuinfo failed "
	228	"(response=0x%04x)\n", sccb->header.response_code);
	229	rc = -EIO;
	230	goto out;
	231	}
	232	sclp_fill_cpu_info(info, sccb);
	233	out:
	234	free_page((unsigned long) sccb);
	235	return rc;
	236	}
	237
08d07968 HC	238	struct cpu_configure_sccb {
	239	struct sccb_header header;
	240	} __attribute__((packed, aligned(8)));
	241
	242	static int do_cpu_configure(sclp_cmdw_t cmd)
	243	{
	244	struct cpu_configure_sccb *sccb;
	245	int rc;
	246
	247	if (!SCLP_HAS_CPU_RECONFIG)
	248	return -EOPNOTSUPP;
	249	/*
	250	* This is not going to cross a page boundary since we force
	251	* kmalloc to have a minimum alignment of 8 bytes on s390.
	252	*/
	253	sccb = kzalloc(sizeof(*sccb), GFP_KERNEL \| GFP_DMA);
	254	if (!sccb)
	255	return -ENOMEM;
	256	sccb->header.length = sizeof(*sccb);
	257	rc = do_sync_request(cmd, sccb);
	258	if (rc)
	259	goto out;
	260	switch (sccb->header.response_code) {
	261	case 0x0020:
	262	case 0x0120:
	263	break;
	264	default:
	265	printk(KERN_WARNING TAG "configure cpu failed (cmd=0x%08x, "
	266	"response=0x%04x)\n", cmd, sccb->header.response_code);
	267	rc = -EIO;
	268	break;
	269	}
	270	out:
	271	kfree(sccb);
	272	return rc;
	273	}
	274
	275	int sclp_cpu_configure(u8 cpu)
	276	{
	277	return do_cpu_configure(SCLP_CMDW_CONFIGURE_CPU \| cpu << 8);
	278	}
	279
	280	int sclp_cpu_deconfigure(u8 cpu)
	281	{
	282	return do_cpu_configure(SCLP_CMDW_DECONFIGURE_CPU \| cpu << 8);
	283	}
4b28a8fe	284
e0bc2495 HC	285	#ifdef CONFIG_MEMORY_HOTPLUG
	286
	287	static DEFINE_MUTEX(sclp_mem_mutex);
	288	static LIST_HEAD(sclp_mem_list);
	289	static u8 sclp_max_storage_id;
	290	static unsigned long sclp_storage_ids[256 / BITS_PER_LONG];
	291
	292	struct memory_increment {
	293	struct list_head list;
	294	u16 rn;
	295	int standby;
	296	int usecount;
	297	};
	298
	299	struct assign_storage_sccb {
	300	struct sccb_header header;
	301	u16 rn;
	302	} __packed;
	303
	304	static unsigned long long rn2addr(u16 rn)
	305	{
	306	return (unsigned long long) (rn - 1) * rzm;
	307	}
	308
	309	static int do_assign_storage(sclp_cmdw_t cmd, u16 rn)
	310	{
	311	struct assign_storage_sccb *sccb;
	312	int rc;
	313
	314	sccb = (void *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
	315	if (!sccb)
	316	return -ENOMEM;
	317	sccb->header.length = PAGE_SIZE;
	318	sccb->rn = rn;
	319	rc = do_sync_request(cmd, sccb);
	320	if (rc)
	321	goto out;
	322	switch (sccb->header.response_code) {
	323	case 0x0020:
	324	case 0x0120:
	325	break;
	326	default:
	327	rc = -EIO;
	328	break;
	329	}
	330	out:
	331	free_page((unsigned long) sccb);
	332	return rc;
	333	}
	334
	335	static int sclp_assign_storage(u16 rn)
	336	{
	337	return do_assign_storage(0x000d0001, rn);
	338	}
	339
	340	static int sclp_unassign_storage(u16 rn)
	341	{
	342	return do_assign_storage(0x000c0001, rn);
	343	}
	344
	345	struct attach_storage_sccb {
	346	struct sccb_header header;
	347	u16 :16;
	348	u16 assigned;
349	u32 :32;
350	u32 entries[0];
351	} __packed;
352
353	static int sclp_attach_storage(u8 id)
354	{
355	struct attach_storage_sccb *sccb;
356	int rc;
357	int i;
358
359	sccb = (void *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
360	if (!sccb)
361	return -ENOMEM;
362	sccb->header.length = PAGE_SIZE;
363	rc = do_sync_request(0x00080001 \| id << 8, sccb);
364	if (rc)
365	goto out;
366	switch (sccb->header.response_code) {
367	case 0x0020:
368	set_bit(id, sclp_storage_ids);
369	for (i = 0; i < sccb->assigned; i++)
370	sclp_unassign_storage(sccb->entries[i] >> 16);
371	break;
372	default:
373	rc = -EIO;
374	break;
375	}
376	out:
377	free_page((unsigned long) sccb);
378	return rc;
379	}
380
381	static int sclp_mem_change_state(unsigned long start, unsigned long size,
382	int online)
383	{
384	struct memory_increment *incr;
385	unsigned long long istart;
386	int rc = 0;
387
388	list_for_each_entry(incr, &sclp_mem_list, list) {
389	istart = rn2addr(incr->rn);
390	if (start + size - 1 < istart)
391	break;
392	if (start > istart + rzm - 1)
393	continue;
394	if (online) {
395	if (incr->usecount++)
396	continue;
397	/*
398	* Don't break the loop if one assign fails. Loop may
399	* be walked again on CANCEL and we can't save
400	* information if state changed before or not.
401	* So continue and increase usecount for all increments.
402	*/
403	rc \|= sclp_assign_storage(incr->rn);
404	} else {
405	if (--incr->usecount)
406	continue;
407	sclp_unassign_storage(incr->rn);
408	}
409	}
410	return rc ? -EIO : 0;
411	}
412
413	static int sclp_mem_notifier(struct notifier_block *nb,
414	unsigned long action, void *data)
415	{
416	unsigned long start, size;
417	struct memory_notify *arg;
418	unsigned char id;
419	int rc = 0;
420
421	arg = data;
422	start = arg->start_pfn << PAGE_SHIFT;
423	size = arg->nr_pages << PAGE_SHIFT;
424	mutex_lock(&sclp_mem_mutex);
425	for (id = 0; id <= sclp_max_storage_id; id++)
426	if (!test_bit(id, sclp_storage_ids))
427	sclp_attach_storage(id);
428	switch (action) {
429	case MEM_ONLINE:
7e9238fb GS	430	case MEM_GOING_OFFLINE:
7e9238fb GS	431	case MEM_CANCEL_OFFLINE:
e0bc2495 HC	432	break;
	433	case MEM_GOING_ONLINE:
	434	rc = sclp_mem_change_state(start, size, 1);
	435	break;
	436	case MEM_CANCEL_ONLINE:
	437	sclp_mem_change_state(start, size, 0);
	438	break;
7e9238fb GS	439	case MEM_OFFLINE:
	440	sclp_mem_change_state(start, size, 0);
	441	break;
e0bc2495 HC	442	default:
	443	rc = -EINVAL;
	444	break;
	445	}
	446	mutex_unlock(&sclp_mem_mutex);
	447	return rc ? NOTIFY_BAD : NOTIFY_OK;
	448	}
	449
	450	static struct notifier_block sclp_mem_nb = {
	451	.notifier_call = sclp_mem_notifier,
	452	};
	453
	454	static void __init add_memory_merged(u16 rn)
	455	{
	456	static u16 first_rn, num;
	457	unsigned long long start, size;
	458
	459	if (rn && first_rn && (first_rn + num == rn)) {
	460	num++;
	461	return;
	462	}
	463	if (!first_rn)
	464	goto skip_add;
	465	start = rn2addr(first_rn);
	466	size = (unsigned long long ) num * rzm;
	467	if (start >= VMEM_MAX_PHYS)
	468	goto skip_add;
	469	if (start + size > VMEM_MAX_PHYS)
	470	size = VMEM_MAX_PHYS - start;
	471	add_memory(0, start, size);
	472	skip_add:
	473	first_rn = rn;
	474	num = 1;
	475	}
	476
	477	static void __init sclp_add_standby_memory(void)
	478	{
	479	struct memory_increment *incr;
	480
	481	list_for_each_entry(incr, &sclp_mem_list, list)
	482	if (incr->standby)
	483	add_memory_merged(incr->rn);
	484	add_memory_merged(0);
	485	}
	486
	487	static void __init insert_increment(u16 rn, int standby, int assigned)
	488	{
	489	struct memory_increment incr, new_incr;
	490	struct list_head *prev;
	491	u16 last_rn;
	492
	493	new_incr = kzalloc(sizeof(*new_incr), GFP_KERNEL);
	494	if (!new_incr)
	495	return;
	496	new_incr->rn = rn;
	497	new_incr->standby = standby;
	498	last_rn = 0;
	499	prev = &sclp_mem_list;
	500	list_for_each_entry(incr, &sclp_mem_list, list) {
	501	if (assigned && incr->rn > rn)
	502	break;
	503	if (!assigned && incr->rn - last_rn > 1)
	504	break;
	505	last_rn = incr->rn;
506	prev = &incr->list;
507	}
508	if (!assigned)
509	new_incr->rn = last_rn + 1;
510	if (new_incr->rn > rnmax) {
511	kfree(new_incr);
512	return;
513	}
514	list_add(&new_incr->list, prev);
515	}
516
517	struct read_storage_sccb {
518	struct sccb_header header;
519	u16 max_id;
520	u16 assigned;
521	u16 standby;
522	u16 :16;
523	u32 entries[0];
524	} __packed;
525
526	static int __init sclp_detect_standby_memory(void)
527	{
528	struct read_storage_sccb *sccb;
529	int i, id, assigned, rc;
530
531	if (!early_read_info_sccb_valid)
532	return 0;
533	if ((sclp_facilities & 0xe00000000000ULL) != 0xe00000000000ULL)
534	return 0;
535	rc = -ENOMEM;
536	sccb = (void *) __get_free_page(GFP_KERNEL \| GFP_DMA);
537	if (!sccb)
538	goto out;
539	assigned = 0;
540	for (id = 0; id <= sclp_max_storage_id; id++) {
541	memset(sccb, 0, PAGE_SIZE);
542	sccb->header.length = PAGE_SIZE;
543	rc = do_sync_request(0x00040001 \| id << 8, sccb);
544	if (rc)
545	goto out;
546	switch (sccb->header.response_code) {
547	case 0x0010:
548	set_bit(id, sclp_storage_ids);
549	for (i = 0; i < sccb->assigned; i++) {
550	if (!sccb->entries[i])
551	continue;
552	assigned++;
553	insert_increment(sccb->entries[i] >> 16, 0, 1);
554	}
555	break;
556	case 0x0310:
557	break;
558	case 0x0410:
559	for (i = 0; i < sccb->assigned; i++) {
560	if (!sccb->entries[i])
561	continue;
562	assigned++;
563	insert_increment(sccb->entries[i] >> 16, 1, 1);
564	}
565	break;
566	default:
567	rc = -EIO;
568	break;
569	}
570	if (!rc)
571	sclp_max_storage_id = sccb->max_id;
572	}
573	if (rc \|\| list_empty(&sclp_mem_list))
574	goto out;
575	for (i = 1; i <= rnmax - assigned; i++)
576	insert_increment(0, 1, 0);
577	rc = register_memory_notifier(&sclp_mem_nb);
578	if (rc)
579	goto out;
580	sclp_add_standby_memory();
581	out:
582	free_page((unsigned long) sccb);
583	return rc;
584	}
585	__initcall(sclp_detect_standby_memory);
586
587	#endif /* CONFIG_MEMORY_HOTPLUG */
588
4b28a8fe HC	589	/*
	590	* Channel path configuration related functions.
	591	*/
	592
	593	#define SCLP_CMDW_CONFIGURE_CHPATH 0x000f0001
	594	#define SCLP_CMDW_DECONFIGURE_CHPATH 0x000e0001
	595	#define SCLP_CMDW_READ_CHPATH_INFORMATION 0x00030001
	596
	597	struct chp_cfg_sccb {
	598	struct sccb_header header;
	599	u8 ccm;
	600	u8 reserved[6];
	601	u8 cssid;
	602	} __attribute__((packed));
	603
	604	static int do_chp_configure(sclp_cmdw_t cmd)
	605	{
	606	struct chp_cfg_sccb *sccb;
	607	int rc;
	608
	609	if (!SCLP_HAS_CHP_RECONFIG)
	610	return -EOPNOTSUPP;
	611	/* Prepare sccb. */
	612	sccb = (struct chp_cfg_sccb *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
	613	if (!sccb)
	614	return -ENOMEM;
	615	sccb->header.length = sizeof(*sccb);
	616	rc = do_sync_request(cmd, sccb);
	617	if (rc)
	618	goto out;
	619	switch (sccb->header.response_code) {
	620	case 0x0020:
	621	case 0x0120:
	622	case 0x0440:
	623	case 0x0450:
	624	break;
	625	default:
	626	printk(KERN_WARNING TAG "configure channel-path failed "
	627	"(cmd=0x%08x, response=0x%04x)\n", cmd,
	628	sccb->header.response_code);
	629	rc = -EIO;
	630	break;
	631	}
	632	out:
	633	free_page((unsigned long) sccb);
	634	return rc;
	635	}
	636
	637	/**
	638	* sclp_chp_configure - perform configure channel-path sclp command
	639	* @chpid: channel-path ID
	640	*
	641	* Perform configure channel-path command sclp command for specified chpid.
	642	* Return 0 after command successfully finished, non-zero otherwise.
	643	*/
	644	int sclp_chp_configure(struct chp_id chpid)
	645	{
	646	return do_chp_configure(SCLP_CMDW_CONFIGURE_CHPATH \| chpid.id << 8);
	647	}
	648
	649	/**
	650	* sclp_chp_deconfigure - perform deconfigure channel-path sclp command
	651	* @chpid: channel-path ID
	652	*
653	* Perform deconfigure channel-path command sclp command for specified chpid
654	* and wait for completion. On success return 0. Return non-zero otherwise.
655	*/
656	int sclp_chp_deconfigure(struct chp_id chpid)
657	{
658	return do_chp_configure(SCLP_CMDW_DECONFIGURE_CHPATH \| chpid.id << 8);
659	}
660
661	struct chp_info_sccb {
662	struct sccb_header header;
663	u8 recognized[SCLP_CHP_INFO_MASK_SIZE];
664	u8 standby[SCLP_CHP_INFO_MASK_SIZE];
665	u8 configured[SCLP_CHP_INFO_MASK_SIZE];
666	u8 ccm;
667	u8 reserved[6];
668	u8 cssid;
669	} __attribute__((packed));
670
671	/**
672	* sclp_chp_read_info - perform read channel-path information sclp command
673	* @info: resulting channel-path information data
674	*
675	* Perform read channel-path information sclp command and wait for completion.
676	* On success, store channel-path information in @info and return 0. Return
677	* non-zero otherwise.
678	*/
679	int sclp_chp_read_info(struct sclp_chp_info *info)
680	{
681	struct chp_info_sccb *sccb;
682	int rc;
683
684	if (!SCLP_HAS_CHP_INFO)
685	return -EOPNOTSUPP;
686	/* Prepare sccb. */
687	sccb = (struct chp_info_sccb *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
688	if (!sccb)
689	return -ENOMEM;
690	sccb->header.length = sizeof(*sccb);
691	rc = do_sync_request(SCLP_CMDW_READ_CHPATH_INFORMATION, sccb);
692	if (rc)
693	goto out;
694	if (sccb->header.response_code != 0x0010) {
695	printk(KERN_WARNING TAG "read channel-path info failed "
696	"(response=0x%04x)\n", sccb->header.response_code);
697	rc = -EIO;
698	goto out;
699	}
700	memcpy(info->recognized, sccb->recognized, SCLP_CHP_INFO_MASK_SIZE);
701	memcpy(info->standby, sccb->standby, SCLP_CHP_INFO_MASK_SIZE);
702	memcpy(info->configured, sccb->configured, SCLP_CHP_INFO_MASK_SIZE);
703	out:
704	free_page((unsigned long) sccb);
705	return rc;
706	}