#include "archinc.h"
#include "armvic.h"
#include "cli.h"
#include "clichar.h"

#include <stdio.h>
#include <stdlib.h>

/*
 * Needed to replace macros defined in lpc210x.h
 */
#define VICVectAddrN(n) (*(volatile unsigned long *)(0xfffff100 + ((n)*4)))
#define VICVectCtrlN(n) (*(volatile unsigned long *)(0xfffff200 + ((n)*4)))

static unsigned int unassignedVectorIrqs = 0;

DECLARE_ISR(unassignedVectorIsr);

ISR_FUNCTION(unassignedVectorIsr)
{
  ISR_ENTER();

  unassignedVectorIrqs++;

  // acknowledge the interrupt at the VIC
  VICIrqDone;

  ISR_LEAVE();
}

static int vicstatHandler(int argc, char *argv[], int flags)
{
  int bufLen;
  char * pOutBuf;
  unsigned char putData;

  pOutBuf = clicharGetOutputBuffer(&bufLen);
  sprintf(pOutBuf, "%s: unassigned Vector IRQs[%u]\r\n",argv[0], unassignedVectorIrqs);
  clicharSendOutputBuffer(pOutBuf, bufLen);
  return 0;
}

int armvicInit(void)
{
  int i;

  /* Clear all interrupt enables */
  VICIntEnClr = (unsigned long)0xffffffff;

  /* Initialize all interrupts as IRQs (no FIQs, please) */
  VICIntSelect = (unsigned long)0;

  /* Setup the 'default' (unassigned vector/spurious) vector */
  VICDefVectAddr = (unsigned long)unassignedVectorIsr;

  /* Initialize the 16 vector 'slots' */
  for(i=0;i<16;i++) {
    VICVectCtrlN(i) = (unsigned long)0;
    VICVectAddrN(i) = (unsigned long)&unassignedVectorIsr;
    }

  return 0;
}

/* second initialization after CLI is up */

int armvicInit2(void)
{
  cliRegisterCommand("vicstat", vicstatHandler, "dump info on VIC");
}

int armvicIntPrioLevelSet(int vecSlot, int priorityLevel)
{
  /* Check vector slot */
  if ((vecSlot < 0) || (vecSlot > 15))
    return -1;

  VICVectCtrlN(vecSlot) = (unsigned long)((priorityLevel & 0x1F) | 0x20);

  return 0;

}

int armvicIntConnect(int vecSlot, int vecNum, armNestedIsr_t isr)
{
  /* Check vector slot */
  if ((vecSlot < 0) || (vecSlot > 15))
    return -1;

  /* Check vector number */
  if ((vecNum < LPC21XX_IRQVEC_FIRST) || (vecNum > LPC21XX_IRQVEC_LAST))
    return -1;

  /* Set the IRQ/FIQ Vector */
  VICVectAddrN(vecSlot) = (unsigned long)isr;

  /* Set the initial IRQ/FIQ priority to the vector number */
  VICVectCtrlN(vecSlot) = (unsigned long)((vecNum & 0x1F) | 0x20);

  return 0;
}

int armvicIntDisconnect(int vecSlot)
{
  /* Check vector slot */
  if ((vecSlot < 0) || (vecSlot > 15))
    return -1;

  VICVectCtrlN(vecSlot) = 0;

  // should probably connect to a default unknown vector handler
  VICVectAddrN(vecSlot) = (unsigned long)&unassignedVectorIsr;

  return 0;
}

int armvicSoftIntAssert(int vecNum)
{
  // TODO: not implemented
  return -1;
}

int armvicSoftIntNegate(int vecNum)
{
  // TODO: not implemented
  return -1;
}

int armvicSoftIntNegateAll(void)
{
  // TODO: not implemented
  return -1;
}

int armvicIntEnable(int vecNum)
{
  if ((vecNum < LPC21XX_IRQVEC_FIRST) || (vecNum > LPC21XX_IRQVEC_LAST)) {
    return -1;
    }

  VICIntEnable = (unsigned long)VECNUM_TO_MASK(vecNum);

  return 0;
}

int armvicIntDisable(int vecNum)
{
  if ((vecNum < LPC21XX_IRQVEC_FIRST) || (vecNum > LPC21XX_IRQVEC_LAST)) {
    return -1;
    }

  VICIntEnClr = (unsigned long)VECNUM_TO_MASK(vecNum);

  return 0;
}