Module Name:    src
Committed By:   jmcneill
Date:           Sun May 10 15:31:48 UTC 2015

Modified Files:
        src/sys/arch/arm/nvidia: tegra_ahcisata.c tegra_car.c tegra_carreg.h
            tegra_var.h

Log Message:
Tegra SATA ungating support


To generate a diff of this commit:
cvs rdiff -u -r1.2 -r1.3 src/sys/arch/arm/nvidia/tegra_ahcisata.c
cvs rdiff -u -r1.7 -r1.8 src/sys/arch/arm/nvidia/tegra_car.c
cvs rdiff -u -r1.9 -r1.10 src/sys/arch/arm/nvidia/tegra_carreg.h
cvs rdiff -u -r1.12 -r1.13 src/sys/arch/arm/nvidia/tegra_var.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.2 src/sys/arch/arm/nvidia/tegra_ahcisata.c:1.3
--- src/sys/arch/arm/nvidia/tegra_ahcisata.c:1.2	Sun Apr 26 16:41:04 2015
+++ src/sys/arch/arm/nvidia/tegra_ahcisata.c	Sun May 10 15:31:48 2015
@@ -1,4 +1,4 @@
-/* $NetBSD: tegra_ahcisata.c,v 1.2 2015/04/26 16:41:04 jmcneill Exp $ */
+/* $NetBSD: tegra_ahcisata.c,v 1.3 2015/05/10 15:31:48 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.2 2015/04/26 16:41:04 jmcneill Exp $");
+__KERNEL_RCSID(0, "$NetBSD: tegra_ahcisata.c,v 1.3 2015/05/10 15:31:48 jmcneill Exp $");
 
 #include <sys/param.h>
 #include <sys/bus.h>
@@ -42,15 +42,22 @@ __KERNEL_RCSID(0, "$NetBSD: tegra_ahcisa
 #include <dev/ic/ahcisatavar.h>
 
 #include <arm/nvidia/tegra_var.h>
+#include <arm/nvidia/tegra_ahcisatareg.h>
+
+#define TEGRA_AHCISATA_OFFSET	0x7000
 
 static int	tegra_ahcisata_match(device_t, cfdata_t, void *);
 static void	tegra_ahcisata_attach(device_t, device_t, void *);
 
 struct tegra_ahcisata_softc {
 	struct ahci_softc	sc;
+	bus_space_tag_t		sc_bst;
+	bus_space_handle_t	sc_bsh;
 	void			*sc_ih;
 };
 
+static void	tegra_ahcisata_init(struct tegra_ahcisata_softc *);
+
 CFATTACH_DECL_NEW(tegra_ahcisata, sizeof(struct tegra_ahcisata_softc),
 	tegra_ahcisata_match, tegra_ahcisata_attach, NULL, NULL);
 
@@ -67,17 +74,26 @@ tegra_ahcisata_attach(device_t parent, d
 	struct tegraio_attach_args * const tio = aux;
 	const struct tegra_locators * const loc = &tio->tio_loc;
 
+	sc->sc_bst = tio->tio_bst;
+	bus_space_subregion(tio->tio_bst, tio->tio_bsh,
+	    loc->loc_offset, loc->loc_size, &sc->sc_bsh);
+
 	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;
 	bus_space_subregion(tio->tio_bst, tio->tio_bsh,
-	    loc->loc_offset, loc->loc_size, &sc->sc.sc_ahcih);
+	    loc->loc_offset + TEGRA_AHCISATA_OFFSET,
+	    loc->loc_size - TEGRA_AHCISATA_OFFSET, &sc->sc.sc_ahcih);
 	sc->sc.sc_ahci_ports = 1;
 
 	aprint_naive("\n");
 	aprint_normal(": SATA\n");
 
+	tegra_car_periph_sata_enable();
+
+	tegra_ahcisata_init(sc);
+
 	sc->sc_ih = intr_establish(loc->loc_intr, IPL_BIO, IST_LEVEL,
 	    ahci_intr, &sc->sc);
 	if (sc->sc_ih == NULL) {
@@ -89,3 +105,41 @@ tegra_ahcisata_attach(device_t parent, d
 
 	ahci_attach(&sc->sc);
 }
+
+static void
+tegra_ahcisata_init(struct tegra_ahcisata_softc *sc)
+{
+	bus_space_tag_t bst = sc->sc_bst;
+	bus_space_handle_t bsh = sc->sc_bsh;
+
+	/* Enable IFPS device block */
+	tegra_reg_set_clear(bst, bsh, TEGRA_SATA_CONFIGURATION_REG,
+	    TEGRA_SATA_CONFIGURATION_EN_FPCI, 0);
+
+	/* Backdoor update the programming interface field and class code */
+	tegra_reg_set_clear(bst, bsh, TEGRA_T_SATA0_CFG_SATA_REG,
+	    TEGRA_T_SATA0_CFG_SATA_BACKDOOR_PROG_IF_EN, 0);
+	bus_space_write_4(bst, bsh, TEGRA_T_SATA0_BKDOOR_CC_REG,
+	    __SHIFTIN(0x1016, TEGRA_T_SATA0_BKDOOR_CC_CLASS_CODE) |
+	    __SHIFTIN(0x1, TEGRA_T_SATA0_BKDOOR_CC_PROG_IF));
+	tegra_reg_set_clear(bst, bsh, TEGRA_T_SATA0_CFG_SATA_REG,
+	    0, TEGRA_T_SATA0_CFG_SATA_BACKDOOR_PROG_IF_EN);
+
+	/* Enable access and bus mastering */
+	tegra_reg_set_clear(bst, bsh, TEGRA_T_SATA0_CFG1_REG,
+	    TEGRA_T_SATA0_CFG1_SERR |
+	    TEGRA_T_SATA0_CFG1_BUS_MASTER |
+	    TEGRA_T_SATA0_CFG1_MEM_SPACE |
+	    TEGRA_T_SATA0_CFG1_IO_SPACE,
+	    0);
+
+	/* MMIO setup */
+	bus_space_write_4(bst, bsh, TEGRA_SATA_FPCI_BAR5_REG,
+	    __SHIFTIN(0x10000, TEGRA_SATA_FPCI_BAR_START));
+	bus_space_write_4(bst, bsh, TEGRA_T_SATA0_CFG9_REG,
+	    __SHIFTIN(0x8000, TEGRA_T_SATA0_CFG9_BASE_ADDRESS));
+
+	/* Enable interrupts */
+	tegra_reg_set_clear(bst, bsh, TEGRA_SATA_INTR_MASK_REG,
+	    TEGRA_SATA_INTR_MASK_IP_INT, 0);
+}

