This used to be done with registers direct access, which is not clear
and optimal.

Signed-off-by: Valentin Longchamp <valentin.longch...@keymile.com>
Signed-off-by: Holger Brunck <holger.bru...@keymile.com>
cc: Gerlando Falauto <gerlando.fala...@keymile.com>
cc: Prafulla Wadaskar <prafu...@marvell.com>
---
 board/keymile/km_arm/km_arm.c |   55 +++++++++++++++++++++--------------------
 include/configs/km/km_arm.h   |    2 +-
 2 files changed, 29 insertions(+), 28 deletions(-)

diff --git a/board/keymile/km_arm/km_arm.c b/board/keymile/km_arm/km_arm.c
index c6c9a71..2507734 100644
--- a/board/keymile/km_arm/km_arm.c
+++ b/board/keymile/km_arm/km_arm.c
@@ -242,20 +242,15 @@ int misc_init_r(void)
 
 int board_early_init_f(void)
 {
-       u32 tmp;
-
        kirkwood_mpp_conf(kwmpp_config);
 
        /*
-        * The FLASH_GPIO_PIN switches between using a
+        * The KM_FLASH_GPIO_PIN switches between using a
         * NAND or a SPI FLASH. Set this pin on start
         * to NAND mode.
         */
-       tmp = readl(KW_GPIO0_BASE);
-       writel(tmp | FLASH_GPIO_PIN , KW_GPIO0_BASE);
-       tmp = readl(KW_GPIO0_BASE + 4);
-       writel(tmp & (~FLASH_GPIO_PIN) , KW_GPIO0_BASE + 4);
-
+       kw_gpio_set_valid(KM_FLASH_GPIO_PIN, 1);
+       kw_gpio_direction_output(KM_FLASH_GPIO_PIN, 1);
 #if defined(CONFIG_SOFT_I2C)
        /* init the GPIO for I2C Bitbang driver */
        kw_gpio_set_valid(KM_KIRKWOOD_SDA_PIN, 1);
@@ -284,35 +279,41 @@ int board_init(void)
        return 0;
 }
 
+int km_hw_spi_bus_claim(int on)
+{
+       int gpio_value = !on;
+
+       if (on) {
+               kwmpp_config[0] = MPP0_SPI_SCn;
+               kwmpp_config[1] = MPP1_SPI_MOSI;
+               kwmpp_config[2] = MPP2_SPI_SCK;
+               kwmpp_config[3] = MPP3_SPI_MISO;
+       } else {
+               kwmpp_config[0] = MPP0_NF_IO2;
+               kwmpp_config[1] = MPP1_NF_IO3;
+               kwmpp_config[2] = MPP2_NF_IO4;
+               kwmpp_config[3] = MPP3_NF_IO5;
+       }
+
+       /* Multi-Purpose Pins Functionality configuration */
+       kirkwood_mpp_conf(kwmpp_config);
+       kw_gpio_set_value(KM_FLASH_GPIO_PIN, gpio_value);
+
+       return 0;
+}
+
 #if defined(CONFIG_CMD_SF)
 int do_spi_toggle(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 {
-       u32 tmp;
        if (argc < 2)
                return cmd_usage(cmdtp);
 
        if ((strcmp(argv[1], "off") == 0)) {
                printf("SPI FLASH disabled, NAND enabled\n");
-               /* Multi-Purpose Pins Functionality configuration */
-               kwmpp_config[0] = MPP0_NF_IO2;
-               kwmpp_config[1] = MPP1_NF_IO3;
-               kwmpp_config[2] = MPP2_NF_IO4;
-               kwmpp_config[3] = MPP3_NF_IO5;
-
-               kirkwood_mpp_conf(kwmpp_config);
-               tmp = readl(KW_GPIO0_BASE);
-               writel(tmp | FLASH_GPIO_PIN , KW_GPIO0_BASE);
+               km_hw_spi_bus_claim(0);
        } else if ((strcmp(argv[1], "on") == 0)) {
                printf("SPI FLASH enabled, NAND disabled\n");
-               /* Multi-Purpose Pins Functionality configuration */
-               kwmpp_config[0] = MPP0_SPI_SCn;
-               kwmpp_config[1] = MPP1_SPI_MOSI;
-               kwmpp_config[2] = MPP2_SPI_SCK;
-               kwmpp_config[3] = MPP3_SPI_MISO;
-
-               kirkwood_mpp_conf(kwmpp_config);
-               tmp = readl(KW_GPIO0_BASE);
-               writel(tmp & (~FLASH_GPIO_PIN) , KW_GPIO0_BASE);
+               km_hw_spi_bus_claim(1);
        } else {
                return cmd_usage(cmdtp);
        }
diff --git a/include/configs/km/km_arm.h b/include/configs/km/km_arm.h
index 36eb765..e2e8793 100644
--- a/include/configs/km/km_arm.h
+++ b/include/configs/km/km_arm.h
@@ -227,7 +227,7 @@ int get_scl(void);
 #define CONFIG_SPI_FLASH
 #define CONFIG_SPI_FLASH_STMICRO
 
-#define FLASH_GPIO_PIN                 0x00010000
+#define KM_FLASH_GPIO_PIN      16
 
 #define MTDIDS_DEFAULT         "nand0=orion_nand"
 /* test-only: partitioning needs some tuning, this is just for tests */
-- 
1.7.1

_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
http://lists.denx.de/mailman/listinfo/u-boot

Reply via email to