rgmii.c revision 1.1.6.2 1 1.1.6.2 yamt /* $NetBSD: rgmii.c,v 1.1.6.2 2010/08/11 22:52:33 yamt Exp $ */
2 1.1.6.2 yamt /*
3 1.1.6.2 yamt * Copyright (c) 2010 KIYOHARA Takashi
4 1.1.6.2 yamt * All rights reserved.
5 1.1.6.2 yamt *
6 1.1.6.2 yamt * Redistribution and use in source and binary forms, with or without
7 1.1.6.2 yamt * modification, are permitted provided that the following conditions
8 1.1.6.2 yamt * are met:
9 1.1.6.2 yamt * 1. Redistributions of source code must retain the above copyright
10 1.1.6.2 yamt * notice, this list of conditions and the following disclaimer.
11 1.1.6.2 yamt * 2. Redistributions in binary form must reproduce the above copyright
12 1.1.6.2 yamt * notice, this list of conditions and the following disclaimer in the
13 1.1.6.2 yamt * documentation and/or other materials provided with the distribution.
14 1.1.6.2 yamt *
15 1.1.6.2 yamt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 1.1.6.2 yamt * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
17 1.1.6.2 yamt * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
18 1.1.6.2 yamt * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
19 1.1.6.2 yamt * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
20 1.1.6.2 yamt * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
21 1.1.6.2 yamt * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 1.1.6.2 yamt * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
23 1.1.6.2 yamt * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
24 1.1.6.2 yamt * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
25 1.1.6.2 yamt * POSSIBILITY OF SUCH DAMAGE.
26 1.1.6.2 yamt */
27 1.1.6.2 yamt #include <sys/cdefs.h>
28 1.1.6.2 yamt __KERNEL_RCSID(0, "$NetBSD: rgmii.c,v 1.1.6.2 2010/08/11 22:52:33 yamt Exp $");
29 1.1.6.2 yamt
30 1.1.6.2 yamt #include <sys/param.h>
31 1.1.6.2 yamt #include <sys/bus.h>
32 1.1.6.2 yamt #include <sys/device.h>
33 1.1.6.2 yamt
34 1.1.6.2 yamt #include <net/if.h>
35 1.1.6.2 yamt #include <net/if_media.h>
36 1.1.6.2 yamt
37 1.1.6.2 yamt #include <powerpc/ibm4xx/dev/rgmiireg.h>
38 1.1.6.2 yamt #include <powerpc/ibm4xx/dev/rmiivar.h>
39 1.1.6.2 yamt #include <powerpc/ibm4xx/dev/opbvar.h>
40 1.1.6.2 yamt
41 1.1.6.2 yamt
42 1.1.6.2 yamt static void rgmii_enable(device_t, int);
43 1.1.6.2 yamt static void rgmii_disable(device_t, int);
44 1.1.6.2 yamt static void rgmii_speed(device_t, int, int);
45 1.1.6.2 yamt
46 1.1.6.2 yamt
47 1.1.6.2 yamt void
48 1.1.6.2 yamt rgmii_attach(device_t self, int instance,
49 1.1.6.2 yamt void (**enable)(device_t, int),
50 1.1.6.2 yamt void (**disable)(device_t, int),
51 1.1.6.2 yamt void (**speed)(device_t, int, int))
52 1.1.6.2 yamt {
53 1.1.6.2 yamt struct opb_softc *sc = device_private(self);
54 1.1.6.2 yamt uint32_t ssr;
55 1.1.6.2 yamt
56 1.1.6.2 yamt instance %= 2;
57 1.1.6.2 yamt
58 1.1.6.2 yamt rgmii_disable(self, instance);
59 1.1.6.2 yamt ssr = bus_space_read_4(sc->sc_iot, sc->sc_rgmiih, RGMII0_SSR);
60 1.1.6.2 yamt ssr &= ~SSR_SP(instance, SSR_SP_MASK);
61 1.1.6.2 yamt bus_space_write_4(sc->sc_iot, sc->sc_rgmiih, RGMII0_SSR, ssr);
62 1.1.6.2 yamt
63 1.1.6.2 yamt *enable = rgmii_enable;
64 1.1.6.2 yamt *disable = rgmii_disable;
65 1.1.6.2 yamt *speed = rgmii_speed;
66 1.1.6.2 yamt }
67 1.1.6.2 yamt
68 1.1.6.2 yamt static void
69 1.1.6.2 yamt rgmii_enable(device_t self, int instance)
70 1.1.6.2 yamt {
71 1.1.6.2 yamt struct opb_softc *sc = device_private(self);
72 1.1.6.2 yamt uint32_t fer;
73 1.1.6.2 yamt
74 1.1.6.2 yamt instance %= 2;
75 1.1.6.2 yamt
76 1.1.6.2 yamt fer = bus_space_read_4(sc->sc_iot, sc->sc_rgmiih, RGMII0_FER);
77 1.1.6.2 yamt fer &= ~FER_MDIOEN_MASK;
78 1.1.6.2 yamt fer |= FER_MDIOEN(instance);
79 1.1.6.2 yamt bus_space_write_4(sc->sc_iot, sc->sc_rgmiih, RGMII0_FER, fer);
80 1.1.6.2 yamt }
81 1.1.6.2 yamt
82 1.1.6.2 yamt static void
83 1.1.6.2 yamt rgmii_disable(device_t self, int instance)
84 1.1.6.2 yamt {
85 1.1.6.2 yamt struct opb_softc *sc = device_private(self);
86 1.1.6.2 yamt uint32_t fer;
87 1.1.6.2 yamt
88 1.1.6.2 yamt instance %= 2;
89 1.1.6.2 yamt
90 1.1.6.2 yamt fer = bus_space_read_4(sc->sc_iot, sc->sc_rgmiih, RGMII0_FER);
91 1.1.6.2 yamt fer &= ~FER_MDIOEN_MASK;
92 1.1.6.2 yamt bus_space_write_4(sc->sc_iot, sc->sc_rgmiih, RGMII0_FER, fer);
93 1.1.6.2 yamt }
94 1.1.6.2 yamt
95 1.1.6.2 yamt static void
96 1.1.6.2 yamt rgmii_speed(device_t self, int instance, int speed)
97 1.1.6.2 yamt {
98 1.1.6.2 yamt struct opb_softc *sc = device_private(self);
99 1.1.6.2 yamt uint32_t ssr;
100 1.1.6.2 yamt
101 1.1.6.2 yamt instance %= 2;
102 1.1.6.2 yamt
103 1.1.6.2 yamt ssr = bus_space_read_4(sc->sc_iot, sc->sc_rgmiih, RGMII0_SSR);
104 1.1.6.2 yamt ssr &= ~SSR_SP(instance, SSR_SP_MASK);
105 1.1.6.2 yamt switch (speed) {
106 1.1.6.2 yamt case IFM_1000_T:
107 1.1.6.2 yamt ssr |= SSR_SP(instance, SSR_SP_1000MBPS);
108 1.1.6.2 yamt break;
109 1.1.6.2 yamt case IFM_100_TX:
110 1.1.6.2 yamt ssr |= SSR_SP(instance, SSR_SP_100MBPS);
111 1.1.6.2 yamt break;
112 1.1.6.2 yamt case IFM_10_T:
113 1.1.6.2 yamt ssr |= SSR_SP(instance, SSR_SP_10MBPS);
114 1.1.6.2 yamt break;
115 1.1.6.2 yamt }
116 1.1.6.2 yamt bus_space_write_4(sc->sc_iot, sc->sc_rgmiih, RGMII0_SSR, ssr);
117 1.1.6.2 yamt }
118