xref: /rk3399_rockchip-uboot/board/astro/mcf5373l/fpga.c (revision 24b852a7a2b8eca71789100983bdb5104cc00696)
19d79e575SWolfgang Wegner /*
29d79e575SWolfgang Wegner  * (C) Copyright 2006
39d79e575SWolfgang Wegner  * Wolfgang Wegner, ASTRO Strobel Kommunikationssysteme GmbH,
49d79e575SWolfgang Wegner  * w.wegner@astro-kom.de
59d79e575SWolfgang Wegner  *
69d79e575SWolfgang Wegner  * based on the files by
79d79e575SWolfgang Wegner  * Heiko Schocher, DENX Software Engineering, hs@denx.de
89d79e575SWolfgang Wegner  * and
99d79e575SWolfgang Wegner  * Rich Ireland, Enterasys Networks, rireland@enterasys.com.
109d79e575SWolfgang Wegner  * Keith Outwater, keith_outwater@mvis.com.
119d79e575SWolfgang Wegner  *
121a459660SWolfgang Denk  * SPDX-License-Identifier:	GPL-2.0+
139d79e575SWolfgang Wegner  */
149d79e575SWolfgang Wegner 
159d79e575SWolfgang Wegner /* Altera/Xilinx FPGA configuration support for the ASTRO "URMEL" board */
169d79e575SWolfgang Wegner 
179d79e575SWolfgang Wegner #include <common.h>
18*24b852a7SSimon Glass #include <console.h>
199d79e575SWolfgang Wegner #include <watchdog.h>
209d79e575SWolfgang Wegner #include <altera.h>
219d79e575SWolfgang Wegner #include <ACEX1K.h>
229d79e575SWolfgang Wegner #include <spartan3.h>
239d79e575SWolfgang Wegner #include <command.h>
249d79e575SWolfgang Wegner #include <asm/immap_5329.h>
259d79e575SWolfgang Wegner #include <asm/io.h>
269d79e575SWolfgang Wegner #include "fpga.h"
279d79e575SWolfgang Wegner 
289d79e575SWolfgang Wegner DECLARE_GLOBAL_DATA_PTR;
299d79e575SWolfgang Wegner 
altera_pre_fn(int cookie)309d79e575SWolfgang Wegner int altera_pre_fn(int cookie)
319d79e575SWolfgang Wegner {
329d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
339d79e575SWolfgang Wegner 	unsigned char tmp_char;
349d79e575SWolfgang Wegner 	unsigned short tmp_short;
359d79e575SWolfgang Wegner 
369d79e575SWolfgang Wegner 	/* first, set the required pins to GPIO function */
379d79e575SWolfgang Wegner 	/* PAR_T0IN -> GPIO */
389d79e575SWolfgang Wegner 	tmp_char = readb(&gpiop->par_timer);
399d79e575SWolfgang Wegner 	tmp_char &= 0xfc;
409d79e575SWolfgang Wegner 	writeb(tmp_char, &gpiop->par_timer);
419d79e575SWolfgang Wegner 	/* all QSPI pins -> GPIO */
429d79e575SWolfgang Wegner 	writew(0x0000, &gpiop->par_qspi);
439d79e575SWolfgang Wegner 	/* U0RTS, U0CTS -> GPIO */
449d79e575SWolfgang Wegner 	tmp_short = __raw_readw(&gpiop->par_uart);
459d79e575SWolfgang Wegner 	tmp_short &= 0xfff3;
469d79e575SWolfgang Wegner 	__raw_writew(tmp_short, &gpiop->par_uart);
479d79e575SWolfgang Wegner 	/* all PWM pins -> GPIO */
489d79e575SWolfgang Wegner 	writeb(0x00, &gpiop->par_pwm);
499d79e575SWolfgang Wegner 	/* next, set data direction registers */
509d79e575SWolfgang Wegner 	writeb(0x01, &gpiop->pddr_timer);
519d79e575SWolfgang Wegner 	writeb(0x25, &gpiop->pddr_qspi);
529d79e575SWolfgang Wegner 	writeb(0x0c, &gpiop->pddr_uart);
539d79e575SWolfgang Wegner 	writeb(0x04, &gpiop->pddr_pwm);
549d79e575SWolfgang Wegner 
559d79e575SWolfgang Wegner 	/* ensure other SPI peripherals are deselected */
569d79e575SWolfgang Wegner 	writeb(0x08, &gpiop->ppd_uart);
579d79e575SWolfgang Wegner 	writeb(0x38, &gpiop->ppd_qspi);
589d79e575SWolfgang Wegner 
599d79e575SWolfgang Wegner 	/* CONFIG = 0 STATUS = 0 -> FPGA in reset state */
609d79e575SWolfgang Wegner 	writeb(0xFB, &gpiop->pclrr_uart);
619d79e575SWolfgang Wegner 	/* enable Altera configuration by clearing QSPI_CS2 and DT0IN */
629d79e575SWolfgang Wegner 	writeb(0xFE, &gpiop->pclrr_timer);
639d79e575SWolfgang Wegner 	writeb(0xDF, &gpiop->pclrr_qspi);
649d79e575SWolfgang Wegner 	return FPGA_SUCCESS;
659d79e575SWolfgang Wegner }
669d79e575SWolfgang Wegner 
679d79e575SWolfgang Wegner /* Set the state of CONFIG Pin */
altera_config_fn(int assert_config,int flush,int cookie)689d79e575SWolfgang Wegner int altera_config_fn(int assert_config, int flush, int cookie)
699d79e575SWolfgang Wegner {
709d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
719d79e575SWolfgang Wegner 
729d79e575SWolfgang Wegner 	if (assert_config)
739d79e575SWolfgang Wegner 		writeb(0x04, &gpiop->ppd_uart);
749d79e575SWolfgang Wegner 	else
759d79e575SWolfgang Wegner 		writeb(0xFB, &gpiop->pclrr_uart);
769d79e575SWolfgang Wegner 	return FPGA_SUCCESS;
779d79e575SWolfgang Wegner }
789d79e575SWolfgang Wegner 
799d79e575SWolfgang Wegner /* Returns the state of STATUS Pin */
altera_status_fn(int cookie)809d79e575SWolfgang Wegner int altera_status_fn(int cookie)
819d79e575SWolfgang Wegner {
829d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
839d79e575SWolfgang Wegner 
849d79e575SWolfgang Wegner 	if (readb(&gpiop->ppd_pwm) & 0x08)
859d79e575SWolfgang Wegner 		return FPGA_FAIL;
869d79e575SWolfgang Wegner 	return FPGA_SUCCESS;
879d79e575SWolfgang Wegner }
889d79e575SWolfgang Wegner 
899d79e575SWolfgang Wegner /* Returns the state of CONF_DONE Pin */
altera_done_fn(int cookie)909d79e575SWolfgang Wegner int altera_done_fn(int cookie)
919d79e575SWolfgang Wegner {
929d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
939d79e575SWolfgang Wegner 
949d79e575SWolfgang Wegner 	if (readb(&gpiop->ppd_pwm) & 0x20)
959d79e575SWolfgang Wegner 		return FPGA_FAIL;
969d79e575SWolfgang Wegner 	return FPGA_SUCCESS;
979d79e575SWolfgang Wegner }
989d79e575SWolfgang Wegner 
999d79e575SWolfgang Wegner /*
1009d79e575SWolfgang Wegner  * writes the complete buffer to the FPGA
1019d79e575SWolfgang Wegner  * writing the complete buffer in one function is much faster,
1029d79e575SWolfgang Wegner  * then calling it for every bit
1039d79e575SWolfgang Wegner  */
altera_write_fn(const void * buf,size_t len,int flush,int cookie)104ddc94378SSimon Glass int altera_write_fn(const void *buf, size_t len, int flush, int cookie)
1059d79e575SWolfgang Wegner {
1069d79e575SWolfgang Wegner 	size_t bytecount = 0;
1079d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
1089d79e575SWolfgang Wegner 	unsigned char *data = (unsigned char *)buf;
1099d79e575SWolfgang Wegner 	unsigned char val = 0;
1109d79e575SWolfgang Wegner 	int i;
1119d79e575SWolfgang Wegner 	int len_40 = len / 40;
1129d79e575SWolfgang Wegner 
1139d79e575SWolfgang Wegner 	while (bytecount < len) {
1149d79e575SWolfgang Wegner 		val = data[bytecount++];
1159d79e575SWolfgang Wegner 		i = 8;
1169d79e575SWolfgang Wegner 		do {
1179d79e575SWolfgang Wegner 			writeb(0xFB, &gpiop->pclrr_qspi);
1189d79e575SWolfgang Wegner 			if (val & 0x01)
1199d79e575SWolfgang Wegner 				writeb(0x01, &gpiop->ppd_qspi);
1209d79e575SWolfgang Wegner 			else
1219d79e575SWolfgang Wegner 				writeb(0xFE, &gpiop->pclrr_qspi);
1229d79e575SWolfgang Wegner 			writeb(0x04, &gpiop->ppd_qspi);
1239d79e575SWolfgang Wegner 			val >>= 1;
1249d79e575SWolfgang Wegner 			i--;
1259d79e575SWolfgang Wegner 		} while (i > 0);
1269d79e575SWolfgang Wegner 
1279d79e575SWolfgang Wegner 		if (bytecount % len_40 == 0) {
1289d79e575SWolfgang Wegner #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
1299d79e575SWolfgang Wegner 			WATCHDOG_RESET();
1309d79e575SWolfgang Wegner #endif
1319d79e575SWolfgang Wegner #ifdef CONFIG_SYS_FPGA_PROG_FEEDBACK
1329d79e575SWolfgang Wegner 			putc('.');	/* let them know we are alive */
1339d79e575SWolfgang Wegner #endif
1349d79e575SWolfgang Wegner #ifdef CONFIG_SYS_FPGA_CHECK_CTRLC
1359d79e575SWolfgang Wegner 			if (ctrlc())
1369d79e575SWolfgang Wegner 				return FPGA_FAIL;
1379d79e575SWolfgang Wegner #endif
1389d79e575SWolfgang Wegner 		}
1399d79e575SWolfgang Wegner 	}
1409d79e575SWolfgang Wegner 	return FPGA_SUCCESS;
1419d79e575SWolfgang Wegner }
1429d79e575SWolfgang Wegner 
1439d79e575SWolfgang Wegner /* called, when programming is aborted */
altera_abort_fn(int cookie)1449d79e575SWolfgang Wegner int altera_abort_fn(int cookie)
1459d79e575SWolfgang Wegner {
1469d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
1479d79e575SWolfgang Wegner 
1489d79e575SWolfgang Wegner 	writeb(0x20, &gpiop->ppd_qspi);
1499d79e575SWolfgang Wegner 	writeb(0x08, &gpiop->ppd_uart);
1509d79e575SWolfgang Wegner 	return FPGA_SUCCESS;
1519d79e575SWolfgang Wegner }
1529d79e575SWolfgang Wegner 
1539d79e575SWolfgang Wegner /* called, when programming was succesful */
altera_post_fn(int cookie)1549d79e575SWolfgang Wegner int altera_post_fn(int cookie)
1559d79e575SWolfgang Wegner {
1569d79e575SWolfgang Wegner 	return altera_abort_fn(cookie);
1579d79e575SWolfgang Wegner }
1589d79e575SWolfgang Wegner 
1599d79e575SWolfgang Wegner /*
1609d79e575SWolfgang Wegner  * Note that these are pointers to code that is in Flash. They will be
1619d79e575SWolfgang Wegner  * relocated at runtime.
1629d79e575SWolfgang Wegner  * FIXME: relocation not yet working for coldfire, see below!
1639d79e575SWolfgang Wegner  */
1649d79e575SWolfgang Wegner Altera_CYC2_Passive_Serial_fns altera_fns = {
1659d79e575SWolfgang Wegner 	altera_pre_fn,
1669d79e575SWolfgang Wegner 	altera_config_fn,
1679d79e575SWolfgang Wegner 	altera_status_fn,
1689d79e575SWolfgang Wegner 	altera_done_fn,
1699d79e575SWolfgang Wegner 	altera_write_fn,
1709d79e575SWolfgang Wegner 	altera_abort_fn,
1719d79e575SWolfgang Wegner 	altera_post_fn
1729d79e575SWolfgang Wegner };
1739d79e575SWolfgang Wegner 
1749d79e575SWolfgang Wegner Altera_desc altera_fpga[CONFIG_FPGA_COUNT] = {
1759d79e575SWolfgang Wegner 	{Altera_CYC2,
1769d79e575SWolfgang Wegner 	 passive_serial,
1779d79e575SWolfgang Wegner 	 85903,
1789d79e575SWolfgang Wegner 	 (void *)&altera_fns,
1799d79e575SWolfgang Wegner 	 NULL,
1809d79e575SWolfgang Wegner 	 0}
1819d79e575SWolfgang Wegner };
1829d79e575SWolfgang Wegner 
1839d79e575SWolfgang Wegner /* Initialize the fpga.  Return 1 on success, 0 on failure. */
astro5373l_altera_load(void)1849d79e575SWolfgang Wegner int astro5373l_altera_load(void)
1859d79e575SWolfgang Wegner {
1869d79e575SWolfgang Wegner 	int i;
1879d79e575SWolfgang Wegner 
1889d79e575SWolfgang Wegner 	for (i = 0; i < CONFIG_FPGA_COUNT; i++) {
1899d79e575SWolfgang Wegner 		/*
1909d79e575SWolfgang Wegner 		 * I did not yet manage to get relocation work properly,
1919d79e575SWolfgang Wegner 		 * so set stuff here instead of static initialisation:
1929d79e575SWolfgang Wegner 		 */
1939d79e575SWolfgang Wegner 		altera_fns.pre = altera_pre_fn;
1949d79e575SWolfgang Wegner 		altera_fns.config = altera_config_fn;
1959d79e575SWolfgang Wegner 		altera_fns.status = altera_status_fn;
1969d79e575SWolfgang Wegner 		altera_fns.done = altera_done_fn;
1979d79e575SWolfgang Wegner 		altera_fns.write = altera_write_fn;
1989d79e575SWolfgang Wegner 		altera_fns.abort = altera_abort_fn;
1999d79e575SWolfgang Wegner 		altera_fns.post = altera_post_fn;
2009d79e575SWolfgang Wegner 		altera_fpga[i].iface_fns = (void *)&altera_fns;
2019d79e575SWolfgang Wegner 		fpga_add(fpga_altera, &altera_fpga[i]);
2029d79e575SWolfgang Wegner 	}
2039d79e575SWolfgang Wegner 	return 1;
2049d79e575SWolfgang Wegner }
2059d79e575SWolfgang Wegner 
2069d79e575SWolfgang Wegner /* Set the FPGA's PROG_B line to the specified level */
xilinx_pgm_config_fn(int assert,int flush,int cookie)2072df9d5c4SMichal Simek int xilinx_pgm_config_fn(int assert, int flush, int cookie)
2089d79e575SWolfgang Wegner {
2099d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
2109d79e575SWolfgang Wegner 
2119d79e575SWolfgang Wegner 	if (assert)
2129d79e575SWolfgang Wegner 		writeb(0xFB, &gpiop->pclrr_uart);
2139d79e575SWolfgang Wegner 	else
2149d79e575SWolfgang Wegner 		writeb(0x04, &gpiop->ppd_uart);
2159d79e575SWolfgang Wegner 	return assert;
2169d79e575SWolfgang Wegner }
2179d79e575SWolfgang Wegner 
2189d79e575SWolfgang Wegner /*
2199d79e575SWolfgang Wegner  * Test the state of the active-low FPGA INIT line.  Return 1 on INIT
2209d79e575SWolfgang Wegner  * asserted (low).
2219d79e575SWolfgang Wegner  */
xilinx_init_config_fn(int cookie)2222df9d5c4SMichal Simek int xilinx_init_config_fn(int cookie)
2239d79e575SWolfgang Wegner {
2249d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
2259d79e575SWolfgang Wegner 
2269d79e575SWolfgang Wegner 	return (readb(&gpiop->ppd_pwm) & 0x08) == 0;
2279d79e575SWolfgang Wegner }
2289d79e575SWolfgang Wegner 
2299d79e575SWolfgang Wegner /* Test the state of the active-high FPGA DONE pin */
xilinx_done_config_fn(int cookie)2302df9d5c4SMichal Simek int xilinx_done_config_fn(int cookie)
2319d79e575SWolfgang Wegner {
2329d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
2339d79e575SWolfgang Wegner 
2349d79e575SWolfgang Wegner 	return (readb(&gpiop->ppd_pwm) & 0x20) >> 5;
2359d79e575SWolfgang Wegner }
2369d79e575SWolfgang Wegner 
2379d79e575SWolfgang Wegner /* Abort an FPGA operation */
xilinx_abort_config_fn(int cookie)2382df9d5c4SMichal Simek int xilinx_abort_config_fn(int cookie)
2399d79e575SWolfgang Wegner {
2409d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
2419d79e575SWolfgang Wegner 	/* ensure all SPI peripherals and FPGAs are deselected */
2429d79e575SWolfgang Wegner 	writeb(0x08, &gpiop->ppd_uart);
2439d79e575SWolfgang Wegner 	writeb(0x01, &gpiop->ppd_timer);
2449d79e575SWolfgang Wegner 	writeb(0x38, &gpiop->ppd_qspi);
2459d79e575SWolfgang Wegner 	return FPGA_FAIL;
2469d79e575SWolfgang Wegner }
2479d79e575SWolfgang Wegner 
2489d79e575SWolfgang Wegner /*
2499d79e575SWolfgang Wegner  * FPGA pre-configuration function. Just make sure that
2509d79e575SWolfgang Wegner  * FPGA reset is asserted to keep the FPGA from starting up after
2519d79e575SWolfgang Wegner  * configuration.
2529d79e575SWolfgang Wegner  */
xilinx_pre_config_fn(int cookie)2539d79e575SWolfgang Wegner int xilinx_pre_config_fn(int cookie)
2549d79e575SWolfgang Wegner {
2559d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
2569d79e575SWolfgang Wegner 	unsigned char tmp_char;
2579d79e575SWolfgang Wegner 	unsigned short tmp_short;
2589d79e575SWolfgang Wegner 
2599d79e575SWolfgang Wegner 	/* first, set the required pins to GPIO function */
2609d79e575SWolfgang Wegner 	/* PAR_T0IN -> GPIO */
2619d79e575SWolfgang Wegner 	tmp_char = readb(&gpiop->par_timer);
2629d79e575SWolfgang Wegner 	tmp_char &= 0xfc;
2639d79e575SWolfgang Wegner 	writeb(tmp_char, &gpiop->par_timer);
2649d79e575SWolfgang Wegner 	/* all QSPI pins -> GPIO */
2659d79e575SWolfgang Wegner 	writew(0x0000, &gpiop->par_qspi);
2669d79e575SWolfgang Wegner 	/* U0RTS, U0CTS -> GPIO */
2679d79e575SWolfgang Wegner 	tmp_short = __raw_readw(&gpiop->par_uart);
2689d79e575SWolfgang Wegner 	tmp_short &= 0xfff3;
2699d79e575SWolfgang Wegner 	__raw_writew(tmp_short, &gpiop->par_uart);
2709d79e575SWolfgang Wegner 	/* all PWM pins -> GPIO */
2719d79e575SWolfgang Wegner 	writeb(0x00, &gpiop->par_pwm);
2729d79e575SWolfgang Wegner 	/* next, set data direction registers */
2739d79e575SWolfgang Wegner 	writeb(0x01, &gpiop->pddr_timer);
2749d79e575SWolfgang Wegner 	writeb(0x25, &gpiop->pddr_qspi);
2759d79e575SWolfgang Wegner 	writeb(0x0c, &gpiop->pddr_uart);
2769d79e575SWolfgang Wegner 	writeb(0x04, &gpiop->pddr_pwm);
2779d79e575SWolfgang Wegner 
2789d79e575SWolfgang Wegner 	/* ensure other SPI peripherals are deselected */
2799d79e575SWolfgang Wegner 	writeb(0x08, &gpiop->ppd_uart);
2809d79e575SWolfgang Wegner 	writeb(0x38, &gpiop->ppd_qspi);
2819d79e575SWolfgang Wegner 	writeb(0x01, &gpiop->ppd_timer);
2829d79e575SWolfgang Wegner 
2839d79e575SWolfgang Wegner 	/* CONFIG = 0, STATUS = 0 -> FPGA in reset state */
2849d79e575SWolfgang Wegner 	writeb(0xFB, &gpiop->pclrr_uart);
2859d79e575SWolfgang Wegner 	/* enable Xilinx configuration by clearing QSPI_CS2 and U0CTS */
2869d79e575SWolfgang Wegner 	writeb(0xF7, &gpiop->pclrr_uart);
2879d79e575SWolfgang Wegner 	writeb(0xDF, &gpiop->pclrr_qspi);
2889d79e575SWolfgang Wegner 	return 0;
2899d79e575SWolfgang Wegner }
2909d79e575SWolfgang Wegner 
2919d79e575SWolfgang Wegner /*
2929d79e575SWolfgang Wegner  * FPGA post configuration function. Should perform a test if FPGA is running.
2939d79e575SWolfgang Wegner  */
xilinx_post_config_fn(int cookie)2949d79e575SWolfgang Wegner int xilinx_post_config_fn(int cookie)
2959d79e575SWolfgang Wegner {
2969d79e575SWolfgang Wegner 	int rc = 0;
2979d79e575SWolfgang Wegner 
2989d79e575SWolfgang Wegner 	/*
2999d79e575SWolfgang Wegner 	 * no test yet
3009d79e575SWolfgang Wegner 	 */
3019d79e575SWolfgang Wegner 	return rc;
3029d79e575SWolfgang Wegner }
3039d79e575SWolfgang Wegner 
xilinx_clk_config_fn(int assert_clk,int flush,int cookie)3042df9d5c4SMichal Simek int xilinx_clk_config_fn(int assert_clk, int flush, int cookie)
3059d79e575SWolfgang Wegner {
3069d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
3079d79e575SWolfgang Wegner 
3089d79e575SWolfgang Wegner 	if (assert_clk)
3099d79e575SWolfgang Wegner 		writeb(0x04, &gpiop->ppd_qspi);
3109d79e575SWolfgang Wegner 	else
3119d79e575SWolfgang Wegner 		writeb(0xFB, &gpiop->pclrr_qspi);
3129d79e575SWolfgang Wegner 	return assert_clk;
3139d79e575SWolfgang Wegner }
3149d79e575SWolfgang Wegner 
xilinx_wr_config_fn(int assert_write,int flush,int cookie)3152df9d5c4SMichal Simek int xilinx_wr_config_fn(int assert_write, int flush, int cookie)
3169d79e575SWolfgang Wegner {
3179d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
3189d79e575SWolfgang Wegner 
3199d79e575SWolfgang Wegner 	if (assert_write)
3209d79e575SWolfgang Wegner 		writeb(0x01, &gpiop->ppd_qspi);
3219d79e575SWolfgang Wegner 	else
3229d79e575SWolfgang Wegner 		writeb(0xFE, &gpiop->pclrr_qspi);
3239d79e575SWolfgang Wegner 	return assert_write;
3249d79e575SWolfgang Wegner }
3259d79e575SWolfgang Wegner 
xilinx_fastwr_config_fn(void * buf,size_t len,int flush,int cookie)3262df9d5c4SMichal Simek int xilinx_fastwr_config_fn(void *buf, size_t len, int flush, int cookie)
3279d79e575SWolfgang Wegner {
3289d79e575SWolfgang Wegner 	size_t bytecount = 0;
3299d79e575SWolfgang Wegner 	gpio_t *gpiop = (gpio_t *)MMAP_GPIO;
3309d79e575SWolfgang Wegner 	unsigned char *data = (unsigned char *)buf;
3319d79e575SWolfgang Wegner 	unsigned char val = 0;
3329d79e575SWolfgang Wegner 	int i;
3339d79e575SWolfgang Wegner 	int len_40 = len / 40;
3349d79e575SWolfgang Wegner 
3359d79e575SWolfgang Wegner 	for (bytecount = 0; bytecount < len; bytecount++) {
3369d79e575SWolfgang Wegner 		val = *(data++);
3379d79e575SWolfgang Wegner 		for (i = 8; i > 0; i--) {
3389d79e575SWolfgang Wegner 			writeb(0xFB, &gpiop->pclrr_qspi);
3399d79e575SWolfgang Wegner 			if (val & 0x80)
3409d79e575SWolfgang Wegner 				writeb(0x01, &gpiop->ppd_qspi);
3419d79e575SWolfgang Wegner 			else
3429d79e575SWolfgang Wegner 				writeb(0xFE, &gpiop->pclrr_qspi);
3439d79e575SWolfgang Wegner 			writeb(0x04, &gpiop->ppd_qspi);
3449d79e575SWolfgang Wegner 			val <<= 1;
3459d79e575SWolfgang Wegner 		}
3469d79e575SWolfgang Wegner 		if (bytecount % len_40 == 0) {
3479d79e575SWolfgang Wegner #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
3489d79e575SWolfgang Wegner 			WATCHDOG_RESET();
3499d79e575SWolfgang Wegner #endif
3509d79e575SWolfgang Wegner #ifdef CONFIG_SYS_FPGA_PROG_FEEDBACK
3519d79e575SWolfgang Wegner 			putc('.');	/* let them know we are alive */
3529d79e575SWolfgang Wegner #endif
3539d79e575SWolfgang Wegner #ifdef CONFIG_SYS_FPGA_CHECK_CTRLC
3549d79e575SWolfgang Wegner 			if (ctrlc())
3559d79e575SWolfgang Wegner 				return FPGA_FAIL;
3569d79e575SWolfgang Wegner #endif
3579d79e575SWolfgang Wegner 		}
3589d79e575SWolfgang Wegner 	}
3599d79e575SWolfgang Wegner 	return FPGA_SUCCESS;
3609d79e575SWolfgang Wegner }
3619d79e575SWolfgang Wegner 
3629d79e575SWolfgang Wegner /*
3639d79e575SWolfgang Wegner  * Note that these are pointers to code that is in Flash.  They will be
3649d79e575SWolfgang Wegner  * relocated at runtime.
3659d79e575SWolfgang Wegner  * FIXME: relocation not yet working for coldfire, see below!
3669d79e575SWolfgang Wegner  */
3672a6e3869SMichal Simek xilinx_spartan3_slave_serial_fns xilinx_fns = {
3689d79e575SWolfgang Wegner 	xilinx_pre_config_fn,
3692df9d5c4SMichal Simek 	xilinx_pgm_config_fn,
3702df9d5c4SMichal Simek 	xilinx_clk_config_fn,
3712df9d5c4SMichal Simek 	xilinx_init_config_fn,
3722df9d5c4SMichal Simek 	xilinx_done_config_fn,
3732df9d5c4SMichal Simek 	xilinx_wr_config_fn,
3749d79e575SWolfgang Wegner 	0,
3752df9d5c4SMichal Simek 	xilinx_fastwr_config_fn
3769d79e575SWolfgang Wegner };
3779d79e575SWolfgang Wegner 
378f8c1be98SMichal Simek xilinx_desc xilinx_fpga[CONFIG_FPGA_COUNT] = {
3792a6e3869SMichal Simek 	{xilinx_spartan3,
3809d79e575SWolfgang Wegner 	 slave_serial,
3819d79e575SWolfgang Wegner 	 XILINX_XC3S4000_SIZE,
3829d79e575SWolfgang Wegner 	 (void *)&xilinx_fns,
38314cfc4f3SMichal Simek 	 0,
38414cfc4f3SMichal Simek 	 &spartan3_op}
3859d79e575SWolfgang Wegner };
3869d79e575SWolfgang Wegner 
3879d79e575SWolfgang Wegner /* Initialize the fpga.  Return 1 on success, 0 on failure. */
astro5373l_xilinx_load(void)3889d79e575SWolfgang Wegner int astro5373l_xilinx_load(void)
3899d79e575SWolfgang Wegner {
3909d79e575SWolfgang Wegner 	int i;
3919d79e575SWolfgang Wegner 
3929d79e575SWolfgang Wegner 	fpga_init();
3939d79e575SWolfgang Wegner 
3949d79e575SWolfgang Wegner 	for (i = 0; i < CONFIG_FPGA_COUNT; i++) {
3959d79e575SWolfgang Wegner 		/*
3969d79e575SWolfgang Wegner 		 * I did not yet manage to get relocation work properly,
3979d79e575SWolfgang Wegner 		 * so set stuff here instead of static initialisation:
3989d79e575SWolfgang Wegner 		 */
3999d79e575SWolfgang Wegner 		xilinx_fns.pre = xilinx_pre_config_fn;
4002df9d5c4SMichal Simek 		xilinx_fns.pgm = xilinx_pgm_config_fn;
4012df9d5c4SMichal Simek 		xilinx_fns.clk = xilinx_clk_config_fn;
4022df9d5c4SMichal Simek 		xilinx_fns.init = xilinx_init_config_fn;
4032df9d5c4SMichal Simek 		xilinx_fns.done = xilinx_done_config_fn;
4042df9d5c4SMichal Simek 		xilinx_fns.wr = xilinx_wr_config_fn;
4052df9d5c4SMichal Simek 		xilinx_fns.bwr = xilinx_fastwr_config_fn;
4069d79e575SWolfgang Wegner 		xilinx_fpga[i].iface_fns = (void *)&xilinx_fns;
4079d79e575SWolfgang Wegner 		fpga_add(fpga_xilinx, &xilinx_fpga[i]);
4089d79e575SWolfgang Wegner 	}
4099d79e575SWolfgang Wegner 	return 1;
4109d79e575SWolfgang Wegner }
411