Index: src/sys/arch/arm/nvidia/tegra_car.c
diff -u src/sys/arch/arm/nvidia/tegra_car.c:1.7 src/sys/arch/arm/nvidia/tegra_car.c:1.8
--- src/sys/arch/arm/nvidia/tegra_car.c:1.7	Sun May 10 11:04:59 2015
+++ src/sys/arch/arm/nvidia/tegra_car.c	Sun May 10 15:31:48 2015
@@ -1,4 +1,4 @@
-/* $NetBSD: tegra_car.c,v 1.7 2015/05/10 11:04:59 jmcneill Exp $ */
+/* $NetBSD: tegra_car.c,v 1.8 2015/05/10 15:31:48 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.7 2015/05/10 11:04:59 jmcneill Exp $");
+__KERNEL_RCSID(0, "$NetBSD: tegra_car.c,v 1.8 2015/05/10 15:31:48 jmcneill Exp $");
 
 #include <sys/param.h>
 #include <sys/bus.h>
@@ -40,6 +40,7 @@ __KERNEL_RCSID(0, "$NetBSD: tegra_car.c,
 
 #include <arm/nvidia/tegra_reg.h>
 #include <arm/nvidia/tegra_carreg.h>
+#include <arm/nvidia/tegra_pmcreg.h>
 #include <arm/nvidia/tegra_var.h>
 
 static int	tegra_car_match(device_t, cfdata_t, void *);
@@ -80,8 +81,10 @@ tegra_car_attach(device_t parent, device
 	aprint_naive("\n");
 	aprint_normal(": CAR\n");
 
+	printf("CAR_PLLE_BASE_REG = %#x\n", bus_space_read_4(sc->sc_bst, sc->sc_bsh, CAR_PLLE_BASE_REG));
 	aprint_verbose_dev(self, "PLLX = %u Hz\n", tegra_car_pllx_rate());
 	aprint_verbose_dev(self, "PLLC = %u Hz\n", tegra_car_pllc_rate());
+	aprint_verbose_dev(self, "PLLE = %u Hz\n", tegra_car_plle_rate());
 	aprint_verbose_dev(self, "PLLU = %u Hz\n", tegra_car_pllu_rate());
 	aprint_verbose_dev(self, "PLLP0 = %u Hz\n", tegra_car_pllp0_rate());
 }
@@ -141,6 +144,13 @@ tegra_car_pllc_rate(void)
 }
 
 u_int
+tegra_car_plle_rate(void)
+{
+	return tegra_car_pll_rate(CAR_PLLE_BASE_REG, CAR_PLLE_BASE_DIVM,
+	    CAR_PLLE_BASE_DIVN, CAR_PLLE_BASE_DIVP_CML);
+}
+
+u_int
 tegra_car_pllu_rate(void)
 {
 	bus_space_tag_t bst;
@@ -401,3 +411,29 @@ tegra_car_periph_hda_enable(void)
 	bus_space_write_4(bst, bsh, CAR_RST_DEV_W_CLR_REG,
 	    CAR_DEV_W_HDA2HDMICODEC);
 }
+
+void
+tegra_car_periph_sata_enable(void)
+{
+	bus_space_tag_t bst;
+	bus_space_handle_t bsh;
+
+	tegra_car_get_bs(&bst, &bsh);
+
+	/* Enable CML clock for SATA */
+	tegra_reg_set_clear(bst, bsh, CAR_PLLE_AUX_REG,
+	    CAR_PLLE_AUX_CML1_OEN, 0);
+
+	/* De-assert reset to SATA PADPLL */
+	tegra_reg_set_clear(bst, bsh, CAR_SATA_PLL_CFG0_REG,
+	    0, CAR_SATA_PLL_CFG0_PADPLL_RESET_OVERRIDE_VALUE);
+	delay(15);
+
+	/* Ungate SAX partition in the PMC */
+	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_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.9 src/sys/arch/arm/nvidia/tegra_carreg.h:1.10
--- src/sys/arch/arm/nvidia/tegra_carreg.h:1.9	Sun May 10 11:12:07 2015
+++ src/sys/arch/arm/nvidia/tegra_carreg.h	Sun May 10 15:31:48 2015
@@ -1,4 +1,4 @@
-/* $NetBSD: tegra_carreg.h,v 1.9 2015/05/10 11:12:07 jmcneill Exp $ */
+/* $NetBSD: tegra_carreg.h,v 1.10 2015/05/10 15:31:48 jmcneill Exp $ */
 
 /*-
  * Copyright (c) 2015 Jared D. McNeill <jmcne...@invisible.ca>
@@ -89,6 +89,17 @@
 
 #define CAR_PLLX_MISC_REG	0xe4
 
+#define CAR_PLLE_BASE_REG	0xe8
+#define CAR_PLLE_BASE_ENABLE		__BIT(30)
+#define CAR_PLLE_BASE_LOCK_OVERRIDE	__BIT(29)
+#define CAR_PLLE_BASE_FDIV48		__BIT(28)
+#define CAR_PLLE_BASE_DIVP_CML		__BITS(27,24)
+#define CAR_PLLE_BASE_EXT_SETUP_23_16	__BITS(23,16)
+#define CAR_PLLE_BASE_DIVN		__BITS(15,8)
+#define CAR_PLLE_BASE_DIVM		__BITS(7,0)
+
+#define CAR_PLLE_MISC_REG	0xec
+
 #define CAR_CLKSRC_UARTA_REG		0x178
 #define CAR_CLKSRC_UARTB_REG		0x17c
 #define CAR_CLKSRC_UARTC_REG		0x1a0
@@ -270,4 +281,39 @@
 #define CAR_UTMIP_PLL_CFG2_PD_SAMP_A_POWERUP	__BIT(1)
 #define CAR_UTMIP_PLL_CFG2_PD_SAMP_A_POWERDOWN	__BIT(0)
 
+#define CAR_PLLE_AUX_REG		0x48c
+#define CAR_PLLE_AUX_SS_SEQ_INCLUDE		__BIT(31)
+#define CAR_PLLE_AUX_REF_SEL_PLLREFE		__BIT(28)
+#define CAR_PLLE_AUX_SEQ_STATE			__BITS(27,26)
+#define CAR_PLLE_AUX_SEQ_START_STATE		__BIT(25)
+#define CAR_PLLE_AUX_SEQ_ENABLE			__BIT(24)
+#define CAR_PLLE_AUX_SS_DLY			__BITS(23,16)
+#define CAR_PLLE_AUX_LOCK_DLY			__BITS(15,8)
+#define CAR_PLLE_AUX_FAST_PT			__BIT(7)
+#define CAR_PLLE_AUX_SS_SWCTL			__BIT(6)
+#define CAR_PLLE_AUX_CONFIG_SWCTL		__BIT(5)
+#define CAR_PLLE_AUX_ENABLE_SWCTL		__BIT(4)
+#define CAR_PLLE_AUX_USE_LOCKDET		__BIT(3)
+#define CAR_PLLE_AUX_REF_SRC			__BIT(2)
+#define CAR_PLLE_AUX_CML1_OEN			__BIT(1)
+#define CAR_PLLE_AUX_CML0_OEN			__BIT(0)
+
+#define CAR_SATA_PLL_CFG0_REG		0x490
+#define CAR_SATA_PLL_CFG0_SEQ_STATE		__BITS(27,26)
+#define CAR_SATA_PLL_CFG0_SEQ_START_STATE	__BIT(25)
+#define CAR_SATA_PLL_CFG0_SEQ_ENABLE		__BIT(24)
+#define CAR_SATA_PLL_CFG0_SEQ_PADPLL_PD_INPUT_VALUE __BIT(7)
+#define CAR_SATA_PLL_CFG0_SEQ_LANE_PD_INPUT_VALUE __BIT(6)
+#define CAR_SATA_PLL_CFG0_SEQ_RESET_INPUT_VALUE	__BIT(5)
+#define CAR_SATA_PLL_CFG0_SEQ_IN_SWCTL		__BIT(4)
+#define CAR_SATA_PLL_CFG0_PADPLL_USE_LOCKDET	__BIT(2)
+#define CAR_SATA_PLL_CFG0_PADPLL_RESET_OVERRIDE_VALUE __BIT(1)
+#define CAR_SATA_PLL_CFG0_PADPLL_RESET_SWCTL	__BIT(0)
+
+#define CAR_SATA_PLL_CFG1_REG		0x494
+#define CAR_SATA_PLL_CFG1_LANE_IDDQ2_PADPLL_RESET_DLY __BITS(31,24)
+#define CAR_SATA_PLL_CFG1_PADPLL_IDDQ2LANE_SLUMBER_DLY __BITS(23,16)
+#define CAR_SATA_PLL_CFG1_PADPLL_PU_POST_DLY	__BITS(15,8)
+#define CAR_SATA_PLL_CFG1_LANE_IDDQ2_PADPLL_IDDQ_DLY __BITS(7,0)
+
 #endif /* _ARM_TEGRA_CARREG_H */

