[linux-2.6-block.git] / drivers / net / phy / spi_ks8995.c

/*
 * SPI driver for Micrel/Kendin KS8995M and KSZ8864RMN ethernet switches
 *
 * Copyright (C) 2008 Gabor Juhos <juhosg at openwrt.org>
 *
 * This file was based on: drivers/spi/at25.c
 *     Copyright (C) 2006 David Brownell
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published
 * by the Free Software Foundation.
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/delay.h>
#include <linux/device.h>

#include <linux/spi/spi.h>

#define DRV_VERSION		"0.1.1"
#define DRV_DESC		"Micrel KS8995 Ethernet switch SPI driver"

/* ------------------------------------------------------------------------ */

#define KS8995_REG_ID0		0x00    /* Chip ID0 */
#define KS8995_REG_ID1		0x01    /* Chip ID1 */

#define KS8995_REG_GC0		0x02    /* Global Control 0 */
#define KS8995_REG_GC1		0x03    /* Global Control 1 */
#define KS8995_REG_GC2		0x04    /* Global Control 2 */
#define KS8995_REG_GC3		0x05    /* Global Control 3 */
#define KS8995_REG_GC4		0x06    /* Global Control 4 */
#define KS8995_REG_GC5		0x07    /* Global Control 5 */
#define KS8995_REG_GC6		0x08    /* Global Control 6 */
#define KS8995_REG_GC7		0x09    /* Global Control 7 */
#define KS8995_REG_GC8		0x0a    /* Global Control 8 */
#define KS8995_REG_GC9		0x0b    /* Global Control 9 */

#define KS8995_REG_PC(p, r)	((0x10 * p) + r)	 /* Port Control */
#define KS8995_REG_PS(p, r)	((0x10 * p) + r + 0xe)  /* Port Status */

#define KS8995_REG_TPC0		0x60    /* TOS Priority Control 0 */
#define KS8995_REG_TPC1		0x61    /* TOS Priority Control 1 */
#define KS8995_REG_TPC2		0x62    /* TOS Priority Control 2 */
#define KS8995_REG_TPC3		0x63    /* TOS Priority Control 3 */
#define KS8995_REG_TPC4		0x64    /* TOS Priority Control 4 */
#define KS8995_REG_TPC5		0x65    /* TOS Priority Control 5 */
#define KS8995_REG_TPC6		0x66    /* TOS Priority Control 6 */
#define KS8995_REG_TPC7		0x67    /* TOS Priority Control 7 */

#define KS8995_REG_MAC0		0x68    /* MAC address 0 */
#define KS8995_REG_MAC1		0x69    /* MAC address 1 */
#define KS8995_REG_MAC2		0x6a    /* MAC address 2 */
#define KS8995_REG_MAC3		0x6b    /* MAC address 3 */
#define KS8995_REG_MAC4		0x6c    /* MAC address 4 */
#define KS8995_REG_MAC5		0x6d    /* MAC address 5 */

#define KS8995_REG_IAC0		0x6e    /* Indirect Access Control 0 */
#define KS8995_REG_IAC1		0x6f    /* Indirect Access Control 0 */
#define KS8995_REG_IAD7		0x70    /* Indirect Access Data 7 */
#define KS8995_REG_IAD6		0x71    /* Indirect Access Data 6 */
#define KS8995_REG_IAD5		0x72    /* Indirect Access Data 5 */
#define KS8995_REG_IAD4		0x73    /* Indirect Access Data 4 */
#define KS8995_REG_IAD3		0x74    /* Indirect Access Data 3 */
#define KS8995_REG_IAD2		0x75    /* Indirect Access Data 2 */
#define KS8995_REG_IAD1		0x76    /* Indirect Access Data 1 */
#define KS8995_REG_IAD0		0x77    /* Indirect Access Data 0 */

#define KSZ8864_REG_ID1		0xfe	/* Chip ID in bit 7 */

#define KS8995_REGS_SIZE	0x80
#define KSZ8864_REGS_SIZE	0x100

#define ID1_CHIPID_M		0xf
#define ID1_CHIPID_S		4
#define ID1_REVISION_M		0x7
#define ID1_REVISION_S		1
#define ID1_START_SW		1	/* start the switch */

