kernel: switch to upstream
This driver is upstream since 2012 (commit: a8e510f682f), so switch to it and remove own sources. Also place it under "Network Devices" menu together with other phy drivers. Signed-off-by: Sergey Ryazanov <ryazanov.s.a@gmail.com> SVN-Revision: 45269
This commit is contained in:
		| @@ -810,3 +810,20 @@ define KernelPackage/vmxnet3/description | |||||||
| endef | endef | ||||||
|  |  | ||||||
| $(eval $(call KernelPackage,vmxnet3)) | $(eval $(call KernelPackage,vmxnet3)) | ||||||
|  |  | ||||||
|  |  | ||||||
|  | define KernelPackage/spi-ks8995 | ||||||
|  |   SUBMENU:=$(NETWORK_DEVICES_MENU) | ||||||
|  |   TITLE:=Micrel/Kendin KS8995 Ethernet switch control | ||||||
|  |   FILES:=$(LINUX_DIR)/drivers/net/phy/spi_ks8995.ko | ||||||
|  |   KCONFIG:=CONFIG_MICREL_KS8995MA \ | ||||||
|  | 	CONFIG_SPI=y \ | ||||||
|  | 	CONFIG_SPI_MASTER=y | ||||||
|  |   AUTOLOAD:=$(call AutoLoad,50,spi_ks8995) | ||||||
|  | endef | ||||||
|  |  | ||||||
|  | define KernelPackage/spi-ks8995/description | ||||||
|  |   Kernel module for Micrel/Kendin KS8995 ethernet switch | ||||||
|  | endef | ||||||
|  |  | ||||||
|  | $(eval $(call KernelPackage,spi-ks8995)) | ||||||
|   | |||||||
| @@ -1,54 +0,0 @@ | |||||||
| # |  | ||||||
| # Copyright (C) 2008 OpenWrt.org |  | ||||||
| # |  | ||||||
| # This is free software, licensed under the GNU General Public License v2. |  | ||||||
| # See /LICENSE for more information. |  | ||||||
| # |  | ||||||
|  |  | ||||||
| include $(TOPDIR)/rules.mk |  | ||||||
| include $(INCLUDE_DIR)/kernel.mk |  | ||||||
|  |  | ||||||
| PKG_NAME:=spi-ks8995 |  | ||||||
| PKG_RELEASE:=1 |  | ||||||
|  |  | ||||||
| include $(INCLUDE_DIR)/package.mk |  | ||||||
|  |  | ||||||
| define KernelPackage/spi-ks8995 |  | ||||||
|   SUBMENU:=SPI Support |  | ||||||
|   TITLE:=Micrel/Kendin KS8995 Ethernet switch control |  | ||||||
|   FILES:=$(PKG_BUILD_DIR)/spi_ks8995.ko |  | ||||||
|   KCONFIG:=CONFIG_SPI=y \ |  | ||||||
| 	CONFIG_SPI_MASTER=y |  | ||||||
|   AUTOLOAD:=$(call AutoLoad,50,spi_ks8995) |  | ||||||
| endef |  | ||||||
|  |  | ||||||
| define KernelPackage/spi-ks8995/description |  | ||||||
|   Kernel module for Micrel/Kendin KS8995 ethernet switch |  | ||||||
| endef |  | ||||||
|  |  | ||||||
| EXTRA_KCONFIG:= \ |  | ||||||
| 	CONFIG_SPI_KS8995=m |  | ||||||
|  |  | ||||||
| EXTRA_CFLAGS:= \ |  | ||||||
| 	$(patsubst CONFIG_%, -DCONFIG_%=1, $(patsubst %=m,%,$(filter %=m,$(EXTRA_KCONFIG)))) \ |  | ||||||
| 	$(patsubst CONFIG_%, -DCONFIG_%=1, $(patsubst %=y,%,$(filter %=y,$(EXTRA_KCONFIG)))) \ |  | ||||||
|  |  | ||||||
| MAKE_OPTS:= \ |  | ||||||
| 	ARCH="$(LINUX_KARCH)" \ |  | ||||||
| 	CROSS_COMPILE="$(TARGET_CROSS)" \ |  | ||||||
| 	SUBDIRS="$(PKG_BUILD_DIR)" \ |  | ||||||
| 	EXTRA_CFLAGS="$(EXTRA_CFLAGS)" \ |  | ||||||
| 	$(EXTRA_KCONFIG) |  | ||||||
|  |  | ||||||
| define Build/Prepare |  | ||||||
| 	mkdir -p $(PKG_BUILD_DIR) |  | ||||||
| 	$(CP) ./src/* $(PKG_BUILD_DIR)/ |  | ||||||
| endef |  | ||||||
|  |  | ||||||
| define Build/Compile |  | ||||||
| 	$(MAKE) -C "$(LINUX_DIR)" \ |  | ||||||
| 		$(MAKE_OPTS) \ |  | ||||||
| 		modules |  | ||||||
| endef |  | ||||||
|  |  | ||||||
| $(eval $(call KernelPackage,spi-ks8995)) |  | ||||||
| @@ -1,3 +0,0 @@ | |||||||
| config SPI_KS8995 |  | ||||||
| 	tristate "Micrel/Kendin KS8995 Ethernet switch" |  | ||||||
| 	depends on SPI |  | ||||||
| @@ -1 +0,0 @@ | |||||||
| obj-${CONFIG_SPI_KS8995}	+= spi_ks8995.o |  | ||||||
| @@ -1,419 +0,0 @@ | |||||||
| /* |  | ||||||
|  * SPI driver for Micrel/Kendin KS8995M ethernet switch |  | ||||||
|  * |  | ||||||
|  * 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. |  | ||||||
|  */ |  | ||||||
|  |  | ||||||
| #include <linux/types.h> |  | ||||||
| #include <linux/kernel.h> |  | ||||||
| #include <linux/init.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/Kendin 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 KS8995_REGS_SIZE	0x80 |  | ||||||
|  |  | ||||||
| #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; |  | ||||||
| }; |  | ||||||
|  |  | ||||||
| /*-------------------------------------------------------------------------*/ |  | ||||||
|  |  | ||||||
| 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); |  | ||||||
| } |  | ||||||
|  |  | ||||||
| /*-------------------------------------------------------------------------*/ |  | ||||||
|  |  | ||||||
| #if 0 |  | ||||||
| static int ks8995_setup(struct spi_device *spi) |  | ||||||
| { |  | ||||||
| 	struct ks8995_switch *ks; |  | ||||||
| 	u8 t; |  | ||||||
|  |  | ||||||
| 	ks = dev_get_drvdata(&spi->dev); |  | ||||||
|  |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_GC0, 0x4c); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_GC1, 0x05); |  | ||||||
|  |  | ||||||
| 	ks8995_read_reg(ks, KS8995_REG_GC2, &t); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_GC2, t | 1); |  | ||||||
|  |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_GC4, 0x20); |  | ||||||
|  |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_PC(1,0), 0x61); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_PC(2,0), 0x61); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_PC(3,0), 0x61); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_PC(4,0), 0x61); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_PC(5,0), 0x61); |  | ||||||
|  |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_PC(5,11), 0x18); |  | ||||||
|  |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_TPC0, 0xff); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_TPC1, 0xff); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_TPC2, 0xff); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_TPC3, 0xff); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_TPC4, 0xff); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_TPC5, 0xff); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_TPC6, 0xff); |  | ||||||
| 	ks8995_write_reg(ks, KS8995_REG_TPC7, 0xfe); |  | ||||||
|  |  | ||||||
| 	return 0; |  | ||||||
| } |  | ||||||
| #endif |  | ||||||
|  |  | ||||||
| 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 int ks8995_registers_read(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_SIZE)) |  | ||||||
| 		return 0; |  | ||||||
|  |  | ||||||
| 	if ((off + count) > KS8995_REGS_SIZE) |  | ||||||
| 		count = KS8995_REGS_SIZE - off; |  | ||||||
|  |  | ||||||
| 	if (unlikely(!count)) |  | ||||||
| 		return count; |  | ||||||
|  |  | ||||||
| 	return ks8995_read(ks8995, buf, off, count); |  | ||||||
| } |  | ||||||
|  |  | ||||||
|  |  | ||||||
| static int ks8995_registers_write(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_SIZE)) |  | ||||||
| 		return -EFBIG; |  | ||||||
|  |  | ||||||
| 	if ((off + count) > KS8995_REGS_SIZE) |  | ||||||
| 		count = KS8995_REGS_SIZE - off; |  | ||||||
|  |  | ||||||
| 	if (unlikely(!count)) |  | ||||||
| 		return count; |  | ||||||
|  |  | ||||||
| 	return ks8995_write(ks8995, buf, off, count); |  | ||||||
| } |  | ||||||
|  |  | ||||||
|  |  | ||||||
| static 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) { |  | ||||||
| 		dev_err(&spi->dev, "no memory for private data\n"); |  | ||||||
| 		return-ENOMEM; |  | ||||||
| 	} |  | ||||||
|  |  | ||||||
| 	mutex_init(&ks->lock); |  | ||||||
| 	ks->pdata = pdata; |  | ||||||
| 	ks->spi = spi_dev_get(spi); |  | ||||||
| 	dev_set_drvdata(&spi->dev, 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; |  | ||||||
| 	} |  | ||||||
|  |  | ||||||
| 	err = ks8995_reset(ks); |  | ||||||
| 	if (err) |  | ||||||
| 		goto err_drvdata; |  | ||||||
|  |  | ||||||
| 	err = sysfs_create_bin_file(&spi->dev.kobj, &ks8995_registers_attr); |  | ||||||
| 	if (err) { |  | ||||||
| 		dev_err(&spi->dev, "unable to create sysfs file, err=%d\n", |  | ||||||
| 					err); |  | ||||||
| 		goto err_drvdata; |  | ||||||
| 	} |  | ||||||
|  |  | ||||||
| 	dev_info(&spi->dev, "KS89%02X device found, Chip ID:%01x, " |  | ||||||
| 			"Revision:%01x\n", ids[0], |  | ||||||
| 			get_chip_id(ids[1]), get_chip_rev(ids[1])); |  | ||||||
|  |  | ||||||
| 	return 0; |  | ||||||
|  |  | ||||||
| err_drvdata: |  | ||||||
| 	dev_set_drvdata(&spi->dev, NULL); |  | ||||||
| 	kfree(ks); |  | ||||||
| 	return err; |  | ||||||
| } |  | ||||||
|  |  | ||||||
| static int ks8995_remove(struct spi_device *spi) |  | ||||||
| { |  | ||||||
| 	struct ks8995_data	*ks8995; |  | ||||||
|  |  | ||||||
| 	ks8995 = dev_get_drvdata(&spi->dev); |  | ||||||
| 	sysfs_remove_bin_file(&spi->dev.kobj, &ks8995_registers_attr); |  | ||||||
|  |  | ||||||
| 	dev_set_drvdata(&spi->dev, NULL); |  | ||||||
| 	kfree(ks8995); |  | ||||||
|  |  | ||||||
| 	return 0; |  | ||||||
| } |  | ||||||
|  |  | ||||||
| /*-------------------------------------------------------------------------*/ |  | ||||||
|  |  | ||||||
| static struct spi_driver ks8995_driver = { |  | ||||||
| 	.driver = { |  | ||||||
| 		.name		= "spi-ks8995", |  | ||||||
| 		.bus		= &spi_bus_type, |  | ||||||
| 		.owner		= THIS_MODULE, |  | ||||||
| 	}, |  | ||||||
| 	.probe		= ks8995_probe, |  | ||||||
| 	.remove		= ks8995_remove, |  | ||||||
| }; |  | ||||||
|  |  | ||||||
| static int __init ks8995_init(void) |  | ||||||
| { |  | ||||||
| 	printk(KERN_INFO DRV_DESC " version " DRV_VERSION"\n"); |  | ||||||
|  |  | ||||||
| 	return spi_register_driver(&ks8995_driver); |  | ||||||
| } |  | ||||||
| module_init(ks8995_init); |  | ||||||
|  |  | ||||||
| static void __exit ks8995_exit(void) |  | ||||||
| { |  | ||||||
| 	spi_unregister_driver(&ks8995_driver); |  | ||||||
| } |  | ||||||
| module_exit(ks8995_exit); |  | ||||||
|  |  | ||||||
| MODULE_DESCRIPTION(DRV_DESC); |  | ||||||
| MODULE_VERSION(DRV_VERSION); |  | ||||||
| MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>"); |  | ||||||
| MODULE_LICENSE("GPL v2"); |  | ||||||
|  |  | ||||||
		Reference in New Issue
	
	Block a user
	 John Crispin
					John Crispin