[mirror_ubuntu-artful-kernel.git] / drivers / rapidio / rio-sysfs.c

/*
 * RapidIO sysfs attributes and support
 *
 * Copyright 2005 MontaVista Software, Inc.
 * Matt Porter <mporter@kernel.crashing.org>
 *
 * This program is free software; you can redistribute  it and/or modify it
 * under  the terms of  the GNU General  Public License as published by the
 * Free Software Foundation;  either version 2 of the  License, or (at your
 * option) any later version.
 */

#include <linux/kernel.h>
#include <linux/rio.h>
#include <linux/rio_drv.h>
#include <linux/stat.h>
#include <linux/capability.h>

#include "rio.h"

/* Sysfs support */
#define rio_config_attr(field, format_string)					\
static ssize_t								\
field##_show(struct device *dev, struct device_attribute *attr, char *buf)			\
{									\
	struct rio_dev *rdev = to_rio_dev(dev);				\
									\
	return sprintf(buf, format_string, rdev->field);		\
}									\
static DEVICE_ATTR_RO(field);

rio_config_attr(did, "0x%04x\n");
rio_config_attr(vid, "0x%04x\n");
rio_config_attr(device_rev, "0x%08x\n");
rio_config_attr(asm_did, "0x%04x\n");
rio_config_attr(asm_vid, "0x%04x\n");
rio_config_attr(asm_rev, "0x%04x\n");
rio_config_attr(destid, "0x%04x\n");
rio_config_attr(hopcount, "0x%02x\n");

static ssize_t routes_show(struct device *dev, struct device_attribute *attr, char *buf)
{
	struct rio_dev *rdev = to_rio_dev(dev);
	char *str = buf;
	int i;

	for (i = 0; i < RIO_MAX_ROUTE_ENTRIES(rdev->net->hport->sys_size);
			i++) {
		if (rdev->rswitch->route_table[i] == RIO_INVALID_ROUTE)
			continue;
		str +=
		    sprintf(str, "%04x %02x\n", i,
			    rdev->rswitch->route_table[i]);
	}

	return (str - buf);
}
static DEVICE_ATTR_RO(routes);

static ssize_t lprev_show(struct device *dev,
			  struct device_attribute *attr, char *buf)
{
	struct rio_dev *rdev = to_rio_dev(dev);

	return sprintf(buf, "%s\n",
			(rdev->prev) ? rio_name(rdev->prev) : "root");
}
static DEVICE_ATTR_RO(lprev);

static ssize_t lnext_show(struct device *dev,
			  struct device_attribute *attr, char *buf)
{
	struct rio_dev *rdev = to_rio_dev(dev);
	char *str = buf;
	int i;

	if (rdev->pef & RIO_PEF_SWITCH) {
		for (i = 0; i < RIO_GET_TOTAL_PORTS(rdev->swpinfo); i++) {
			if (rdev->rswitch->nextdev[i])
				str += sprintf(str, "%s\n",
					rio_name(rdev->rswitch->nextdev[i]));
			else
				str += sprintf(str, "null\n");
		}
	}

	return str - buf;
}
static DEVICE_ATTR_RO(lnext);

static ssize_t modalias_show(struct device *dev,
			     struct device_attribute *attr, char *buf)
{
	struct rio_dev *rdev = to_rio_dev(dev);

	return sprintf(buf, "rapidio:v%04Xd%04Xav%04Xad%04X\n",
		       rdev->vid, rdev->did, rdev->asm_vid, rdev->asm_did);
}
static DEVICE_ATTR_RO(modalias);

static struct attribute *rio_dev_attrs[] = {
	&dev_attr_did.attr,
	&dev_attr_vid.attr,
	&dev_attr_device_rev.attr,
	&dev_attr_asm_did.attr,
	&dev_attr_asm_vid.attr,
	&dev_attr_asm_rev.attr,
	&dev_attr_lprev.attr,
	&dev_attr_destid.attr,
	&dev_attr_modalias.attr,

	/* Switch-only attributes */
	&dev_attr_routes.attr,
	&dev_attr_lnext.attr,
	&dev_attr_hopcount.attr,
	NULL,
};

