Subversion Repositories mips_enhanced

#include "testmod.h"

asm(

"       .text\n"

"       .align 4\n"

"       .global get_pid\n"

"get_sem:\n"

"       set  mpsem, %o1\n"

"       set  0, %o0\n"

"       retl\n"

"       ldstuba [%o1] 1, %o0 \n"

/*"     swapa [%o1] 1, %o0 \n"*/

"ret_sem:\n"

/*"     set 1, %o0 \n" */

"       set 0, %o0 \n"

"       set mpsem, %o1\n"

"       retl\n"

"       st  %o0, [%o1]          \n"

"get_pid:\n"

"        mov  %asr17, %o0\n"

"        srl  %o0, 28, %o0\n"

"        retl\n"

"        and %o0, 0xf, %o0\n"

"mread: retl\n"

"        lda  [%o0] 1, %o0\n"

"getccfg: set 0xc, %o0\n"

"         retl\n"

"         lda [%o0] 2, %o0\n"

"       .data\n"

"       .align 4\n"

"       .global mpsem\n"

/*"mpsem:       .word 1\n"*/

"mpsem: .word 0\n"

);

#define MPLOOPS 10

volatile int cnt = 0;

volatile int pstart[17] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,1};

volatile int pdone[17] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,1};

volatile int pindex[17] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,1};

static int absl(int a, int b)

{

  if (a > b)

    return(a-b);

  else

    return(b-a);

}

static void psync(volatile int arr[], int n, int ncpu)

{

  int i, go;

  arr[n] = 1;

  do {

    go = 1;

    for (i = 0; i < ncpu; i++)

      if (!arr[i]) go = 0;

  } while (!go);

}

int mptest(volatile int *irqmp_ptr)

{

  int id, i, sem, ncpu;

  unsigned int ccfg;

  ncpu = (((*(irqmp_ptr + 0x10/4)) >> 28) & 0x0f) + 1;

  if (ncpu == 1) return(-1);

  id = get_pid();

  report_subtest(MP_TEST + (id <<4));

  ccfg = getccfg();

  if (!((ccfg >> 27) & 1)) fail(1);

  *(irqmp_ptr + 0x10/4) = (1 << (id+1));

  psync(pstart, id, ncpu);

  for (pindex[id] = 0; pindex[id] < MPLOOPS; pindex[id]++)

  {

//    do {sem = get_sem();} while (!sem);

    do {sem = get_sem();} while (sem);

    for (i = 0; i < ncpu; i++)

    {

      if (absl(pindex[id], pindex[i]) > 1) fail(2);

    }

    cnt++;

    ret_sem();

  }

  psync(pdone, id, ncpu);

  if (cnt != (MPLOOPS*ncpu)) fail(3);

  if ((cnt <= 0) || (cnt > (MPLOOPS*ncpu))) fail(3);

  if (id != 0) asm("ta 0");

  return(0);

}

int mptest_start(volatile int *irqmp_ptr)

{

  int id, i, sem, ncpu;

  unsigned int ccfg;

  ncpu = (((*(irqmp_ptr + 0x10/4)) >> 28) & 0x0f) + 1;

  if (ncpu == 1) return(-1);

  id = get_pid();

  if (id == 0) {

    *(irqmp_ptr + 0x10/4) = 0x0ffff;

  }

}

int mptest_end(volatile int *irqmp_ptr)

{

  int id, i, sem, ncpu;

  unsigned int ccfg;

  ncpu = (((*(irqmp_ptr + 0x10/4)) >> 28) & 0x0f) + 1;

  if (ncpu == 1) return(-1);

  id = get_pid();

  report_subtest(MP_TEST + (id << 4));

  ccfg = getccfg();

  if (!((ccfg >> 27) & 1)) fail(1);

  psync(pstart, id, ncpu);

  for (pindex[id] = 0; pindex[id] < MPLOOPS; pindex[id]++)

  {

//    do {sem = get_sem();} while (!sem);

    do {sem = get_sem();} while (sem);

    for (i = 0; i < ncpu; i++)

    {

      if (absl(pindex[id], pindex[i]) > 1) fail(2);

    }

    cnt++;

    ret_sem();

  }

  psync(pdone, id, ncpu);

  if (cnt != (MPLOOPS*ncpu)) fail(3);

  if ((cnt <= 0) || (cnt > (MPLOOPS*ncpu))) fail(3);

  if (id != 0) asm("ta 0");

  return(0);

}