159 lines
3.9 KiB
Diff
159 lines
3.9 KiB
Diff
From 16b8c52f80f20e07866e397ff52ff9658766437b Mon Sep 17 00:00:00 2001
|
|
From: Luka Perkov <luka@openwrt.org>
|
|
Date: Wed, 29 Aug 2012 22:08:16 +0200
|
|
Subject: net: switchlib: add driver for Atheros AR8216
|
|
|
|
Signed-off-by: Luka Perkov <luka@openwrt.org>
|
|
Signed-off-by: Daniel Schwierzeck <daniel.schwierzeck@gmail.com>
|
|
|
|
--- a/drivers/net/switch/Makefile
|
|
+++ b/drivers/net/switch/Makefile
|
|
@@ -13,6 +13,7 @@ LIB := $(obj)libswitch.o
|
|
COBJS-$(CONFIG_SWITCH_MULTI) += switch.o
|
|
COBJS-$(CONFIG_SWITCH_PSB697X) += psb697x.o
|
|
COBJS-$(CONFIG_SWITCH_ADM6996I) += adm6996i.o
|
|
+COBJS-$(CONFIG_SWITCH_AR8216) += ar8216.o
|
|
|
|
COBJS := $(COBJS-y)
|
|
SRCS := $(COBJS:.o=.c)
|
|
--- /dev/null
|
|
+++ b/drivers/net/switch/ar8216.c
|
|
@@ -0,0 +1,115 @@
|
|
+/*
|
|
+ * Copyright (C) 2012 Luka Perkov <luka@openwrt.org>
|
|
+ *
|
|
+ * This file is released under the terms of GPL v2 and any later version.
|
|
+ * See the file COPYING in the root directory of the source tree for details.
|
|
+ */
|
|
+
|
|
+#include <common.h>
|
|
+#include <malloc.h>
|
|
+#include <miiphy.h>
|
|
+#include <switch.h>
|
|
+#include <netdev.h>
|
|
+
|
|
+#define BITS(_s, _n) (((1UL << (_n)) - 1) << _s)
|
|
+
|
|
+#define AR8216_REG_CTRL 0x0000
|
|
+#define AR8216_CTRL_REVISION BITS(0, 8)
|
|
+#define AR8216_CTRL_VERSION BITS(8, 8)
|
|
+
|
|
+#define AR8216_PROBE_RETRIES 10
|
|
+
|
|
+static void split_addr(u32 regaddr, u16 *r1, u16 *r2, u16 *page)
|
|
+{
|
|
+ regaddr >>= 1;
|
|
+ *r1 = regaddr & 0x1e;
|
|
+
|
|
+ regaddr >>= 5;
|
|
+ *r2 = regaddr & 0x7;
|
|
+
|
|
+ regaddr >>= 3;
|
|
+ *page = regaddr & 0x1ff;
|
|
+}
|
|
+
|
|
+static int ar8216_mii_read(struct mii_dev *bus, u32 reg)
|
|
+{
|
|
+ u16 r1, r2, page;
|
|
+ u16 lo, hi;
|
|
+
|
|
+ split_addr(reg, &r1, &r2, &page);
|
|
+
|
|
+ bus->write(bus, 0x18, MDIO_DEVAD_NONE, 0, page);
|
|
+ __udelay(1000);
|
|
+
|
|
+ lo = bus->read(bus, 0x10 | r2, MDIO_DEVAD_NONE, r1);
|
|
+ hi = bus->read(bus, 0x10 | r2, MDIO_DEVAD_NONE, r1 + 1);
|
|
+
|
|
+ return (hi << 16) | lo;
|
|
+}
|
|
+
|
|
+static void ar8216_mii_write(struct mii_dev *bus, u16 reg, u32 val)
|
|
+{
|
|
+ u16 r1, r2, r3;
|
|
+ u16 lo, hi;
|
|
+
|
|
+ split_addr((u32) reg, &r1, &r2, &r3);
|
|
+
|
|
+ bus->write(bus, 0x18, MDIO_DEVAD_NONE, 0, r3);
|
|
+ __udelay(1000);
|
|
+
|
|
+ lo = val & 0xffff;
|
|
+ hi = (u16) (val >> 16);
|
|
+ bus->write(bus, 0x10 | r2, MDIO_DEVAD_NONE, r1 + 1, hi);
|
|
+ bus->write(bus, 0x10 | r2, MDIO_DEVAD_NONE, r1, lo);
|
|
+}
|
|
+
|
|
+static int ar8216_probe(struct switch_device *dev)
|
|
+{
|
|
+ struct mii_dev *bus = dev->bus;
|
|
+ u32 val;
|
|
+ u16 id;
|
|
+
|
|
+ val = ar8216_mii_read(bus, AR8216_REG_CTRL);
|
|
+ if (val == ~0)
|
|
+ return 1;
|
|
+
|
|
+ id = val & (AR8216_CTRL_REVISION | AR8216_CTRL_VERSION);
|
|
+
|
|
+ switch (id) {
|
|
+ case 0x0101:
|
|
+ return 0;
|
|
+ default:
|
|
+ return 1;
|
|
+ }
|
|
+}
|
|
+
|
|
+static void ar8216_setup(struct switch_device *dev)
|
|
+{
|
|
+ struct mii_dev *bus = dev->bus;
|
|
+
|
|
+ ar8216_mii_write(bus, 0x200, 0x200);
|
|
+ ar8216_mii_write(bus, 0x300, 0x200);
|
|
+ ar8216_mii_write(bus, 0x400, 0x200);
|
|
+ ar8216_mii_write(bus, 0x500, 0x200);
|
|
+ ar8216_mii_write(bus, 0x600, 0x7d);
|
|
+ ar8216_mii_write(bus, 0x38, 0xc000050e);
|
|
+ ar8216_mii_write(bus, 0x104, 0x4004);
|
|
+ ar8216_mii_write(bus, 0x60, 0xffffffff);
|
|
+ ar8216_mii_write(bus, 0x64, 0xaaaaaaaa);
|
|
+ ar8216_mii_write(bus, 0x68, 0x55555555);
|
|
+ ar8216_mii_write(bus, 0x6c, 0x0);
|
|
+ ar8216_mii_write(bus, 0x70, 0x41af);
|
|
+}
|
|
+
|
|
+static struct switch_driver ar8216_drv = {
|
|
+ .name = "ar8216",
|
|
+};
|
|
+
|
|
+void switch_ar8216_init(void)
|
|
+{
|
|
+ /* for archs with manual relocation */
|
|
+ ar8216_drv.probe = ar8216_probe;
|
|
+ ar8216_drv.setup = ar8216_setup;
|
|
+
|
|
+ switch_driver_register(&ar8216_drv);
|
|
+}
|
|
--- a/drivers/net/switch/switch.c
|
|
+++ b/drivers/net/switch/switch.c
|
|
@@ -24,6 +24,9 @@ void switch_init(void)
|
|
#if defined(CONFIG_SWITCH_ADM6996I)
|
|
switch_adm6996i_init();
|
|
#endif
|
|
+#if defined(CONFIG_SWITCH_AR8216)
|
|
+ switch_ar8216_init();
|
|
+#endif
|
|
|
|
board_switch_init();
|
|
}
|
|
--- a/include/switch.h
|
|
+++ b/include/switch.h
|
|
@@ -92,6 +92,7 @@ static inline void switch_setup(struct s
|
|
/* Init functions for supported Switch drivers */
|
|
extern void switch_psb697x_init(void);
|
|
extern void switch_adm6996i_init(void);
|
|
+extern void switch_ar8216_init(void);
|
|
|
|
#endif /* __SWITCH_H */
|
|
|