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

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

#define KMSG_COMPONENT "sclp_cmd"
#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt

#include <linux/completion.h>
#include <linux/init.h>
#include <linux/errno.h>
#include <linux/err.h>
#include <linux/slab.h>
#include <linux/string.h>
#include <linux/mm.h>
#include <linux/mmzone.h>
#include <linux/memory.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <asm/chpid.h>
#include <asm/sclp.h>
#include <asm/setup.h>
#include <asm/ctl_reg.h>

#include "sclp.h"

#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	fac85;			/* 85 */
	u8	_reserved3[91 - 86];	/* 86-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 u8 sclp_fac85;
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_DEFAULT_KEY | PSW_MASK_BASE | PSW_MASK_EA |
			PSW_MASK_BA | PSW_MASK_EXT | PSW_MASK_WAIT);
	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.function_code = 0x80;
			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;
	sclp_fac85 = sccb->fac85;
	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;
}

u8 sclp_get_fac85(void)
{
	return sclp_fac85;
}
EXPORT_SYMBOL_GPL(sclp_get_fac85);

/*
 * 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) {
		pr_warning("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) {
		pr_warning("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:
		pr_warning("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];
static int sclp_mem_state_changed;

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

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

int arch_get_memory_phys_device(unsigned long start_pfn)
{
	if (!rzm)
		return 0;
	return PFN_PHYS(start_pfn) >> ilog2(rzm);
}

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:
		pr_warning("assign storage failed (cmd=0x%08x, "
			   "response=0x%04x, rn=0x%04x)\n", cmd,
			   sccb->header.response_code, rn);
		rc = -EIO;
		break;
	}
out:
	free_page((unsigned long) sccb);
	return rc;
}

static int sclp_assign_storage(u16 rn)
{
	unsigned long long start, address;
	int rc;

	rc = do_assign_storage(0x000d0001, rn);
	if (rc)
		goto out;
	start = address = rn2addr(rn);
	for (; address < start + rzm; address += PAGE_SIZE)
		page_set_storage_key(address, PAGE_DEFAULT_KEY, 0);
out:
	return rc;
}

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++) {
			if (sccb->entries[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_each_clear_bit(id, sclp_storage_ids, sclp_max_storage_id + 1)
		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;
	}
	if (!rc)
		sclp_mem_state_changed = 1;
	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;
	if (memory_end_set && (start >= memory_end))
		goto skip_add;
	if (memory_end_set && (start + size > memory_end))
		size = memory_end - 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;
	if (!standby)
		new_incr->usecount = 1;
	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);
}

static int sclp_mem_freeze(struct device *dev)
{
	if (!sclp_mem_state_changed)
		return 0;
	pr_err("Memory hotplug state changed, suspend refused.\n");
	return -EPERM;
}

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

static const struct dev_pm_ops sclp_mem_pm_ops = {
	.freeze		= sclp_mem_freeze,
};

static struct platform_driver sclp_mem_pdrv = {
	.driver = {
		.name	= "sclp_mem",
		.pm	= &sclp_mem_pm_ops,
	},
};

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