[mirror_ubuntu-bionic-kernel.git] / drivers / s390 / char / sclp_cmd.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright IBM Corp. 2007,2012
 *
 * 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/export.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/ctl_reg.h>
#include <asm/chpid.h>
#include <asm/setup.h>
#include <asm/page.h>
#include <asm/sclp.h>
#include <asm/numa.h>

#include "sclp.h"

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

	complete(completion);
}

int sclp_sync_request(sclp_cmdw_t cmd, void *sccb)
{
	return sclp_sync_request_timeout(cmd, sccb, 0);
}

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

	request = kzalloc(sizeof(*request), GFP_KERNEL);
	if (!request)
		return -ENOMEM;
	if (timeout)
		request->queue_timeout = timeout;
	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_warn("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_CONFIGURE_CPU		0x00110001
#define SCLP_CMDW_DECONFIGURE_CPU	0x00100001

int _sclp_get_core_info(struct sclp_core_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 = sclp_sync_request_timeout(SCLP_CMDW_READ_CPU_INFO, sccb,
				       SCLP_QUEUE_INTERVAL);
	if (rc)
		goto out;
	if (sccb->header.response_code != 0x0010) {
		pr_warn("readcpuinfo failed (response=0x%04x)\n",
			sccb->header.response_code);
		rc = -EIO;
		goto out;
	}
	sclp_fill_core_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_core_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 = sclp_sync_request_timeout(cmd, sccb, SCLP_QUEUE_INTERVAL);
	if (rc)
		goto out;
	switch (sccb->header.response_code) {
	case 0x0020:
	case 0x0120:
		break;
	default:
		pr_warn("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_core_configure(u8 core)
{
	return do_core_configure(SCLP_CMDW_CONFIGURE_CPU | core << 8);
}

int sclp_core_deconfigure(u8 core)
{
	return do_core_configure(SCLP_CMDW_DECONFIGURE_CPU | core << 8);
}

#ifdef CONFIG_MEMORY_HOTPLUG

static DEFINE_MUTEX(sclp_mem_mutex);
static LIST_HEAD(sclp_mem_list);
static u8 sclp_max_storage_id;
static DECLARE_BITMAP(sclp_storage_ids, 256);
static int sclp_mem_state_changed;

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

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

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

static unsigned long long rn2addr(u16 rn)
{
	return (unsigned long long) (rn - 1) * sclp.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 = sclp_sync_request_timeout(cmd, sccb, SCLP_QUEUE_INTERVAL);
	if (rc)
		goto out;
	switch (sccb->header.response_code) {
	case 0x0020:
	case 0x0120:
		break;
	default:
		pr_warn("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;
	int rc;

	rc = do_assign_storage(0x000d0001, rn);
	if (rc)
		return rc;
	start = rn2addr(rn);
	storage_key_init_range(start, start + sclp.rzm);
	return 0;
}

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;
	sccb->header.function_code = 0x40;
	rc = sclp_sync_request_timeout(0x00080001 | id << 8, sccb,
				       SCLP_QUEUE_INTERVAL);
	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 + sclp.rzm - 1)
			continue;
		if (online)
			rc |= sclp_assign_storage(incr->rn);
		else
			sclp_unassign_storage(incr->rn);
		if (rc == 0)
			incr->standby = online ? 0 : 1;
	}
	return rc ? -EIO : 0;
}

static bool contains_standby_increment(unsigned long start, unsigned long end)
{
	struct memory_increment *incr;
	unsigned long istart;

	list_for_each_entry(incr, &sclp_mem_list, list) {
		istart = rn2addr(incr->rn);
		if (end - 1 < istart)
			continue;
		if (start > istart + sclp.rzm - 1)
			continue;
		if (incr->standby)
			return true;
	}
	return false;
}

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_GOING_OFFLINE:
		/*
		 * We do not allow to set memory blocks offline that contain
		 * standby memory. This is done to simplify the "memory online"
		 * case.
		 */
		if (contains_standby_increment(start, start + size))
			rc = -EPERM;
		break;
	case MEM_ONLINE:
	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 align_to_block_size(unsigned long long *start,
				       unsigned long long *size,
				       unsigned long long alignment)
{
	unsigned long long start_align, size_align;

	start_align = roundup(*start, alignment);
	size_align = rounddown(*start + *size, alignment) - start_align;

	pr_info("Standby memory at 0x%llx (%lluM of %lluM usable)\n",
		*start, size_align >> 20, *size >> 20);
	*start = start_align;
	*size = size_align;
}

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

	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 * sclp.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;
	block_size = memory_block_size_bytes();
	align_to_block_size(&start, &size, block_size);
	if (!size)
		goto skip_add;
	for (addr = start; addr < start + size; addr += block_size)
		add_memory(numa_pfn_to_nid(PFN_DOWN(addr)), addr, block_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 > sclp.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 (OLDMEM_BASE) /* No standby memory in kdump mode */
		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 = sclp_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 <= sclp.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 = PTR_ERR_OR_ZERO(sclp_pdev);
	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 = sclp_sync_request(cmd, sccb);
	if (rc)
		goto out;
	switch (sccb->header.response_code) {
	case 0x0020:
	case 0x0120:
	case 0x0440:
	case 0x0450:
		break;
	default:
		pr_warn("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 = sclp_sync_request(SCLP_CMDW_READ_CHPATH_INFORMATION, sccb);
	if (rc)
		goto out;
	if (sccb->header.response_code != 0x0010) {
		pr_warn("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
b2441318	1	// SPDX-License-Identifier: GPL-2.0
08d07968	2	/*
7441b062	3	* Copyright IBM Corp. 2007,2012
08d07968	4	*
03997904 GS	5	* Author(s): Heiko Carstens <heiko.carstens@de.ibm.com>,
03997904 GS	6	* Peter Oberparleiter <peter.oberparleiter@de.ibm.com>
08d07968 HC	7	*/
08d07968 HC	8
b3ff088b MS	9	#define KMSG_COMPONENT "sclp_cmd"
	10	#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
	11
08d07968 HC	12	#include <linux/completion.h>
	13	#include <linux/init.h>
	14	#include <linux/errno.h>
03997904	15	#include <linux/err.h>
7441b062	16	#include <linux/export.h>
08d07968 HC	17	#include <linux/slab.h>
08d07968 HC	18	#include <linux/string.h>
e0bc2495 HC	19	#include <linux/mm.h>
	20	#include <linux/mmzone.h>
	21	#include <linux/memory.h>
1526bf9c	22	#include <linux/module.h>
03997904	23	#include <linux/platform_device.h>
6b70a920	24	#include <asm/ctl_reg.h>
4b28a8fe	25	#include <asm/chpid.h>
23d75d9c	26	#include <asm/setup.h>
6b70a920 HC	27	#include <asm/page.h>
6b70a920 HC	28	#include <asm/sclp.h>
c29a7baf	29	#include <asm/numa.h>
08d07968	30
b3ff088b	31	#include "sclp.h"
08d07968	32
08d07968 HC	33	static void sclp_sync_callback(struct sclp_req req, void data)
	34	{
	35	struct completion *completion = data;
	36
	37	complete(completion);
	38	}
	39
d475f942	40	int sclp_sync_request(sclp_cmdw_t cmd, void *sccb)
9f0128f9 GS	41	{
	42	return sclp_sync_request_timeout(cmd, sccb, 0);
	43	}
	44
	45	int sclp_sync_request_timeout(sclp_cmdw_t cmd, void *sccb, int timeout)
08d07968 HC	46	{
	47	struct completion completion;
	48	struct sclp_req *request;
	49	int rc;
	50
	51	request = kzalloc(sizeof(*request), GFP_KERNEL);
	52	if (!request)
	53	return -ENOMEM;
9f0128f9 GS	54	if (timeout)
9f0128f9 GS	55	request->queue_timeout = timeout;
08d07968 HC	56	request->command = cmd;
	57	request->sccb = sccb;
	58	request->status = SCLP_REQ_FILLED;
	59	request->callback = sclp_sync_callback;
	60	request->callback_data = &completion;
	61	init_completion(&completion);
	62
	63	/* Perform sclp request. */
	64	rc = sclp_add_request(request);
	65	if (rc)
	66	goto out;
	67	wait_for_completion(&completion);
	68
	69	/* Check response. */
	70	if (request->status != SCLP_REQ_DONE) {
baebc70a JP	71	pr_warn("sync request failed (cmd=0x%08x, status=0x%02x)\n",
baebc70a JP	72	cmd, request->status);
08d07968 HC	73	rc = -EIO;
	74	}
	75	out:
	76	kfree(request);
	77	return rc;
	78	}
	79
	80	/*
	81	* CPU configuration related functions.
	82	*/
	83
08d07968 HC	84	#define SCLP_CMDW_CONFIGURE_CPU 0x00110001
	85	#define SCLP_CMDW_DECONFIGURE_CPU 0x00100001
	86
af51160e	87	int _sclp_get_core_info(struct sclp_core_info *info)
08d07968 HC	88	{
	89	int rc;
	90	struct read_cpu_info_sccb *sccb;
	91
	92	if (!SCLP_HAS_CPU_INFO)
	93	return -EOPNOTSUPP;
48483b32	94	sccb = (void *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
08d07968 HC	95	if (!sccb)
08d07968 HC	96	return -ENOMEM;
08d07968	97	sccb->header.length = sizeof(*sccb);
9f0128f9 GS	98	rc = sclp_sync_request_timeout(SCLP_CMDW_READ_CPU_INFO, sccb,
9f0128f9 GS	99	SCLP_QUEUE_INTERVAL);
08d07968 HC	100	if (rc)
	101	goto out;
	102	if (sccb->header.response_code != 0x0010) {
baebc70a JP	103	pr_warn("readcpuinfo failed (response=0x%04x)\n",
baebc70a JP	104	sccb->header.response_code);
08d07968 HC	105	rc = -EIO;
	106	goto out;
	107	}
d08d9430	108	sclp_fill_core_info(info, sccb);
08d07968 HC	109	out:
	110	free_page((unsigned long) sccb);
	111	return rc;
	112	}
	113
08d07968 HC	114	struct cpu_configure_sccb {
	115	struct sccb_header header;
	116	} __attribute__((packed, aligned(8)));
	117
d08d9430	118	static int do_core_configure(sclp_cmdw_t cmd)
08d07968 HC	119	{
	120	struct cpu_configure_sccb *sccb;
	121	int rc;
	122
	123	if (!SCLP_HAS_CPU_RECONFIG)
	124	return -EOPNOTSUPP;
	125	/*
	126	* This is not going to cross a page boundary since we force
	127	* kmalloc to have a minimum alignment of 8 bytes on s390.
	128	*/
	129	sccb = kzalloc(sizeof(*sccb), GFP_KERNEL \| GFP_DMA);
	130	if (!sccb)
	131	return -ENOMEM;
	132	sccb->header.length = sizeof(*sccb);
9f0128f9	133	rc = sclp_sync_request_timeout(cmd, sccb, SCLP_QUEUE_INTERVAL);
08d07968 HC	134	if (rc)
	135	goto out;
	136	switch (sccb->header.response_code) {
	137	case 0x0020:
	138	case 0x0120:
	139	break;
	140	default:
baebc70a JP	141	pr_warn("configure cpu failed (cmd=0x%08x, response=0x%04x)\n",
baebc70a JP	142	cmd, sccb->header.response_code);
08d07968 HC	143	rc = -EIO;
	144	break;
	145	}
	146	out:
	147	kfree(sccb);
	148	return rc;
	149	}
	150
d08d9430	151	int sclp_core_configure(u8 core)
08d07968	152	{
d08d9430	153	return do_core_configure(SCLP_CMDW_CONFIGURE_CPU \| core << 8);
08d07968 HC	154	}
08d07968 HC	155
d08d9430	156	int sclp_core_deconfigure(u8 core)
08d07968	157	{
d08d9430	158	return do_core_configure(SCLP_CMDW_DECONFIGURE_CPU \| core << 8);
08d07968	159	}
4b28a8fe	160
e0bc2495 HC	161	#ifdef CONFIG_MEMORY_HOTPLUG
	162
	163	static DEFINE_MUTEX(sclp_mem_mutex);
	164	static LIST_HEAD(sclp_mem_list);
	165	static u8 sclp_max_storage_id;
b8a43b04	166	static DECLARE_BITMAP(sclp_storage_ids, 256);
03997904	167	static int sclp_mem_state_changed;
e0bc2495 HC	168
	169	struct memory_increment {
	170	struct list_head list;
	171	u16 rn;
	172	int standby;
e0bc2495 HC	173	};
	174
	175	struct assign_storage_sccb {
	176	struct sccb_header header;
	177	u16 rn;
	178	} __packed;
	179
9c95258c HC	180	int arch_get_memory_phys_device(unsigned long start_pfn)
9c95258c HC	181	{
37c5f6c8	182	if (!sclp.rzm)
9c95258c	183	return 0;
37c5f6c8	184	return PFN_PHYS(start_pfn) >> ilog2(sclp.rzm);
9c95258c HC	185	}
9c95258c HC	186
e0bc2495 HC	187	static unsigned long long rn2addr(u16 rn)
e0bc2495 HC	188	{
37c5f6c8	189	return (unsigned long long) (rn - 1) * sclp.rzm;
e0bc2495 HC	190	}
	191
	192	static int do_assign_storage(sclp_cmdw_t cmd, u16 rn)
	193	{
	194	struct assign_storage_sccb *sccb;
	195	int rc;
	196
	197	sccb = (void *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
	198	if (!sccb)
	199	return -ENOMEM;
	200	sccb->header.length = PAGE_SIZE;
	201	sccb->rn = rn;
9f0128f9	202	rc = sclp_sync_request_timeout(cmd, sccb, SCLP_QUEUE_INTERVAL);
e0bc2495 HC	203	if (rc)
	204	goto out;
	205	switch (sccb->header.response_code) {
	206	case 0x0020:
	207	case 0x0120:
	208	break;
	209	default:
baebc70a JP	210	pr_warn("assign storage failed (cmd=0x%08x, response=0x%04x, rn=0x%04x)\n",
baebc70a JP	211	cmd, sccb->header.response_code, rn);
e0bc2495 HC	212	rc = -EIO;
	213	break;
	214	}
	215	out:
	216	free_page((unsigned long) sccb);
	217	return rc;
	218	}
	219
	220	static int sclp_assign_storage(u16 rn)
	221	{
6b70a920	222	unsigned long long start;
0cd2f620 HC	223	int rc;
	224
	225	rc = do_assign_storage(0x000d0001, rn);
	226	if (rc)
6b70a920 HC	227	return rc;
6b70a920 HC	228	start = rn2addr(rn);
37c5f6c8	229	storage_key_init_range(start, start + sclp.rzm);
6b70a920	230	return 0;
e0bc2495 HC	231	}
	232
	233	static int sclp_unassign_storage(u16 rn)
	234	{
	235	return do_assign_storage(0x000c0001, rn);
	236	}
	237
	238	struct attach_storage_sccb {
	239	struct sccb_header header;
	240	u16 :16;
	241	u16 assigned;
	242	u32 :32;
	243	u32 entries[0];
	244	} __packed;
	245
	246	static int sclp_attach_storage(u8 id)
	247	{
	248	struct attach_storage_sccb *sccb;
	249	int rc;
	250	int i;
	251
	252	sccb = (void *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
	253	if (!sccb)
	254	return -ENOMEM;
	255	sccb->header.length = PAGE_SIZE;
45be0a02	256	sccb->header.function_code = 0x40;
9f0128f9 GS	257	rc = sclp_sync_request_timeout(0x00080001 \| id << 8, sccb,
9f0128f9 GS	258	SCLP_QUEUE_INTERVAL);
e0bc2495 HC	259	if (rc)
	260	goto out;
	261	switch (sccb->header.response_code) {
	262	case 0x0020:
	263	set_bit(id, sclp_storage_ids);
8adb4ca3 HC	264	for (i = 0; i < sccb->assigned; i++) {
	265	if (sccb->entries[i])
	266	sclp_unassign_storage(sccb->entries[i] >> 16);
	267	}
e0bc2495 HC	268	break;
	269	default:
	270	rc = -EIO;
	271	break;
	272	}
	273	out:
	274	free_page((unsigned long) sccb);
	275	return rc;
	276	}
	277
	278	static int sclp_mem_change_state(unsigned long start, unsigned long size,
	279	int online)
	280	{
	281	struct memory_increment *incr;
	282	unsigned long long istart;
	283	int rc = 0;
	284
	285	list_for_each_entry(incr, &sclp_mem_list, list) {
	286	istart = rn2addr(incr->rn);
	287	if (start + size - 1 < istart)
	288	break;
37c5f6c8	289	if (start > istart + sclp.rzm - 1)
e0bc2495	290	continue;
15535560	291	if (online)
e0bc2495	292	rc \|= sclp_assign_storage(incr->rn);
15535560	293	else
e0bc2495	294	sclp_unassign_storage(incr->rn);
8741ce6d MH	295	if (rc == 0)
8741ce6d MH	296	incr->standby = online ? 0 : 1;
e0bc2495 HC	297	}
	298	return rc ? -EIO : 0;
	299	}
	300
8741ce6d MH	301	static bool contains_standby_increment(unsigned long start, unsigned long end)
	302	{
	303	struct memory_increment *incr;
	304	unsigned long istart;
	305
	306	list_for_each_entry(incr, &sclp_mem_list, list) {
	307	istart = rn2addr(incr->rn);
	308	if (end - 1 < istart)
	309	continue;
37c5f6c8	310	if (start > istart + sclp.rzm - 1)
8741ce6d MH	311	continue;
	312	if (incr->standby)
	313	return true;
	314	}
	315	return false;
	316	}
	317
e0bc2495 HC	318	static int sclp_mem_notifier(struct notifier_block *nb,
	319	unsigned long action, void *data)
	320	{
	321	unsigned long start, size;
	322	struct memory_notify *arg;
	323	unsigned char id;
	324	int rc = 0;
	325
	326	arg = data;
	327	start = arg->start_pfn << PAGE_SHIFT;
	328	size = arg->nr_pages << PAGE_SHIFT;
	329	mutex_lock(&sclp_mem_mutex);
fc89db4b AM	330	for_each_clear_bit(id, sclp_storage_ids, sclp_max_storage_id + 1)
fc89db4b AM	331	sclp_attach_storage(id);
e0bc2495	332	switch (action) {
7e9238fb	333	case MEM_GOING_OFFLINE:
8741ce6d MH	334	/*
	335	* We do not allow to set memory blocks offline that contain
	336	* standby memory. This is done to simplify the "memory online"
	337	* case.
	338	*/
	339	if (contains_standby_increment(start, start + size))
	340	rc = -EPERM;
	341	break;
	342	case MEM_ONLINE:
7e9238fb	343	case MEM_CANCEL_OFFLINE:
e0bc2495 HC	344	break;
	345	case MEM_GOING_ONLINE:
	346	rc = sclp_mem_change_state(start, size, 1);
	347	break;
	348	case MEM_CANCEL_ONLINE:
	349	sclp_mem_change_state(start, size, 0);
	350	break;
7e9238fb GS	351	case MEM_OFFLINE:
	352	sclp_mem_change_state(start, size, 0);
	353	break;
e0bc2495 HC	354	default:
	355	rc = -EINVAL;
	356	break;
	357	}
03997904 GS	358	if (!rc)
03997904 GS	359	sclp_mem_state_changed = 1;
e0bc2495 HC	360	mutex_unlock(&sclp_mem_mutex);
	361	return rc ? NOTIFY_BAD : NOTIFY_OK;
	362	}
	363
	364	static struct notifier_block sclp_mem_nb = {
	365	.notifier_call = sclp_mem_notifier,
	366	};
	367
8741ce6d	368	static void __init align_to_block_size(unsigned long long *start,
c29a7baf MH	369	unsigned long long *size,
c29a7baf MH	370	unsigned long long alignment)
8741ce6d	371	{
c29a7baf	372	unsigned long long start_align, size_align;
8741ce6d	373
8741ce6d MH	374	start_align = roundup(*start, alignment);
	375	size_align = rounddown(start + size, alignment) - start_align;
	376
	377	pr_info("Standby memory at 0x%llx (%lluM of %lluM usable)\n",
	378	start, size_align >> 20, size >> 20);
	379	*start = start_align;
	380	*size = size_align;
	381	}
	382
e0bc2495 HC	383	static void __init add_memory_merged(u16 rn)
e0bc2495 HC	384	{
c29a7baf	385	unsigned long long start, size, addr, block_size;
e0bc2495	386	static u16 first_rn, num;
e0bc2495 HC	387
	388	if (rn && first_rn && (first_rn + num == rn)) {
	389	num++;
	390	return;
	391	}
	392	if (!first_rn)
	393	goto skip_add;
	394	start = rn2addr(first_rn);
37c5f6c8	395	size = (unsigned long long) num * sclp.rzm;
e0bc2495 HC	396	if (start >= VMEM_MAX_PHYS)
	397	goto skip_add;
	398	if (start + size > VMEM_MAX_PHYS)
	399	size = VMEM_MAX_PHYS - start;
23d75d9c HC	400	if (memory_end_set && (start >= memory_end))
	401	goto skip_add;
	402	if (memory_end_set && (start + size > memory_end))
	403	size = memory_end - start;
c29a7baf MH	404	block_size = memory_block_size_bytes();
	405	align_to_block_size(&start, &size, block_size);
	406	if (!size)
	407	goto skip_add;
	408	for (addr = start; addr < start + size; addr += block_size)
	409	add_memory(numa_pfn_to_nid(PFN_DOWN(addr)), addr, block_size);
e0bc2495 HC	410	skip_add:
	411	first_rn = rn;
	412	num = 1;
	413	}
	414
	415	static void __init sclp_add_standby_memory(void)
	416	{
	417	struct memory_increment *incr;
	418
	419	list_for_each_entry(incr, &sclp_mem_list, list)
	420	if (incr->standby)
	421	add_memory_merged(incr->rn);
	422	add_memory_merged(0);
	423	}
	424
	425	static void __init insert_increment(u16 rn, int standby, int assigned)
	426	{
	427	struct memory_increment incr, new_incr;
	428	struct list_head *prev;
	429	u16 last_rn;
	430
	431	new_incr = kzalloc(sizeof(*new_incr), GFP_KERNEL);
	432	if (!new_incr)
	433	return;
	434	new_incr->rn = rn;
	435	new_incr->standby = standby;
	436	last_rn = 0;
	437	prev = &sclp_mem_list;
	438	list_for_each_entry(incr, &sclp_mem_list, list) {
	439	if (assigned && incr->rn > rn)
	440	break;
	441	if (!assigned && incr->rn - last_rn > 1)
	442	break;
	443	last_rn = incr->rn;
	444	prev = &incr->list;
	445	}
	446	if (!assigned)
	447	new_incr->rn = last_rn + 1;
37c5f6c8	448	if (new_incr->rn > sclp.rnmax) {
e0bc2495 HC	449	kfree(new_incr);
	450	return;
	451	}
	452	list_add(&new_incr->list, prev);
	453	}
	454
03997904 GS	455	static int sclp_mem_freeze(struct device *dev)
	456	{
	457	if (!sclp_mem_state_changed)
	458	return 0;
	459	pr_err("Memory hotplug state changed, suspend refused.\n");
	460	return -EPERM;
	461	}
	462
e0bc2495 HC	463	struct read_storage_sccb {
	464	struct sccb_header header;
	465	u16 max_id;
	466	u16 assigned;
	467	u16 standby;
	468	u16 :16;
	469	u32 entries[0];
	470	} __packed;
	471
47145210	472	static const struct dev_pm_ops sclp_mem_pm_ops = {
03997904 GS	473	.freeze = sclp_mem_freeze,
	474	};
	475
	476	static struct platform_driver sclp_mem_pdrv = {
	477	.driver = {
	478	.name = "sclp_mem",
	479	.pm = &sclp_mem_pm_ops,
	480	},
	481	};
	482
e0bc2495 HC	483	static int __init sclp_detect_standby_memory(void)
e0bc2495 HC	484	{
03997904	485	struct platform_device *sclp_pdev;
e0bc2495 HC	486	struct read_storage_sccb *sccb;
	487	int i, id, assigned, rc;
	488
52319b45 MH	489	if (OLDMEM_BASE) /* No standby memory in kdump mode */
52319b45 MH	490	return 0;
78335a30	491	if ((sclp.facilities & 0xe00000000000ULL) != 0xe00000000000ULL)
e0bc2495 HC	492	return 0;
	493	rc = -ENOMEM;
	494	sccb = (void *) __get_free_page(GFP_KERNEL \| GFP_DMA);
	495	if (!sccb)
	496	goto out;
	497	assigned = 0;
	498	for (id = 0; id <= sclp_max_storage_id; id++) {
	499	memset(sccb, 0, PAGE_SIZE);
	500	sccb->header.length = PAGE_SIZE;
d475f942	501	rc = sclp_sync_request(0x00040001 \| id << 8, sccb);
e0bc2495 HC	502	if (rc)
	503	goto out;
	504	switch (sccb->header.response_code) {
	505	case 0x0010:
	506	set_bit(id, sclp_storage_ids);
	507	for (i = 0; i < sccb->assigned; i++) {
	508	if (!sccb->entries[i])
	509	continue;
	510	assigned++;
	511	insert_increment(sccb->entries[i] >> 16, 0, 1);
	512	}
	513	break;
	514	case 0x0310:
	515	break;
	516	case 0x0410:
	517	for (i = 0; i < sccb->assigned; i++) {
	518	if (!sccb->entries[i])
	519	continue;
	520	assigned++;
	521	insert_increment(sccb->entries[i] >> 16, 1, 1);
	522	}
	523	break;
	524	default:
	525	rc = -EIO;
	526	break;
	527	}
	528	if (!rc)
	529	sclp_max_storage_id = sccb->max_id;
	530	}
	531	if (rc \|\| list_empty(&sclp_mem_list))
	532	goto out;
37c5f6c8	533	for (i = 1; i <= sclp.rnmax - assigned; i++)
e0bc2495 HC	534	insert_increment(0, 1, 0);
	535	rc = register_memory_notifier(&sclp_mem_nb);
	536	if (rc)
	537	goto out;
03997904 GS	538	rc = platform_driver_register(&sclp_mem_pdrv);
	539	if (rc)
	540	goto out;
	541	sclp_pdev = platform_device_register_simple("sclp_mem", -1, NULL, 0);
5896f8fe	542	rc = PTR_ERR_OR_ZERO(sclp_pdev);
03997904 GS	543	if (rc)
03997904 GS	544	goto out_driver;
e0bc2495	545	sclp_add_standby_memory();
03997904 GS	546	goto out;
	547	out_driver:
	548	platform_driver_unregister(&sclp_mem_pdrv);
e0bc2495 HC	549	out:
	550	free_page((unsigned long) sccb);
	551	return rc;
	552	}
	553	__initcall(sclp_detect_standby_memory);
	554
	555	#endif /* CONFIG_MEMORY_HOTPLUG */
	556
4b28a8fe HC	557	/*
	558	* Channel path configuration related functions.
	559	*/
	560
	561	#define SCLP_CMDW_CONFIGURE_CHPATH 0x000f0001
	562	#define SCLP_CMDW_DECONFIGURE_CHPATH 0x000e0001
	563	#define SCLP_CMDW_READ_CHPATH_INFORMATION 0x00030001
	564
	565	struct chp_cfg_sccb {
	566	struct sccb_header header;
	567	u8 ccm;
	568	u8 reserved[6];
	569	u8 cssid;
	570	} __attribute__((packed));
	571
	572	static int do_chp_configure(sclp_cmdw_t cmd)
	573	{
	574	struct chp_cfg_sccb *sccb;
	575	int rc;
	576
	577	if (!SCLP_HAS_CHP_RECONFIG)
	578	return -EOPNOTSUPP;
	579	/* Prepare sccb. */
	580	sccb = (struct chp_cfg_sccb *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
	581	if (!sccb)
	582	return -ENOMEM;
	583	sccb->header.length = sizeof(*sccb);
d475f942	584	rc = sclp_sync_request(cmd, sccb);
4b28a8fe HC	585	if (rc)
	586	goto out;
	587	switch (sccb->header.response_code) {
	588	case 0x0020:
	589	case 0x0120:
	590	case 0x0440:
	591	case 0x0450:
	592	break;
	593	default:
baebc70a JP	594	pr_warn("configure channel-path failed (cmd=0x%08x, response=0x%04x)\n",
baebc70a JP	595	cmd, sccb->header.response_code);
4b28a8fe HC	596	rc = -EIO;
	597	break;
	598	}
	599	out:
	600	free_page((unsigned long) sccb);
	601	return rc;
	602	}
	603
	604	/**
	605	* sclp_chp_configure - perform configure channel-path sclp command
	606	* @chpid: channel-path ID
	607	*
	608	* Perform configure channel-path command sclp command for specified chpid.
	609	* Return 0 after command successfully finished, non-zero otherwise.
	610	*/
	611	int sclp_chp_configure(struct chp_id chpid)
	612	{
	613	return do_chp_configure(SCLP_CMDW_CONFIGURE_CHPATH \| chpid.id << 8);
	614	}
	615
	616	/**
	617	* sclp_chp_deconfigure - perform deconfigure channel-path sclp command
	618	* @chpid: channel-path ID
	619	*
	620	* Perform deconfigure channel-path command sclp command for specified chpid
	621	* and wait for completion. On success return 0. Return non-zero otherwise.
	622	*/
	623	int sclp_chp_deconfigure(struct chp_id chpid)
	624	{
	625	return do_chp_configure(SCLP_CMDW_DECONFIGURE_CHPATH \| chpid.id << 8);
	626	}
	627
	628	struct chp_info_sccb {
	629	struct sccb_header header;
	630	u8 recognized[SCLP_CHP_INFO_MASK_SIZE];
	631	u8 standby[SCLP_CHP_INFO_MASK_SIZE];
	632	u8 configured[SCLP_CHP_INFO_MASK_SIZE];
	633	u8 ccm;
	634	u8 reserved[6];
	635	u8 cssid;
	636	} __attribute__((packed));
	637
	638	/**
	639	* sclp_chp_read_info - perform read channel-path information sclp command
	640	* @info: resulting channel-path information data
	641	*
	642	* Perform read channel-path information sclp command and wait for completion.
	643	* On success, store channel-path information in @info and return 0. Return
	644	* non-zero otherwise.
	645	*/
	646	int sclp_chp_read_info(struct sclp_chp_info *info)
	647	{
	648	struct chp_info_sccb *sccb;
	649	int rc;
	650
	651	if (!SCLP_HAS_CHP_INFO)
	652	return -EOPNOTSUPP;
	653	/* Prepare sccb. */
	654	sccb = (struct chp_info_sccb *) get_zeroed_page(GFP_KERNEL \| GFP_DMA);
	655	if (!sccb)
	656	return -ENOMEM;
	657	sccb->header.length = sizeof(*sccb);
d475f942	658	rc = sclp_sync_request(SCLP_CMDW_READ_CHPATH_INFORMATION, sccb);
4b28a8fe HC	659	if (rc)
	660	goto out;
	661	if (sccb->header.response_code != 0x0010) {
baebc70a JP	662	pr_warn("read channel-path info failed (response=0x%04x)\n",
baebc70a JP	663	sccb->header.response_code);
4b28a8fe HC	664	rc = -EIO;
	665	goto out;
	666	}
	667	memcpy(info->recognized, sccb->recognized, SCLP_CHP_INFO_MASK_SIZE);
	668	memcpy(info->standby, sccb->standby, SCLP_CHP_INFO_MASK_SIZE);
	669	memcpy(info->configured, sccb->configured, SCLP_CHP_INFO_MASK_SIZE);
	670	out:
	671	free_page((unsigned long) sccb);
	672	return rc;
	673	}