static ssize_t
rio_read_config(struct file *filp, struct kobject *kobj,
		struct bin_attribute *bin_attr,
		char *buf, loff_t off, size_t count)
{
	struct rio_dev *dev = to_rio_dev(kobj_to_dev(kobj));
	unsigned int size = 0x100;
	loff_t init_off = off;
	u8 *data = (u8 *) buf;

	/* Several chips lock up trying to read undefined config space */
	if (capable(CAP_SYS_ADMIN))
		size = RIO_MAINT_SPACE_SZ;

	if (off >= size)
		return 0;
	if (off + count > size) {
		size -= off;
		count = size;
	} else {
		size = count;
	}

	if ((off & 1) && size) {
		u8 val;
		rio_read_config_8(dev, off, &val);
		data[off - init_off] = val;
		off++;
		size--;
	}

	if ((off & 3) && size > 2) {
		u16 val;
		rio_read_config_16(dev, off, &val);
		data[off - init_off] = (val >> 8) & 0xff;
		data[off - init_off + 1] = val & 0xff;
		off += 2;
		size -= 2;
	}

	while (size > 3) {
		u32 val;
		rio_read_config_32(dev, off, &val);
		data[off - init_off] = (val >> 24) & 0xff;
		data[off - init_off + 1] = (val >> 16) & 0xff;
		data[off - init_off + 2] = (val >> 8) & 0xff;
		data[off - init_off + 3] = val & 0xff;
		off += 4;
		size -= 4;
	}

	if (size >= 2) {
		u16 val;
		rio_read_config_16(dev, off, &val);
		data[off - init_off] = (val >> 8) & 0xff;
		data[off - init_off + 1] = val & 0xff;
		off += 2;
		size -= 2;
	}

	if (size > 0) {
		u8 val;
		rio_read_config_8(dev, off, &val);
		data[off - init_off] = val;
		off++;
		--size;
	}

	return count;
}

static ssize_t
rio_write_config(struct file *filp, struct kobject *kobj,
		 struct bin_attribute *bin_attr,
		 char *buf, loff_t off, size_t count)
{
	struct rio_dev *dev = to_rio_dev(kobj_to_dev(kobj));
	unsigned int size = count;
	loff_t init_off = off;
	u8 *data = (u8 *) buf;

	if (off >= RIO_MAINT_SPACE_SZ)
		return 0;
	if (off + count > RIO_MAINT_SPACE_SZ) {
		size = RIO_MAINT_SPACE_SZ - off;
		count = size;
	}

	if ((off & 1) && size) {
		rio_write_config_8(dev, off, data[off - init_off]);
		off++;
		size--;
	}

	if ((off & 3) && (size > 2)) {
		u16 val = data[off - init_off + 1];
		val |= (u16) data[off - init_off] << 8;
		rio_write_config_16(dev, off, val);
		off += 2;
		size -= 2;
	}

	while (size > 3) {
		u32 val = data[off - init_off + 3];
		val |= (u32) data[off - init_off + 2] << 8;
		val |= (u32) data[off - init_off + 1] << 16;
		val |= (u32) data[off - init_off] << 24;
		rio_write_config_32(dev, off, val);
		off += 4;
		size -= 4;
	}

	if (size >= 2) {
		u16 val = data[off - init_off + 1];
		val |= (u16) data[off - init_off] << 8;
		rio_write_config_16(dev, off, val);
		off += 2;
		size -= 2;
	}

	if (size) {
		rio_write_config_8(dev, off, data[off - init_off]);
		off++;
		--size;
	}

	return count;
}

static struct bin_attribute rio_config_attr = {
	.attr = {
		 .name = "config",
		 .mode = S_IRUGO | S_IWUSR,
		 },
	.size = RIO_MAINT_SPACE_SZ,
	.read = rio_read_config,
	.write = rio_write_config,
};

static struct bin_attribute *rio_dev_bin_attrs[] = {
	&rio_config_attr,
	NULL,
};

static umode_t rio_dev_is_attr_visible(struct kobject *kobj,
				       struct attribute *attr, int n)
{
	struct rio_dev *rdev = to_rio_dev(kobj_to_dev(kobj));
	umode_t mode = attr->mode;

