/*
 * spidma.c
 *
 *  Created on: 27.07.2013
 *      Author: mfro
 */

#include "spidma.h"
#include <MCD_dma.h>
#include "mcd_initiators.h"
#include "bas_printf.h"

extern char _SYS_SRAM[];
#define SYS_SRAM &_SYS_SRAM[0]

void *dma_memcpy(void *dst, void *src, size_t n)
{
	int ret;
	int32_t start = MCF_SLT_SCNT(0);
	int32_t end;

	ret = MCD_startDma(0, src, 1, dst, 1, n, 1, DMA_ALWAYS, 0, MCD_SINGLE_DMA, 0);
	if (ret == MCD_OK)
	{
		xprintf("DMA on channel 0 successfully started\r\n");
	}

	do
	{
		ret = MCD_dmaStatus(0);
		xprintf(".");
	} while (ret != MCD_DONE);
	xprintf("\r\n");

	end = MCF_SLT_SCNT(0);

	xprintf("took %d seconds (1 Mbyte)\r\n", (end - start) / 132 / 1000);
#ifdef _NOT_USED_
	__asm__ __volatile__("move.w	sr,d0\n\t"
						 "stop		#0x270\n\t"
						 "move.w	d0,sr": : :);	/* halt CPU until DMA finished */
#endif /* _NOT_USED_ */

	return dst;
}

int spidma_init(void)
{
	int res;

	res = MCD_initDma((dmaRegs *) &MCF_DMA_TASKBAR, SYS_SRAM, MCD_RELOC_TASKS | MCD_COMM_PREFETCH_EN);
	if (res != MCD_OK)
	{
		xprintf("DMA API initialization failed (0x%x)\r\n", res);
		return 0;
	}
	xprintf("DMA API initialized. Tasks are at %p\r\n", SYS_SRAM);

	// test
	dma_memcpy((void *) 0x40000000, (void *) 0x30000000, 0x100000);
	xprintf("DMA finished\r\n");
	return 1;
}