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

#include "hw.h"
#include "serial.h"
#include "print.h"

#include "xc88x.h"

#include "mdu88x.h"

__xdata char *simif;

unsigned long lop1, lop2, lres, mdu_lres;
unsigned int iop1, iop2, ires1, ires2, mdu_ires1, mdu_ires2;

signed long slop1, slop2, slres, mdu_slres;
signed int siop1, siop2, sires1, sires2, mdu_sires1, mdu_sires2;

int ok, fail, i;
uint8_t r, shifts;

void
test_32div16(char verbose)
{
  ok= fail= 0;
  for (i= 0; i<100; i++)
    {
      lop1= labs(rand()) * abs(rand());
      do {
	iop2= abs(rand()) * abs(rand()%3);
      }
      while (!iop2);

      lres= lop1 / iop2;
      ires1= lop1 % iop2;

      if (verbose)
	printf("%8lx/%4x %10lu/%5u=%10lu,%5u ", lop1, iop2, lop1, iop2, lres, ires1);
      r= mdu_32udiv16(lop1, iop2, &mdu_lres, &mdu_ires1);
      if (verbose)
	printf("mdu=%10lu,%5u ", mdu_lres, mdu_ires1);
      if ((lres != mdu_lres) ||
	  (ires1 != mdu_ires1))
	{
	  if (verbose)
	    printf("fail ");
	  fail++;
	}
      else
	{
	  if (verbose)
	    printf("ok ");
	  ok++;
	}
      if (r &&
	  verbose)
	{
	  if (r&0x20)
	    printf("err ");
	}
      if (verbose)
	printf("\n");
    }
  printf("32udiv16 test: succ=%d fails=%d\n\n", ok, fail);
}

void
test_32sdiv16(char verbose)
{
  ok= fail= 0;
  for (i= 0; i<100; i++)
    {
      do {
	slop1= (long)rand() * rand() * (rand()%3-1);
      }
      while (!slop1);
      do {
	siop2= rand() * (rand()%3-1);
      }
      while (!siop2);

      slres= slop1 / siop2;
      sires1= slop1 % siop2;

      if (verbose)
	printf("%8lx/%4x %+11ld/%+6d=%+11ld,%+6d ",
	       slop1, siop2,
	       slop1, siop2,
	       slres, sires1);
      r= mdu_32sdiv16(slop1, siop2, &mdu_slres, &mdu_sires1);
      if (verbose)
	printf("mdu=%+11ld,%+6d ",
	       mdu_slres, mdu_sires1);
      if ((slres != mdu_slres) ||
	  (sires1 != mdu_sires1))
	{
	  if (verbose)
	    printf("fail ");
	  fail++;
	}
      else
	{
	  if (verbose)
	    printf("ok ");
	  ok++;
	}
      if (r &&
	  verbose)
	{
	  if (r&0x20)
	    printf("err ");
	}
      if (verbose)
	printf("\n");
    }
  printf("32sdiv16 test: succ=%d fails=%d\n\n", ok, fail);
}

void
test_16div16(char verbose)
{
  ok= fail= 0;
  for (i= 0; i<100; i++)
    {
      iop1= abs(rand()) * 1+abs(rand()%2);
      do {
	iop2= abs(rand());
      }
      while (!iop2);

      ires1= iop1 / iop2;
      ires2= iop1 % iop2;

      if (verbose)
	printf("%4x/%4x %5u/%5u=%5u,%5u ", iop1, iop2, iop1, iop2, ires1, ires2);
      r= mdu_16udiv16(iop1, iop2, &mdu_ires1, &mdu_ires2);
      if (verbose)
	printf("mdu=%5u,%5u ", mdu_ires1, mdu_ires2);
      if ((ires1 != mdu_ires1) ||
	  (ires2 != mdu_ires2))
	{
	  if (verbose)
	    printf("fail ");
	  fail++;
	}
      else
	{
	  if (verbose)
	    printf("ok ");
	  ok++;
	}
      if (r &&
	  verbose)
	{
	  if (r&0x20)
	    printf("err ");
	}
      if (verbose)
	printf("\n");
    }
  printf("16udiv16 test: succ=%d fails=%d\n\n", ok, fail);
}