	if (!(rdev->pef & RIO_PEF_SWITCH) &&
	    (attr == &dev_attr_routes.attr ||
	     attr == &dev_attr_lnext.attr ||
	     attr == &dev_attr_hopcount.attr)) {
		/*
		 * Hide switch-specific attributes for a non-switch device.
		 */
		mode = 0;
	}

	return mode;
}

static const struct attribute_group rio_dev_group = {
	.attrs		= rio_dev_attrs,
	.is_visible	= rio_dev_is_attr_visible,
	.bin_attrs	= rio_dev_bin_attrs,
};

const struct attribute_group *rio_dev_groups[] = {
	&rio_dev_group,
	NULL,
};

static ssize_t bus_scan_store(struct bus_type *bus, const char *buf,
				size_t count)
{
	long val;
	int rc;

	if (kstrtol(buf, 0, &val) < 0)
		return -EINVAL;

	if (val == RIO_MPORT_ANY) {
		rc = rio_init_mports();
		goto exit;
	}

	if (val < 0 || val >= RIO_MAX_MPORTS)
		return -EINVAL;

	rc = rio_mport_scan((int)val);
exit:
	if (!rc)
		rc = count;

	return rc;
}
static BUS_ATTR(scan, (S_IWUSR|S_IWGRP), NULL, bus_scan_store);

static struct attribute *rio_bus_attrs[] = {
	&bus_attr_scan.attr,
	NULL,
};

static const struct attribute_group rio_bus_group = {
	.attrs = rio_bus_attrs,
};

const struct attribute_group *rio_bus_groups[] = {
	&rio_bus_group,
	NULL,
};

static ssize_t
port_destid_show(struct device *dev, struct device_attribute *attr,
		 char *buf)
{
	struct rio_mport *mport = to_rio_mport(dev);

	if (mport)
		return sprintf(buf, "0x%04x\n", mport->host_deviceid);
	else
		return -ENODEV;
}
static DEVICE_ATTR_RO(port_destid);

static ssize_t sys_size_show(struct device *dev, struct device_attribute *attr,
			   char *buf)
{
	struct rio_mport *mport = to_rio_mport(dev);

	if (mport)
		return sprintf(buf, "%u\n", mport->sys_size);
	else
		return -ENODEV;
}
static DEVICE_ATTR_RO(sys_size);

static struct attribute *rio_mport_attrs[] = {
	&dev_attr_port_destid.attr,
	&dev_attr_sys_size.attr,
	NULL,
};

static const struct attribute_group rio_mport_group = {
	.attrs = rio_mport_attrs,
};

const struct attribute_group *rio_mport_groups[] = {
	&rio_mport_group,
	NULL,
};
Commit	Line	Data
394b701c MP	1	/*
	2	* RapidIO sysfs attributes and support
	3	*
	4	* Copyright 2005 MontaVista Software, Inc.
	5	* Matt Porter <mporter@kernel.crashing.org>
	6	*
	7	* This program is free software; you can redistribute it and/or modify it
	8	* under the terms of the GNU General Public License as published by the
	9	* Free Software Foundation; either version 2 of the License, or (at your
	10	* option) any later version.
	11	*/
	12
394b701c MP	13	#include <linux/kernel.h>
	14	#include <linux/rio.h>
	15	#include <linux/rio_drv.h>
	16	#include <linux/stat.h>
388b78ad	17	#include <linux/capability.h>
394b701c MP	18
	19	#include "rio.h"
	20
	21	/* Sysfs support */
	22	#define rio_config_attr(field, format_string) \
	23	static ssize_t \
6978bbc0	24	field##_show(struct device dev, struct device_attribute attr, char *buf) \
394b701c MP	25	{ \
	26	struct rio_dev *rdev = to_rio_dev(dev); \
	27	\
	28	return sprintf(buf, format_string, rdev->field); \
	29	} \
6d39c80b	30	static DEVICE_ATTR_RO(field);
394b701c MP	31
	32	rio_config_attr(did, "0x%04x\n");
	33	rio_config_attr(vid, "0x%04x\n");
	34	rio_config_attr(device_rev, "0x%08x\n");
	35	rio_config_attr(asm_did, "0x%04x\n");
	36	rio_config_attr(asm_vid, "0x%04x\n");
	37	rio_config_attr(asm_rev, "0x%04x\n");
