162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * SPI driver for Micrel/Kendin KS8995M and KSZ8864RMN ethernet switches
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2008 Gabor Juhos <juhosg at openwrt.org>
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * This file was based on: drivers/spi/at25.c
862306a36Sopenharmony_ci *     Copyright (C) 2006 David Brownell
962306a36Sopenharmony_ci */
1062306a36Sopenharmony_ci
1162306a36Sopenharmony_ci#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
1262306a36Sopenharmony_ci
1362306a36Sopenharmony_ci#include <linux/types.h>
1462306a36Sopenharmony_ci#include <linux/kernel.h>
1562306a36Sopenharmony_ci#include <linux/module.h>
1662306a36Sopenharmony_ci#include <linux/delay.h>
1762306a36Sopenharmony_ci#include <linux/device.h>
1862306a36Sopenharmony_ci#include <linux/gpio/consumer.h>
1962306a36Sopenharmony_ci#include <linux/of.h>
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_ci#include <linux/spi/spi.h>
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci#define DRV_VERSION		"0.1.1"
2462306a36Sopenharmony_ci#define DRV_DESC		"Micrel KS8995 Ethernet switch SPI driver"
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci/* ------------------------------------------------------------------------ */
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_ci#define KS8995_REG_ID0		0x00    /* Chip ID0 */
2962306a36Sopenharmony_ci#define KS8995_REG_ID1		0x01    /* Chip ID1 */
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_ci#define KS8995_REG_GC0		0x02    /* Global Control 0 */
3262306a36Sopenharmony_ci#define KS8995_REG_GC1		0x03    /* Global Control 1 */
3362306a36Sopenharmony_ci#define KS8995_REG_GC2		0x04    /* Global Control 2 */
3462306a36Sopenharmony_ci#define KS8995_REG_GC3		0x05    /* Global Control 3 */
3562306a36Sopenharmony_ci#define KS8995_REG_GC4		0x06    /* Global Control 4 */
3662306a36Sopenharmony_ci#define KS8995_REG_GC5		0x07    /* Global Control 5 */
3762306a36Sopenharmony_ci#define KS8995_REG_GC6		0x08    /* Global Control 6 */
3862306a36Sopenharmony_ci#define KS8995_REG_GC7		0x09    /* Global Control 7 */
3962306a36Sopenharmony_ci#define KS8995_REG_GC8		0x0a    /* Global Control 8 */
4062306a36Sopenharmony_ci#define KS8995_REG_GC9		0x0b    /* Global Control 9 */
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ci#define KS8995_REG_PC(p, r)	((0x10 * p) + r)	 /* Port Control */
4362306a36Sopenharmony_ci#define KS8995_REG_PS(p, r)	((0x10 * p) + r + 0xe)  /* Port Status */
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_ci#define KS8995_REG_TPC0		0x60    /* TOS Priority Control 0 */
4662306a36Sopenharmony_ci#define KS8995_REG_TPC1		0x61    /* TOS Priority Control 1 */
4762306a36Sopenharmony_ci#define KS8995_REG_TPC2		0x62    /* TOS Priority Control 2 */
4862306a36Sopenharmony_ci#define KS8995_REG_TPC3		0x63    /* TOS Priority Control 3 */
4962306a36Sopenharmony_ci#define KS8995_REG_TPC4		0x64    /* TOS Priority Control 4 */
5062306a36Sopenharmony_ci#define KS8995_REG_TPC5		0x65    /* TOS Priority Control 5 */
5162306a36Sopenharmony_ci#define KS8995_REG_TPC6		0x66    /* TOS Priority Control 6 */
5262306a36Sopenharmony_ci#define KS8995_REG_TPC7		0x67    /* TOS Priority Control 7 */
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_ci#define KS8995_REG_MAC0		0x68    /* MAC address 0 */
5562306a36Sopenharmony_ci#define KS8995_REG_MAC1		0x69    /* MAC address 1 */
5662306a36Sopenharmony_ci#define KS8995_REG_MAC2		0x6a    /* MAC address 2 */
5762306a36Sopenharmony_ci#define KS8995_REG_MAC3		0x6b    /* MAC address 3 */
5862306a36Sopenharmony_ci#define KS8995_REG_MAC4		0x6c    /* MAC address 4 */
5962306a36Sopenharmony_ci#define KS8995_REG_MAC5		0x6d    /* MAC address 5 */
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_ci#define KS8995_REG_IAC0		0x6e    /* Indirect Access Control 0 */
6262306a36Sopenharmony_ci#define KS8995_REG_IAC1		0x6f    /* Indirect Access Control 0 */
6362306a36Sopenharmony_ci#define KS8995_REG_IAD7		0x70    /* Indirect Access Data 7 */
6462306a36Sopenharmony_ci#define KS8995_REG_IAD6		0x71    /* Indirect Access Data 6 */
6562306a36Sopenharmony_ci#define KS8995_REG_IAD5		0x72    /* Indirect Access Data 5 */
6662306a36Sopenharmony_ci#define KS8995_REG_IAD4		0x73    /* Indirect Access Data 4 */
6762306a36Sopenharmony_ci#define KS8995_REG_IAD3		0x74    /* Indirect Access Data 3 */
6862306a36Sopenharmony_ci#define KS8995_REG_IAD2		0x75    /* Indirect Access Data 2 */
6962306a36Sopenharmony_ci#define KS8995_REG_IAD1		0x76    /* Indirect Access Data 1 */
7062306a36Sopenharmony_ci#define KS8995_REG_IAD0		0x77    /* Indirect Access Data 0 */
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_ci#define KSZ8864_REG_ID1		0xfe	/* Chip ID in bit 7 */
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_ci#define KS8995_REGS_SIZE	0x80
7562306a36Sopenharmony_ci#define KSZ8864_REGS_SIZE	0x100
7662306a36Sopenharmony_ci#define KSZ8795_REGS_SIZE	0x100
7762306a36Sopenharmony_ci
7862306a36Sopenharmony_ci#define ID1_CHIPID_M		0xf
7962306a36Sopenharmony_ci#define ID1_CHIPID_S		4
8062306a36Sopenharmony_ci#define ID1_REVISION_M		0x7
8162306a36Sopenharmony_ci#define ID1_REVISION_S		1
8262306a36Sopenharmony_ci#define ID1_START_SW		1	/* start the switch */
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci#define FAMILY_KS8995		0x95
8562306a36Sopenharmony_ci#define FAMILY_KSZ8795		0x87
8662306a36Sopenharmony_ci#define CHIPID_M		0
8762306a36Sopenharmony_ci#define KS8995_CHIP_ID		0x00
8862306a36Sopenharmony_ci#define KSZ8864_CHIP_ID		0x01
8962306a36Sopenharmony_ci#define KSZ8795_CHIP_ID		0x09
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_ci#define KS8995_CMD_WRITE	0x02U
9262306a36Sopenharmony_ci#define KS8995_CMD_READ		0x03U
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ci#define KS8995_RESET_DELAY	10 /* usec */
9562306a36Sopenharmony_ci
9662306a36Sopenharmony_cienum ks8995_chip_variant {
9762306a36Sopenharmony_ci	ks8995,
9862306a36Sopenharmony_ci	ksz8864,
9962306a36Sopenharmony_ci	ksz8795,
10062306a36Sopenharmony_ci	max_variant
10162306a36Sopenharmony_ci};
10262306a36Sopenharmony_ci
10362306a36Sopenharmony_cistruct ks8995_chip_params {
10462306a36Sopenharmony_ci	char *name;
10562306a36Sopenharmony_ci	int family_id;
10662306a36Sopenharmony_ci	int chip_id;
10762306a36Sopenharmony_ci	int regs_size;
10862306a36Sopenharmony_ci	int addr_width;
10962306a36Sopenharmony_ci	int addr_shift;
11062306a36Sopenharmony_ci};
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_cistatic const struct ks8995_chip_params ks8995_chip[] = {
11362306a36Sopenharmony_ci	[ks8995] = {
11462306a36Sopenharmony_ci		.name = "KS8995MA",
11562306a36Sopenharmony_ci		.family_id = FAMILY_KS8995,
11662306a36Sopenharmony_ci		.chip_id = KS8995_CHIP_ID,
11762306a36Sopenharmony_ci		.regs_size = KS8995_REGS_SIZE,
11862306a36Sopenharmony_ci		.addr_width = 8,
11962306a36Sopenharmony_ci		.addr_shift = 0,
12062306a36Sopenharmony_ci	},
12162306a36Sopenharmony_ci	[ksz8864] = {
12262306a36Sopenharmony_ci		.name = "KSZ8864RMN",
12362306a36Sopenharmony_ci		.family_id = FAMILY_KS8995,
12462306a36Sopenharmony_ci		.chip_id = KSZ8864_CHIP_ID,
12562306a36Sopenharmony_ci		.regs_size = KSZ8864_REGS_SIZE,
12662306a36Sopenharmony_ci		.addr_width = 8,
12762306a36Sopenharmony_ci		.addr_shift = 0,
12862306a36Sopenharmony_ci	},
12962306a36Sopenharmony_ci	[ksz8795] = {
13062306a36Sopenharmony_ci		.name = "KSZ8795CLX",
13162306a36Sopenharmony_ci		.family_id = FAMILY_KSZ8795,
13262306a36Sopenharmony_ci		.chip_id = KSZ8795_CHIP_ID,
13362306a36Sopenharmony_ci		.regs_size = KSZ8795_REGS_SIZE,
13462306a36Sopenharmony_ci		.addr_width = 12,
13562306a36Sopenharmony_ci		.addr_shift = 1,
13662306a36Sopenharmony_ci	},
13762306a36Sopenharmony_ci};
13862306a36Sopenharmony_ci
13962306a36Sopenharmony_cistruct ks8995_switch {
14062306a36Sopenharmony_ci	struct spi_device	*spi;
14162306a36Sopenharmony_ci	struct mutex		lock;
14262306a36Sopenharmony_ci	struct gpio_desc	*reset_gpio;
14362306a36Sopenharmony_ci	struct bin_attribute	regs_attr;
14462306a36Sopenharmony_ci	const struct ks8995_chip_params	*chip;
14562306a36Sopenharmony_ci	int			revision_id;
14662306a36Sopenharmony_ci};
14762306a36Sopenharmony_ci
14862306a36Sopenharmony_cistatic const struct spi_device_id ks8995_id[] = {
14962306a36Sopenharmony_ci	{"ks8995", ks8995},
15062306a36Sopenharmony_ci	{"ksz8864", ksz8864},
15162306a36Sopenharmony_ci	{"ksz8795", ksz8795},
15262306a36Sopenharmony_ci	{ }
15362306a36Sopenharmony_ci};
15462306a36Sopenharmony_ciMODULE_DEVICE_TABLE(spi, ks8995_id);
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_cistatic const struct of_device_id ks8895_spi_of_match[] = {
15762306a36Sopenharmony_ci	{ .compatible = "micrel,ks8995" },
15862306a36Sopenharmony_ci	{ .compatible = "micrel,ksz8864" },
15962306a36Sopenharmony_ci	{ .compatible = "micrel,ksz8795" },
16062306a36Sopenharmony_ci	{ },
16162306a36Sopenharmony_ci};
16262306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, ks8895_spi_of_match);
16362306a36Sopenharmony_ci
16462306a36Sopenharmony_cistatic inline u8 get_chip_id(u8 val)
16562306a36Sopenharmony_ci{
16662306a36Sopenharmony_ci	return (val >> ID1_CHIPID_S) & ID1_CHIPID_M;
16762306a36Sopenharmony_ci}
16862306a36Sopenharmony_ci
16962306a36Sopenharmony_cistatic inline u8 get_chip_rev(u8 val)
17062306a36Sopenharmony_ci{
17162306a36Sopenharmony_ci	return (val >> ID1_REVISION_S) & ID1_REVISION_M;
17262306a36Sopenharmony_ci}
17362306a36Sopenharmony_ci
17462306a36Sopenharmony_ci/* create_spi_cmd - create a chip specific SPI command header
17562306a36Sopenharmony_ci * @ks: pointer to switch instance
17662306a36Sopenharmony_ci * @cmd: SPI command for switch
17762306a36Sopenharmony_ci * @address: register address for command
17862306a36Sopenharmony_ci *
17962306a36Sopenharmony_ci * Different chip families use different bit pattern to address the switches
18062306a36Sopenharmony_ci * registers:
18162306a36Sopenharmony_ci *
18262306a36Sopenharmony_ci * KS8995: 8bit command + 8bit address
18362306a36Sopenharmony_ci * KSZ8795: 3bit command + 12bit address + 1bit TR (?)
18462306a36Sopenharmony_ci */
18562306a36Sopenharmony_cistatic inline __be16 create_spi_cmd(struct ks8995_switch *ks, int cmd,
18662306a36Sopenharmony_ci				    unsigned address)
18762306a36Sopenharmony_ci{
18862306a36Sopenharmony_ci	u16 result = cmd;
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_ci	/* make room for address (incl. address shift) */
19162306a36Sopenharmony_ci	result <<= ks->chip->addr_width + ks->chip->addr_shift;
19262306a36Sopenharmony_ci	/* add address */
19362306a36Sopenharmony_ci	result |= address << ks->chip->addr_shift;
19462306a36Sopenharmony_ci	/* SPI protocol needs big endian */
19562306a36Sopenharmony_ci	return cpu_to_be16(result);
19662306a36Sopenharmony_ci}
19762306a36Sopenharmony_ci/* ------------------------------------------------------------------------ */
19862306a36Sopenharmony_cistatic int ks8995_read(struct ks8995_switch *ks, char *buf,
19962306a36Sopenharmony_ci		 unsigned offset, size_t count)
20062306a36Sopenharmony_ci{
20162306a36Sopenharmony_ci	__be16 cmd;
20262306a36Sopenharmony_ci	struct spi_transfer t[2];
20362306a36Sopenharmony_ci	struct spi_message m;
20462306a36Sopenharmony_ci	int err;
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_ci	cmd = create_spi_cmd(ks, KS8995_CMD_READ, offset);
20762306a36Sopenharmony_ci	spi_message_init(&m);
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_ci	memset(&t, 0, sizeof(t));
21062306a36Sopenharmony_ci
21162306a36Sopenharmony_ci	t[0].tx_buf = &cmd;
21262306a36Sopenharmony_ci	t[0].len = sizeof(cmd);
21362306a36Sopenharmony_ci	spi_message_add_tail(&t[0], &m);
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci	t[1].rx_buf = buf;
21662306a36Sopenharmony_ci	t[1].len = count;
21762306a36Sopenharmony_ci	spi_message_add_tail(&t[1], &m);
21862306a36Sopenharmony_ci
21962306a36Sopenharmony_ci	mutex_lock(&ks->lock);
22062306a36Sopenharmony_ci	err = spi_sync(ks->spi, &m);
22162306a36Sopenharmony_ci	mutex_unlock(&ks->lock);
22262306a36Sopenharmony_ci
22362306a36Sopenharmony_ci	return err ? err : count;
22462306a36Sopenharmony_ci}
22562306a36Sopenharmony_ci
22662306a36Sopenharmony_cistatic int ks8995_write(struct ks8995_switch *ks, char *buf,
22762306a36Sopenharmony_ci		 unsigned offset, size_t count)
22862306a36Sopenharmony_ci{
22962306a36Sopenharmony_ci	__be16 cmd;
23062306a36Sopenharmony_ci	struct spi_transfer t[2];
23162306a36Sopenharmony_ci	struct spi_message m;
23262306a36Sopenharmony_ci	int err;
23362306a36Sopenharmony_ci
23462306a36Sopenharmony_ci	cmd = create_spi_cmd(ks, KS8995_CMD_WRITE, offset);
23562306a36Sopenharmony_ci	spi_message_init(&m);
23662306a36Sopenharmony_ci
23762306a36Sopenharmony_ci	memset(&t, 0, sizeof(t));
23862306a36Sopenharmony_ci
23962306a36Sopenharmony_ci	t[0].tx_buf = &cmd;
24062306a36Sopenharmony_ci	t[0].len = sizeof(cmd);
24162306a36Sopenharmony_ci	spi_message_add_tail(&t[0], &m);
24262306a36Sopenharmony_ci
24362306a36Sopenharmony_ci	t[1].tx_buf = buf;
24462306a36Sopenharmony_ci	t[1].len = count;
24562306a36Sopenharmony_ci	spi_message_add_tail(&t[1], &m);
24662306a36Sopenharmony_ci
24762306a36Sopenharmony_ci	mutex_lock(&ks->lock);
24862306a36Sopenharmony_ci	err = spi_sync(ks->spi, &m);
24962306a36Sopenharmony_ci	mutex_unlock(&ks->lock);
25062306a36Sopenharmony_ci
25162306a36Sopenharmony_ci	return err ? err : count;
25262306a36Sopenharmony_ci}
25362306a36Sopenharmony_ci
25462306a36Sopenharmony_cistatic inline int ks8995_read_reg(struct ks8995_switch *ks, u8 addr, u8 *buf)
25562306a36Sopenharmony_ci{
25662306a36Sopenharmony_ci	return ks8995_read(ks, buf, addr, 1) != 1;
25762306a36Sopenharmony_ci}
25862306a36Sopenharmony_ci
25962306a36Sopenharmony_cistatic inline int ks8995_write_reg(struct ks8995_switch *ks, u8 addr, u8 val)
26062306a36Sopenharmony_ci{
26162306a36Sopenharmony_ci	char buf = val;
26262306a36Sopenharmony_ci
26362306a36Sopenharmony_ci	return ks8995_write(ks, &buf, addr, 1) != 1;
26462306a36Sopenharmony_ci}
26562306a36Sopenharmony_ci
26662306a36Sopenharmony_ci/* ------------------------------------------------------------------------ */
26762306a36Sopenharmony_ci
26862306a36Sopenharmony_cistatic int ks8995_stop(struct ks8995_switch *ks)
26962306a36Sopenharmony_ci{
27062306a36Sopenharmony_ci	return ks8995_write_reg(ks, KS8995_REG_ID1, 0);
27162306a36Sopenharmony_ci}
27262306a36Sopenharmony_ci
27362306a36Sopenharmony_cistatic int ks8995_start(struct ks8995_switch *ks)
27462306a36Sopenharmony_ci{
27562306a36Sopenharmony_ci	return ks8995_write_reg(ks, KS8995_REG_ID1, 1);
27662306a36Sopenharmony_ci}
27762306a36Sopenharmony_ci
27862306a36Sopenharmony_cistatic int ks8995_reset(struct ks8995_switch *ks)
27962306a36Sopenharmony_ci{
28062306a36Sopenharmony_ci	int err;
28162306a36Sopenharmony_ci
28262306a36Sopenharmony_ci	err = ks8995_stop(ks);
28362306a36Sopenharmony_ci	if (err)
28462306a36Sopenharmony_ci		return err;
28562306a36Sopenharmony_ci
28662306a36Sopenharmony_ci	udelay(KS8995_RESET_DELAY);
28762306a36Sopenharmony_ci
28862306a36Sopenharmony_ci	return ks8995_start(ks);
28962306a36Sopenharmony_ci}
29062306a36Sopenharmony_ci
29162306a36Sopenharmony_cistatic ssize_t ks8995_registers_read(struct file *filp, struct kobject *kobj,
29262306a36Sopenharmony_ci	struct bin_attribute *bin_attr, char *buf, loff_t off, size_t count)
29362306a36Sopenharmony_ci{
29462306a36Sopenharmony_ci	struct device *dev;
29562306a36Sopenharmony_ci	struct ks8995_switch *ks8995;
29662306a36Sopenharmony_ci
29762306a36Sopenharmony_ci	dev = kobj_to_dev(kobj);
29862306a36Sopenharmony_ci	ks8995 = dev_get_drvdata(dev);
29962306a36Sopenharmony_ci
30062306a36Sopenharmony_ci	return ks8995_read(ks8995, buf, off, count);
30162306a36Sopenharmony_ci}
30262306a36Sopenharmony_ci
30362306a36Sopenharmony_cistatic ssize_t ks8995_registers_write(struct file *filp, struct kobject *kobj,
30462306a36Sopenharmony_ci	struct bin_attribute *bin_attr, char *buf, loff_t off, size_t count)
30562306a36Sopenharmony_ci{
30662306a36Sopenharmony_ci	struct device *dev;
30762306a36Sopenharmony_ci	struct ks8995_switch *ks8995;
30862306a36Sopenharmony_ci
30962306a36Sopenharmony_ci	dev = kobj_to_dev(kobj);
31062306a36Sopenharmony_ci	ks8995 = dev_get_drvdata(dev);
31162306a36Sopenharmony_ci
31262306a36Sopenharmony_ci	return ks8995_write(ks8995, buf, off, count);
31362306a36Sopenharmony_ci}
31462306a36Sopenharmony_ci
31562306a36Sopenharmony_ci/* ks8995_get_revision - get chip revision
31662306a36Sopenharmony_ci * @ks: pointer to switch instance
31762306a36Sopenharmony_ci *
31862306a36Sopenharmony_ci * Verify chip family and id and get chip revision.
31962306a36Sopenharmony_ci */
32062306a36Sopenharmony_cistatic int ks8995_get_revision(struct ks8995_switch *ks)
32162306a36Sopenharmony_ci{
32262306a36Sopenharmony_ci	int err;
32362306a36Sopenharmony_ci	u8 id0, id1, ksz8864_id;
32462306a36Sopenharmony_ci
32562306a36Sopenharmony_ci	/* read family id */
32662306a36Sopenharmony_ci	err = ks8995_read_reg(ks, KS8995_REG_ID0, &id0);
32762306a36Sopenharmony_ci	if (err) {
32862306a36Sopenharmony_ci		err = -EIO;
32962306a36Sopenharmony_ci		goto err_out;
33062306a36Sopenharmony_ci	}
33162306a36Sopenharmony_ci
33262306a36Sopenharmony_ci	/* verify family id */
33362306a36Sopenharmony_ci	if (id0 != ks->chip->family_id) {
33462306a36Sopenharmony_ci		dev_err(&ks->spi->dev, "chip family id mismatch: expected 0x%02x but 0x%02x read\n",
33562306a36Sopenharmony_ci			ks->chip->family_id, id0);
33662306a36Sopenharmony_ci		err = -ENODEV;
33762306a36Sopenharmony_ci		goto err_out;
33862306a36Sopenharmony_ci	}
33962306a36Sopenharmony_ci
34062306a36Sopenharmony_ci	switch (ks->chip->family_id) {
34162306a36Sopenharmony_ci	case FAMILY_KS8995:
34262306a36Sopenharmony_ci		/* try reading chip id at CHIP ID1 */
34362306a36Sopenharmony_ci		err = ks8995_read_reg(ks, KS8995_REG_ID1, &id1);
34462306a36Sopenharmony_ci		if (err) {
34562306a36Sopenharmony_ci			err = -EIO;
34662306a36Sopenharmony_ci			goto err_out;
34762306a36Sopenharmony_ci		}
34862306a36Sopenharmony_ci
34962306a36Sopenharmony_ci		/* verify chip id */
35062306a36Sopenharmony_ci		if ((get_chip_id(id1) == CHIPID_M) &&
35162306a36Sopenharmony_ci		    (get_chip_id(id1) == ks->chip->chip_id)) {
35262306a36Sopenharmony_ci			/* KS8995MA */
35362306a36Sopenharmony_ci			ks->revision_id = get_chip_rev(id1);
35462306a36Sopenharmony_ci		} else if (get_chip_id(id1) != CHIPID_M) {
35562306a36Sopenharmony_ci			/* KSZ8864RMN */
35662306a36Sopenharmony_ci			err = ks8995_read_reg(ks, KS8995_REG_ID1, &ksz8864_id);
35762306a36Sopenharmony_ci			if (err) {
35862306a36Sopenharmony_ci				err = -EIO;
35962306a36Sopenharmony_ci				goto err_out;
36062306a36Sopenharmony_ci			}
36162306a36Sopenharmony_ci
36262306a36Sopenharmony_ci			if ((ksz8864_id & 0x80) &&
36362306a36Sopenharmony_ci			    (ks->chip->chip_id == KSZ8864_CHIP_ID)) {
36462306a36Sopenharmony_ci				ks->revision_id = get_chip_rev(id1);
36562306a36Sopenharmony_ci			}
36662306a36Sopenharmony_ci
36762306a36Sopenharmony_ci		} else {
36862306a36Sopenharmony_ci			dev_err(&ks->spi->dev, "unsupported chip id for KS8995 family: 0x%02x\n",
36962306a36Sopenharmony_ci				id1);
37062306a36Sopenharmony_ci			err = -ENODEV;
37162306a36Sopenharmony_ci		}
37262306a36Sopenharmony_ci		break;
37362306a36Sopenharmony_ci	case FAMILY_KSZ8795:
37462306a36Sopenharmony_ci		/* try reading chip id at CHIP ID1 */
37562306a36Sopenharmony_ci		err = ks8995_read_reg(ks, KS8995_REG_ID1, &id1);
37662306a36Sopenharmony_ci		if (err) {
37762306a36Sopenharmony_ci			err = -EIO;
37862306a36Sopenharmony_ci			goto err_out;
37962306a36Sopenharmony_ci		}
38062306a36Sopenharmony_ci
38162306a36Sopenharmony_ci		if (get_chip_id(id1) == ks->chip->chip_id) {
38262306a36Sopenharmony_ci			ks->revision_id = get_chip_rev(id1);
38362306a36Sopenharmony_ci		} else {
38462306a36Sopenharmony_ci			dev_err(&ks->spi->dev, "unsupported chip id for KSZ8795 family: 0x%02x\n",
38562306a36Sopenharmony_ci				id1);
38662306a36Sopenharmony_ci			err = -ENODEV;
38762306a36Sopenharmony_ci		}
38862306a36Sopenharmony_ci		break;
38962306a36Sopenharmony_ci	default:
39062306a36Sopenharmony_ci		dev_err(&ks->spi->dev, "unsupported family id: 0x%02x\n", id0);
39162306a36Sopenharmony_ci		err = -ENODEV;
39262306a36Sopenharmony_ci		break;
39362306a36Sopenharmony_ci	}
39462306a36Sopenharmony_cierr_out:
39562306a36Sopenharmony_ci	return err;
39662306a36Sopenharmony_ci}
39762306a36Sopenharmony_ci
39862306a36Sopenharmony_cistatic const struct bin_attribute ks8995_registers_attr = {
39962306a36Sopenharmony_ci	.attr = {
40062306a36Sopenharmony_ci		.name   = "registers",
40162306a36Sopenharmony_ci		.mode   = 0600,
40262306a36Sopenharmony_ci	},
40362306a36Sopenharmony_ci	.size   = KS8995_REGS_SIZE,
40462306a36Sopenharmony_ci	.read   = ks8995_registers_read,
40562306a36Sopenharmony_ci	.write  = ks8995_registers_write,
40662306a36Sopenharmony_ci};
40762306a36Sopenharmony_ci
40862306a36Sopenharmony_ci/* ------------------------------------------------------------------------ */
40962306a36Sopenharmony_cistatic int ks8995_probe(struct spi_device *spi)
41062306a36Sopenharmony_ci{
41162306a36Sopenharmony_ci	struct ks8995_switch *ks;
41262306a36Sopenharmony_ci	int err;
41362306a36Sopenharmony_ci	int variant = spi_get_device_id(spi)->driver_data;
41462306a36Sopenharmony_ci
41562306a36Sopenharmony_ci	if (variant >= max_variant) {
41662306a36Sopenharmony_ci		dev_err(&spi->dev, "bad chip variant %d\n", variant);
41762306a36Sopenharmony_ci		return -ENODEV;
41862306a36Sopenharmony_ci	}
41962306a36Sopenharmony_ci
42062306a36Sopenharmony_ci	ks = devm_kzalloc(&spi->dev, sizeof(*ks), GFP_KERNEL);
42162306a36Sopenharmony_ci	if (!ks)
42262306a36Sopenharmony_ci		return -ENOMEM;
42362306a36Sopenharmony_ci
42462306a36Sopenharmony_ci	mutex_init(&ks->lock);
42562306a36Sopenharmony_ci	ks->spi = spi;
42662306a36Sopenharmony_ci	ks->chip = &ks8995_chip[variant];
42762306a36Sopenharmony_ci
42862306a36Sopenharmony_ci	ks->reset_gpio = devm_gpiod_get_optional(&spi->dev, "reset",
42962306a36Sopenharmony_ci						 GPIOD_OUT_HIGH);
43062306a36Sopenharmony_ci	err = PTR_ERR_OR_ZERO(ks->reset_gpio);
43162306a36Sopenharmony_ci	if (err) {
43262306a36Sopenharmony_ci		dev_err(&spi->dev,
43362306a36Sopenharmony_ci			"failed to get reset gpio: %d\n", err);
43462306a36Sopenharmony_ci		return err;
43562306a36Sopenharmony_ci	}
43662306a36Sopenharmony_ci
43762306a36Sopenharmony_ci	err = gpiod_set_consumer_name(ks->reset_gpio, "switch-reset");
43862306a36Sopenharmony_ci	if (err)
43962306a36Sopenharmony_ci		return err;
44062306a36Sopenharmony_ci
44162306a36Sopenharmony_ci	/* de-assert switch reset */
44262306a36Sopenharmony_ci	/* FIXME: this likely requires a delay */
44362306a36Sopenharmony_ci	gpiod_set_value_cansleep(ks->reset_gpio, 0);
44462306a36Sopenharmony_ci
44562306a36Sopenharmony_ci	spi_set_drvdata(spi, ks);
44662306a36Sopenharmony_ci
44762306a36Sopenharmony_ci	spi->mode = SPI_MODE_0;
44862306a36Sopenharmony_ci	spi->bits_per_word = 8;
44962306a36Sopenharmony_ci	err = spi_setup(spi);
45062306a36Sopenharmony_ci	if (err) {
45162306a36Sopenharmony_ci		dev_err(&spi->dev, "spi_setup failed, err=%d\n", err);
45262306a36Sopenharmony_ci		return err;
45362306a36Sopenharmony_ci	}
45462306a36Sopenharmony_ci
45562306a36Sopenharmony_ci	err = ks8995_get_revision(ks);
45662306a36Sopenharmony_ci	if (err)
45762306a36Sopenharmony_ci		return err;
45862306a36Sopenharmony_ci
45962306a36Sopenharmony_ci	memcpy(&ks->regs_attr, &ks8995_registers_attr, sizeof(ks->regs_attr));
46062306a36Sopenharmony_ci	ks->regs_attr.size = ks->chip->regs_size;
46162306a36Sopenharmony_ci
46262306a36Sopenharmony_ci	err = ks8995_reset(ks);
46362306a36Sopenharmony_ci	if (err)
46462306a36Sopenharmony_ci		return err;
46562306a36Sopenharmony_ci
46662306a36Sopenharmony_ci	sysfs_attr_init(&ks->regs_attr.attr);
46762306a36Sopenharmony_ci	err = sysfs_create_bin_file(&spi->dev.kobj, &ks->regs_attr);
46862306a36Sopenharmony_ci	if (err) {
46962306a36Sopenharmony_ci		dev_err(&spi->dev, "unable to create sysfs file, err=%d\n",
47062306a36Sopenharmony_ci				    err);
47162306a36Sopenharmony_ci		return err;
47262306a36Sopenharmony_ci	}
47362306a36Sopenharmony_ci
47462306a36Sopenharmony_ci	dev_info(&spi->dev, "%s device found, Chip ID:%x, Revision:%x\n",
47562306a36Sopenharmony_ci		 ks->chip->name, ks->chip->chip_id, ks->revision_id);
47662306a36Sopenharmony_ci
47762306a36Sopenharmony_ci	return 0;
47862306a36Sopenharmony_ci}
47962306a36Sopenharmony_ci
48062306a36Sopenharmony_cistatic void ks8995_remove(struct spi_device *spi)
48162306a36Sopenharmony_ci{
48262306a36Sopenharmony_ci	struct ks8995_switch *ks = spi_get_drvdata(spi);
48362306a36Sopenharmony_ci
48462306a36Sopenharmony_ci	sysfs_remove_bin_file(&spi->dev.kobj, &ks->regs_attr);
48562306a36Sopenharmony_ci
48662306a36Sopenharmony_ci	/* assert reset */
48762306a36Sopenharmony_ci	gpiod_set_value_cansleep(ks->reset_gpio, 1);
48862306a36Sopenharmony_ci}
48962306a36Sopenharmony_ci
49062306a36Sopenharmony_ci/* ------------------------------------------------------------------------ */
49162306a36Sopenharmony_cistatic struct spi_driver ks8995_driver = {
49262306a36Sopenharmony_ci	.driver = {
49362306a36Sopenharmony_ci		.name	    = "spi-ks8995",
49462306a36Sopenharmony_ci		.of_match_table = ks8895_spi_of_match,
49562306a36Sopenharmony_ci	},
49662306a36Sopenharmony_ci	.probe	  = ks8995_probe,
49762306a36Sopenharmony_ci	.remove	  = ks8995_remove,
49862306a36Sopenharmony_ci	.id_table = ks8995_id,
49962306a36Sopenharmony_ci};
50062306a36Sopenharmony_ci
50162306a36Sopenharmony_cimodule_spi_driver(ks8995_driver);
50262306a36Sopenharmony_ci
50362306a36Sopenharmony_ciMODULE_DESCRIPTION(DRV_DESC);
50462306a36Sopenharmony_ciMODULE_VERSION(DRV_VERSION);
50562306a36Sopenharmony_ciMODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>");
50662306a36Sopenharmony_ciMODULE_LICENSE("GPL v2");
507