#define FAMILY_KS8995		0x95
#define CHIPID_M		0

#define KS8995_CMD_WRITE	0x02U
#define KS8995_CMD_READ		0x03U

#define KS8995_RESET_DELAY	10 /* usec */

struct ks8995_pdata {
	/* not yet implemented */
};

struct ks8995_switch {
	struct spi_device	*spi;
	struct mutex		lock;
	struct ks8995_pdata	*pdata;
	struct bin_attribute	regs_attr;
};

static inline u8 get_chip_id(u8 val)
{
	return (val >> ID1_CHIPID_S) & ID1_CHIPID_M;
}

static inline u8 get_chip_rev(u8 val)
{
	return (val >> ID1_REVISION_S) & ID1_REVISION_M;
}

/* ------------------------------------------------------------------------ */
static int ks8995_read(struct ks8995_switch *ks, char *buf,
		 unsigned offset, size_t count)
{
	u8 cmd[2];
	struct spi_transfer t[2];
	struct spi_message m;
	int err;

	spi_message_init(&m);

	memset(&t, 0, sizeof(t));

	t[0].tx_buf = cmd;
	t[0].len = sizeof(cmd);
	spi_message_add_tail(&t[0], &m);

	t[1].rx_buf = buf;
	t[1].len = count;
	spi_message_add_tail(&t[1], &m);

	cmd[0] = KS8995_CMD_READ;
	cmd[1] = offset;

	mutex_lock(&ks->lock);
	err = spi_sync(ks->spi, &m);
	mutex_unlock(&ks->lock);

	return err ? err : count;
}


static int ks8995_write(struct ks8995_switch *ks, char *buf,
		 unsigned offset, size_t count)
{
	u8 cmd[2];
	struct spi_transfer t[2];
	struct spi_message m;
	int err;

	spi_message_init(&m);

	memset(&t, 0, sizeof(t));

	t[0].tx_buf = cmd;
	t[0].len = sizeof(cmd);
	spi_message_add_tail(&t[0], &m);

	t[1].tx_buf = buf;
	t[1].len = count;
	spi_message_add_tail(&t[1], &m);

	cmd[0] = KS8995_CMD_WRITE;
	cmd[1] = offset;

	mutex_lock(&ks->lock);
	err = spi_sync(ks->spi, &m);
	mutex_unlock(&ks->lock);

	return err ? err : count;
}

static inline int ks8995_read_reg(struct ks8995_switch *ks, u8 addr, u8 *buf)
{
	return ks8995_read(ks, buf, addr, 1) != 1;
}

static inline int ks8995_write_reg(struct ks8995_switch *ks, u8 addr, u8 val)
{
	char buf = val;

	return ks8995_write(ks, &buf, addr, 1) != 1;
}

/* ------------------------------------------------------------------------ */

static int ks8995_stop(struct ks8995_switch *ks)
{
	return ks8995_write_reg(ks, KS8995_REG_ID1, 0);
}

static int ks8995_start(struct ks8995_switch *ks)
{
	return ks8995_write_reg(ks, KS8995_REG_ID1, 1);
}

static int ks8995_reset(struct ks8995_switch *ks)
{
	int err;

	err = ks8995_stop(ks);
	if (err)
		return err;

	udelay(KS8995_RESET_DELAY);

	return ks8995_start(ks);
}

/* ------------------------------------------------------------------------ */

static ssize_t ks8995_registers_read(struct file *filp, struct kobject *kobj,
	struct bin_attribute *bin_attr, char *buf, loff_t off, size_t count)
{
	struct device *dev;
	struct ks8995_switch *ks8995;

	dev = container_of(kobj, struct device, kobj);
	ks8995 = dev_get_drvdata(dev);

	if (unlikely(off > ks8995->regs_attr.size))
		return 0;

	if ((off + count) > ks8995->regs_attr.size)
		count = ks8995->regs_attr.size - off;

	if (unlikely(!count))
		return count;

	return ks8995_read(ks8995, buf, off, count);
}