cd8b974f AB	38	rio_config_attr(destid, "0x%04x\n");
cd8b974f AB	39	rio_config_attr(hopcount, "0x%02x\n");
394b701c	40
6978bbc0	41	static ssize_t routes_show(struct device dev, struct device_attribute attr, char *buf)
394b701c MP	42	{
	43	struct rio_dev *rdev = to_rio_dev(dev);
	44	char *str = buf;
	45	int i;
	46
e0423236 ZW	47	for (i = 0; i < RIO_MAX_ROUTE_ENTRIES(rdev->net->hport->sys_size);
e0423236 ZW	48	i++) {
394b701c MP	49	if (rdev->rswitch->route_table[i] == RIO_INVALID_ROUTE)
	50	continue;
	51	str +=
	52	sprintf(str, "%04x %02x\n", i,
	53	rdev->rswitch->route_table[i]);
	54	}
	55
394b701c MP	56	return (str - buf);
394b701c MP	57	}
6d39c80b	58	static DEVICE_ATTR_RO(routes);
394b701c	59
cd8b974f AB	60	static ssize_t lprev_show(struct device *dev,
	61	struct device_attribute attr, char buf)
	62	{
	63	struct rio_dev *rdev = to_rio_dev(dev);
	64
	65	return sprintf(buf, "%s\n",
	66	(rdev->prev) ? rio_name(rdev->prev) : "root");
	67	}
6d39c80b	68	static DEVICE_ATTR_RO(lprev);
cd8b974f AB	69
	70	static ssize_t lnext_show(struct device *dev,
	71	struct device_attribute attr, char buf)
	72	{
	73	struct rio_dev *rdev = to_rio_dev(dev);
	74	char *str = buf;
	75	int i;
	76
	77	if (rdev->pef & RIO_PEF_SWITCH) {
	78	for (i = 0; i < RIO_GET_TOTAL_PORTS(rdev->swpinfo); i++) {
	79	if (rdev->rswitch->nextdev[i])
	80	str += sprintf(str, "%s\n",
	81	rio_name(rdev->rswitch->nextdev[i]));
	82	else
	83	str += sprintf(str, "null\n");
	84	}
	85	}
	86
	87	return str - buf;
	88	}
6d39c80b	89	static DEVICE_ATTR_RO(lnext);
cd8b974f	90
3bdbb62f AB	91	static ssize_t modalias_show(struct device *dev,
	92	struct device_attribute attr, char buf)
	93	{
	94	struct rio_dev *rdev = to_rio_dev(dev);
	95
	96	return sprintf(buf, "rapidio:v%04Xd%04Xav%04Xad%04X\n",
	97	rdev->vid, rdev->did, rdev->asm_vid, rdev->asm_did);
	98	}