void
test_16sdiv16(char verbose)
{
  ok= fail= 0;
  for (i= 0; i<100; i++)
    {
      do {
	siop1= rand() * (rand()%3-2);
      }
      while (!siop1);
      do {
	siop2= rand()/8 * (rand()%3-2);
      }
      while (!siop2);

      sires1= siop1 / siop2;
      sires2= siop1 % siop2;

      if (verbose)
	printf("%4x/%4x %+6d/%+6d=%+6d,%+6d ",
	       siop1, siop2,
	       siop1, siop2,
	       sires1, sires2);
      r= mdu_16sdiv16(siop1, siop2, &mdu_sires1, &mdu_sires2);
      if (verbose)
	printf("mdu=%+6d,%+6d ", mdu_sires1, mdu_sires2);
      if ((sires1 != mdu_sires1) ||
	  (sires2 != mdu_sires2))
	{
	  if (verbose)
	    printf("fail ");
	  fail++;
	}
      else
	{
	  if (verbose)
	    printf("ok ");
	  ok++;
	}
      if (r &&
	  verbose)
	{
	  if (r&0x20)
	    printf("err ");
	}
      if (verbose)
	printf("\n");
    }
  printf("16sdiv16 test: succ=%d fails=%d\n\n", ok, fail);
}

void
test_16mul16(char verbose)
{
  ok= fail= 0;
  for (i= 0; i<100; i++)
    {
      iop1= abs(rand()) /*+abs(rand())*/;
      iop2= abs(rand()) /*+abs(rand())*/;

      lres= (unsigned long)iop1 * (unsigned long)iop2;

      if (verbose)
	printf("%4x*%4x %5u*%5u=%10lu ", iop1, iop2, iop1, iop2, lres);
      r= mdu_16umul16(iop1, iop2, &mdu_lres);
      if (verbose)
	printf("mdu=%10lu ", mdu_lres);
      if (lres != mdu_lres)
	{
	  if (verbose)
	    printf("fail ");
	  fail++;
	}
      else
	{
	  if (verbose)
	    printf("ok ");
	  ok++;
	}
      if (r &&
	  verbose)
	{
	  if (r&0x80)
	    printf("err ");
	}
      if (verbose)
	printf("\n");
    }
  printf("16umul16 test: succ=%d fails=%d\n\n", ok, fail);
}

void
test_16smul16(char verbose)
{
  ok= fail= 0;
  for (i= 0; i<100; i++)
    {
      siop1= rand() * (rand()%3-2);
      do {
	siop2= rand()/8 * (rand()%3-2);
      }
      while (!siop2);

      slres= siop1 * (signed long)siop2;

      if (verbose)
	printf("%4x*%4x %+6d*%+6d=%+11ld ",
	       siop1, siop2,
	       siop1, siop2,
	       slres);
      r= mdu_16smul16(siop1, siop2, &mdu_slres);
      if (verbose)
	printf("mdu=%+11ld ", mdu_slres);
      if (slres != mdu_slres)
	{
	  if (verbose)
	    printf("fail ");
	  fail++;
	}
      else
	{
	  if (verbose)
	    printf("ok ");
	  ok++;
	}
      if (r &&
	  verbose)
	{
	  if (r&0x20)
	    printf("err ");
	}
      if (verbose)
	printf("\n");
    }
  printf("16sumul16 test: succ=%d fails=%d\n\n", ok, fail);
}