static ssize_t ks8995_registers_write(struct file *filp, struct kobject *kobj,
	struct bin_attribute *bin_attr, char *buf, loff_t off, size_t count)
{
	struct device *dev;
	struct ks8995_switch *ks8995;

	dev = container_of(kobj, struct device, kobj);
	ks8995 = dev_get_drvdata(dev);

	if (unlikely(off >= ks8995->regs_attr.size))
		return -EFBIG;

	if ((off + count) > ks8995->regs_attr.size)
		count = ks8995->regs_attr.size - off;

	if (unlikely(!count))
		return count;

	return ks8995_write(ks8995, buf, off, count);
}


static const struct bin_attribute ks8995_registers_attr = {
	.attr = {
		.name   = "registers",
		.mode   = S_IRUSR | S_IWUSR,
	},
	.size   = KS8995_REGS_SIZE,
	.read   = ks8995_registers_read,
	.write  = ks8995_registers_write,
};

/* ------------------------------------------------------------------------ */

static int ks8995_probe(struct spi_device *spi)
{
	struct ks8995_switch    *ks;
	struct ks8995_pdata     *pdata;
	u8      ids[2];
	int     err;

	/* Chip description */
	pdata = spi->dev.platform_data;

	ks = kzalloc(sizeof(*ks), GFP_KERNEL);
	if (!ks)
		return -ENOMEM;

	mutex_init(&ks->lock);
	ks->pdata = pdata;
	ks->spi = spi_dev_get(spi);
	spi_set_drvdata(spi, ks);

	spi->mode = SPI_MODE_0;
	spi->bits_per_word = 8;
	err = spi_setup(spi);
	if (err) {
		dev_err(&spi->dev, "spi_setup failed, err=%d\n", err);
		goto err_drvdata;
	}

	err = ks8995_read(ks, ids, KS8995_REG_ID0, sizeof(ids));
	if (err < 0) {
		dev_err(&spi->dev, "unable to read id registers, err=%d\n",
				err);
		goto err_drvdata;
	}

	switch (ids[0]) {
	case FAMILY_KS8995:
		break;
	default:
		dev_err(&spi->dev, "unknown family id:%02x\n", ids[0]);
		err = -ENODEV;
		goto err_drvdata;
	}

	memcpy(&ks->regs_attr, &ks8995_registers_attr, sizeof(ks->regs_attr));
	if (get_chip_id(ids[1]) != CHIPID_M) {
		u8 val;

		/* Check if this is a KSZ8864RMN */
		err = ks8995_read(ks, &val, KSZ8864_REG_ID1, sizeof(val));
		if (err < 0) {
			dev_err(&spi->dev,
				"unable to read chip id register, err=%d\n",
				err);
			goto err_drvdata;
		}
		if ((val & 0x80) == 0) {
			dev_err(&spi->dev, "unknown chip:%02x,0\n", ids[1]);
			goto err_drvdata;
		}
		ks->regs_attr.size = KSZ8864_REGS_SIZE;
	}

	err = ks8995_reset(ks);
	if (err)
		goto err_drvdata;

	err = sysfs_create_bin_file(&spi->dev.kobj, &ks->regs_attr);
	if (err) {
		dev_err(&spi->dev, "unable to create sysfs file, err=%d\n",
				    err);
		goto err_drvdata;
	}

	if (get_chip_id(ids[1]) == CHIPID_M) {
		dev_info(&spi->dev,
			 "KS8995 device found, Chip ID:%x, Revision:%x\n",
			 get_chip_id(ids[1]), get_chip_rev(ids[1]));
	} else {
		dev_info(&spi->dev, "KSZ8864 device found, Revision:%x\n",
			 get_chip_rev(ids[1]));
	}

	return 0;

err_drvdata:
	kfree(ks);
	return err;
}

static int ks8995_remove(struct spi_device *spi)
{
	struct ks8995_data      *ks8995;

	ks8995 = spi_get_drvdata(spi);
	sysfs_remove_bin_file(&spi->dev.kobj, &ks8995_registers_attr);

	kfree(ks8995);

	return 0;
}

/* ------------------------------------------------------------------------ */

static struct spi_driver ks8995_driver = {
	.driver = {
		.name	    = "spi-ks8995",
		.owner	   = THIS_MODULE,
	},
	.probe	  = ks8995_probe,
	.remove	  = ks8995_remove,
};