6d39c80b GKH	99	static DEVICE_ATTR_RO(modalias);
	100
	101	static struct attribute *rio_dev_attrs[] = {
	102	&dev_attr_did.attr,
	103	&dev_attr_vid.attr,
	104	&dev_attr_device_rev.attr,
	105	&dev_attr_asm_did.attr,
	106	&dev_attr_asm_vid.attr,
	107	&dev_attr_asm_rev.attr,
	108	&dev_attr_lprev.attr,
	109	&dev_attr_destid.attr,
	110	&dev_attr_modalias.attr,
3bdbb62f	111
70359c4a DT	112	/* Switch-only attributes */
	113	&dev_attr_routes.attr,
	114	&dev_attr_lnext.attr,
	115	&dev_attr_hopcount.attr,
6d39c80b GKH	116	NULL,
6d39c80b GKH	117	};
ac38d723	118
394b701c	119	static ssize_t
2c3c8bea CW	120	rio_read_config(struct file filp, struct kobject kobj,
2c3c8bea CW	121	struct bin_attribute *bin_attr,
91a69029	122	char *buf, loff_t off, size_t count)
394b701c	123	{
a253f1ee	124	struct rio_dev *dev = to_rio_dev(kobj_to_dev(kobj));
394b701c MP	125	unsigned int size = 0x100;
	126	loff_t init_off = off;
	127	u8 data = (u8 ) buf;
	128
	129	/* Several chips lock up trying to read undefined config space */
	130	if (capable(CAP_SYS_ADMIN))
fe41947e	131	size = RIO_MAINT_SPACE_SZ;
394b701c	132
fe41947e	133	if (off >= size)
394b701c MP	134	return 0;
	135	if (off + count > size) {
	136	size -= off;
	137	count = size;
	138	} else {
	139	size = count;
	140	}
	141
	142	if ((off & 1) && size) {
	143	u8 val;
	144	rio_read_config_8(dev, off, &val);
	145	data[off - init_off] = val;
	146	off++;
	147	size--;
	148	}
	149
	150	if ((off & 3) && size > 2) {
	151	u16 val;
	152	rio_read_config_16(dev, off, &val);
	153	data[off - init_off] = (val >> 8) & 0xff;
	154	data[off - init_off + 1] = val & 0xff;
	155	off += 2;
	156	size -= 2;
	157	}
	158
	159	while (size > 3) {
	160	u32 val;
	161	rio_read_config_32(dev, off, &val);
	162	data[off - init_off] = (val >> 24) & 0xff;
	163	data[off - init_off + 1] = (val >> 16) & 0xff;
	164	data[off - init_off + 2] = (val >> 8) & 0xff;
	165	data[off - init_off + 3] = val & 0xff;
	166	off += 4;
	167	size -= 4;
	168	}
	169
	170	if (size >= 2) {
	171	u16 val;
	172	rio_read_config_16(dev, off, &val);
	173	data[off - init_off] = (val >> 8) & 0xff;
	174	data[off - init_off + 1] = val & 0xff;
	175	off += 2;
	176	size -= 2;
	177	}
	178
	179	if (size > 0) {
	180	u8 val;
	181	rio_read_config_8(dev, off, &val);
	182	data[off - init_off] = val;
	183	off++;
	184	--size;
	185	}
	186
	187	return count;
	188	}
	189
	190	static ssize_t
2c3c8bea CW	191	rio_write_config(struct file filp, struct kobject kobj,
2c3c8bea CW	192	struct bin_attribute *bin_attr,
91a69029	193	char *buf, loff_t off, size_t count)
394b701c	194	{
a253f1ee	195	struct rio_dev *dev = to_rio_dev(kobj_to_dev(kobj));
394b701c MP	196	unsigned int size = count;
	197	loff_t init_off = off;
	198	u8 data = (u8 ) buf;
	199
fe41947e	200	if (off >= RIO_MAINT_SPACE_SZ)
394b701c	201	return 0;
fe41947e AB	202	if (off + count > RIO_MAINT_SPACE_SZ) {
fe41947e AB	203	size = RIO_MAINT_SPACE_SZ - off;
394b701c MP	204	count = size;
	205	}
	206
	207	if ((off & 1) && size) {
	208	rio_write_config_8(dev, off, data[off - init_off]);
	209	off++;
	210	size--;
	211	}
	212
	213	if ((off & 3) && (size > 2)) {
	214	u16 val = data[off - init_off + 1];
	215	val \|= (u16) data[off - init_off] << 8;
	216	rio_write_config_16(dev, off, val);
	217	off += 2;
	218	size -= 2;
	219	}
	220
	221	while (size > 3) {
	222	u32 val = data[off - init_off + 3];
	223	val \|= (u32) data[off - init_off + 2] << 8;
	224	val \|= (u32) data[off - init_off + 1] << 16;
	225	val \|= (u32) data[off - init_off] << 24;
	226	rio_write_config_32(dev, off, val);
	227	off += 4;
	228	size -= 4;
	229	}
	230
	231	if (size >= 2) {
	232	u16 val = data[off - init_off + 1];
	233	val \|= (u16) data[off - init_off] << 8;
	234	rio_write_config_16(dev, off, val);
	235	off += 2;
	236	size -= 2;
	237	}
	238
	239	if (size) {
	240	rio_write_config_8(dev, off, data[off - init_off]);
	241	off++;
	242	--size;
	243	}
	244
	245	return count;
	246	}
	247
	248	static struct bin_attribute rio_config_attr = {
	249	.attr = {
	250	.name = "config",
	251	.mode = S_IRUGO \| S_IWUSR,
394b701c	252	},
fe41947e	253	.size = RIO_MAINT_SPACE_SZ,
394b701c MP	254	.read = rio_read_config,
	255	.write = rio_write_config,
	256	};
	257