void
test_norm(char verbose)
{
  uint8_t mdu_shifts;
  
  ok= fail= 0;
  for (i= 0; i<100; i++)
    {
      do
	{
	  lop1= labs(rand()) * abs(rand());
	}
      while (lop1 == 0);

      if (lop1 & 0x80000000)
	{
	  lres= lop1;
	  shifts= 0;
	}
      else
	{
	  shifts= 0;
	  lres= lop1;
	  while ((lres & 0x80000000) == 0)
	    {
	      lres<<= 1;
	      shifts++;
	    }
	}
      
      if (verbose)
	printf("%8lx< %10lu=%8lx,%2d ", lop1, lop1, lres, shifts);
      r= mdu_norm(lop1, &mdu_lres, &mdu_shifts);
      if (verbose)
	printf("mdu=%8lx,%2d ", mdu_lres, mdu_shifts);
      if ((lres != mdu_lres) ||
	  (shifts != mdu_shifts))
	{
	  if (verbose)
	    printf("fail ");
	  fail++;
	}
      else
	{
	  if (verbose)
	    printf("ok ");
	  ok++;
	}
      if (r &&
	  verbose)
	{
	  if (r&0x80)
	    printf("err ");
	  if (r&0x40)
	    printf("ovr ");
	}
      if (verbose)
	printf("\n");
    }
  printf("norm test: succ=%d fails=%d\n\n", ok, fail);
}

void
test_lshift(char verbose)
{
  ok= fail= 0;
  for (i= 0; i<100; i++)
    {
      do
	{
	  lop1= labs(rand()) * abs(rand());
	}
      while (lop1 == 0);
      do {
	shifts= rand() & 0x1f;
      }
      while (shifts==0);
      
      r= rand() & 1;

      if (r)
	lres= lop1 << shifts;
      else
	lres= lop1 >> shifts;
      
      if (verbose)
	printf("%8lx%c%2d=%8lx ", lop1, r?'<':'>', shifts, lres);
      r= mdu_lshift(lop1, shifts, r, &mdu_lres);
      if (verbose)
	printf("mdu=%8lx ", mdu_lres);
      if (lres != mdu_lres)
	{
	  if (verbose)
	    printf("fail ");
	  fail++;
	}
      else
	{
	  if (verbose)
	    printf("ok ");
	  ok++;
	}
      if (r &&
	  verbose)
	{
	  if (r&0x80)
	    printf("err ");
	}
      if (verbose)
	printf("\n");
    }
  printf("lshift test: succ=%d fails=%d\n\n", ok, fail);
}

void
test_ashift(char verbose)
{
  ok= fail= 0;
  for (i= 0; i<100; i++)
    {
      do
	{
	  slop1= (long)rand()/64 * rand()/64 * (rand()%3-2+i%2);
	}
      while (slop1 == 0);
      do {
	shifts= rand() & 0x1f;
      }
      while (shifts==0);
      
      r= rand() & 1;

      if (r)
	slres= slop1 << shifts;
      else
	slres= slop1 >> shifts;
      
      if (verbose)
	printf("%8lx%c%2d=%8lx ", slop1, r?'<':'>', shifts, slres);
      r= mdu_ashift(slop1, shifts, r, &mdu_slres);
      if (verbose)
	printf("mdu=%8lx ", mdu_slres);
      if (slres != mdu_slres)
	{
	  if (verbose)
	    printf("fail ");
	  fail++;
	}
      else
	{
	  if (verbose)
	    printf("ok ");
	  ok++;
	}
      if (r &&
	  verbose)
	{
	  if (r&0x20)
	    printf("err ");
	}
      if (verbose)
	printf("\n");
    }
  printf("ashift test: succ=%d fails=%d\n\n", ok, fail);
}

void main(void)
{
  simif= (__xdata char *)0xffff;
  serial_init(9600);

  test_32div16(0);
  test_32sdiv16(0);
  test_16div16(0);
  test_16sdiv16(0);
  test_16mul16(0);
  test_16smul16(0);
  test_norm(0);
  test_lshift(0);
  test_ashift(0);
  
  *simif= 's';
  while (1)
    {
    }
}