ar71xx: build firmware image for the WNDR3700 v4 board
[openwrt/svn-archive/archive.git] / package / boot / uboot-lantiq / patches / 0022-net-switchlib-add-driver-for-Atheros-AR8216.patch
1 From 16b8c52f80f20e07866e397ff52ff9658766437b Mon Sep 17 00:00:00 2001
2 From: Luka Perkov <luka@openwrt.org>
3 Date: Wed, 29 Aug 2012 22:08:16 +0200
4 Subject: net: switchlib: add driver for Atheros AR8216
5
6 Signed-off-by: Luka Perkov <luka@openwrt.org>
7 Signed-off-by: Daniel Schwierzeck <daniel.schwierzeck@gmail.com>
8
9 --- a/drivers/net/switch/Makefile
10 +++ b/drivers/net/switch/Makefile
11 @@ -13,6 +13,7 @@ LIB := $(obj)libswitch.o
12 COBJS-$(CONFIG_SWITCH_MULTI) += switch.o
13 COBJS-$(CONFIG_SWITCH_PSB697X) += psb697x.o
14 COBJS-$(CONFIG_SWITCH_ADM6996I) += adm6996i.o
15 +COBJS-$(CONFIG_SWITCH_AR8216) += ar8216.o
16
17 COBJS := $(COBJS-y)
18 SRCS := $(COBJS:.o=.c)
19 --- /dev/null
20 +++ b/drivers/net/switch/ar8216.c
21 @@ -0,0 +1,115 @@
22 +/*
23 + * Copyright (C) 2012 Luka Perkov <luka@openwrt.org>
24 + *
25 + * This file is released under the terms of GPL v2 and any later version.
26 + * See the file COPYING in the root directory of the source tree for details.
27 + */
28 +
29 +#include <common.h>
30 +#include <malloc.h>
31 +#include <miiphy.h>
32 +#include <switch.h>
33 +#include <netdev.h>
34 +
35 +#define BITS(_s, _n) (((1UL << (_n)) - 1) << _s)
36 +
37 +#define AR8216_REG_CTRL 0x0000
38 +#define AR8216_CTRL_REVISION BITS(0, 8)
39 +#define AR8216_CTRL_VERSION BITS(8, 8)
40 +
41 +#define AR8216_PROBE_RETRIES 10
42 +
43 +static void split_addr(u32 regaddr, u16 *r1, u16 *r2, u16 *page)
44 +{
45 + regaddr >>= 1;
46 + *r1 = regaddr & 0x1e;
47 +
48 + regaddr >>= 5;
49 + *r2 = regaddr & 0x7;
50 +
51 + regaddr >>= 3;
52 + *page = regaddr & 0x1ff;
53 +}
54 +
55 +static int ar8216_mii_read(struct mii_dev *bus, u32 reg)
56 +{
57 + u16 r1, r2, page;
58 + u16 lo, hi;
59 +
60 + split_addr(reg, &r1, &r2, &page);
61 +
62 + bus->write(bus, 0x18, MDIO_DEVAD_NONE, 0, page);
63 + __udelay(1000);
64 +
65 + lo = bus->read(bus, 0x10 | r2, MDIO_DEVAD_NONE, r1);
66 + hi = bus->read(bus, 0x10 | r2, MDIO_DEVAD_NONE, r1 + 1);
67 +
68 + return (hi << 16) | lo;
69 +}
70 +
71 +static void ar8216_mii_write(struct mii_dev *bus, u16 reg, u32 val)
72 +{
73 + u16 r1, r2, r3;
74 + u16 lo, hi;
75 +
76 + split_addr((u32) reg, &r1, &r2, &r3);
77 +
78 + bus->write(bus, 0x18, MDIO_DEVAD_NONE, 0, r3);
79 + __udelay(1000);
80 +
81 + lo = val & 0xffff;
82 + hi = (u16) (val >> 16);
83 + bus->write(bus, 0x10 | r2, MDIO_DEVAD_NONE, r1 + 1, hi);
84 + bus->write(bus, 0x10 | r2, MDIO_DEVAD_NONE, r1, lo);
85 +}
86 +
87 +static int ar8216_probe(struct switch_device *dev)
88 +{
89 + struct mii_dev *bus = dev->bus;
90 + u32 val;
91 + u16 id;
92 +
93 + val = ar8216_mii_read(bus, AR8216_REG_CTRL);
94 + if (val == ~0)
95 + return 1;
96 +
97 + id = val & (AR8216_CTRL_REVISION | AR8216_CTRL_VERSION);
98 +
99 + switch (id) {
100 + case 0x0101:
101 + return 0;
102 + default:
103 + return 1;
104 + }
105 +}
106 +
107 +static void ar8216_setup(struct switch_device *dev)
108 +{
109 + struct mii_dev *bus = dev->bus;
110 +
111 + ar8216_mii_write(bus, 0x200, 0x200);
112 + ar8216_mii_write(bus, 0x300, 0x200);
113 + ar8216_mii_write(bus, 0x400, 0x200);
114 + ar8216_mii_write(bus, 0x500, 0x200);
115 + ar8216_mii_write(bus, 0x600, 0x7d);
116 + ar8216_mii_write(bus, 0x38, 0xc000050e);
117 + ar8216_mii_write(bus, 0x104, 0x4004);
118 + ar8216_mii_write(bus, 0x60, 0xffffffff);
119 + ar8216_mii_write(bus, 0x64, 0xaaaaaaaa);
120 + ar8216_mii_write(bus, 0x68, 0x55555555);
121 + ar8216_mii_write(bus, 0x6c, 0x0);
122 + ar8216_mii_write(bus, 0x70, 0x41af);
123 +}
124 +
125 +static struct switch_driver ar8216_drv = {
126 + .name = "ar8216",
127 +};
128 +
129 +void switch_ar8216_init(void)
130 +{
131 + /* for archs with manual relocation */
132 + ar8216_drv.probe = ar8216_probe;
133 + ar8216_drv.setup = ar8216_setup;
134 +
135 + switch_driver_register(&ar8216_drv);
136 +}
137 --- a/drivers/net/switch/switch.c
138 +++ b/drivers/net/switch/switch.c
139 @@ -24,6 +24,9 @@ void switch_init(void)
140 #if defined(CONFIG_SWITCH_ADM6996I)
141 switch_adm6996i_init();
142 #endif
143 +#if defined(CONFIG_SWITCH_AR8216)
144 + switch_ar8216_init();
145 +#endif
146
147 board_switch_init();
148 }
149 --- a/include/switch.h
150 +++ b/include/switch.h
151 @@ -92,6 +92,7 @@ static inline void switch_setup(struct s
152 /* Init functions for supported Switch drivers */
153 extern void switch_psb697x_init(void);
154 extern void switch_adm6996i_init(void);
155 +extern void switch_ar8216_init(void);
156
157 #endif /* __SWITCH_H */
158