Module Name: src Committed By: jmcneill Date: Thu May 14 00:00:44 UTC 2015
Modified Files: src/sys/arch/arm/nvidia: tegra_ahcisata.c tegra_car.c tegra_carreg.h Log Message: fix SATA controller init To generate a diff of this commit: cvs rdiff -u -r1.3 -r1.4 src/sys/arch/arm/nvidia/tegra_ahcisata.c cvs rdiff -u -r1.11 -r1.12 src/sys/arch/arm/nvidia/tegra_car.c cvs rdiff -u -r1.12 -r1.13 src/sys/arch/arm/nvidia/tegra_carreg.h Please note that diffs are not public domain; they are subject to the copyright notices on the relevant files.
Modified files: Index: src/sys/arch/arm/nvidia/tegra_ahcisata.c diff -u src/sys/arch/arm/nvidia/tegra_ahcisata.c:1.3 src/sys/arch/arm/nvidia/tegra_ahcisata.c:1.4 --- src/sys/arch/arm/nvidia/tegra_ahcisata.c:1.3 Sun May 10 15:31:48 2015 +++ src/sys/arch/arm/nvidia/tegra_ahcisata.c Thu May 14 00:00:44 2015 @@ -1,4 +1,4 @@ -/* $NetBSD: tegra_ahcisata.c,v 1.3 2015/05/10 15:31:48 jmcneill Exp $ */ +/* $NetBSD: tegra_ahcisata.c,v 1.4 2015/05/14 00:00:44 jmcneill Exp $ */ /*- * Copyright (c) 2015 Jared D. McNeill <jmcne...@invisible.ca> @@ -29,7 +29,7 @@ #include "locators.h" #include <sys/cdefs.h> -__KERNEL_RCSID(0, "$NetBSD: tegra_ahcisata.c,v 1.3 2015/05/10 15:31:48 jmcneill Exp $"); +__KERNEL_RCSID(0, "$NetBSD: tegra_ahcisata.c,v 1.4 2015/05/14 00:00:44 jmcneill Exp $"); #include <sys/param.h> #include <sys/bus.h> @@ -54,6 +54,8 @@ struct tegra_ahcisata_softc { bus_space_tag_t sc_bst; bus_space_handle_t sc_bsh; void *sc_ih; + + struct tegra_gpio_pin *sc_pin_power; }; static void tegra_ahcisata_init(struct tegra_ahcisata_softc *); @@ -73,6 +75,8 @@ tegra_ahcisata_attach(device_t parent, d struct tegra_ahcisata_softc * const sc = device_private(self); struct tegraio_attach_args * const tio = aux; const struct tegra_locators * const loc = &tio->tio_loc; + prop_dictionary_t prop = device_properties(self); + const char *pin; sc->sc_bst = tio->tio_bst; bus_space_subregion(tio->tio_bst, tio->tio_bsh, @@ -81,7 +85,7 @@ tegra_ahcisata_attach(device_t parent, d sc->sc.sc_atac.atac_dev = self; sc->sc.sc_dmat = tio->tio_dmat; sc->sc.sc_ahcit = tio->tio_bst; - sc->sc.sc_ahcis = loc->loc_size; + sc->sc.sc_ahcis = loc->loc_size - TEGRA_AHCISATA_OFFSET; bus_space_subregion(tio->tio_bst, tio->tio_bsh, loc->loc_offset + TEGRA_AHCISATA_OFFSET, loc->loc_size - TEGRA_AHCISATA_OFFSET, &sc->sc.sc_ahcih); @@ -90,6 +94,12 @@ tegra_ahcisata_attach(device_t parent, d aprint_naive("\n"); aprint_normal(": SATA\n"); + if (prop_dictionary_get_cstring_nocopy(prop, "power-gpio", &pin)) { + sc->sc_pin_power = tegra_gpio_acquire(pin, GPIO_PIN_OUTPUT); + if (sc->sc_pin_power) + tegra_gpio_write(sc->sc_pin_power, 1); + } + tegra_car_periph_sata_enable(); tegra_ahcisata_init(sc); Index: src/sys/arch/arm/nvidia/tegra_car.c diff -u src/sys/arch/arm/nvidia/tegra_car.c:1.11 src/sys/arch/arm/nvidia/tegra_car.c:1.12 --- src/sys/arch/arm/nvidia/tegra_car.c:1.11 Wed May 13 11:06:13 2015 +++ src/sys/arch/arm/nvidia/tegra_car.c Thu May 14 00:00:44 2015 @@ -1,4 +1,4 @@ -/* $NetBSD: tegra_car.c,v 1.11 2015/05/13 11:06:13 jmcneill Exp $ */ +/* $NetBSD: tegra_car.c,v 1.12 2015/05/14 00:00:44 jmcneill Exp $ */ /*- * Copyright (c) 2015 Jared D. McNeill <jmcne...@invisible.ca> @@ -29,7 +29,7 @@ #include "locators.h" #include <sys/cdefs.h> -__KERNEL_RCSID(0, "$NetBSD: tegra_car.c,v 1.11 2015/05/13 11:06:13 jmcneill Exp $"); +__KERNEL_RCSID(0, "$NetBSD: tegra_car.c,v 1.12 2015/05/14 00:00:44 jmcneill Exp $"); #include <sys/param.h> #include <sys/bus.h> @@ -462,6 +462,23 @@ tegra_car_periph_sata_enable(void) tegra_car_get_bs(&bst, &bsh); + const u_int pllp_rate = tegra_car_pllp0_rate(); + + /* Set SATA_OOB clock source to PLLP, 204MHz */ + const u_int sataoob_div = pllp_rate / 200000000; + bus_space_write_4(bst, bsh, CAR_CLKSRC_SATA_OOB_REG, + __SHIFTIN(CAR_CLKSRC_SATA_SRC_PLLP_OUT0, + CAR_CLKSRC_SATA_SRC) | + __SHIFTIN(sataoob_div - 1, CAR_CLKSRC_SATA_OOB_DIV)); + + /* Set SATA clock source to PLLP, 102MHz */ + const u_int sata_div = pllp_rate / 100000000; + bus_space_write_4(bst, bsh, CAR_CLKSRC_SATA_REG, + CAR_CLKSRC_SATA_AUX_CLK_ENB | + __SHIFTIN(CAR_CLKSRC_SATA_SRC_PLLP_OUT0, + CAR_CLKSRC_SATA_SRC) | + __SHIFTIN(sata_div - 1, CAR_CLKSRC_SATA_DIV)); + /* Enable CML clock for SATA */ tegra_reg_set_clear(bst, bsh, CAR_PLLE_AUX_REG, CAR_PLLE_AUX_CML1_OEN, 0); @@ -475,6 +492,7 @@ tegra_car_periph_sata_enable(void) tegra_pmc_power(PMC_PARTID_SAX, true); /* Turn on the clocks to SATA and de-assert resets */ + bus_space_write_4(bst, bsh, CAR_CLK_ENB_W_SET_REG, CAR_DEV_W_SATACOLD); bus_space_write_4(bst, bsh, CAR_CLK_ENB_V_SET_REG, CAR_DEV_V_SATA); bus_space_write_4(bst, bsh, CAR_RST_DEV_W_CLR_REG, CAR_DEV_W_SATACOLD); bus_space_write_4(bst, bsh, CAR_RST_DEV_V_CLR_REG, CAR_DEV_V_SATA); Index: src/sys/arch/arm/nvidia/tegra_carreg.h diff -u src/sys/arch/arm/nvidia/tegra_carreg.h:1.12 src/sys/arch/arm/nvidia/tegra_carreg.h:1.13 --- src/sys/arch/arm/nvidia/tegra_carreg.h:1.12 Wed May 13 11:06:13 2015 +++ src/sys/arch/arm/nvidia/tegra_carreg.h Thu May 14 00:00:44 2015 @@ -1,4 +1,4 @@ -/* $NetBSD: tegra_carreg.h,v 1.12 2015/05/13 11:06:13 jmcneill Exp $ */ +/* $NetBSD: tegra_carreg.h,v 1.13 2015/05/14 00:00:44 jmcneill Exp $ */ /*- * Copyright (c) 2015 Jared D. McNeill <jmcne...@invisible.ca> @@ -308,6 +308,23 @@ #define CAR_CCLKG_BURST_POLICY_CWAKEUP_SOURCE_CLKM 0 #define CAR_CCLKG_BURST_POLICY_CWAKEUP_SOURCE_PLLX_OUT0_LJ 8 +#define CAR_CLKSRC_SATA_OOB_REG 0x420 +#define CAR_CLKSRC_SATA_OOB_SRC __BITS(31,29) +#define CAR_CLKSRC_SATA_OOB_SRC_PLLP_OUT0 0 +#define CAR_CLKSRC_SATA_OOB_SRC_PLLC_OUT0 2 +#define CAR_CLKSRC_SATA_OOB_SRC_PLLM_OUT0 4 +#define CAR_CLKSRC_SATA_OOB_SRC_CLKM 6 +#define CAR_CLKSRC_SATA_OOB_DIV __BITS(7,0) + +#define CAR_CLKSRC_SATA_REG 0x424 +#define CAR_CLKSRC_SATA_SRC __BITS(31,29) +#define CAR_CLKSRC_SATA_SRC_PLLP_OUT0 0 +#define CAR_CLKSRC_SATA_SRC_PLLC_OUT0 2 +#define CAR_CLKSRC_SATA_SRC_PLLM_OUT0 4 +#define CAR_CLKSRC_SATA_SRC_CLKM 6 +#define CAR_CLKSRC_SATA_AUX_CLK_ENB __BIT(24) +#define CAR_CLKSRC_SATA_DIV __BITS(7,0) + #define CAR_UTMIP_PLL_CFG0_REG 0x480 #define CAR_UTMIP_PLL_CFG1_REG 0x484