[mirror_ubuntu-hirsute-kernel.git] / drivers / pci / hotplug / rpaphp_slot.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * RPA Virtual I/O device functions
 * Copyright (C) 2004 Linda Xie <lxie@us.ibm.com>
 *
 * All rights reserved.
 *
 * Send feedback to <lxie@us.ibm.com>
 *
 */
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/sysfs.h>
#include <linux/pci.h>
#include <linux/string.h>
#include <linux/slab.h>

#include <asm/rtas.h>
#include "rpaphp.h"

/* free up the memory used by a slot */
void dealloc_slot_struct(struct slot *slot)
{
	of_node_put(slot->dn);
	kfree(slot->name);
	kfree(slot);
}

struct slot *alloc_slot_struct(struct device_node *dn,
		int drc_index, char *drc_name, int power_domain)
{
	struct slot *slot;

	slot = kzalloc(sizeof(struct slot), GFP_KERNEL);
	if (!slot)
		goto error_nomem;
	slot->name = kstrdup(drc_name, GFP_KERNEL);
	if (!slot->name)
		goto error_slot;
	slot->dn = of_node_get(dn);
	slot->index = drc_index;
	slot->power_domain = power_domain;
	slot->hotplug_slot.ops = &rpaphp_hotplug_slot_ops;

	return (slot);

error_slot:
	kfree(slot);
error_nomem:
	return NULL;
}

static int is_registered(struct slot *slot)
{
	struct slot *tmp_slot;

	list_for_each_entry(tmp_slot, &rpaphp_slot_head, rpaphp_slot_list) {
		if (!strcmp(tmp_slot->name, slot->name))
			return 1;
	}
	return 0;
}

int rpaphp_deregister_slot(struct slot *slot)
{
	int retval = 0;
	struct hotplug_slot *php_slot = &slot->hotplug_slot;

	 dbg("%s - Entry: deregistering slot=%s\n",
		__func__, slot->name);

	list_del(&slot->rpaphp_slot_list);
	pci_hp_deregister(php_slot);
	dealloc_slot_struct(slot);

	dbg("%s - Exit: rc[%d]\n", __func__, retval);
	return retval;
}
EXPORT_SYMBOL_GPL(rpaphp_deregister_slot);

int rpaphp_register_slot(struct slot *slot)
{
	struct hotplug_slot *php_slot = &slot->hotplug_slot;
	struct device_node *child;
	u32 my_index;
	int retval;
	int slotno = -1;

	dbg("%s registering slot:path[%pOF] index[%x], name[%s] pdomain[%x] type[%d]\n",
		__func__, slot->dn, slot->index, slot->name,
		slot->power_domain, slot->type);

	/* should not try to register the same slot twice */
	if (is_registered(slot)) {
		err("rpaphp_register_slot: slot[%s] is already registered\n", slot->name);
		return -EAGAIN;
	}

	for_each_child_of_node(slot->dn, child) {
		retval = of_property_read_u32(child, "ibm,my-drc-index", &my_index);
		if (my_index == slot->index) {
			slotno = PCI_SLOT(PCI_DN(child)->devfn);
			of_node_put(child);
			break;
		}
	}

	retval = pci_hp_register(php_slot, slot->bus, slotno, slot->name);
	if (retval) {
		err("pci_hp_register failed with error %d\n", retval);
		return retval;
	}

	/* add slot to our internal list */
	list_add(&slot->rpaphp_slot_list, &rpaphp_slot_head);
	info("Slot [%s] registered\n", slot->name);
	return 0;
}
Commit	Line	Data
736759ef	1	// SPDX-License-Identifier: GPL-2.0+
1da177e4	2	/*
f7625980	3	* RPA Virtual I/O device functions
1da177e4 LT	4	* Copyright (C) 2004 Linda Xie <lxie@us.ibm.com>
	5	*
	6	* All rights reserved.
	7	*
1da177e4 LT	8	* Send feedback to <lxie@us.ibm.com>
	9	*
	10	*/
	11	#include <linux/kernel.h>
	12	#include <linux/module.h>
1da177e4 LT	13	#include <linux/sysfs.h>
1da177e4 LT	14	#include <linux/pci.h>
4e57b681 TS	15	#include <linux/string.h>
	16	#include <linux/slab.h>
	17
1da177e4 LT	18	#include <asm/rtas.h>
	19	#include "rpaphp.h"
	20
