diff options
Diffstat (limited to 'arch/m68k/cpu/mcf5227x/cpu_init.c')
| -rw-r--r-- | arch/m68k/cpu/mcf5227x/cpu_init.c | 138 | 
1 files changed, 70 insertions, 68 deletions
diff --git a/arch/m68k/cpu/mcf5227x/cpu_init.c b/arch/m68k/cpu/mcf5227x/cpu_init.c index beb78f583..e23b20df9 100644 --- a/arch/m68k/cpu/mcf5227x/cpu_init.c +++ b/arch/m68k/cpu/mcf5227x/cpu_init.c @@ -3,7 +3,7 @@   * (C) Copyright 2000-2003   * Wolfgang Denk, DENX Software Engineering, wd@denx.de.   * - * (C) Copyright 2004-2007 Freescale Semiconductor, Inc. + * (C) Copyright 2004-2007, 2012 Freescale Semiconductor, Inc.   * TsiChung Liew (Tsi-Chung.Liew@freescale.com)   *   * See file CREDITS for list of people who contributed to this @@ -29,6 +29,7 @@  #include <watchdog.h>  #include <asm/immap.h> +#include <asm/io.h>  #include <asm/rtc.h>  /* @@ -40,70 +41,70 @@   */  void cpu_init_f(void)  { -	volatile scm1_t *scm1 = (scm1_t *) MMAP_SCM1; -	volatile gpio_t *gpio = (gpio_t *) MMAP_GPIO; -	volatile fbcs_t *fbcs = (fbcs_t *) MMAP_FBCS; -	volatile pll_t *pll = (volatile pll_t *)MMAP_PLL; +	scm1_t *scm1 = (scm1_t *) MMAP_SCM1; +	gpio_t *gpio = (gpio_t *) MMAP_GPIO; +	fbcs_t *fbcs = (fbcs_t *) MMAP_FBCS; +	pll_t *pll = (pll_t *)MMAP_PLL;  #if !defined(CONFIG_CF_SBF)  	/* Workaround, must place before fbcs */ -	pll->psr = 0x12; +	out_be32(&pll->psr, 0x12); -	scm1->mpr = 0x77777777; -	scm1->pacra = 0; -	scm1->pacrb = 0; -	scm1->pacrc = 0; -	scm1->pacrd = 0; -	scm1->pacre = 0; -	scm1->pacrf = 0; -	scm1->pacrg = 0; -	scm1->pacri = 0; +	out_be32(&scm1->mpr, 0x77777777); +	out_be32(&scm1->pacra, 0); +	out_be32(&scm1->pacrb, 0); +	out_be32(&scm1->pacrc, 0); +	out_be32(&scm1->pacrd, 0); +	out_be32(&scm1->pacre, 0); +	out_be32(&scm1->pacrf, 0); +	out_be32(&scm1->pacrg, 0); +	out_be32(&scm1->pacri, 0);  #if (defined(CONFIG_SYS_CS0_BASE) && defined(CONFIG_SYS_CS0_MASK) \       && defined(CONFIG_SYS_CS0_CTRL)) -	fbcs->csar0 = CONFIG_SYS_CS0_BASE; -	fbcs->cscr0 = CONFIG_SYS_CS0_CTRL; -	fbcs->csmr0 = CONFIG_SYS_CS0_MASK; +	out_be32(&fbcs->csar0, CONFIG_SYS_CS0_BASE); +	out_be32(&fbcs->cscr0, CONFIG_SYS_CS0_CTRL); +	out_be32(&fbcs->csmr0, CONFIG_SYS_CS0_MASK);  #endif  #endif				/* CONFIG_CF_SBF */  #if (defined(CONFIG_SYS_CS1_BASE) && defined(CONFIG_SYS_CS1_MASK) \       && defined(CONFIG_SYS_CS1_CTRL)) -	fbcs->csar1 = CONFIG_SYS_CS1_BASE; -	fbcs->cscr1 = CONFIG_SYS_CS1_CTRL; -	fbcs->csmr1 = CONFIG_SYS_CS1_MASK; +	out_be32(&fbcs->csar1, CONFIG_SYS_CS1_BASE); +	out_be32(&fbcs->cscr1, CONFIG_SYS_CS1_CTRL); +	out_be32(&fbcs->csmr1, CONFIG_SYS_CS1_MASK);  #endif  #if (defined(CONFIG_SYS_CS2_BASE) && defined(CONFIG_SYS_CS2_MASK) \       && defined(CONFIG_SYS_CS2_CTRL)) -	fbcs->csar2 = CONFIG_SYS_CS2_BASE; -	fbcs->cscr2 = CONFIG_SYS_CS2_CTRL; -	fbcs->csmr2 = CONFIG_SYS_CS2_MASK; +	out_be32(&fbcs->csar2, CONFIG_SYS_CS2_BASE); +	out_be32(&fbcs->cscr2, CONFIG_SYS_CS2_CTRL); +	out_be32(&fbcs->csmr2, CONFIG_SYS_CS2_MASK);  #endif  #if (defined(CONFIG_SYS_CS3_BASE) && defined(CONFIG_SYS_CS3_MASK) \       && defined(CONFIG_SYS_CS3_CTRL)) -	fbcs->csar3 = CONFIG_SYS_CS3_BASE; -	fbcs->cscr3 = CONFIG_SYS_CS3_CTRL; -	fbcs->csmr3 = CONFIG_SYS_CS3_MASK; +	out_be32(&fbcs->csar3, CONFIG_SYS_CS3_BASE); +	out_be32(&fbcs->cscr3, CONFIG_SYS_CS3_CTRL); +	out_be32(&fbcs->csmr3, CONFIG_SYS_CS3_MASK);  #endif  #if (defined(CONFIG_SYS_CS4_BASE) && defined(CONFIG_SYS_CS4_MASK) \       && defined(CONFIG_SYS_CS4_CTRL)) -	fbcs->csar4 = CONFIG_SYS_CS4_BASE; -	fbcs->cscr4 = CONFIG_SYS_CS4_CTRL; -	fbcs->csmr4 = CONFIG_SYS_CS4_MASK; +	out_be32(&fbcs->csar4, CONFIG_SYS_CS4_BASE); +	out_be32(&fbcs->cscr4, CONFIG_SYS_CS4_CTRL); +	out_be32(&fbcs->csmr4, CONFIG_SYS_CS4_MASK);  #endif  #if (defined(CONFIG_SYS_CS5_BASE) && defined(CONFIG_SYS_CS5_MASK) \       && defined(CONFIG_SYS_CS5_CTRL)) -	fbcs->csar5 = CONFIG_SYS_CS5_BASE; -	fbcs->cscr5 = CONFIG_SYS_CS5_CTRL; -	fbcs->csmr5 = CONFIG_SYS_CS5_MASK; +	out_be32(&fbcs->csar5, CONFIG_SYS_CS5_BASE); +	out_be32(&fbcs->cscr5, CONFIG_SYS_CS5_CTRL); +	out_be32(&fbcs->csmr5, CONFIG_SYS_CS5_MASK);  #endif  #ifdef CONFIG_FSL_I2C -	gpio->par_i2c = GPIO_PAR_I2C_SCL_SCL | GPIO_PAR_I2C_SDA_SDA; +	out_8(&gpio->par_i2c, GPIO_PAR_I2C_SCL_SCL | GPIO_PAR_I2C_SDA_SDA);  #endif  	icache_enable(); @@ -115,11 +116,11 @@ void cpu_init_f(void)  int cpu_init_r(void)  {  #ifdef CONFIG_MCFRTC -	volatile rtc_t *rtc = (volatile rtc_t *)(CONFIG_SYS_MCFRTC_BASE); -	volatile rtcex_t *rtcex = (volatile rtcex_t *)&rtc->extended; +	rtc_t *rtc = (rtc_t *)(CONFIG_SYS_MCFRTC_BASE); +	rtcex_t *rtcex = (rtcex_t *)&rtc->extended; -	rtcex->gocu = (CONFIG_SYS_RTC_OSCILLATOR >> 16) & 0xFFFF; -	rtcex->gocl = CONFIG_SYS_RTC_OSCILLATOR & 0xFFFF; +	out_be32(&rtcex->gocu, (CONFIG_SYS_RTC_OSCILLATOR >> 16) & 0xffff); +	out_be32(&rtcex->gocl, CONFIG_SYS_RTC_OSCILLATOR & 0xffff);  #endif  	return (0); @@ -127,27 +128,27 @@ int cpu_init_r(void)  void uart_port_conf(int port)  { -	volatile gpio_t *gpio = (gpio_t *) MMAP_GPIO; +	gpio_t *gpio = (gpio_t *) MMAP_GPIO;  	/* Setup Ports: */  	switch (port) {  	case 0: -		gpio->par_uart &= -		    (GPIO_PAR_UART_U0TXD_UNMASK & GPIO_PAR_UART_U0RXD_UNMASK); -		gpio->par_uart |= -		    (GPIO_PAR_UART_U0TXD_U0TXD | GPIO_PAR_UART_U0RXD_U0RXD); +		clrbits_be16(&gpio->par_uart, +			~(GPIO_PAR_UART_U0TXD_UNMASK & GPIO_PAR_UART_U0RXD_UNMASK)); +		setbits_be16(&gpio->par_uart, +			GPIO_PAR_UART_U0TXD_U0TXD | GPIO_PAR_UART_U0RXD_U0RXD);  		break;  	case 1: -		gpio->par_uart &= -		    (GPIO_PAR_UART_U1TXD_UNMASK & GPIO_PAR_UART_U1RXD_UNMASK); -		gpio->par_uart |= -		    (GPIO_PAR_UART_U1TXD_U1TXD | GPIO_PAR_UART_U1RXD_U1RXD); +		clrbits_be16(&gpio->par_uart, +			~(GPIO_PAR_UART_U1TXD_UNMASK & GPIO_PAR_UART_U1RXD_UNMASK)); +		setbits_be16(&gpio->par_uart, +			GPIO_PAR_UART_U1TXD_U1TXD | GPIO_PAR_UART_U1RXD_U1RXD);  		break;  	case 2: -		gpio->par_dspi &= -		    (GPIO_PAR_DSPI_SIN_UNMASK & GPIO_PAR_DSPI_SOUT_UNMASK); -		gpio->par_dspi = -		    (GPIO_PAR_DSPI_SIN_U2RXD | GPIO_PAR_DSPI_SOUT_U2TXD); +		clrbits_8(&gpio->par_dspi, +			~(GPIO_PAR_DSPI_SIN_UNMASK & GPIO_PAR_DSPI_SOUT_UNMASK)); +		out_8(&gpio->par_dspi, +			GPIO_PAR_DSPI_SIN_U2RXD | GPIO_PAR_DSPI_SOUT_U2TXD);  		break;  	}  } @@ -155,32 +156,32 @@ void uart_port_conf(int port)  #ifdef CONFIG_CF_DSPI  void cfspi_port_conf(void)  { -	volatile gpio_t *gpio = (gpio_t *) MMAP_GPIO; +	gpio_t *gpio = (gpio_t *) MMAP_GPIO; -	gpio->par_dspi = -	    GPIO_PAR_DSPI_SIN_SIN | GPIO_PAR_DSPI_SOUT_SOUT | -	    GPIO_PAR_DSPI_SCK_SCK; +	out_8(&gpio->par_dspi, +		GPIO_PAR_DSPI_SIN_SIN | GPIO_PAR_DSPI_SOUT_SOUT | +		GPIO_PAR_DSPI_SCK_SCK);  }  int cfspi_claim_bus(uint bus, uint cs)  { -	volatile dspi_t *dspi = (dspi_t *) MMAP_DSPI; -	volatile gpio_t *gpio = (gpio_t *) MMAP_GPIO; +	dspi_t *dspi = (dspi_t *) MMAP_DSPI; +	gpio_t *gpio = (gpio_t *) MMAP_GPIO; -	if ((dspi->sr & DSPI_SR_TXRXS) != DSPI_SR_TXRXS) +	if ((in_be32(&dspi->sr) & DSPI_SR_TXRXS) != DSPI_SR_TXRXS)  		return -1;  	/* Clear FIFO and resume transfer */ -	dspi->mcr &= ~(DSPI_MCR_CTXF | DSPI_MCR_CRXF); +	clrbits_be32(&dspi->mcr, DSPI_MCR_CTXF | DSPI_MCR_CRXF);  	switch (cs) {  	case 0: -		gpio->par_dspi &= ~GPIO_PAR_DSPI_PCS0_UNMASK; -		gpio->par_dspi |= GPIO_PAR_DSPI_PCS0_PCS0; +		clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS0_UNMASK); +		setbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS0_PCS0);  		break;  	case 2: -		gpio->par_timer &= GPIO_PAR_TIMER_T2IN_UNMASK; -		gpio->par_timer |= GPIO_PAR_TIMER_T2IN_DSPIPCS2; +		clrbits_8(&gpio->par_timer, ~GPIO_PAR_TIMER_T2IN_UNMASK); +		setbits_8(&gpio->par_timer, GPIO_PAR_TIMER_T2IN_DSPIPCS2);  		break;  	} @@ -189,17 +190,18 @@ int cfspi_claim_bus(uint bus, uint cs)  void cfspi_release_bus(uint bus, uint cs)  { -	volatile dspi_t *dspi = (dspi_t *) MMAP_DSPI; -	volatile gpio_t *gpio = (gpio_t *) MMAP_GPIO; +	dspi_t *dspi = (dspi_t *) MMAP_DSPI; +	gpio_t *gpio = (gpio_t *) MMAP_GPIO; -	dspi->mcr &= ~(DSPI_MCR_CTXF | DSPI_MCR_CRXF);	/* Clear FIFO */ +	/* Clear FIFO */ +	clrbits_be32(&dspi->mcr, DSPI_MCR_CTXF | DSPI_MCR_CRXF);  	switch (cs) {  	case 0: -		gpio->par_dspi &= ~GPIO_PAR_DSPI_PCS0_PCS0; +		clrbits_8(&gpio->par_dspi, GPIO_PAR_DSPI_PCS0_PCS0);  		break;  	case 2: -		gpio->par_timer &= GPIO_PAR_TIMER_T2IN_UNMASK; +		clrbits_8(&gpio->par_timer, ~GPIO_PAR_TIMER_T2IN_UNMASK);  		break;  	}  }  |