Home | History | Annotate | Line # | Download | only in nxp
if_enet_imx.c revision 1.1
      1  1.1  skrll /*	$NetBSD: if_enet_imx.c,v 1.1 2020/12/23 14:42:38 skrll Exp $	*/
      2  1.1  skrll 
      3  1.1  skrll /*-
      4  1.1  skrll  * Copyright (c) 2019 Genetec Corporation.  All rights reserved.
      5  1.1  skrll  * Written by Hashimoto Kenichi for Genetec Corporation.
      6  1.1  skrll  *
      7  1.1  skrll  * Redistribution and use in source and binary forms, with or without
      8  1.1  skrll  * modification, are permitted provided that the following conditions
      9  1.1  skrll  * are met:
     10  1.1  skrll  * 1. Redistributions of source code must retain the above copyright
     11  1.1  skrll  *    notice, this list of conditions and the following disclaimer.
     12  1.1  skrll  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  skrll  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  skrll  *    documentation and/or other materials provided with the distribution.
     15  1.1  skrll  *
     16  1.1  skrll  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17  1.1  skrll  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18  1.1  skrll  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19  1.1  skrll  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20  1.1  skrll  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21  1.1  skrll  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22  1.1  skrll  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23  1.1  skrll  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24  1.1  skrll  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  1.1  skrll  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  1.1  skrll  * SUCH DAMAGE.
     27  1.1  skrll  */
     28  1.1  skrll 
     29  1.1  skrll #include <sys/cdefs.h>
     30  1.1  skrll __KERNEL_RCSID(0, "$NetBSD: if_enet_imx.c,v 1.1 2020/12/23 14:42:38 skrll Exp $");
     31  1.1  skrll 
     32  1.1  skrll #include "opt_fdt.h"
     33  1.1  skrll 
     34  1.1  skrll #include <sys/param.h>
     35  1.1  skrll #include <sys/bus.h>
     36  1.1  skrll #include <sys/device.h>
     37  1.1  skrll 
     38  1.1  skrll #include <arm/imx/if_enetreg.h>
     39  1.1  skrll #include <arm/imx/if_enetvar.h>
     40  1.1  skrll 
     41  1.1  skrll #include <dev/fdt/fdtvar.h>
     42  1.1  skrll 
     43  1.1  skrll struct enet_fdt_softc {
     44  1.1  skrll 	struct enet_softc sc_enet;
     45  1.1  skrll 
     46  1.1  skrll 	struct fdtbus_gpio_pin *sc_pin_reset;
     47  1.1  skrll };
     48  1.1  skrll 
     49  1.1  skrll CFATTACH_DECL_NEW(enet_fdt, sizeof(struct enet_fdt_softc),
     50  1.1  skrll     enet_match, enet_attach, NULL, NULL);
     51  1.1  skrll 
     52  1.1  skrll static const struct of_compat_data compat_data[] = {
     53  1.1  skrll 	/* compatible			imxtype */
     54  1.1  skrll 	{ "fsl,imx6q-fec",		6 },
     55  1.1  skrll 	{ "fsl,imx6sx-fec",		7 },
     56  1.1  skrll 	{ NULL }
     57  1.1  skrll };
     58  1.1  skrll 
     59  1.1  skrll static int enet_init_clocks(struct enet_softc *);
     60  1.1  skrll static void enet_phy_reset(struct enet_fdt_softc *, const int);
     61  1.1  skrll static int enet_phy_id(struct enet_softc *, const int);
     62  1.1  skrll static void *enet_intr_establish(struct enet_softc *, int, u_int);
     63  1.1  skrll 
     64  1.1  skrll int
     65  1.1  skrll enet_match(device_t parent, cfdata_t cf, void *aux)
     66  1.1  skrll {
     67  1.1  skrll 	struct fdt_attach_args * const faa = aux;
     68  1.1  skrll 
     69  1.1  skrll 	return of_match_compat_data(faa->faa_phandle, compat_data);
     70  1.1  skrll }
     71  1.1  skrll 
     72  1.1  skrll void
     73  1.1  skrll enet_attach(device_t parent, device_t self, void *aux)
     74  1.1  skrll {
     75  1.1  skrll 	struct enet_fdt_softc * const efsc = device_private(self);
     76  1.1  skrll 	struct enet_softc *sc = &efsc->sc_enet;
     77  1.1  skrll 	struct fdt_attach_args * const faa = aux;
     78  1.1  skrll 	prop_dictionary_t prop = device_properties(self);
     79  1.1  skrll 	const int phandle = faa->faa_phandle;
     80  1.1  skrll 	bus_space_tag_t bst = faa->faa_bst;
     81  1.1  skrll 	bus_space_handle_t bsh;
     82  1.1  skrll 	bus_addr_t addr;
     83  1.1  skrll 	bus_size_t size;
     84  1.1  skrll 	int error;
     85  1.1  skrll 
     86  1.1  skrll 	if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
     87  1.1  skrll 		aprint_error(": couldn't get enet registers\n");
     88  1.1  skrll 		return;
     89  1.1  skrll 	}
     90  1.1  skrll 
     91  1.1  skrll 	error = bus_space_map(bst, addr, size, 0, &bsh);
     92  1.1  skrll 	if (error) {
     93  1.1  skrll 		aprint_error(": couldn't map enet registers: %d\n", error);
     94  1.1  skrll 		return;
     95  1.1  skrll 	}
     96  1.1  skrll 
     97  1.1  skrll 	sc->sc_clk_ipg = fdtbus_clock_get(phandle, "ipg");
     98  1.1  skrll 	if (sc->sc_clk_ipg == NULL) {
     99  1.1  skrll 		aprint_error(": couldn't get clock ipg\n");
    100  1.1  skrll 		goto failure;
    101  1.1  skrll 	}
    102  1.1  skrll 	sc->sc_clk_enet = fdtbus_clock_get(phandle, "ahb");
    103  1.1  skrll 	if (sc->sc_clk_enet == NULL) {
    104  1.1  skrll 		aprint_error(": couldn't get clock ahb\n");
    105  1.1  skrll 		goto failure;
    106  1.1  skrll 	}
    107  1.1  skrll 	sc->sc_clk_enet_ref = fdtbus_clock_get(phandle, "ptp");
    108  1.1  skrll 	if (sc->sc_clk_enet_ref == NULL) {
    109  1.1  skrll 		aprint_error(": couldn't get clock ptp\n");
    110  1.1  skrll 		goto failure;
    111  1.1  skrll 	}
    112  1.1  skrll 
    113  1.1  skrll 	if (fdtbus_clock_enable(phandle, "enet_clk_ref", false) != 0) {
    114  1.1  skrll 		aprint_error(": couldn't enable clock enet_clk_ref\n");
    115  1.1  skrll 		goto failure;
    116  1.1  skrll 	}
    117  1.1  skrll 	if (fdtbus_clock_enable(phandle, "enet_out", false) != 0) {
    118  1.1  skrll 		aprint_error(": couldn't enable clock enet_out\n");
    119  1.1  skrll 		goto failure;
    120  1.1  skrll 	}
    121  1.1  skrll 
    122  1.1  skrll 	aprint_naive("\n");
    123  1.1  skrll 	aprint_normal(": Gigabit Ethernet Controller\n");
    124  1.1  skrll 
    125  1.1  skrll 	sc->sc_dev = self;
    126  1.1  skrll 	sc->sc_iot = bst;
    127  1.1  skrll 	sc->sc_ioh = bsh;
    128  1.1  skrll 	sc->sc_dmat = faa->faa_dmat;
    129  1.1  skrll 
    130  1.1  skrll 	sc->sc_imxtype = of_search_compatible(phandle, compat_data)->data;
    131  1.1  skrll 	sc->sc_unit = 0;
    132  1.1  skrll 	sc->sc_phyid = enet_phy_id(sc, phandle);
    133  1.1  skrll 
    134  1.1  skrll 	const char *phy_mode = fdtbus_get_string(phandle, "phy-mode");
    135  1.1  skrll 	if (phy_mode == NULL) {
    136  1.1  skrll 		aprint_error(": missing 'phy-mode' property\n");
    137  1.1  skrll 		goto failure;
    138  1.1  skrll 	}
    139  1.1  skrll 
    140  1.1  skrll 	if (strcmp(phy_mode, "rgmii-txid") == 0) {
    141  1.1  skrll 		prop_dictionary_set_bool(prop, "tx_internal_delay", true);
    142  1.1  skrll 		sc->sc_rgmii = 1;
    143  1.1  skrll 	} else if (strcmp(phy_mode, "rgmii-rxid") == 0) {
    144  1.1  skrll 		prop_dictionary_set_bool(prop, "rx_internal_delay", true);
    145  1.1  skrll 		sc->sc_rgmii = 1;
    146  1.1  skrll 	} else if (strcmp(phy_mode, "rgmii-id") == 0) {
    147  1.1  skrll 		prop_dictionary_set_bool(prop, "tx_internal_delay", true);
    148  1.1  skrll 		prop_dictionary_set_bool(prop, "rx_internal_delay", true);
    149  1.1  skrll 		sc->sc_rgmii = 1;
    150  1.1  skrll 	} else if (strcmp(phy_mode, "rgmii") == 0) {
    151  1.1  skrll 		sc->sc_rgmii = 1;
    152  1.1  skrll 	} else {
    153  1.1  skrll 		sc->sc_rgmii = 0;
    154  1.1  skrll 	}
    155  1.1  skrll 
    156  1.1  skrll 	sc->sc_ih = enet_intr_establish(sc, phandle, 0);
    157  1.1  skrll 	if (sc->sc_ih == NULL)
    158  1.1  skrll 		goto failure;
    159  1.1  skrll 
    160  1.1  skrll 	if (sc->sc_imxtype == 7) {
    161  1.1  skrll 		sc->sc_ih2 = enet_intr_establish(sc, phandle, 1);
    162  1.1  skrll 		sc->sc_ih3 = enet_intr_establish(sc, phandle, 2);
    163  1.1  skrll 		if (sc->sc_ih2 == NULL || sc->sc_ih3 == NULL)
    164  1.1  skrll 			goto failure;
    165  1.1  skrll 	}
    166  1.1  skrll 
    167  1.1  skrll 	enet_init_clocks(sc);
    168  1.1  skrll 	sc->sc_clock = clk_get_rate(sc->sc_clk_ipg);
    169  1.1  skrll 
    170  1.1  skrll 	enet_phy_reset(efsc, phandle);
    171  1.1  skrll 
    172  1.1  skrll 	if (enet_attach_common(self) != 0)
    173  1.1  skrll 		goto failure;
    174  1.1  skrll 
    175  1.1  skrll 	return;
    176  1.1  skrll 
    177  1.1  skrll failure:
    178  1.1  skrll 	bus_space_unmap(sc->sc_iot, sc->sc_ioh, size);
    179  1.1  skrll 	return;
    180  1.1  skrll }
    181  1.1  skrll 
    182  1.1  skrll static void *
    183  1.1  skrll enet_intr_establish(struct enet_softc *sc, int phandle, u_int index)
    184  1.1  skrll {
    185  1.1  skrll 	char intrstr[128];
    186  1.1  skrll 	void *ih;
    187  1.1  skrll 
    188  1.1  skrll 	if (!fdtbus_intr_str(phandle, index, intrstr, sizeof(intrstr))) {
    189  1.1  skrll 		aprint_error_dev(sc->sc_dev, "failed to decode interrupt %d\n",
    190  1.1  skrll 		    index);
    191  1.1  skrll 		return NULL;
    192  1.1  skrll 	}
    193  1.1  skrll 
    194  1.1  skrll 	ih = fdtbus_intr_establish(phandle, index, IPL_NET, 0, enet_intr, sc);
    195  1.1  skrll 	if (ih == NULL) {
    196  1.1  skrll 		aprint_error_dev(sc->sc_dev, "failed to establish interrupt on %s\n",
    197  1.1  skrll 		    intrstr);
    198  1.1  skrll 		return NULL;
    199  1.1  skrll 	}
    200  1.1  skrll 	aprint_normal_dev(sc->sc_dev, "interrupting on %s\n", intrstr);
    201  1.1  skrll 
    202  1.1  skrll 	return ih;
    203  1.1  skrll }
    204  1.1  skrll 
    205  1.1  skrll static int
    206  1.1  skrll enet_init_clocks(struct enet_softc *sc)
    207  1.1  skrll {
    208  1.1  skrll 	int error;
    209  1.1  skrll 
    210  1.1  skrll 	error = clk_enable(sc->sc_clk_ipg);
    211  1.1  skrll 	if (error) {
    212  1.1  skrll 		aprint_error_dev(sc->sc_dev, "couldn't enable ipg: %d\n", error);
    213  1.1  skrll 		return error;
    214  1.1  skrll 	}
    215  1.1  skrll 	error = clk_enable(sc->sc_clk_enet);
    216  1.1  skrll 	if (error) {
    217  1.1  skrll 		aprint_error_dev(sc->sc_dev, "couldn't enable enet: %d\n", error);
    218  1.1  skrll 		return error;
    219  1.1  skrll 	}
    220  1.1  skrll 	error = clk_enable(sc->sc_clk_enet_ref);
    221  1.1  skrll 	if (error) {
    222  1.1  skrll 		aprint_error_dev(sc->sc_dev, "couldn't enable enet_ref: %d\n", error);
    223  1.1  skrll 		return error;
    224  1.1  skrll 	}
    225  1.1  skrll 
    226  1.1  skrll 	return 0;
    227  1.1  skrll }
    228  1.1  skrll 
    229  1.1  skrll static void
    230  1.1  skrll enet_phy_reset(struct enet_fdt_softc *sc, const int phandle)
    231  1.1  skrll {
    232  1.1  skrll 	u_int msec;
    233  1.1  skrll 
    234  1.1  skrll 	sc->sc_pin_reset = fdtbus_gpio_acquire(phandle, "phy-reset-gpios", GPIO_PIN_OUTPUT);
    235  1.1  skrll 	if (sc->sc_pin_reset == NULL) {
    236  1.1  skrll 		aprint_error_dev(sc->sc_enet.sc_dev, "couldn't find phy reset gpios\n");
    237  1.1  skrll 		return;
    238  1.1  skrll 	}
    239  1.1  skrll 
    240  1.1  skrll 	if (of_getprop_uint32(phandle, "phy-reset-duration", &msec))
    241  1.1  skrll 		msec = 1;
    242  1.1  skrll 
    243  1.1  skrll 	/* Reset */
    244  1.1  skrll 	fdtbus_gpio_write(sc->sc_pin_reset, 1);
    245  1.1  skrll 	delay(msec * 1000);
    246  1.1  skrll 	fdtbus_gpio_write(sc->sc_pin_reset, 0);
    247  1.1  skrll 
    248  1.1  skrll 	/* Post delay */
    249  1.1  skrll 	if (of_getprop_uint32(phandle, "phy-reset-post-delay", &msec))
    250  1.1  skrll 		msec = 0;
    251  1.1  skrll 
    252  1.1  skrll 	delay(msec * 1000);
    253  1.1  skrll }
    254  1.1  skrll 
    255  1.1  skrll static int
    256  1.1  skrll enet_phy_id(struct enet_softc *sc, const int phandle)
    257  1.1  skrll {
    258  1.1  skrll 	int phy_phandle;
    259  1.1  skrll 	bus_addr_t addr;
    260  1.1  skrll 
    261  1.1  skrll 	phy_phandle = fdtbus_get_phandle(phandle, "phy-handle");
    262  1.1  skrll 	if (phy_phandle == -1)
    263  1.1  skrll 		return MII_PHY_ANY;
    264  1.1  skrll 
    265  1.1  skrll 	if (fdtbus_get_reg(phy_phandle, 0, &addr, NULL) != 0)
    266  1.1  skrll 		return MII_PHY_ANY;
    267  1.1  skrll 
    268  1.1  skrll 	return (int)addr;
    269  1.1  skrll }
    270