1da177e4	21	/* free up the memory used by a slot */
1da177e4 LT	22	void dealloc_slot_struct(struct slot *slot)
1da177e4 LT	23	{
91800660	24	of_node_put(slot->dn);
b2132fec	25	kfree(slot->name);
1da177e4	26	kfree(slot);
1da177e4 LT	27	}
1da177e4 LT	28
5fd39c35	29	struct slot alloc_slot_struct(struct device_node dn,
ff3ce480	30	int drc_index, char *drc_name, int power_domain)
1da177e4 LT	31	{
1da177e4 LT	32	struct slot *slot;
f7625980	33
f5afe806	34	slot = kzalloc(sizeof(struct slot), GFP_KERNEL);
1da177e4 LT	35	if (!slot)
1da177e4 LT	36	goto error_nomem;
b2132fec AC	37	slot->name = kstrdup(drc_name, GFP_KERNEL);
b2132fec AC	38	if (!slot->name)
125450f8	39	goto error_slot;
91800660	40	slot->dn = of_node_get(dn);
1da177e4	41	slot->index = drc_index;
1da177e4	42	slot->power_domain = power_domain;
125450f8	43	slot->hotplug_slot.ops = &rpaphp_hotplug_slot_ops;
f7625980	44
1da177e4 LT	45	return (slot);
1da177e4 LT	46
1da177e4 LT	47	error_slot:
	48	kfree(slot);
	49	error_nomem:
	50	return NULL;
	51	}
	52
	53	static int is_registered(struct slot *slot)
	54	{
5fd39c35	55	struct slot *tmp_slot;
1da177e4 LT	56
	57	list_for_each_entry(tmp_slot, &rpaphp_slot_head, rpaphp_slot_list) {
	58	if (!strcmp(tmp_slot->name, slot->name))
	59	return 1;
f7625980	60	}
1da177e4 LT	61	return 0;
	62	}
	63
f6afbad8	64	int rpaphp_deregister_slot(struct slot *slot)
1da177e4 LT	65	{
1da177e4 LT	66	int retval = 0;
125450f8	67	struct hotplug_slot *php_slot = &slot->hotplug_slot;
1da177e4 LT	68
1da177e4 LT	69	dbg("%s - Entry: deregistering slot=%s\n",
66bef8c0	70	__func__, slot->name);
1da177e4 LT	71
1da177e4 LT	72	list_del(&slot->rpaphp_slot_list);
51bbf9be LW	73	pci_hp_deregister(php_slot);
51bbf9be LW	74	dealloc_slot_struct(slot);
1da177e4	75
66bef8c0	76	dbg("%s - Exit: rc[%d]\n", __func__, retval);
1da177e4 LT	77	return retval;
1da177e4 LT	78	}
61ee9cd5	79	EXPORT_SYMBOL_GPL(rpaphp_deregister_slot);
1da177e4	80
f6afbad8	81	int rpaphp_register_slot(struct slot *slot)
1da177e4	82	{
125450f8	83	struct hotplug_slot *php_slot = &slot->hotplug_slot;
e2413a7d TD	84	struct device_node *child;
e2413a7d TD	85	u32 my_index;
1da177e4	86	int retval;
e2413a7d	87	int slotno = -1;
1da177e4	88
b63773a8 RH	89	dbg("%s registering slot:path[%pOF] index[%x], name[%s] pdomain[%x] type[%d]\n",
b63773a8 RH	90	__func__, slot->dn, slot->index, slot->name,
1da177e4	91	slot->power_domain, slot->type);
f1e79092	92
1da177e4	93	/* should not try to register the same slot twice */
f1e79092	94	if (is_registered(slot)) {
f6afbad8	95	err("rpaphp_register_slot: slot[%s] is already registered\n", slot->name);
3499f072	96	return -EAGAIN;
f7625980	97	}
f1e79092	98
e2413a7d TD	99	for_each_child_of_node(slot->dn, child) {
	100	retval = of_property_read_u32(child, "ibm,my-drc-index", &my_index);
	101	if (my_index == slot->index) {
	102	slotno = PCI_SLOT(PCI_DN(child)->devfn);
	103	of_node_put(child);
	104	break;
	105	}
	106	}
	107
1359f270	108	retval = pci_hp_register(php_slot, slot->bus, slotno, slot->name);
1da177e4 LT	109	if (retval) {
1da177e4 LT	110	err("pci_hp_register failed with error %d\n", retval);
3499f072	111	return retval;
1da177e4	112	}
1da177e4	113
f1e79092	114	/* add slot to our internal list */
1da177e4	115	list_add(&slot->rpaphp_slot_list, &rpaphp_slot_head);
1b7c9fca	116	info("Slot [%s] registered\n", slot->name);
1da177e4 LT	117	return 0;
1da177e4 LT	118	}