mirror of
git://projects.qi-hardware.com/openwrt-xburst.git
synced 2025-04-21 12:27:27 +03:00
migrate gateworks board support to the new at24 eeprom driver
git-svn-id: svn://svn.openwrt.org/openwrt/trunk@13450 3c298f89-4303-0410-b956-a3cf2f4a3e73
This commit is contained in:
@@ -1,6 +1,6 @@
|
||||
--- a/arch/arm/mach-ixp4xx/avila-setup.c
|
||||
+++ b/arch/arm/mach-ixp4xx/avila-setup.c
|
||||
@@ -14,10 +14,18 @@
|
||||
@@ -14,10 +14,16 @@
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/device.h>
|
||||
@@ -11,21 +11,19 @@
|
||||
#include <linux/tty.h>
|
||||
#include <linux/serial_8250.h>
|
||||
#include <linux/slab.h>
|
||||
+#ifdef CONFIG_SENSORS_EEPROM
|
||||
+# include <linux/i2c.h>
|
||||
+# include <linux/eeprom.h>
|
||||
+#endif
|
||||
+#include <linux/i2c.h>
|
||||
+#include <linux/i2c/at24.h>
|
||||
+
|
||||
#include <linux/i2c-gpio.h>
|
||||
|
||||
#include <asm/types.h>
|
||||
@@ -29,6 +37,13 @@
|
||||
@@ -29,6 +35,13 @@
|
||||
#include <asm/mach/arch.h>
|
||||
#include <asm/mach/flash.h>
|
||||
|
||||
+struct avila_board_info {
|
||||
+ unsigned char *model;
|
||||
+ void (* setup)(void);
|
||||
+ void (*setup)(void);
|
||||
+};
|
||||
+
|
||||
+static struct avila_board_info *avila_info __initdata;
|
||||
@@ -33,7 +31,38 @@
|
||||
static struct flash_platform_data avila_flash_data = {
|
||||
.map_name = "cfi_probe",
|
||||
.width = 2,
|
||||
@@ -163,10 +178,160 @@ static struct platform_device *avila_dev
|
||||
@@ -132,16 +145,181 @@ static struct platform_device avila_pata
|
||||
.resource = avila_pata_resources,
|
||||
};
|
||||
|
||||
+/* Built-in 10/100 Ethernet MAC interfaces */
|
||||
+static struct eth_plat_info avila_npeb_data = {
|
||||
+ .phy = 0,
|
||||
+ .rxq = 3,
|
||||
+ .txreadyq = 20,
|
||||
+};
|
||||
+
|
||||
+static struct eth_plat_info avila_npec_data = {
|
||||
+ .phy = 1,
|
||||
+ .rxq = 4,
|
||||
+ .txreadyq = 21,
|
||||
+};
|
||||
+
|
||||
+static struct platform_device avila_npeb_device = {
|
||||
+ .name = "ixp4xx_eth",
|
||||
+ .id = IXP4XX_ETH_NPEB,
|
||||
+ .dev.platform_data = &avila_npeb_data,
|
||||
+};
|
||||
+
|
||||
+static struct platform_device avila_npec_device = {
|
||||
+ .name = "ixp4xx_eth",
|
||||
+ .id = IXP4XX_ETH_NPEC,
|
||||
+ .dev.platform_data = &avila_npec_data,
|
||||
+};
|
||||
+
|
||||
static struct platform_device *avila_devices[] __initdata = {
|
||||
&avila_i2c_gpio,
|
||||
&avila_flash,
|
||||
&avila_uart
|
||||
};
|
||||
|
||||
@@ -43,7 +72,6 @@
|
||||
+ platform_device_register(&avila_npec_device);
|
||||
+}
|
||||
+
|
||||
+#ifdef CONFIG_SENSORS_EEPROM
|
||||
+static void __init avila_gw2342_setup(void)
|
||||
+{
|
||||
+ platform_device_register(&avila_npeb_device);
|
||||
@@ -122,66 +150,57 @@
|
||||
+
|
||||
+ for (i = 0; i < ARRAY_SIZE(avila_boards); i++) {
|
||||
+ struct avila_board_info *info = &avila_boards[i];
|
||||
+ if (strncmp(info->model, model, strlen(info->model)) == 0)
|
||||
+ if (strcmp(info->model, model) == 0)
|
||||
+ return info;
|
||||
+ }
|
||||
+
|
||||
+ return NULL;
|
||||
+}
|
||||
+
|
||||
+struct avila_eeprom_header {
|
||||
+ unsigned char mac0[ETH_ALEN];
|
||||
+ unsigned char mac1[ETH_ALEN];
|
||||
+ unsigned char res0[4];
|
||||
+ unsigned char magic[2];
|
||||
+ unsigned char config[14];
|
||||
+ unsigned char model[16];
|
||||
+static struct at24_iface *at24_if;
|
||||
+
|
||||
+static int at24_setup(struct at24_iface *iface, void *context)
|
||||
+{
|
||||
+ char mac_addr[ETH_ALEN];
|
||||
+ char model[6];
|
||||
+
|
||||
+ at24_if = iface;
|
||||
+
|
||||
+ /* Read MAC addresses */
|
||||
+ if (at24_if->read(at24_if, mac_addr, 0x0, 6) == 6) {
|
||||
+ memcpy(&avila_npeb_data.hwaddr, mac_addr, ETH_ALEN);
|
||||
+ }
|
||||
+ if (at24_if->read(at24_if, mac_addr, 0x6, 6) == 6) {
|
||||
+ memcpy(&avila_npec_data.hwaddr, mac_addr, ETH_ALEN);
|
||||
+ }
|
||||
+
|
||||
+ /* Read the first 6 bytes of the model number */
|
||||
+ if (at24_if->read(at24_if, model, 0x20, 6) == 6) {
|
||||
+ avila_info = avila_find_board_info(model);
|
||||
+ }
|
||||
+
|
||||
+ return 0;
|
||||
+}
|
||||
+
|
||||
+static struct at24_platform_data avila_eeprom_info = {
|
||||
+ .byte_len = 1024,
|
||||
+ .page_size = 16,
|
||||
+ .flags = AT24_FLAG_READONLY,
|
||||
+ .setup = at24_setup,
|
||||
+};
|
||||
+
|
||||
+static int __init avila_eeprom_notify(struct notifier_block *self,
|
||||
+ unsigned long event, void *t)
|
||||
+{
|
||||
+ struct eeprom_data *ee = t;
|
||||
+ struct avila_eeprom_header hdr;
|
||||
+
|
||||
+ if (avila_info)
|
||||
+ return NOTIFY_DONE;
|
||||
+
|
||||
+ /* The eeprom is at address 0x51 */
|
||||
+ if (event != EEPROM_REGISTER || ee->client.addr != 0x51)
|
||||
+ return NOTIFY_DONE;
|
||||
+
|
||||
+ ee->attr->read(&ee->client.dev.kobj, ee->attr, (char *)&hdr,
|
||||
+ 0, sizeof(hdr));
|
||||
+
|
||||
+ if (hdr.magic[0] != 'G' || hdr.magic[1] != 'W')
|
||||
+ return NOTIFY_DONE;
|
||||
+
|
||||
+ memcpy(&avila_npeb_data.hwaddr, hdr.mac0, ETH_ALEN);
|
||||
+ memcpy(&avila_npec_data.hwaddr, hdr.mac1, ETH_ALEN);
|
||||
+
|
||||
+ avila_info = avila_find_board_info(hdr.model);
|
||||
+
|
||||
+ return NOTIFY_OK;
|
||||
+}
|
||||
+
|
||||
+static struct notifier_block avila_eeprom_notifier __initdata = {
|
||||
+ .notifier_call = avila_eeprom_notify
|
||||
+static struct i2c_board_info __initdata avila_i2c_board_info[] = {
|
||||
+/* {
|
||||
+ I2C_BOARD_INFO("rtc-ds1672", 0x68),
|
||||
+ },*/
|
||||
+ {
|
||||
+ I2C_BOARD_INFO("ad7418", 0x28),
|
||||
+ },
|
||||
+ {
|
||||
+ I2C_BOARD_INFO("24c08", 0x51),
|
||||
+ .platform_data = &avila_eeprom_info
|
||||
+ },
|
||||
+};
|
||||
+
|
||||
+static void __init avila_register_eeprom_notifier(void)
|
||||
+{
|
||||
+ register_eeprom_notifier(&avila_eeprom_notifier);
|
||||
+}
|
||||
+
|
||||
+static void __init avila_unregister_eeprom_notifier(void)
|
||||
+{
|
||||
+ unregister_eeprom_notifier(&avila_eeprom_notifier);
|
||||
+}
|
||||
+#else /* CONFIG_SENSORS_EEPROM */
|
||||
+static inline void avila_register_eeprom_notifier(void) {};
|
||||
+static inline void avila_unregister_eeprom_notifier(void) {};
|
||||
+#endif /* CONFIG_SENSORS_EEPROM */
|
||||
+
|
||||
static void __init avila_init(void)
|
||||
{
|
||||
@@ -194,13 +213,12 @@
|
||||
avila_flash_resource.start = IXP4XX_EXP_BUS_BASE(0);
|
||||
avila_flash_resource.end =
|
||||
IXP4XX_EXP_BUS_BASE(0) + ixp4xx_exp_bus_size - 1;
|
||||
@@ -184,9 +349,28 @@ static void __init avila_init(void)
|
||||
@@ -159,7 +337,28 @@ static void __init avila_init(void)
|
||||
|
||||
platform_device_register(&avila_pata);
|
||||
|
||||
- platform_device_register(avila_npeb_device);
|
||||
- platform_device_register(avila_npec_device);
|
||||
+ avila_register_eeprom_notifier();
|
||||
+ i2c_register_board_info(0, avila_i2c_board_info,
|
||||
+ ARRAY_SIZE(avila_i2c_board_info));
|
||||
+}
|
||||
+
|
||||
+static int __init avila_model_setup(void)
|
||||
@@ -218,7 +236,6 @@
|
||||
+ avila_gw23xx_setup();
|
||||
+ }
|
||||
+
|
||||
+ avila_unregister_eeprom_notifier();
|
||||
+ return 0;
|
||||
}
|
||||
+late_initcall(avila_model_setup);
|
||||
|
||||
Reference in New Issue
Block a user