1c00ac259SPeter Tyser /*
2c00ac259SPeter Tyser * Copyright 2008 Extreme Engineering Solutions, Inc.
3c00ac259SPeter Tyser *
41a459660SWolfgang Denk * SPDX-License-Identifier: GPL-2.0+
5c00ac259SPeter Tyser */
6c00ac259SPeter Tyser
7c00ac259SPeter Tyser #include <common.h>
8c00ac259SPeter Tyser #include <command.h>
9c00ac259SPeter Tyser #include <asm/processor.h>
10c00ac259SPeter Tyser #include <asm/mmu.h>
11c00ac259SPeter Tyser #include <asm/immap_85xx.h>
12c00ac259SPeter Tyser #include <asm/fsl_pci.h>
13c00ac259SPeter Tyser #include <asm/io.h>
14c00ac259SPeter Tyser #include <asm/cache.h>
15*0e00a84cSMasahiro Yamada #include <linux/libfdt.h>
16c00ac259SPeter Tyser #include <fdt_support.h>
17c00ac259SPeter Tyser #include <pca953x.h>
18c00ac259SPeter Tyser
19c00ac259SPeter Tyser DECLARE_GLOBAL_DATA_PTR;
20c00ac259SPeter Tyser
21c00ac259SPeter Tyser extern void ft_board_pci_setup(void *blob, bd_t *bd);
22c00ac259SPeter Tyser
flash_cs_fixup(void)23c00ac259SPeter Tyser static void flash_cs_fixup(void)
24c00ac259SPeter Tyser {
25c00ac259SPeter Tyser int flash_sel;
26c00ac259SPeter Tyser
27c00ac259SPeter Tyser /*
28c00ac259SPeter Tyser * Print boot dev and swap flash flash chip selects if booted from 2nd
29c00ac259SPeter Tyser * flash. Swapping chip selects presents user with a common memory
30c00ac259SPeter Tyser * map regardless of which flash was booted from.
31c00ac259SPeter Tyser */
32c00ac259SPeter Tyser flash_sel = !((pca953x_get_val(CONFIG_SYS_I2C_PCA953X_ADDR0) &
33c00ac259SPeter Tyser CONFIG_SYS_PCA953X_C0_FLASH_PASS_CS));
34eddf52b5SPeter Tyser printf("Flash: Executed from flash%d\n", flash_sel ? 2 : 1);
35c00ac259SPeter Tyser
36c00ac259SPeter Tyser if (flash_sel) {
37c00ac259SPeter Tyser set_lbc_br(0, CONFIG_SYS_BR1_PRELIM);
38c00ac259SPeter Tyser set_lbc_or(0, CONFIG_SYS_OR1_PRELIM);
39c00ac259SPeter Tyser
40c00ac259SPeter Tyser set_lbc_br(1, CONFIG_SYS_BR0_PRELIM);
41c00ac259SPeter Tyser set_lbc_or(1, CONFIG_SYS_OR0_PRELIM);
42c00ac259SPeter Tyser }
43c00ac259SPeter Tyser }
44c00ac259SPeter Tyser
board_early_init_r(void)45c00ac259SPeter Tyser int board_early_init_r(void)
46c00ac259SPeter Tyser {
47c00ac259SPeter Tyser /* Initialize PCA9557 devices */
48c00ac259SPeter Tyser pca953x_set_pol(CONFIG_SYS_I2C_PCA953X_ADDR0, 0xff, 0);
49c00ac259SPeter Tyser pca953x_set_pol(CONFIG_SYS_I2C_PCA953X_ADDR1, 0xff, 0);
50c00ac259SPeter Tyser pca953x_set_pol(CONFIG_SYS_I2C_PCA953X_ADDR2, 0xff, 0);
51c00ac259SPeter Tyser pca953x_set_pol(CONFIG_SYS_I2C_PCA953X_ADDR3, 0xff, 0);
52c00ac259SPeter Tyser
53c00ac259SPeter Tyser /*
54c00ac259SPeter Tyser * Remap NOR flash region to caching-inhibited
55c00ac259SPeter Tyser * so that flash can be erased/programmed properly.
56c00ac259SPeter Tyser */
57c00ac259SPeter Tyser
58c00ac259SPeter Tyser /* Flush d-cache and invalidate i-cache of any FLASH data */
59c00ac259SPeter Tyser flush_dcache();
60c00ac259SPeter Tyser invalidate_icache();
61c00ac259SPeter Tyser
62c00ac259SPeter Tyser /* Invalidate existing TLB entry for NOR flash */
63c00ac259SPeter Tyser disable_tlb(0);
64c00ac259SPeter Tyser set_tlb(1, (CONFIG_SYS_FLASH_BASE2 & 0xf0000000),
65c00ac259SPeter Tyser (CONFIG_SYS_FLASH_BASE2 & 0xf0000000),
66c00ac259SPeter Tyser MAS3_SX|MAS3_SW|MAS3_SR, MAS2_I|MAS2_G,
67c00ac259SPeter Tyser 0, 0, BOOKE_PAGESZ_256M, 1);
68c00ac259SPeter Tyser
69c00ac259SPeter Tyser flash_cs_fixup();
70c00ac259SPeter Tyser
71c00ac259SPeter Tyser return 0;
72c00ac259SPeter Tyser }
73c00ac259SPeter Tyser
74c00ac259SPeter Tyser #if defined(CONFIG_OF_BOARD_SETUP)
ft_board_setup(void * blob,bd_t * bd)75e895a4b0SSimon Glass int ft_board_setup(void *blob, bd_t *bd)
76c00ac259SPeter Tyser {
77c00ac259SPeter Tyser #ifdef CONFIG_PCI
78c00ac259SPeter Tyser ft_board_pci_setup(blob, bd);
79c00ac259SPeter Tyser #endif
80c00ac259SPeter Tyser ft_cpu_setup(blob, bd);
81e895a4b0SSimon Glass
82e895a4b0SSimon Glass return 0;
83c00ac259SPeter Tyser }
84c00ac259SPeter Tyser #endif
85