module_spi_driver(ks8995_driver);

MODULE_DESCRIPTION(DRV_DESC);
MODULE_VERSION(DRV_VERSION);
MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
a8e510f6	1	/*
240a12d5	2	* SPI driver for Micrel/Kendin KS8995M and KSZ8864RMN ethernet switches
a8e510f6 FL	3	*
	4	* Copyright (C) 2008 Gabor Juhos <juhosg at openwrt.org>
	5	*
	6	* This file was based on: drivers/spi/at25.c
	7	* Copyright (C) 2006 David Brownell
	8	*
	9	* This program is free software; you can redistribute it and/or modify it
	10	* under the terms of the GNU General Public License version 2 as published
	11	* by the Free Software Foundation.
	12	*/
	13
8d242488 JP	14	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
8d242488 JP	15
a8e510f6 FL	16	#include <linux/types.h>
a8e510f6 FL	17	#include <linux/kernel.h>
a8e510f6 FL	18	#include <linux/module.h>
	19	#include <linux/delay.h>
	20	#include <linux/device.h>
	21
	22	#include <linux/spi/spi.h>
	23
	24	#define DRV_VERSION "0.1.1"
	25	#define DRV_DESC "Micrel KS8995 Ethernet switch SPI driver"
	26
	27	/* ------------------------------------------------------------------------ */
	28
	29	#define KS8995_REG_ID0 0x00 /* Chip ID0 */
	30	#define KS8995_REG_ID1 0x01 /* Chip ID1 */
	31
	32	#define KS8995_REG_GC0 0x02 /* Global Control 0 */
	33	#define KS8995_REG_GC1 0x03 /* Global Control 1 */
	34	#define KS8995_REG_GC2 0x04 /* Global Control 2 */
	35	#define KS8995_REG_GC3 0x05 /* Global Control 3 */
	36	#define KS8995_REG_GC4 0x06 /* Global Control 4 */
	37	#define KS8995_REG_GC5 0x07 /* Global Control 5 */
	38	#define KS8995_REG_GC6 0x08 /* Global Control 6 */
	39	#define KS8995_REG_GC7 0x09 /* Global Control 7 */
	40	#define KS8995_REG_GC8 0x0a /* Global Control 8 */
	41	#define KS8995_REG_GC9 0x0b /* Global Control 9 */
	42
	43	#define KS8995_REG_PC(p, r) ((0x10 * p) + r) /* Port Control */
	44	#define KS8995_REG_PS(p, r) ((0x10 * p) + r + 0xe) /* Port Status */
	45
	46	#define KS8995_REG_TPC0 0x60 /* TOS Priority Control 0 */
	47	#define KS8995_REG_TPC1 0x61 /* TOS Priority Control 1 */
	48	#define KS8995_REG_TPC2 0x62 /* TOS Priority Control 2 */
	49	#define KS8995_REG_TPC3 0x63 /* TOS Priority Control 3 */
	50	#define KS8995_REG_TPC4 0x64 /* TOS Priority Control 4 */
	51	#define KS8995_REG_TPC5 0x65 /* TOS Priority Control 5 */
	52	#define KS8995_REG_TPC6 0x66 /* TOS Priority Control 6 */
	53	#define KS8995_REG_TPC7 0x67 /* TOS Priority Control 7 */
	54
	55	#define KS8995_REG_MAC0 0x68 /* MAC address 0 */
	56	#define KS8995_REG_MAC1 0x69 /* MAC address 1 */
	57	#define KS8995_REG_MAC2 0x6a /* MAC address 2 */
	58	#define KS8995_REG_MAC3 0x6b /* MAC address 3 */
	59	#define KS8995_REG_MAC4 0x6c /* MAC address 4 */
	60	#define KS8995_REG_MAC5 0x6d /* MAC address 5 */
	61
	62	#define KS8995_REG_IAC0 0x6e /* Indirect Access Control 0 */
	63	#define KS8995_REG_IAC1 0x6f /* Indirect Access Control 0 */
	64	#define KS8995_REG_IAD7 0x70 /* Indirect Access Data 7 */
	65	#define KS8995_REG_IAD6 0x71 /* Indirect Access Data 6 */
	66	#define KS8995_REG_IAD5 0x72 /* Indirect Access Data 5 */
	67	#define KS8995_REG_IAD4 0x73 /* Indirect Access Data 4 */
	68	#define KS8995_REG_IAD3 0x74 /* Indirect Access Data 3 */
	69	#define KS8995_REG_IAD2 0x75 /* Indirect Access Data 2 */
	70	#define KS8995_REG_IAD1 0x76 /* Indirect Access Data 1 */
	71	#define KS8995_REG_IAD0 0x77 /* Indirect Access Data 0 */
	72
