e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#include <stdio.h>

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#include <stdlib.h>

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#include <sys/fcntl.h>

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#include <string.h>

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#include <time.h>

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#include "teac.h"

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#ifdef CHROMIUM

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#include <cr_string.h>

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#include <cr_mem.h>

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#include <cr_error.h>

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define crAlloc(sz) malloc(sz)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define crStrncpy(out,in,sz) strncpy(out,in,sz)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define crMemcpy(out,in,bytes) memcpy(out,in,bytes)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define crStrchr(instr,inchr) strchr(instr,inchr)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define crFree(ptr) free(ptr)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define crRealloc( pp, size ) { \

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(*pp=realloc(*pp,size))) { \

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"failed to reallocate %d bytes!\n",size); \

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort(); \

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync } \

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#include <stdarg.h>

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic void crDebug( const char* fmt, ... ) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync va_list ap;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync va_start(ap,fmt);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync vfprintf(stderr, fmt, ap);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync va_end(ap);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define EADDR_ALLOC_ELAN 0x200000

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define ALLOC_ELAN_SIZE 0x200000

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define EADDR_ALLOC_MAIN 0x400000

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define ALLOC_MAIN_SIZE 0x2000000

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#ifdef ELAN_PRE_KITE

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_DEVINFO_TYPE 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_CAP_TYPE 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#ifdef ELAN_PRE_EAGLE

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#ifdef LINUX

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_DEVINFO_TYPE 1

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_CREATE_TYPE 1

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_DEVINFO_TYPE 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_CREATE_TYPE 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_CAP_TYPE 1

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_DEVINFO_TYPE 2

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_CAP_TYPE 2

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_CREATE_TYPE 2

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if (TEAC_CAP_TYPE == 2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_CAP_ENTRIES(cap) ELAN_CAP_ENTRIES(cap)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define TEAC_CAP_ENTRIES(cap) (cap->Entries)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define RAIL 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#ifndef HOST_TABLE_FILENAME

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define HOST_TABLE_FILENAME "/usr/users/8/welling/elanstuff/teac/teac_host_map.t"

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#define INITIAL_HOST_TABLE_SIZE 256

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic host_t* hosts= NULL; /* this one ends up sorted by host name */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic int* hostsIndex= NULL; /* this is sorted by node ID */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic sdramaddr_t* sdramAddrBase= NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic E3_Addr* elanAddrBase= NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic int nodeTablesInitialized= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic int nodeTableSize= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic int nodeCount= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic int read_node_map()

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync FILE* f= NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int iLine;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync char buf[256];

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (hosts) crFree(hosts);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(hosts= (host_t*)crAlloc(INITIAL_HOST_TABLE_SIZE*sizeof(host_t)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync INITIAL_HOST_TABLE_SIZE*sizeof(host_t));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync nodeTableSize= INITIAL_HOST_TABLE_SIZE;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(f=fopen(HOST_TABLE_FILENAME,"r"))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: cannot open <%s> for reading!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync HOST_TABLE_FILENAME);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync i= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync iLine= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync buf[sizeof(buf)-1]= '\0';

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync while (!feof(f) && !ferror(f)) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync char* tmp;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync char* string;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!fgets(buf, sizeof(buf)-1, f)) break;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync iLine++;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (buf[0]=='#' || buf[0]=='\n' || buf[0]=='\0') continue;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (i>=nodeTableSize) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* We need to grow the table */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int newSize= 2*nodeTableSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crRealloc((void**)&hosts,newSize*sizeof(host_t));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync nodeTableSize= newSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(string=strtok_r(buf," ,;\t\n",&tmp))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: Bad machine name at line %d of %s!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync iLine, HOST_TABLE_FILENAME);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (strlen(string)==0) continue; /* blank line */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync hosts[i].name= strdup(string);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(string=strtok_r(NULL," ,;\t\n",&tmp))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: bad integer string at line %d of %s!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync iLine, HOST_TABLE_FILENAME);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync errno= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync hosts[i].railMask= atoi(string);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (errno != 0) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: bad integer %s at %s line %d!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync string, HOST_TABLE_FILENAME, iLine);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(string=strtok_r(NULL," ,;\t\n",&tmp))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: bad integer string at line %d of %s!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync iLine, HOST_TABLE_FILENAME);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync errno= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync hosts[i].id= atoi(string);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (errno != 0) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: bad integer %s at %s line %d!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync string, HOST_TABLE_FILENAME, iLine);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(string=strtok_r(NULL," ,;\t\n",&tmp))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: bad hex value at line %d of %s!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync iLine, HOST_TABLE_FILENAME);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync errno= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync hosts[i].sdramAddrBase= (sdramaddr_t)strtol(string, (char**)NULL, 0);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (errno != 0) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: bad hex address %s at %s line %d!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync string, HOST_TABLE_FILENAME, iLine);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(string=strtok_r(NULL," ,;\t\n",&tmp))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: bad hex value at line %d of %s!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync iLine, HOST_TABLE_FILENAME);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync errno= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync hosts[i].elanAddrBase= (E3_Addr)strtol(string, (char**)NULL, 0);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (errno != 0) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: bad hex address %s at %s line %d!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync string, HOST_TABLE_FILENAME, iLine);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("line %d: %d: got <%s> %d %d 0x%x 0x%x\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync iLine, i, hosts[i].name, hosts[i].railMask, hosts[i].id,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync hosts[i].sdramAddrBase, hosts[i].elanAddrBase);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync i++;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (ferror(f)) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("Error reading host table");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: error reading <%s>!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync HOST_TABLE_FILENAME);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (void)fclose(f);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic int hostnameCompare(const void* h1, const void* h2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return strcmp(((host_t*)h1)->name, ((host_t*)h2)->name);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic int hostnameLookup(const void* h1, const void* h2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return strcmp((const char*)h1, ((host_t*)h2)->name);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic void initialize_node_tables()

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!nodeTablesInitialized) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int nodeMin;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int nodeMax;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int nodeRange;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Loading Quadrics network map from <%s>\n",HOST_TABLE_FILENAME);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Load information about Quadrics network */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync nodeCount= read_node_map();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (nodeCount==0) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync "libteac: initialize_node_tables: no valid nodes in %s!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync HOST_TABLE_FILENAME);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /*

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync nodeMin= nodeMax= hosts[0].id;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=1; i<nodeCount; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (hosts[i].id<nodeMin) nodeMin= hosts[i].id;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (hosts[i].id>nodeMax) nodeMax= hosts[i].id;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync nodeRange= (nodeMax-nodeMin) + 1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(sdramAddrBase=(sdramaddr_t*)crAlloc(nodeRange*sizeof(sdramaddr_t)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync "libteac: initialize_node_tables: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync nodeRange*sizeof(sdramaddr_t));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(elanAddrBase=(E3_Addr*)crAlloc(nodeRange*sizeof(E3_Addr)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync "libteac: initialize_node_tables: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync nodeRange*sizeof(E3_Addr));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<nodeRange; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync sdramAddrBase[i]= (sdramaddr_t)0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elanAddrBase[i]= (E3_Addr)0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<nodeCount; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync sdramAddrBase[hosts[i].id]= hosts[i].sdramAddrBase;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elanAddrBase[hosts[i].id]= hosts[i].elanAddrBase;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Sort the host table alphabetically by host name for faster lookup */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync qsort( hosts, nodeCount, sizeof(host_t), hostnameCompare );

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Build an ordered index into the hosts table */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (hostsIndex) crFree(hostsIndex);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(hostsIndex= (int*)crAlloc(nodeRange*sizeof(int)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync nodeCount*sizeof(int));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<nodeRange; i++) hostsIndex[i]= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<nodeCount; i++) hostsIndex[hosts[i].id]= i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync nodeTablesInitialized= 1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic int trans_host(const char *hn) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync host_t* h= NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!nodeTablesInitialized) initialize_node_tables();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync char buf[128];

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync i= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync while (i<sizeof(buf)-1 && hn[i] && hn[i]!='.') { buf[i]= hn[i]; i++; };

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync buf[i]= '\0';

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync h=(host_t*)bsearch(hn, hosts, nodeCount, sizeof(host_t), hostnameLookup);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (h) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Lookup <%s> got <%s> <%d> <%x> <%x>\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync hn,h->name,h->id,(int)h->sdramAddrBase,(int)h->elanAddrBase);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync else fprintf(stderr,"Lookup <%s> returned NULL!\n",hn);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (h) return h->id;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync else return -1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncstatic E3_Addr teac_main2elan( ELAN3_CTX *ctx, void* main_addr )

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync E3_Addr result= elan3_main2elan(ctx,main_addr);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /*

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (result==ELAN_BAD_ADDR) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"Address translation error: %0x has no elan equivalent\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (int)main_addr);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return result;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncTcomm *teac_Init(char *lh, char *hh, int lctx, int hctx, int myrank,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync const unsigned char key[TEAC_KEY_SIZE])

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if (TEAC_DEVINFO_TYPE == 2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync ELAN_DEVINFO info;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync ELAN_POSITION position;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync ELAN3_DEVINFO info;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync ELAN_CAPABILITY *cap;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync Tcomm* result= NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int j;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int a;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int b;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync char buf[256];

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync char* here;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if ( TEAC_CREATE_TYPE == 0 )

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync void* control;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!nodeTablesInitialized) initialize_node_tables();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result= (Tcomm*)crAlloc(sizeof(Tcomm)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"teac_Init: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync sizeof(Tcomm));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->ctx = NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->dma = NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->e_dma = 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->s_event = 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->r_event = NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) result->sbuf_pull_event[i] = 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->rbuf_pull_event = 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->m_snd = NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->m_rcv = NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) result->sbuf_ready[i]= NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->rbuf_ready = NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->mbuff= NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) result->sendWrappers[i]= NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->vp = -1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->hhost = result->lhost = -1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->hctx = result->lctx = -1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->msgnum = 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->poll_shift = 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->totalSendBufferBytesAllocated= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->totalRecvBufferBytesAllocated= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync a = trans_host(lh);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync b = trans_host(hh);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->lhost = (a < b)? a : b;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->hhost = (a > b) ? a : b;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->lctx = (lctx<hctx) ? lctx : hctx;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->hctx = (hctx>lctx) ? hctx : lctx;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap = &(result->cap);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if (TEAC_CAP_TYPE == 2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan_nullcap(cap);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Initialize the UserKey to the given value */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crMemcpy((void*)&(cap->cap_userkey.key_values),key,TEAC_KEY_SIZE);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->cap_lowcontext = lctx;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->cap_mycontext = lctx + (myrank%4);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->cap_highcontext = hctx;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->cap_lownode = result->lhost;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->cap_highnode = result->hhost;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->cap_type =

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync ELAN_CAP_TYPE_BLOCK | ELAN_CAP_TYPE_NO_BITMAP | ELAN_CAP_TYPE_MULTI_RAIL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_nullcap(cap);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Initialize the UserKey to the given value */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crMemcpy((void*)&(cap->UserKey),key,TEAC_KEY_SIZE);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->LowContext = lctx;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->MyContext = lctx + (myrank%4);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->HighContext = hctx;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->LowNode = result->lhost;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->HighNode = result->hhost;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->Entries = (hctx - lctx + 1) * (cap->HighNode - cap->LowNode + 1);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync cap->Type =

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync ELAN_CAP_TYPE_BLOCK | ELAN_CAP_TYPE_NO_BITMAP | ELAN_CAP_TYPE_MULTI_RAIL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if ((result->ctx = elan3_init( 0, EADDR_ALLOC_MAIN, ALLOC_MAIN_SIZE,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync EADDR_ALLOC_ELAN, ALLOC_ELAN_SIZE))

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync == NULL) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr, "teac_Init: elan3_init returned NULL context\n");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_block_inputter (result->ctx, 1);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if ( TEAC_CREATE_TYPE == 0 )

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if ((control = elan3_control_open (RAIL)) != NULL) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (elan3_create(control, &(result->cap))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("elan3_create failed with <%s>, but that's OK!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync strerror(errno));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync errno= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync else {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("elan3_control_open failed");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#elif ( TEAC_CREATE_TYPE == 1 )

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (elan3_create(result->ctx, &(result->cap))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("elan3_create failed with <%s>, but that's OK!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync strerror(errno));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync errno= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* I don't think we have to do anything here! */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if (TEAC_DEVINFO_TYPE == 2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (void)elan3_get_devinfo(result->ctx, &info);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (void)elan3_get_position(result->ctx, &position);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Position mode %d, NodeID %d, NumNodes %d, NumLevels %d\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync position.pos_mode,position.pos_nodeid, position.pos_nodes,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync position.pos_levels);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (position.pos_mode != ELAN_POS_MODE_SWITCHED)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("WARNING: position mode is not %d!\n",ELAN_POS_MODE_SWITCHED);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Rail %d\n",info.dev_rail);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#elif (TEAC_DEVINFO_TYPE == 1)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_devinfo(0, &info);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("NodeId: %d, NumNodes: %d, NumLevels: %d, NodeLevel: %d\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync info.Position.NodeId, info.Position.NumNodes,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync info.Position.NumLevels, info.Position.NodeLevel);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_devinfo(0, &info);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("NodeId: %d, NumLevels: %d, NodeLevel: %d\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync info.NodeId, info.NumLevels, info.NodeLevel);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync static char junkString[256];

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if (TEAC_CAP_TYPE == 2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Capability: <%s>\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan_capability_string(&(result->cap),junkString));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("railmask is %d\n",result->cap.cap_railmask);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("bitmap is %x\n",result->cap.cap_bitmap[0]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Capability: <%s>\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_capability_string(&(result->cap),junkString));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("railmask is %d\n",result->cap.RailMask);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("bitmap is %x\n",result->cap.Bitmap[0]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Reality check. */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (gethostname(buf,sizeof(buf)-1)) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("Can't get my own host name");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if ((here= crStrchr(buf,'.')) != NULL) *here= '\0';

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if (TEAC_DEVINFO_TYPE == 2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (trans_host(buf) != (int)position.pos_nodeid) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync "teac_Init: Expected Quadrics port id %d does not match real value %d!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync trans_host(buf), position.pos_nodeid);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#elif (TEAC_DEVINFO_TYPE == 1)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (trans_host(buf) != info.Position.NodeId) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync "teac_Init: Expected Quadrics port id %d does not match real value %d!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync trans_host(buf), info.Position.NodeId);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (trans_host(buf) != info.NodeId) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync "teac_Init: Expected Quadrics port id %d does not match real value %d!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync trans_host(buf), info.NodeId);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (elan3_attach(result->ctx, &(result->cap))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr, "teac_Init: elan3_attach failed\n");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (elan3_addvp(result->ctx, 0, &(result->cap))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr, "teac_Init: elan3_addvp failed\n");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->vp = elan3_process(result->ctx);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (! elan3_set_required_mappings (result->ctx)) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr, "teac_Init: elan3_set_required_mappings failed\n");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->r_event=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (sdramaddr_t**)crAlloc( TEAC_CAP_ENTRIES(cap)*sizeof(sdramaddr_t*) ))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"teac_Init: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync TEAC_CAP_ENTRIES(cap)*sizeof(sdramaddr_t*));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->r_event[0]=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (sdramaddr_t*)crAlloc( TEAC_CAP_ENTRIES(cap)*NUM_SEND_BUFFERS

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync * sizeof(sdramaddr_t) ))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"teac_Init: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync TEAC_CAP_ENTRIES(cap)*NUM_SEND_BUFFERS*sizeof(sdramaddr_t));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->r_event[0][0]=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_allocElan(result->ctx, E3_EVENT_ALIGN,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync TEAC_CAP_ENTRIES(cap)*NUM_SEND_BUFFERS*sizeof(E3_BlockCopyEvent)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocElan failed for r_event block");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (j=1; j<TEAC_CAP_ENTRIES(cap); j++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->r_event[j]= result->r_event[0] + j*NUM_SEND_BUFFERS;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->r_event[j][0]=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->r_event[0][0]+j*NUM_SEND_BUFFERS*sizeof(E3_BlockCopyEvent);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (j=0; j<TEAC_CAP_ENTRIES(cap); j++)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=1; i<NUM_SEND_BUFFERS; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->r_event[j][i]=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->r_event[j][0] + i*sizeof(E3_BlockCopyEvent);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("r_event[0][0] is %x\n",(int)result->r_event[0][0]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->m_rcv=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (volatile E3_uint32**)crAlloc( TEAC_CAP_ENTRIES(cap)*sizeof(E3_uint32*) ))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"teac_Init: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync TEAC_CAP_ENTRIES(cap)*sizeof(E3_uint32*));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->m_rcv[0]= (volatile E3_uint32*)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_allocMain(result->ctx, 0,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync TEAC_CAP_ENTRIES(cap)*NUM_SEND_BUFFERS*sizeof(E3_uint32)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocMain failed for m_rcv block");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=1; i<TEAC_CAP_ENTRIES(cap); i++)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->m_rcv[i]= result->m_rcv[0] + i*NUM_SEND_BUFFERS;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Base of m_rcv is %lx -> %lx\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (long)(result->m_rcv[0]),

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (long)teac_main2elan(result->ctx,(void*)(result->m_rcv[0])));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->mbuff= (teacMsg**)crAlloc( TEAC_CAP_ENTRIES(cap)*sizeof(teacMsg*) ))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"teac_Init: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync TEAC_CAP_ENTRIES(cap)*sizeof(teacMsg*));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->mbuff[0]= (teacMsg*)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_allocMain(result->ctx, 8,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync TEAC_CAP_ENTRIES(cap)*NUM_SEND_BUFFERS*sizeof(teacMsg)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocMain failed for mbuff block");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=1; i<TEAC_CAP_ENTRIES(cap); i++)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->mbuff[i]= result->mbuff[0] + i*NUM_SEND_BUFFERS;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Base of mbuff is %lx -> %lx\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (long)(result->mbuff[0]),

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (long)teac_main2elan(result->ctx,result->mbuff[0]));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->dma= (E3_DMA_MAIN *)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_allocMain(result->ctx,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync E3_DMA_ALIGN, sizeof(E3_DMA_MAIN)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocMain failed for dma");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->e_dma=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_allocElan(result->ctx, E3_DMA_ALIGN, sizeof(E3_DMA)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocElan failed for e_dma");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->s_event=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_allocElan(result->ctx, E3_EVENT_ALIGN,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync sizeof(E3_BlockCopyEvent)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocElan failed for s_event");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("s_event is %x\n",(int)result->s_event);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->sbuf_pull_event[0]=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_allocElan(result->ctx, E3_EVENT_ALIGN,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync NUM_SEND_BUFFERS*sizeof(E3_BlockCopyEvent)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocElan failed for sbuf_pull_event block");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=1; i<NUM_SEND_BUFFERS; i++)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->sbuf_pull_event[i]=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->sbuf_pull_event[0]+i*sizeof(E3_BlockCopyEvent);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->rbuf_pull_event=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_allocElan(result->ctx, E3_EVENT_ALIGN,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync sizeof(E3_BlockCopyEvent)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocElan failed for rbuf_pull_event");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->m_snd= (E3_uint32 *)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_allocMain(result->ctx, 0,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync sizeof(E3_uint32)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocMain failed for m_snd");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->sbuf_ready[0]= (E3_uint32 *)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_allocMain(result->ctx, 0,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync NUM_SEND_BUFFERS*sizeof(E3_uint32)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocMain failed for sbuf_ready block");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=1; i<NUM_SEND_BUFFERS; i++)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->sbuf_ready[i]= result->sbuf_ready[0] + i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->sendWrappers[0]=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (SBuffer*)crAlloc(NUM_SEND_BUFFERS*sizeof(SBuffer)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"teac_Init: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync NUM_SEND_BUFFERS*sizeof(SBuffer));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=1; i<NUM_SEND_BUFFERS; i++)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->sendWrappers[i]= result->sendWrappers[0] + i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->rbuf_ready= (E3_uint32 *)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_allocMain(result->ctx, 0,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync sizeof(E3_uint32)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocMain failed for rbuf_ready");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync char* buf;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(buf= (char*)elan3_allocMain(result->ctx, 8,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync E_BUFFER_INITIAL_SIZE))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Init: elan3_allocMain failed for buffer block");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teac_Close(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->sendWrappers[i]->bufId= i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->sendWrappers[i]->totSize= E_BUFFER_INITIAL_SIZE;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->sendWrappers[i]->validSize= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->sendWrappers[i]->buf= buf;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->totalSendBufferBytesAllocated += result->sendWrappers[i]->totSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_initevent_word (result->ctx,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->s_event, result->m_snd);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_initevent_word (result->ctx,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->rbuf_pull_event, result->rbuf_ready);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_initevent_word (result->ctx,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->sbuf_pull_event[i], result->sbuf_ready[i]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (j=0; j<TEAC_CAP_ENTRIES(cap); j++)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_initevent_word (result->ctx,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->r_event[j][i], &(result->m_rcv[j][i]));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Get the message receive events ready to fire, in case something

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (j=0; j<TEAC_CAP_ENTRIES(cap); j++)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_primeevent(result->ctx, result->r_event[j][i], 1);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Fire the sbuffer free events, so that the buffers look free when

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_primeevent(result->ctx, result->sbuf_pull_event[i], 1);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_setevent( result->ctx, result->sbuf_pull_event[i] );

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* And now we're ready to face the world. */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_block_inputter (result->ctx, 0);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncvoid teac_Close(Tcomm *tcomm)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* First we have to wait until all pending messages have been

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if ((tcomm->sbuf_pull_event[0] != 0) && (tcomm->sbuf_ready[0] != NULL)) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_waitevent_word(tcomm->ctx, tcomm->sbuf_pull_event[i],

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->sbuf_ready[i], 10);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("All TEAC messages have reported home!\n");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_block_inputter (tcomm->ctx, 1);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->e_dma != 0) elan3_freeElan(tcomm->ctx, tcomm->e_dma);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->s_event != 0) elan3_freeElan(tcomm->ctx, tcomm->s_event);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->r_event != NULL) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->r_event[0] != NULL) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->r_event[0][0] != 0) elan3_freeElan(tcomm->ctx,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->r_event[0][0]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crFree(tcomm->r_event[0]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crFree(tcomm->r_event);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->sbuf_pull_event[0] != 0)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_freeElan(tcomm->ctx, tcomm->sbuf_pull_event[0]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->sendWrappers[0] != NULL) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->sendWrappers[i]->buf != NULL) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_free(tcomm->ctx, tcomm->sendWrappers[i]->buf);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->totalSendBufferBytesAllocated -=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->sendWrappers[i]->totSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crFree(tcomm->sendWrappers[0]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->rbuf_pull_event != 0)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_freeElan(tcomm->ctx, tcomm->rbuf_pull_event);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->m_snd != NULL) elan3_free(tcomm->ctx,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (E3_uint32*)tcomm->m_snd);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->m_rcv != NULL) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->m_rcv[0] != NULL) elan3_free(tcomm->ctx,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (E3_uint32*)tcomm->m_rcv[0]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crFree(tcomm->m_rcv);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->sbuf_ready[0] != NULL)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_free(tcomm->ctx, (E3_uint32*)tcomm->sbuf_ready[0]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->rbuf_ready != NULL) elan3_free(tcomm->ctx,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (E3_uint32*)tcomm->rbuf_ready);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->mbuff != NULL) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->mbuff[0] != NULL) elan3_free(tcomm->ctx, tcomm->mbuff[0]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crFree(tcomm->mbuff);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if (TEAC_CREATE_TYPE==2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_detach(tcomm->ctx);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_fini(tcomm->ctx);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* elan3_detach and elan3_destroy seem to crash sometimes in

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncint teac_Select(Tcomm* tcomm, int *ids, int num_ids, int timeout)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int id;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync while (timeout-- > 0) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if ((id= teac_Poll(tcomm, ids, num_ids)) >= 0) return id;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return -1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncint teac_Poll(Tcomm* tcomm, int *ids, int num_ids)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int j;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (j=0; j<num_ids; j++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int index= (j+tcomm->poll_shift) % num_ids;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int thisId= ids[index];

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (elan3_pollevent_word(tcomm->ctx, &(tcomm->m_rcv[thisId][i]), 1)) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#ifdef never

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->poll_shift= index;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return thisId;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return -1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncint teac_sendBufferAvailable(Tcomm* tcomm)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (elan3_pollevent_word(tcomm->ctx, tcomm->sbuf_ready[i], 1))

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return 1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncSBuffer* teac_getSendBuffer( Tcomm* tcomm, long size )

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Find a free send buffer. We'll busy wait in this poll loop

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int i= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync while (1) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (elan3_pollevent_word(tcomm->ctx, tcomm->sbuf_ready[i],

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync 1)) break;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (++i == NUM_SEND_BUFFERS) i= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* We will use this buffer! */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Allocated message buffer %d\n",i);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync *(tcomm->sbuf_ready[i])= 0; /* mark it busy */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* If the associated chunk of memory is smaller than that requested,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->sendWrappers[i]->totSize < size) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->totalSendBufferBytesAllocated -= tcomm->sendWrappers[i]->totSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_free( tcomm->ctx, tcomm->sendWrappers[i]->buf );

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(tcomm->sendWrappers[i]->buf=

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (char*)elan3_allocMain(tcomm->ctx, 8, size))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_getSendBuffer: failed to grow send buffer");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync exit(-1);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->totalSendBufferBytesAllocated += size;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->sendWrappers[i]->totSize= size;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->sendWrappers[i]->validSize= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return tcomm->sendWrappers[i];

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncSBuffer* teac_getUnreadySendBuffer( Tcomm* tcomm, long size )

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync SBuffer* result= NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result= (SBuffer*)crAlloc(sizeof(SBuffer)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"libteac: read_node_map: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync sizeof(SBuffer));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->bufId= -1; /* this marks it unready */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Allocated an unready message buffer!\n");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Allocate some DMA-able memory */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->buf= (char*)elan3_allocMain(tcomm->ctx, 8, size))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_getUnreadySendBuffer: failed to allocate elan3 memory");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync exit(-1);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->totSize= size;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->validSize= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->totalSendBufferBytesAllocated += result->totSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return result;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncSBuffer* teac_makeSendBufferReady( Tcomm* tcomm, SBuffer* buf )

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int i= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* If the input buffer is already ready, just return it */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (buf->bufId >= 0 && buf->bufId<NUM_SEND_BUFFERS) return buf;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Find a free send buffer. We'll busy wait in this poll loop

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync while (1) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (elan3_pollevent_word(tcomm->ctx, tcomm->sbuf_ready[i],

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync 1)) break;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (++i == NUM_SEND_BUFFERS) i= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* We will use this buffer! */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Allocated message buffer %d in makeSendBufferReady\n",i);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync *(tcomm->sbuf_ready[i])= 0; /* mark it busy */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Substitute the unready payload for the old payload */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->totalSendBufferBytesAllocated -= tcomm->sendWrappers[i]->totSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_free( tcomm->ctx, tcomm->sendWrappers[i]->buf );

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->sendWrappers[i]->buf= buf->buf;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->sendWrappers[i]->totSize= buf->totSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->sendWrappers[i]->validSize= buf->validSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crFree(buf);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return tcomm->sendWrappers[i];

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncint teac_Send( Tcomm* tcomm, int* ids, int num_ids, SBuffer* buf, void *start )

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int vp = tcomm->vp;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int iBuf;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int iDest;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync teacMsg *msg;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Complain loudly if this is an unready buffer */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (buf->bufId==-1) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"teac_Send: tried to send an unready buffer!\n");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Reality check: is this one of my buffers? */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (buf->bufId<0 || buf->bufId>=NUM_SEND_BUFFERS) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"teac_Send: I don't know this buffer!\n");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Reality check: did they write too much into the message? */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (buf->validSize > buf->totSize) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"teac_Send: message too large! (%ld vs %ld)\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync buf->validSize, buf->totSize);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync abort();

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync iBuf= buf->bufId;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync msg = &(tcomm->mbuff[vp][iBuf]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync msg->msgnum = tcomm->msgnum++;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync msg->size = buf->validSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync msg->host = vp;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if ( start != NULL )

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync msg->mptr = teac_main2elan( tcomm->ctx, start );

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync msg->mptr = teac_main2elan(tcomm->ctx, buf->buf);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync msg->clr_event = elan3_sdram2elan(tcomm->ctx, tcomm->ctx->sdram,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->sbuf_pull_event[iBuf]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync msg->new= 1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Set up the parts of the DMA that are not specific to destination */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_type = E3_DMA_TYPE(DMA_BYTE,DMA_WRITE,DMA_NORMAL,0);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_size = sizeof(teacMsg);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_srcEvent =

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_sdram2elan(tcomm->ctx,tcomm->ctx->sdram,tcomm->s_event);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_source = teac_main2elan(tcomm->ctx, msg);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_primeevent(tcomm->ctx, tcomm->sbuf_pull_event[buf->bufId], num_ids);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Send this message off to each destination */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (iDest=0; iDest<num_ids; iDest++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_srcCookieVProc =

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_local_cookie(tcomm->ctx, vp, ids[iDest]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_destCookieVProc = ids[iDest];

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_destEvent =

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_sdram2elan(tcomm->ctx,tcomm->ctx->sdram,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->r_event[vp][iBuf])

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync + sdramAddrBase[(ids[iDest]/NUM_SEND_BUFFERS) + tcomm->lhost]

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync - sdramAddrBase[(vp/NUM_SEND_BUFFERS) + tcomm->lhost];

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_dest = teac_main2elan(tcomm->ctx, msg)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync + elanAddrBase[(ids[iDest]/NUM_SEND_BUFFERS) + tcomm->lhost]

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync - elanAddrBase[(vp/NUM_SEND_BUFFERS) + tcomm->lhost];

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_primeevent(tcomm->ctx, tcomm->s_event, 1);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync *(tcomm->m_snd)= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_putdma_main(tcomm->ctx, tcomm->dma, tcomm->e_dma);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("DMA dest event %x, dest mem %lx\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_destEvent,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (long)tcomm->dma->dma_dest);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Mem shifts are %x %x based on %d %d\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elanAddrBase[(ids[iDest]/NUM_SEND_BUFFERS) + tcomm->lhost],

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elanAddrBase[(vp/NUM_SEND_BUFFERS) + tcomm->lhost],

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync ids[iDest],vp);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Send msg %d in buffer %d to %d (list index %d)...",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync msg->msgnum,iBuf, ids[iDest],iDest);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_waitevent_word(tcomm->ctx,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->s_event, tcomm->m_snd, ELAN_WAIT_EVENT);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("message away!\n");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return 1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncRBuffer* teac_Recv(Tcomm* tcomm, int id)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int vp = tcomm->vp;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync RBuffer* result= NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int iEvent= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int iBuf= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int lowestMsgnum;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* poll until we get an incoming message from the given sender */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync while (1) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (elan3_pollevent_word(tcomm->ctx, &(tcomm->m_rcv[id][iEvent]), 1))

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync break;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (++iEvent == NUM_SEND_BUFFERS) iEvent= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* This may not be the earliest event, however. */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync lowestMsgnum= -1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync for (i=0; i<NUM_SEND_BUFFERS; i++) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("Testing for new msg at %lx -> %lx\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (long)&(tcomm->mbuff[id][i]),

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (long)teac_main2elan(tcomm->ctx,(void*)(&tcomm->mbuff[id][i])));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (tcomm->mbuff[id][i].new) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if ((lowestMsgnum < 0)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync || (tcomm->mbuff[id][i].msgnum < (E3_uint32)lowestMsgnum)) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync lowestMsgnum= tcomm->mbuff[id][i].msgnum;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync iBuf= i;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (lowestMsgnum<0) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync "teac_Recv: internal error: can't find message I just got!\n");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->mbuff[id][iBuf].new= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->m_rcv[id][iBuf]= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_primeevent(tcomm->ctx, tcomm->r_event[id][iBuf],1);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("got msg %d in buffer %d from %d!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->mbuff[id][iBuf].msgnum, iBuf, id);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Make some space to put the message when it arrives */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result= (RBuffer*)crAlloc(sizeof(RBuffer)))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync fprintf(stderr,"teac_Recv: unable to allocate %d bytes!\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync sizeof(RBuffer));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return NULL;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->buf= (void*)elan3_allocMain(tcomm->ctx, 8,E_BUFFER_SIZE))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Recv: elan3_allocMain failed for buffer");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->totSize= E_BUFFER_SIZE;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (!(result->buf= (void*)elan3_allocMain(tcomm->ctx, 8,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->mbuff[id][iBuf].size))) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("teac_Recv: elan3_allocMain failed for buffer");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(NULL);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->totSize= tcomm->mbuff[id][iBuf].size;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->totalRecvBufferBytesAllocated+= result->totSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->validSize= tcomm->mbuff[id][iBuf].size;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->from= tcomm->mbuff[id][iBuf].host;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync result->senderMsgnum= tcomm->mbuff[id][iBuf].msgnum;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync /* Set up the DMA to pull the message */

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_type = E3_DMA_TYPE(DMA_BYTE,DMA_READ,DMA_NORMAL,0);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_size = tcomm->mbuff[id][iBuf].size;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_source = tcomm->mbuff[id][iBuf].mptr;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_dest = teac_main2elan(tcomm->ctx,result->buf);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_srcCookieVProc =

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_remote_cookie(tcomm->ctx, vp, tcomm->mbuff[id][iBuf].host);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_destCookieVProc =

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_local_cookie(tcomm->ctx, vp, tcomm->mbuff[id][iBuf].host);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_srcEvent = tcomm->mbuff[id][iBuf].clr_event;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->dma->dma_destEvent =

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_sdram2elan(tcomm->ctx,tcomm->ctx->sdram,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->rbuf_pull_event);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_primeevent(tcomm->ctx, tcomm->rbuf_pull_event,1);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync *(tcomm->rbuf_ready)= 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_getdma_main(tcomm->ctx, tcomm->dma, tcomm->e_dma);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_waitevent_word(tcomm->ctx,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->rbuf_pull_event,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->rbuf_ready, ELAN_WAIT_EVENT);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return(result);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncint teac_Dispose( Tcomm* tcomm, RBuffer* buf )

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync tcomm->totalRecvBufferBytesAllocated -= buf->totSize;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_free(tcomm->ctx, buf->buf);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crFree(buf);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncchar* teac_getTcommString(Tcomm *c, char* buf, int buflen)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync snprintf(buf,buflen-1,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync "<vp= %d, host range %d-%d, ctxnum range %d-%d, msg %d>",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync c->vp,c->lhost,c->hhost,c->lctx,c->hctx,c->msgnum);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync buf[buflen-1]= '\0';

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return buf;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncchar* teac_getConnString(Tcomm *c, int id, char* buf, int buflen)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int rel_rank= id%4;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int node= ((id-rel_rank)/4) + c->lhost;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync snprintf(buf,buflen-1,"vp %d, <%s>:%d",id,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync hosts[hostsIndex[node]].name,rel_rank);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync buf[buflen-1]= '\0';

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("getConnString: lookup id %d -> %d %d -> %s\n",id,rel_rank,node,buf);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return buf;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncint teac_getConnId(Tcomm *c, const char* host, int rank)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int node= trans_host(host);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if 0

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync crDebug("getConnId: <%s> %d %d maps to %d %d\n",

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync host, rank, c->lhost, node, (4*(node - c->lhost) + (rank%4)));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return (4*(node - c->lhost) + (rank%4));

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsyncint teac_getHostInfo(Tcomm *c, char* host, const int hostLength,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync int* railMask, int *nodeId,

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync long* sdramBaseAddr, long* elanBaseAddr)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync{

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if (TEAC_DEVINFO_TYPE == 2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync ELAN_DEVINFO info;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync ELAN_POSITION position;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync ELAN3_DEVINFO info;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync char* here;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if (gethostname(host,hostLength-1)) {

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync perror("Can't get my own host name");

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return 0;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync }

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync host[hostLength-1]= '\0';

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync if ((here= crStrchr(host,'.')) != NULL) *here= '\0';

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if (TEAC_DEVINFO_TYPE == 2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (void)elan3_get_devinfo(c->ctx, &info);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync (void)elan3_get_position(c->ctx, &position);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync *nodeId= position.pos_nodeid;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#elif (TEAC_DEVINFO_TYPE == 1)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_devinfo(0, &info);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync *nodeId= info.Position.NodeId;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync elan3_devinfo(0, &info);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync *nodeId= info.NodeId;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#if (TEAC_CAP_TYPE == 2)

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync *railMask= c->cap.cap_railmask;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#else

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync *railMask= c->cap.RailMask;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync#endif

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync *sdramBaseAddr= (int)c->r_event[0][0];

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync *elanBaseAddr= (long)teac_main2elan(c->ctx,(void*)c->m_rcv[0]);

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync return 1;

e0e0c19eefceaf5d4ec40f9466b58a771f50e799vboxsync}