1 From b8c666eda693906488637c414db9db35b6760e4a Mon Sep 17 00:00:00 2001
2 From: Daniel Schwierzeck <daniel.schwierzeck@gmail.com>
3 Date: Wed, 29 Aug 2012 22:08:15 +0200
4 Subject: net: switchlib: add driver for Lantiq PSB697X switch family
6 Signed-off-by: Daniel Schwierzeck <daniel.schwierzeck@gmail.com>
8 --- a/drivers/net/switch/Makefile
9 +++ b/drivers/net/switch/Makefile
10 @@ -11,6 +11,7 @@ include $(TOPDIR)/config.mk
11 LIB := $(obj)libswitch.o
13 COBJS-$(CONFIG_SWITCH_MULTI) += switch.o
14 +COBJS-$(CONFIG_SWITCH_PSB697X) += psb697x.o
17 SRCS := $(COBJS:.o=.c)
19 +++ b/drivers/net/switch/psb697x.c
22 + * Copyright (C) 2011-2012 Daniel Schwierzeck, daniel.schwierzeck@gmail.com
24 + * This file is released under the terms of GPL v2 and any later version.
25 + * See the file COPYING in the root directory of the source tree for details.
33 +#define PSB697X_CHIPID1 0x2599
34 +#define PSB697X_PORT_COUNT 7
36 +#define PSB697X_PORT_BASE(p) (p * 0x20)
37 +#define PSB697X_REG_PS(p) (PSB697X_PORT_BASE(p) + 0x00)
38 +#define PSB697X_REG_PBC(p) (PSB697X_PORT_BASE(p) + 0x01)
39 +#define PSB697X_REG_PEC(p) (PSB697X_PORT_BASE(p) + 0x02)
41 +#define PSB697X_REG_SGC1 0x0E0 /* Switch Global Control Register 1 */
42 +#define PSB697X_REG_SGC2 0x0E1 /* Switch Global Control Register 2 */
43 +#define PSB697X_REG_CMH 0x0E2 /* CPU Port & Mirror Control */
44 +#define PSB697X_REG_MIICR 0x0F5 /* MII Port Control */
45 +#define PSB697X_REG_CI0 0x100 /* Chip Identifier 0 */
46 +#define PSB697X_REG_CI1 0x101 /* Chip Identifier 1 */
47 +#define PSB697X_REG_MIIAC 0x120 /* MII Indirect Access Control */
48 +#define PSB697X_REG_MIIWD 0x121 /* MII Indirect Write Data */
49 +#define PSB697X_REG_MIIRD 0x122 /* MII Indirect Read Data */
51 +#define PSB697X_REG_PORT_FLP (1 << 2) /* Force link up */
52 +#define PSB697X_REG_PORT_FLD (1 << 1) /* Force link down */
54 +#define PSB697X_REG_SGC2_SE (1 << 15) /* Switch enable */
56 +#define PSB697X_REG_CMH_CPN_MASK 0x7
57 +#define PSB697X_REG_CMH_CPN_SHIFT 5
60 +static inline int psb697x_mii_read(struct mii_dev *bus, u16 reg)
64 + ret = bus->read(bus, (reg >> 5) & 0x1f, MDIO_DEVAD_NONE, reg & 0x1f);
69 +static inline int psb697x_mii_write(struct mii_dev *bus, u16 reg, u16 val)
73 + ret = bus->write(bus, (reg >> 5) & 0x1f, MDIO_DEVAD_NONE,
79 +static int psb697x_probe(struct switch_device *dev)
81 + struct mii_dev *bus = dev->bus;
84 + ci1 = psb697x_mii_read(bus, PSB697X_REG_CI1);
86 + if (ci1 == PSB697X_CHIPID1)
92 +static void psb697x_setup(struct switch_device *dev)
94 + struct mii_dev *bus = dev->bus;
98 + psb697x_mii_write(bus, PSB697X_REG_SGC2, PSB697X_REG_SGC2_SE);
101 + * Force 100 Mbps as default value for CPU ports 5 and 6 to get
104 + psb697x_mii_write(bus, PSB697X_REG_MIICR, 0x0773);
106 + for (i = 0; i < PSB697X_PORT_COUNT; i++) {
107 + state = dev->port_mask & (1 << i);
110 + * Software workaround from Errata Sheet:
111 + * Force link down and reset internal PHY, keep that state
112 + * for all unconnected ports and disable force link down
113 + * for all connected ports
115 + psb697x_mii_write(bus, PSB697X_REG_PBC(i),
116 + PSB697X_REG_PORT_FLD);
118 + if (i == dev->cpu_port)
119 + /* Force link up for CPU port */
120 + psb697x_mii_write(bus, PSB697X_REG_PBC(i),
121 + PSB697X_REG_PORT_FLP);
123 + /* Disable force link down for active LAN ports */
124 + psb697x_mii_write(bus, PSB697X_REG_PBC(i), 0);
128 +static struct switch_driver psb697x_drv = {
132 +void switch_psb697x_init(void)
134 + /* For archs with manual relocation */
135 + psb697x_drv.probe = psb697x_probe;
136 + psb697x_drv.setup = psb697x_setup;
138 + switch_driver_register(&psb697x_drv);
140 --- a/drivers/net/switch/switch.c
141 +++ b/drivers/net/switch/switch.c
142 @@ -18,6 +18,10 @@ void switch_init(void)
143 INIT_LIST_HEAD(&switch_drivers);
144 INIT_LIST_HEAD(&switch_devices);
146 +#if defined(CONFIG_SWITCH_PSB697X)
147 + switch_psb697x_init();
153 --- a/include/switch.h
154 +++ b/include/switch.h
155 @@ -90,6 +90,7 @@ static inline void switch_setup(struct s
158 /* Init functions for supported Switch drivers */
159 +extern void switch_psb697x_init(void);
161 #endif /* __SWITCH_H */