#include "LPC13xx.h"
#include "ssp.h"

void SSPSend( const uint8_t *buf, uint32_t Length )
{
  uint32_t i;
  uint8_t Dummy = Dummy;

  for ( i = 0; i < Length; i++ )
  {
	/* Move on only if NOT busy and TX FIFO not full. */
	while ( (LPC_SSP->SR & (SSPSR_TNF|SSPSR_BSY)) != SSPSR_TNF );
	LPC_SSP->DR = *buf;
	buf++;
#if !LOOPBACK_MODE
	while ( (LPC_SSP->SR & (SSPSR_BSY|SSPSR_RNE)) != SSPSR_RNE );
	/* Whenever a byte is written, MISO FIFO counter increments, Clear FIFO
	on MISO. Otherwise, when SSP0Receive() is called, previous data byte
	is left in the FIFO. */
	Dummy = LPC_SSP->DR;
#else
	/* Wait until the Busy bit is cleared. */
	while ( LPC_SSP->SR & SSPSR_BSY );
#endif
  }
  return;
}

void SSPInit() {

// reset peripherals
LPC_SYSCON->PRESETCTRL |= (0x01<<0); // SSP reset de-asserted
LPC_SYSCON->SYSAHBCLKCTRL |= (0x01<<11); // Enables clock for SSP.
LPC_SYSCON->SSPCLKDIV = 2; // div clock by 2

LPC_IOCON->PIO0_8 &= ~0x07; // ???
LPC_IOCON->PIO0_8 |= 0x01; // MISO

LPC_IOCON->PIO0_9 &= ~0x07; // ???
LPC_IOCON->PIO0_9 |= 0x01; // MOSI

#ifdef __JTAG_DISABLED
LPC_IOCON->SCKLOC = 0x00;
LPC_IOCON->SWCLK_PIO0_10 &= ~0x07;
LPC_IOCON->SWCLK_PIO0_10 |= 0x02;>/* SSP CLK */
#endif

// This register is used to select a pin among three possible choices for the SSP SCK function.
LPC_IOCON->SCKLOC = 1; // Selects SCK function for pin PIO2_11/SCK
LPC_IOCON->PIO2_11 = 1;

// set SSEL as GPIO that the master has total control of the sequence
LPC_IOCON->PIO0_2 &= ~0x07;
LPC_IOCON->PIO0_2 |= 0x01;

// TODO ?????????????????????????????????
LPC_SSP->CR0 = 0x0007;
LPC_SSP->CPSR = 0x02;

LPC_IOCON->PIO0_7 = 0x00; // D/C^
LPC_GPIO0->DIR |= 1 << 7;

LPC_IOCON->PIO2_0 = 0x00; // RES^
LPC_GPIO2->DIR |= 1 << 0;

// SSP Enable with Master mode
LPC_SSP->CR1 = (0x01<<1) | (0x00<<2);

// NVIC_EnableIRQ(SSP_IRQn);

/* Set SSPINMS registers to enable interrupts */
/* enable all error related interrupts */
LPC_SSP->IMSC = (0x1<<0) | (0x1<<1);

/* old debug display routine
* uint32_t i;
// command
LPC_GPIO0->MASKED_ACCESS[0x01<<7] = 0 << 7;

	  // send init
	  SSPSend((uint8_t *)"\x21\xbf\x04\x14\x0c\x20\x0c", 7);
	  // move to (0,0)
	  SSPSend((uint8_t *)"\x80\x40", 2);

// data
LPC_GPIO0->MASKED_ACCESS[0x01<<7] = 1 << 7;

// clear display
  for (i=0;i<84*6;i++)
    SSPSend((uint8_t *)"\x00", 1);
*/
}