#include <u.h>
#include "dat.h"
#include "fns.h"

enum {
	QSPI_CFG,
	QSPI_STATUS,
	QSPI_EN = 5,
	QSPI_TXD4 = 7,
	QSPI_RXD,
	QSPI_TXD1 = 32,
	QSPI_TXD2,
	QSPI_TXD3
};

#define QSPI0 ((void *) 0xE000D000)

static u32int
cmd(ulong *r, int sz, u32int c)
{
	if(sz == 4)
		r[QSPI_TXD4] = c;
	else
		r[QSPI_TXD1 + sz - 1] = c;
	r[QSPI_CFG] |= 1<<16;
	while((r[QSPI_STATUS] & (1<<2|1<<4)) != (1<<2|1<<4))
		;
	return r[QSPI_RXD];
}

void
flash(void)
{
	ulong *r;
	
	r = QSPI0;
	r[QSPI_CFG] = 1<<31 | 1<<19 | 3<<6 | 1<<15 | 1<<14 | 1<<10 | 1<<3 | 1;
	r[QSPI_CFG] &= ~(1<<10);
	r[QSPI_EN] = 1;
	cmd(r, 1, 0x06);
//	cmd(r, 3, 0xD8);
	for(;;)
		print("%x\n", cmd(r, 2, 0x05));
	
}