70359c4a DT	258	static struct bin_attribute *rio_dev_bin_attrs[] = {
	259	&rio_config_attr,
	260	NULL,
	261	};
ac38d723	262
70359c4a DT	263	static umode_t rio_dev_is_attr_visible(struct kobject *kobj,
	264	struct attribute *attr, int n)
	265	{
	266	struct rio_dev *rdev = to_rio_dev(kobj_to_dev(kobj));
	267	umode_t mode = attr->mode;
	268
	269	if (!(rdev->pef & RIO_PEF_SWITCH) &&
	270	(attr == &dev_attr_routes.attr \|\|
	271	attr == &dev_attr_lnext.attr \|\|
	272	attr == &dev_attr_hopcount.attr)) {
	273	/*
	274	* Hide switch-specific attributes for a non-switch device.
	275	*/
	276	mode = 0;
ac38d723 AB	277	}
ac38d723 AB	278
70359c4a	279	return mode;
394b701c MP	280	}
394b701c MP	281
70359c4a DT	282	static const struct attribute_group rio_dev_group = {
	283	.attrs = rio_dev_attrs,
	284	.is_visible = rio_dev_is_attr_visible,
	285	.bin_attrs = rio_dev_bin_attrs,
	286	};
	287
	288	const struct attribute_group *rio_dev_groups[] = {
	289	&rio_dev_group,
	290	NULL,
	291	};
bc8fcfea AB	292
	293	static ssize_t bus_scan_store(struct bus_type bus, const char buf,
	294	size_t count)
	295	{
	296	long val;
bc8fcfea AB	297	int rc;
	298
	299	if (kstrtol(buf, 0, &val) < 0)
	300	return -EINVAL;
	301
	302	if (val == RIO_MPORT_ANY) {
	303	rc = rio_init_mports();
	304	goto exit;
	305	}
	306
	307	if (val < 0 \|\| val >= RIO_MAX_MPORTS)
	308	return -EINVAL;
	309
9edbc30b	310	rc = rio_mport_scan((int)val);
bc8fcfea AB	311	exit:
	312	if (!rc)
	313	rc = count;
	314
	315	return rc;
	316	}
ed1d2da2	317	static BUS_ATTR(scan, (S_IWUSR\|S_IWGRP), NULL, bus_scan_store);
bc8fcfea	318
ed1d2da2 GKH	319	static struct attribute *rio_bus_attrs[] = {
	320	&bus_attr_scan.attr,
	321	NULL,
	322	};
	323
	324	static const struct attribute_group rio_bus_group = {
	325	.attrs = rio_bus_attrs,
	326	};
	327
	328	const struct attribute_group *rio_bus_groups[] = {
	329	&rio_bus_group,
	330	NULL,
bc8fcfea	331	};
2aaf308b AB	332
	333	static ssize_t
	334	port_destid_show(struct device dev, struct device_attribute attr,
	335	char *buf)
	336	{
	337	struct rio_mport *mport = to_rio_mport(dev);
	338
	339	if (mport)
	340	return sprintf(buf, "0x%04x\n", mport->host_deviceid);
	341	else
	342	return -ENODEV;
	343	}
	344	static DEVICE_ATTR_RO(port_destid);
	345
	346	static ssize_t sys_size_show(struct device dev, struct device_attribute attr,
	347	char *buf)
	348	{
	349	struct rio_mport *mport = to_rio_mport(dev);
	350
	351	if (mport)
	352	return sprintf(buf, "%u\n", mport->sys_size);
	353	else
	354	return -ENODEV;
	355	}
	356	static DEVICE_ATTR_RO(sys_size);
	357
	358	static struct attribute *rio_mport_attrs[] = {
	359	&dev_attr_port_destid.attr,
	360	&dev_attr_sys_size.attr,
	361	NULL,
	362	};
	363
	364	static const struct attribute_group rio_mport_group = {
	365	.attrs = rio_mport_attrs,
	366	};
	367
	368	const struct attribute_group *rio_mport_groups[] = {
	369	&rio_mport_group,
	370	NULL,
	371	};