Bo Shen | 927b901 | 2014-11-10 15:24:02 +0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2014 Atmel |
| 3 | * Bo Shen <voice.shen@atmel.com> |
| 4 | * |
| 5 | * SPDX-License-Identifier: GPL-2.0+ |
| 6 | */ |
| 7 | |
| 8 | #include <common.h> |
| 9 | #include <asm/io.h> |
| 10 | #include <asm/arch/at91_common.h> |
| 11 | #include <asm/arch/at91_pmc.h> |
| 12 | #include <asm/arch/at91_rstc.h> |
Bo Shen | 5a4c9c2 | 2014-12-15 13:24:38 +0800 | [diff] [blame] | 13 | #include <asm/arch/atmel_mpddrc.h> |
Bo Shen | da08d79 | 2014-12-03 18:02:20 +0800 | [diff] [blame] | 14 | #include <asm/arch/atmel_usba_udc.h> |
Bo Shen | 927b901 | 2014-11-10 15:24:02 +0800 | [diff] [blame] | 15 | #include <asm/arch/gpio.h> |
| 16 | #include <asm/arch/clk.h> |
| 17 | #include <asm/arch/sama5d3_smc.h> |
| 18 | #include <asm/arch/sama5d4.h> |
Bo Shen | f8009a7 | 2015-01-08 15:20:12 +0800 | [diff] [blame] | 19 | #include <atmel_hlcdc.h> |
Bo Shen | 927b901 | 2014-11-10 15:24:02 +0800 | [diff] [blame] | 20 | #include <atmel_mci.h> |
| 21 | #include <lcd.h> |
| 22 | #include <mmc.h> |
| 23 | #include <net.h> |
| 24 | #include <netdev.h> |
| 25 | #include <nand.h> |
| 26 | #include <spi.h> |
| 27 | |
| 28 | DECLARE_GLOBAL_DATA_PTR; |
| 29 | |
| 30 | #ifdef CONFIG_ATMEL_SPI |
| 31 | int spi_cs_is_valid(unsigned int bus, unsigned int cs) |
| 32 | { |
| 33 | return bus == 0 && cs == 0; |
| 34 | } |
| 35 | |
| 36 | void spi_cs_activate(struct spi_slave *slave) |
| 37 | { |
| 38 | at91_set_pio_output(AT91_PIO_PORTC, 3, 0); |
| 39 | } |
| 40 | |
| 41 | void spi_cs_deactivate(struct spi_slave *slave) |
| 42 | { |
| 43 | at91_set_pio_output(AT91_PIO_PORTC, 3, 1); |
| 44 | } |
| 45 | |
| 46 | static void sama5d4ek_spi0_hw_init(void) |
| 47 | { |
| 48 | at91_set_a_periph(AT91_PIO_PORTC, 0, 0); /* SPI0_MISO */ |
| 49 | at91_set_a_periph(AT91_PIO_PORTC, 1, 0); /* SPI0_MOSI */ |
| 50 | at91_set_a_periph(AT91_PIO_PORTC, 2, 0); /* SPI0_SPCK */ |
| 51 | |
| 52 | at91_set_pio_output(AT91_PIO_PORTC, 3, 1); /* SPI0_CS0 */ |
| 53 | |
| 54 | /* Enable clock */ |
| 55 | at91_periph_clk_enable(ATMEL_ID_SPI0); |
| 56 | } |
| 57 | #endif /* CONFIG_ATMEL_SPI */ |
| 58 | |
| 59 | #ifdef CONFIG_NAND_ATMEL |
| 60 | static void sama5d4ek_nand_hw_init(void) |
| 61 | { |
| 62 | struct at91_smc *smc = (struct at91_smc *)ATMEL_BASE_SMC; |
| 63 | |
| 64 | at91_periph_clk_enable(ATMEL_ID_SMC); |
| 65 | |
| 66 | /* Configure SMC CS3 for NAND */ |
| 67 | writel(AT91_SMC_SETUP_NWE(1) | AT91_SMC_SETUP_NCS_WR(1) | |
| 68 | AT91_SMC_SETUP_NRD(1) | AT91_SMC_SETUP_NCS_RD(1), |
| 69 | &smc->cs[3].setup); |
| 70 | writel(AT91_SMC_PULSE_NWE(2) | AT91_SMC_PULSE_NCS_WR(3) | |
| 71 | AT91_SMC_PULSE_NRD(2) | AT91_SMC_PULSE_NCS_RD(3), |
| 72 | &smc->cs[3].pulse); |
| 73 | writel(AT91_SMC_CYCLE_NWE(5) | AT91_SMC_CYCLE_NRD(5), |
| 74 | &smc->cs[3].cycle); |
| 75 | writel(AT91_SMC_TIMINGS_TCLR(2) | AT91_SMC_TIMINGS_TADL(7) | |
| 76 | AT91_SMC_TIMINGS_TAR(2) | AT91_SMC_TIMINGS_TRR(3) | |
| 77 | AT91_SMC_TIMINGS_TWB(7) | AT91_SMC_TIMINGS_RBNSEL(3)| |
| 78 | AT91_SMC_TIMINGS_NFSEL(1), &smc->cs[3].timings); |
| 79 | writel(AT91_SMC_MODE_RM_NRD | AT91_SMC_MODE_WM_NWE | |
| 80 | AT91_SMC_MODE_EXNW_DISABLE | |
| 81 | AT91_SMC_MODE_DBW_8 | |
| 82 | AT91_SMC_MODE_TDF_CYCLE(3), |
| 83 | &smc->cs[3].mode); |
| 84 | |
| 85 | at91_set_a_periph(AT91_PIO_PORTC, 5, 0); /* D0 */ |
| 86 | at91_set_a_periph(AT91_PIO_PORTC, 6, 0); /* D1 */ |
| 87 | at91_set_a_periph(AT91_PIO_PORTC, 7, 0); /* D2 */ |
| 88 | at91_set_a_periph(AT91_PIO_PORTC, 8, 0); /* D3 */ |
| 89 | at91_set_a_periph(AT91_PIO_PORTC, 9, 0); /* D4 */ |
| 90 | at91_set_a_periph(AT91_PIO_PORTC, 10, 0); /* D5 */ |
| 91 | at91_set_a_periph(AT91_PIO_PORTC, 11, 0); /* D6 */ |
| 92 | at91_set_a_periph(AT91_PIO_PORTC, 12, 0); /* D7 */ |
| 93 | at91_set_a_periph(AT91_PIO_PORTC, 13, 0); /* RE */ |
| 94 | at91_set_a_periph(AT91_PIO_PORTC, 14, 0); /* WE */ |
| 95 | at91_set_a_periph(AT91_PIO_PORTC, 15, 1); /* NCS */ |
| 96 | at91_set_a_periph(AT91_PIO_PORTC, 16, 1); /* RDY */ |
| 97 | at91_set_a_periph(AT91_PIO_PORTC, 17, 1); /* ALE */ |
| 98 | at91_set_a_periph(AT91_PIO_PORTC, 18, 1); /* CLE */ |
| 99 | } |
| 100 | #endif |
| 101 | |
| 102 | #ifdef CONFIG_CMD_USB |
| 103 | static void sama5d4ek_usb_hw_init(void) |
| 104 | { |
| 105 | at91_set_pio_output(AT91_PIO_PORTE, 11, 0); |
| 106 | at91_set_pio_output(AT91_PIO_PORTE, 12, 0); |
| 107 | at91_set_pio_output(AT91_PIO_PORTE, 10, 0); |
| 108 | } |
| 109 | #endif |
| 110 | |
| 111 | #ifdef CONFIG_LCD |
| 112 | vidinfo_t panel_info = { |
| 113 | .vl_col = 800, |
| 114 | .vl_row = 480, |
| 115 | .vl_clk = 33260000, |
Bo Shen | 927b901 | 2014-11-10 15:24:02 +0800 | [diff] [blame] | 116 | .vl_bpix = LCD_BPP, |
| 117 | .vl_tft = 1, |
| 118 | .vl_hsync_len = 5, |
| 119 | .vl_left_margin = 128, |
| 120 | .vl_right_margin = 0, |
| 121 | .vl_vsync_len = 5, |
| 122 | .vl_upper_margin = 23, |
| 123 | .vl_lower_margin = 22, |
| 124 | .mmio = ATMEL_BASE_LCDC, |
| 125 | }; |
| 126 | |
| 127 | /* No power up/down pin for the LCD pannel */ |
| 128 | void lcd_enable(void) { /* Empty! */ } |
| 129 | void lcd_disable(void) { /* Empty! */ } |
| 130 | |
| 131 | unsigned int has_lcdc(void) |
| 132 | { |
| 133 | return 1; |
| 134 | } |
| 135 | |
| 136 | static void sama5d4ek_lcd_hw_init(void) |
| 137 | { |
| 138 | at91_set_a_periph(AT91_PIO_PORTA, 24, 0); /* LCDPWM */ |
| 139 | at91_set_a_periph(AT91_PIO_PORTA, 25, 0); /* LCDDISP */ |
| 140 | at91_set_a_periph(AT91_PIO_PORTA, 26, 0); /* LCDVSYNC */ |
| 141 | at91_set_a_periph(AT91_PIO_PORTA, 27, 0); /* LCDHSYNC */ |
| 142 | at91_set_a_periph(AT91_PIO_PORTA, 28, 0); /* LCDDOTCK */ |
| 143 | at91_set_a_periph(AT91_PIO_PORTA, 29, 0); /* LCDDEN */ |
| 144 | |
| 145 | at91_set_a_periph(AT91_PIO_PORTA, 2, 0); /* LCDD2 */ |
| 146 | at91_set_a_periph(AT91_PIO_PORTA, 3, 0); /* LCDD3 */ |
| 147 | at91_set_a_periph(AT91_PIO_PORTA, 4, 0); /* LCDD4 */ |
| 148 | at91_set_a_periph(AT91_PIO_PORTA, 5, 0); /* LCDD5 */ |
| 149 | at91_set_a_periph(AT91_PIO_PORTA, 6, 0); /* LCDD6 */ |
| 150 | at91_set_a_periph(AT91_PIO_PORTA, 7, 0); /* LCDD7 */ |
| 151 | |
| 152 | at91_set_a_periph(AT91_PIO_PORTA, 10, 0); /* LCDD10 */ |
| 153 | at91_set_a_periph(AT91_PIO_PORTA, 11, 0); /* LCDD11 */ |
| 154 | at91_set_a_periph(AT91_PIO_PORTA, 12, 0); /* LCDD12 */ |
| 155 | at91_set_a_periph(AT91_PIO_PORTA, 13, 0); /* LCDD13 */ |
| 156 | at91_set_a_periph(AT91_PIO_PORTA, 14, 0); /* LCDD14 */ |
| 157 | at91_set_a_periph(AT91_PIO_PORTA, 15, 0); /* LCDD15 */ |
| 158 | |
| 159 | at91_set_a_periph(AT91_PIO_PORTA, 18, 0); /* LCDD18 */ |
| 160 | at91_set_a_periph(AT91_PIO_PORTA, 19, 0); /* LCDD19 */ |
| 161 | at91_set_a_periph(AT91_PIO_PORTA, 20, 0); /* LCDD20 */ |
| 162 | at91_set_a_periph(AT91_PIO_PORTA, 21, 0); /* LCDD21 */ |
| 163 | at91_set_a_periph(AT91_PIO_PORTA, 22, 0); /* LCDD22 */ |
| 164 | at91_set_a_periph(AT91_PIO_PORTA, 23, 0); /* LCDD23 */ |
| 165 | |
| 166 | /* Enable clock */ |
| 167 | at91_periph_clk_enable(ATMEL_ID_LCDC); |
| 168 | } |
| 169 | |
| 170 | #ifdef CONFIG_LCD_INFO |
| 171 | void lcd_show_board_info(void) |
| 172 | { |
| 173 | ulong dram_size, nand_size; |
| 174 | int i; |
| 175 | char temp[32]; |
| 176 | |
| 177 | lcd_printf("2014 ATMEL Corp\n"); |
| 178 | lcd_printf("at91@atmel.com\n"); |
| 179 | lcd_printf("%s CPU at %s MHz\n", get_cpu_name(), |
| 180 | strmhz(temp, get_cpu_clk_rate())); |
| 181 | |
| 182 | dram_size = 0; |
| 183 | for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) |
| 184 | dram_size += gd->bd->bi_dram[i].size; |
| 185 | |
| 186 | nand_size = 0; |
| 187 | #ifdef CONFIG_NAND_ATMEL |
| 188 | for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++) |
| 189 | nand_size += nand_info[i].size; |
| 190 | #endif |
| 191 | lcd_printf("%ld MB SDRAM, %ld MB NAND\n", |
| 192 | dram_size >> 20, nand_size >> 20); |
| 193 | } |
| 194 | #endif /* CONFIG_LCD_INFO */ |
| 195 | |
| 196 | #endif /* CONFIG_LCD */ |
| 197 | |
| 198 | #ifdef CONFIG_GENERIC_ATMEL_MCI |
| 199 | void sama5d4ek_mci1_hw_init(void) |
| 200 | { |
| 201 | at91_set_c_periph(AT91_PIO_PORTE, 19, 1); /* MCI1 CDA */ |
| 202 | at91_set_c_periph(AT91_PIO_PORTE, 20, 1); /* MCI1 DA0 */ |
| 203 | at91_set_c_periph(AT91_PIO_PORTE, 21, 1); /* MCI1 DA1 */ |
| 204 | at91_set_c_periph(AT91_PIO_PORTE, 22, 1); /* MCI1 DA2 */ |
| 205 | at91_set_c_periph(AT91_PIO_PORTE, 23, 1); /* MCI1 DA3 */ |
| 206 | at91_set_c_periph(AT91_PIO_PORTE, 18, 0); /* MCI1 CLK */ |
| 207 | |
| 208 | /* |
| 209 | * As the mci io internal pull down is too strong, so if the io needs |
| 210 | * external pull up, the pull up resistor will be very small, if so |
| 211 | * the power consumption will increase, so disable the interanl pull |
| 212 | * down to save the power. |
| 213 | */ |
| 214 | at91_set_pio_pulldown(AT91_PIO_PORTE, 18, 0); |
| 215 | at91_set_pio_pulldown(AT91_PIO_PORTE, 19, 0); |
| 216 | at91_set_pio_pulldown(AT91_PIO_PORTE, 20, 0); |
| 217 | at91_set_pio_pulldown(AT91_PIO_PORTE, 21, 0); |
| 218 | at91_set_pio_pulldown(AT91_PIO_PORTE, 22, 0); |
| 219 | at91_set_pio_pulldown(AT91_PIO_PORTE, 23, 0); |
| 220 | |
| 221 | /* Enable clock */ |
| 222 | at91_periph_clk_enable(ATMEL_ID_MCI1); |
| 223 | } |
| 224 | |
| 225 | int board_mmc_init(bd_t *bis) |
| 226 | { |
| 227 | /* Enable power for MCI1 interface */ |
| 228 | at91_set_pio_output(AT91_PIO_PORTE, 15, 0); |
| 229 | |
| 230 | return atmel_mci_init((void *)ATMEL_BASE_MCI1); |
| 231 | } |
| 232 | #endif /* CONFIG_GENERIC_ATMEL_MCI */ |
| 233 | |
| 234 | #ifdef CONFIG_MACB |
| 235 | void sama5d4ek_macb0_hw_init(void) |
| 236 | { |
| 237 | at91_set_a_periph(AT91_PIO_PORTB, 0, 0); /* ETXCK_EREFCK */ |
| 238 | at91_set_a_periph(AT91_PIO_PORTB, 6, 0); /* ERXDV */ |
| 239 | at91_set_a_periph(AT91_PIO_PORTB, 8, 0); /* ERX0 */ |
| 240 | at91_set_a_periph(AT91_PIO_PORTB, 9, 0); /* ERX1 */ |
| 241 | at91_set_a_periph(AT91_PIO_PORTB, 7, 0); /* ERXER */ |
| 242 | at91_set_a_periph(AT91_PIO_PORTB, 2, 0); /* ETXEN */ |
| 243 | at91_set_a_periph(AT91_PIO_PORTB, 12, 0); /* ETX0 */ |
| 244 | at91_set_a_periph(AT91_PIO_PORTB, 13, 0); /* ETX1 */ |
| 245 | at91_set_a_periph(AT91_PIO_PORTB, 17, 0); /* EMDIO */ |
| 246 | at91_set_a_periph(AT91_PIO_PORTB, 16, 0); /* EMDC */ |
| 247 | |
| 248 | /* Enable clock */ |
| 249 | at91_periph_clk_enable(ATMEL_ID_GMAC0); |
| 250 | } |
| 251 | #endif |
| 252 | |
| 253 | static void sama5d4ek_serial3_hw_init(void) |
| 254 | { |
| 255 | at91_set_b_periph(AT91_PIO_PORTE, 17, 1); /* TXD3 */ |
| 256 | at91_set_b_periph(AT91_PIO_PORTE, 16, 0); /* RXD3 */ |
| 257 | |
| 258 | /* Enable clock */ |
| 259 | at91_periph_clk_enable(ATMEL_ID_USART3); |
| 260 | } |
| 261 | |
| 262 | int board_early_init_f(void) |
| 263 | { |
| 264 | at91_periph_clk_enable(ATMEL_ID_PIOA); |
| 265 | at91_periph_clk_enable(ATMEL_ID_PIOB); |
| 266 | at91_periph_clk_enable(ATMEL_ID_PIOC); |
| 267 | at91_periph_clk_enable(ATMEL_ID_PIOD); |
| 268 | at91_periph_clk_enable(ATMEL_ID_PIOE); |
| 269 | |
| 270 | sama5d4ek_serial3_hw_init(); |
| 271 | |
| 272 | return 0; |
| 273 | } |
| 274 | |
| 275 | int board_init(void) |
| 276 | { |
| 277 | /* adress of boot parameters */ |
| 278 | gd->bd->bi_boot_params = CONFIG_SYS_SDRAM_BASE + 0x100; |
| 279 | |
| 280 | #ifdef CONFIG_ATMEL_SPI |
| 281 | sama5d4ek_spi0_hw_init(); |
| 282 | #endif |
| 283 | #ifdef CONFIG_NAND_ATMEL |
| 284 | sama5d4ek_nand_hw_init(); |
| 285 | #endif |
| 286 | #ifdef CONFIG_GENERIC_ATMEL_MCI |
| 287 | sama5d4ek_mci1_hw_init(); |
| 288 | #endif |
| 289 | #ifdef CONFIG_MACB |
| 290 | sama5d4ek_macb0_hw_init(); |
| 291 | #endif |
| 292 | #ifdef CONFIG_LCD |
| 293 | sama5d4ek_lcd_hw_init(); |
| 294 | #endif |
| 295 | #ifdef CONFIG_CMD_USB |
| 296 | sama5d4ek_usb_hw_init(); |
| 297 | #endif |
Bo Shen | da08d79 | 2014-12-03 18:02:20 +0800 | [diff] [blame] | 298 | #ifdef CONFIG_USB_GADGET_ATMEL_USBA |
| 299 | at91_udp_hw_init(); |
| 300 | #endif |
Bo Shen | 927b901 | 2014-11-10 15:24:02 +0800 | [diff] [blame] | 301 | |
| 302 | return 0; |
| 303 | } |
| 304 | |
| 305 | int dram_init(void) |
| 306 | { |
| 307 | gd->ram_size = get_ram_size((void *)CONFIG_SYS_SDRAM_BASE, |
| 308 | CONFIG_SYS_SDRAM_SIZE); |
| 309 | return 0; |
| 310 | } |
| 311 | |
| 312 | int board_eth_init(bd_t *bis) |
| 313 | { |
| 314 | int rc = 0; |
| 315 | |
| 316 | #ifdef CONFIG_MACB |
| 317 | rc = macb_eth_initialize(0, (void *)ATMEL_BASE_GMAC0, 0x00); |
| 318 | #endif |
| 319 | |
Bo Shen | da08d79 | 2014-12-03 18:02:20 +0800 | [diff] [blame] | 320 | #ifdef CONFIG_USB_GADGET_ATMEL_USBA |
| 321 | usba_udc_probe(&pdata); |
| 322 | #ifdef CONFIG_USB_ETH_RNDIS |
| 323 | usb_eth_initialize(bis); |
| 324 | #endif |
| 325 | #endif |
| 326 | |
Bo Shen | 927b901 | 2014-11-10 15:24:02 +0800 | [diff] [blame] | 327 | return rc; |
| 328 | } |
Bo Shen | 5a4c9c2 | 2014-12-15 13:24:38 +0800 | [diff] [blame] | 329 | |
| 330 | /* SPL */ |
| 331 | #ifdef CONFIG_SPL_BUILD |
| 332 | void spl_board_init(void) |
| 333 | { |
| 334 | #ifdef CONFIG_SYS_USE_MMC |
| 335 | sama5d4ek_mci1_hw_init(); |
| 336 | #elif CONFIG_SYS_USE_NANDFLASH |
| 337 | sama5d4ek_nand_hw_init(); |
| 338 | #elif CONFIG_SYS_USE_SERIALFLASH |
| 339 | sama5d4ek_spi0_hw_init(); |
| 340 | #endif |
| 341 | } |
| 342 | |
| 343 | static void ddr2_conf(struct atmel_mpddr *ddr2) |
| 344 | { |
| 345 | ddr2->md = (ATMEL_MPDDRC_MD_DBW_32_BITS | ATMEL_MPDDRC_MD_DDR2_SDRAM); |
| 346 | |
| 347 | ddr2->cr = (ATMEL_MPDDRC_CR_NC_COL_10 | |
| 348 | ATMEL_MPDDRC_CR_NR_ROW_14 | |
| 349 | ATMEL_MPDDRC_CR_CAS_DDR_CAS3 | |
| 350 | ATMEL_MPDDRC_CR_NB_8BANKS | |
| 351 | ATMEL_MPDDRC_CR_NDQS_DISABLED | |
| 352 | ATMEL_MPDDRC_CR_DECOD_INTERLEAVED | |
| 353 | ATMEL_MPDDRC_CR_UNAL_SUPPORTED); |
| 354 | |
| 355 | ddr2->rtr = 0x2b0; |
| 356 | |
| 357 | ddr2->tpr0 = (8 << ATMEL_MPDDRC_TPR0_TRAS_OFFSET | |
| 358 | 3 << ATMEL_MPDDRC_TPR0_TRCD_OFFSET | |
| 359 | 3 << ATMEL_MPDDRC_TPR0_TWR_OFFSET | |
| 360 | 10 << ATMEL_MPDDRC_TPR0_TRC_OFFSET | |
| 361 | 3 << ATMEL_MPDDRC_TPR0_TRP_OFFSET | |
| 362 | 2 << ATMEL_MPDDRC_TPR0_TRRD_OFFSET | |
| 363 | 2 << ATMEL_MPDDRC_TPR0_TWTR_OFFSET | |
| 364 | 2 << ATMEL_MPDDRC_TPR0_TMRD_OFFSET); |
| 365 | |
| 366 | ddr2->tpr1 = (2 << ATMEL_MPDDRC_TPR1_TXP_OFFSET | |
| 367 | 200 << ATMEL_MPDDRC_TPR1_TXSRD_OFFSET | |
| 368 | 25 << ATMEL_MPDDRC_TPR1_TXSNR_OFFSET | |
| 369 | 23 << ATMEL_MPDDRC_TPR1_TRFC_OFFSET); |
| 370 | |
| 371 | ddr2->tpr2 = (7 << ATMEL_MPDDRC_TPR2_TFAW_OFFSET | |
| 372 | 2 << ATMEL_MPDDRC_TPR2_TRTP_OFFSET | |
| 373 | 3 << ATMEL_MPDDRC_TPR2_TRPA_OFFSET | |
| 374 | 2 << ATMEL_MPDDRC_TPR2_TXARDS_OFFSET | |
| 375 | 8 << ATMEL_MPDDRC_TPR2_TXARD_OFFSET); |
| 376 | } |
| 377 | |
| 378 | void mem_init(void) |
| 379 | { |
| 380 | struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC; |
| 381 | struct atmel_mpddr ddr2; |
| 382 | |
| 383 | ddr2_conf(&ddr2); |
| 384 | |
| 385 | /* enable MPDDR clock */ |
| 386 | at91_periph_clk_enable(ATMEL_ID_MPDDRC); |
| 387 | writel(0x4, &pmc->scer); |
| 388 | |
| 389 | /* DDRAM2 Controller initialize */ |
| 390 | ddr2_init(ATMEL_BASE_DDRCS, &ddr2); |
| 391 | } |
| 392 | |
| 393 | void at91_pmc_init(void) |
| 394 | { |
| 395 | struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC; |
| 396 | u32 tmp; |
| 397 | |
| 398 | tmp = AT91_PMC_PLLAR_29 | |
| 399 | AT91_PMC_PLLXR_PLLCOUNT(0x3f) | |
| 400 | AT91_PMC_PLLXR_MUL(87) | |
| 401 | AT91_PMC_PLLXR_DIV(1); |
| 402 | at91_plla_init(tmp); |
| 403 | |
| 404 | writel(0x0 << 8, &pmc->pllicpr); |
| 405 | |
| 406 | tmp = AT91_PMC_MCKR_H32MXDIV | |
| 407 | AT91_PMC_MCKR_PLLADIV_2 | |
| 408 | AT91_PMC_MCKR_MDIV_3 | |
| 409 | AT91_PMC_MCKR_CSS_PLLA; |
| 410 | at91_mck_init(tmp); |
| 411 | } |
| 412 | #endif |