240a12d5 PZ	73	#define KSZ8864_REG_ID1 0xfe /* Chip ID in bit 7 */
240a12d5 PZ	74
a8e510f6	75	#define KS8995_REGS_SIZE 0x80
240a12d5	76	#define KSZ8864_REGS_SIZE 0x100
a8e510f6 FL	77
	78	#define ID1_CHIPID_M 0xf
	79	#define ID1_CHIPID_S 4
	80	#define ID1_REVISION_M 0x7
	81	#define ID1_REVISION_S 1
	82	#define ID1_START_SW 1 /* start the switch */
	83
	84	#define FAMILY_KS8995 0x95
	85	#define CHIPID_M 0
	86
	87	#define KS8995_CMD_WRITE 0x02U
	88	#define KS8995_CMD_READ 0x03U
	89
	90	#define KS8995_RESET_DELAY 10 /* usec */
	91
	92	struct ks8995_pdata {
	93	/* not yet implemented */
	94	};
	95
	96	struct ks8995_switch {
	97	struct spi_device *spi;
	98	struct mutex lock;
	99	struct ks8995_pdata *pdata;
240a12d5	100	struct bin_attribute regs_attr;
a8e510f6 FL	101	};
	102
	103	static inline u8 get_chip_id(u8 val)
	104	{
	105	return (val >> ID1_CHIPID_S) & ID1_CHIPID_M;
	106	}
	107
	108	static inline u8 get_chip_rev(u8 val)
	109	{
	110	return (val >> ID1_REVISION_S) & ID1_REVISION_M;
	111	}
	112
	113	/* ------------------------------------------------------------------------ */
	114	static int ks8995_read(struct ks8995_switch ks, char buf,
	115	unsigned offset, size_t count)
	116	{
	117	u8 cmd[2];
	118	struct spi_transfer t[2];
	119	struct spi_message m;
	120	int err;
	121
	122	spi_message_init(&m);
	123
	124	memset(&t, 0, sizeof(t));
	125
	126	t[0].tx_buf = cmd;
	127	t[0].len = sizeof(cmd);
	128	spi_message_add_tail(&t[0], &m);
	129
	130	t[1].rx_buf = buf;
	131	t[1].len = count;
	132	spi_message_add_tail(&t[1], &m);
	133
	134	cmd[0] = KS8995_CMD_READ;
	135	cmd[1] = offset;
	136
	137	mutex_lock(&ks->lock);
	138	err = spi_sync(ks->spi, &m);
	139	mutex_unlock(&ks->lock);
	140
	141	return err ? err : count;
	142	}
	143
	144
	145	static int ks8995_write(struct ks8995_switch ks, char buf,
	146	unsigned offset, size_t count)
	147	{
	148	u8 cmd[2];
	149	struct spi_transfer t[2];
	150	struct spi_message m;
	151	int err;
	152
	153	spi_message_init(&m);
	154
	155	memset(&t, 0, sizeof(t));
	156
	157	t[0].tx_buf = cmd;
	158	t[0].len = sizeof(cmd);
	159	spi_message_add_tail(&t[0], &m);
	160
	161	t[1].tx_buf = buf;
	162	t[1].len = count;
	163	spi_message_add_tail(&t[1], &m);
	164
165	cmd[0] = KS8995_CMD_WRITE;
166	cmd[1] = offset;
167
168	mutex_lock(&ks->lock);
169	err = spi_sync(ks->spi, &m);
170	mutex_unlock(&ks->lock);
171
172	return err ? err : count;
173	}
174
175	static inline int ks8995_read_reg(struct ks8995_switch ks, u8 addr, u8 buf)
176	{
7aff9675	177	return ks8995_read(ks, buf, addr, 1) != 1;
a8e510f6 FL	178	}
	179
	180	static inline int ks8995_write_reg(struct ks8995_switch *ks, u8 addr, u8 val)
	181	{
	182	char buf = val;
	183
7aff9675	184	return ks8995_write(ks, &buf, addr, 1) != 1;
a8e510f6 FL	185	}
	186
	187	/* ------------------------------------------------------------------------ */
	188
	189	static int ks8995_stop(struct ks8995_switch *ks)
	190	{
	191	return ks8995_write_reg(ks, KS8995_REG_ID1, 0);
	192	}
	193
	194	static int ks8995_start(struct ks8995_switch *ks)
	195	{
	196	return ks8995_write_reg(ks, KS8995_REG_ID1, 1);
	197	}
	198
	199	static int ks8995_reset(struct ks8995_switch *ks)
	200	{
	201	int err;
	202
	203	err = ks8995_stop(ks);
	204	if (err)
	205	return err;
	206
	207	udelay(KS8995_RESET_DELAY);
	208
	209	return ks8995_start(ks);
	210	}
	211
	212	/* ------------------------------------------------------------------------ */
	213
	214	static ssize_t ks8995_registers_read(struct file filp, struct kobject kobj,
	215	struct bin_attribute bin_attr, char buf, loff_t off, size_t count)
	216	{
	217	struct device *dev;
	218	struct ks8995_switch *ks8995;
	219
	220	dev = container_of(kobj, struct device, kobj);
	221	ks8995 = dev_get_drvdata(dev);
	222
240a12d5	223	if (unlikely(off > ks8995->regs_attr.size))
a8e510f6 FL	224	return 0;
a8e510f6 FL	225
240a12d5 PZ	226	if ((off + count) > ks8995->regs_attr.size)
240a12d5 PZ	227	count = ks8995->regs_attr.size - off;
a8e510f6 FL	228
	229	if (unlikely(!count))
	230	return count;
	231
	232	return ks8995_read(ks8995, buf, off, count);
	233	}
	234
	235
	236	static ssize_t ks8995_registers_write(struct file filp, struct kobject kobj,
	237	struct bin_attribute bin_attr, char buf, loff_t off, size_t count)
	238	{
	239	struct device *dev;
	240	struct ks8995_switch *ks8995;
	241
	242	dev = container_of(kobj, struct device, kobj);
	243	ks8995 = dev_get_drvdata(dev);
	244
240a12d5	245	if (unlikely(off >= ks8995->regs_attr.size))
a8e510f6 FL	246	return -EFBIG;
a8e510f6 FL	247
240a12d5 PZ	248	if ((off + count) > ks8995->regs_attr.size)
240a12d5 PZ	249	count = ks8995->regs_attr.size - off;
a8e510f6 FL	250
	251	if (unlikely(!count))
	252	return count;
	253
	254	return ks8995_write(ks8995, buf, off, count);
	255	}
	256
	257