Index: src/sys/arch/arm/nvidia/tegra_var.h
diff -u src/sys/arch/arm/nvidia/tegra_var.h:1.12 src/sys/arch/arm/nvidia/tegra_var.h:1.13
--- src/sys/arch/arm/nvidia/tegra_var.h:1.12	Sun May 10 11:04:59 2015
+++ src/sys/arch/arm/nvidia/tegra_var.h	Sun May 10 15:31:48 2015
@@ -1,4 +1,4 @@
-/* $NetBSD: tegra_var.h,v 1.12 2015/05/10 11:04:59 jmcneill Exp $ */
+/* $NetBSD: tegra_var.h,v 1.13 2015/05/10 15:31:48 jmcneill Exp $ */
 
 /*-
  * Copyright (c) 2015 Jared D. McNeill <jmcne...@invisible.ca>
@@ -75,6 +75,7 @@ void	tegra_dma_bootstrap(psize_t);
 
 u_int	tegra_car_osc_rate(void);
 u_int	tegra_car_pllc_rate(void);
+u_int	tegra_car_plle_rate(void);
 u_int	tegra_car_pllx_rate(void);
 u_int	tegra_car_pllu_rate(void);
 u_int	tegra_car_pllp0_rate(void);
@@ -83,6 +84,7 @@ u_int	tegra_car_periph_sdmmc_rate(u_int)
 int	tegra_car_periph_sdmmc_set_div(u_int, u_int);
 int	tegra_car_periph_usb_enable(u_int);
 void	tegra_car_periph_hda_enable(void);
+void	tegra_car_periph_sata_enable(void);
 void	tegra_car_utmip_init(void);
 void	tegra_car_utmip_enable(u_int);
 

Reply via email to