240a12d5	258	static const struct bin_attribute ks8995_registers_attr = {
a8e510f6 FL	259	.attr = {
	260	.name = "registers",
	261	.mode = S_IRUSR \| S_IWUSR,
	262	},
	263	.size = KS8995_REGS_SIZE,
	264	.read = ks8995_registers_read,
	265	.write = ks8995_registers_write,
	266	};
	267
	268	/* ------------------------------------------------------------------------ */
	269
633d1594	270	static int ks8995_probe(struct spi_device *spi)
a8e510f6 FL	271	{
	272	struct ks8995_switch *ks;
	273	struct ks8995_pdata *pdata;
	274	u8 ids[2];
	275	int err;
	276
	277	/* Chip description */
	278	pdata = spi->dev.platform_data;
	279
	280	ks = kzalloc(sizeof(*ks), GFP_KERNEL);
e68ed8f0	281	if (!ks)
a8e510f6	282	return -ENOMEM;
a8e510f6 FL	283
	284	mutex_init(&ks->lock);
	285	ks->pdata = pdata;
	286	ks->spi = spi_dev_get(spi);
5d5f1846	287	spi_set_drvdata(spi, ks);
a8e510f6 FL	288
	289	spi->mode = SPI_MODE_0;
	290	spi->bits_per_word = 8;
	291	err = spi_setup(spi);
	292	if (err) {
	293	dev_err(&spi->dev, "spi_setup failed, err=%d\n", err);
	294	goto err_drvdata;
	295	}
	296
	297	err = ks8995_read(ks, ids, KS8995_REG_ID0, sizeof(ids));
	298	if (err < 0) {
	299	dev_err(&spi->dev, "unable to read id registers, err=%d\n",
	300	err);
	301	goto err_drvdata;
	302	}
	303
	304	switch (ids[0]) {
	305	case FAMILY_KS8995:
	306	break;
	307	default:
	308	dev_err(&spi->dev, "unknown family id:%02x\n", ids[0]);
	309	err = -ENODEV;
	310	goto err_drvdata;
	311	}
	312
240a12d5 PZ	313	memcpy(&ks->regs_attr, &ks8995_registers_attr, sizeof(ks->regs_attr));
	314	if (get_chip_id(ids[1]) != CHIPID_M) {
	315	u8 val;
	316
	317	/* Check if this is a KSZ8864RMN */
	318	err = ks8995_read(ks, &val, KSZ8864_REG_ID1, sizeof(val));
	319	if (err < 0) {
	320	dev_err(&spi->dev,
	321	"unable to read chip id register, err=%d\n",
	322	err);
	323	goto err_drvdata;
	324	}
	325	if ((val & 0x80) == 0) {
	326	dev_err(&spi->dev, "unknown chip:%02x,0\n", ids[1]);
	327	goto err_drvdata;
	328	}
	329	ks->regs_attr.size = KSZ8864_REGS_SIZE;
	330	}
	331
a8e510f6 FL	332	err = ks8995_reset(ks);
	333	if (err)
	334	goto err_drvdata;
	335
240a12d5	336	err = sysfs_create_bin_file(&spi->dev.kobj, &ks->regs_attr);
a8e510f6 FL	337	if (err) {
	338	dev_err(&spi->dev, "unable to create sysfs file, err=%d\n",
	339	err);
	340	goto err_drvdata;
	341	}
	342
240a12d5 PZ	343	if (get_chip_id(ids[1]) == CHIPID_M) {
	344	dev_info(&spi->dev,
	345	"KS8995 device found, Chip ID:%x, Revision:%x\n",
	346	get_chip_id(ids[1]), get_chip_rev(ids[1]));
	347	} else {
	348	dev_info(&spi->dev, "KSZ8864 device found, Revision:%x\n",
	349	get_chip_rev(ids[1]));
	350	}
a8e510f6 FL	351
	352	return 0;
	353
	354	err_drvdata:
a8e510f6 FL	355	kfree(ks);
	356	return err;
	357	}
	358
633d1594	359	static int ks8995_remove(struct spi_device *spi)
a8e510f6 FL	360	{
	361	struct ks8995_data *ks8995;
	362
5d5f1846	363	ks8995 = spi_get_drvdata(spi);
a8e510f6 FL	364	sysfs_remove_bin_file(&spi->dev.kobj, &ks8995_registers_attr);
a8e510f6 FL	365
a8e510f6 FL	366	kfree(ks8995);
	367
	368	return 0;
	369	}
	370
	371	/* ------------------------------------------------------------------------ */
	372
	373	static struct spi_driver ks8995_driver = {
	374	.driver = {
	375	.name = "spi-ks8995",
a8e510f6 FL	376	.owner = THIS_MODULE,
	377	},
	378	.probe = ks8995_probe,
633d1594	379	.remove = ks8995_remove,
a8e510f6 FL	380	};
a8e510f6 FL	381
1a9561a3	382	module_spi_driver(ks8995_driver);
a8e510f6 FL	383
	384	MODULE_DESCRIPTION(DRV_DESC);
	385	MODULE_VERSION(DRV_VERSION);
	386	MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>");
	387	MODULE_LICENSE("GPL v2");