예제 #1
0
CIN MgErr CINRun(LStrHandle pathname, int32 *flags, int32 *fd, int32 *UnixErr, int32 *LVErr) {

  int32 pathnamelen;

  pathnamelen = LStrLen(*pathname) + 1;
  *UnixErr = 0;
  *LVErr = noErr;
  if ( (*LVErr = NumericArrayResize(uB, 1L, (UHandle*)&pathname, pathnamelen))) {
    goto out;
  } else {
    LStrLen(*pathname) = pathnamelen;
    LStrBuf(*pathname)[pathnamelen - 1] = 0;
    if ( ( *fd = open(LStrBuf(*pathname), *flags) ) < 0 ) {
      *UnixErr = (int32) errno;
      *LVErr = (int32) UnixToLVErr();
      goto out;
    } else if ( fcntl(*fd, F_SETFL, *flags) < 0 ) {
      *UnixErr = (int32) errno;
      *LVErr = (int32) UnixToLVErr();
      goto out;
    }
    *flags = fcntl(*fd, F_GETFL);
  };
 out:
  return noErr;
}
CIN MgErr CINRun(LStrHandle Rtai_lxrt_t, int16 *Dynx, int16 *Size, int32 *Srq, LStrHandle Arg, LStrHandle Buffer, int32 *BufPosInArg, int32 *UnixErr, int32 *LVErr) {

  int  DEBUG=0;  
  union rtai_lxrt_t retval;
  int *iArg=NULL;
  char lbuf[LStrLen(*Buffer)+1]; // dynamically allocate on Stack; +1 if it is zero

  *UnixErr = 0;
  *LVErr = noErr;
  DEBUG=LStrLen(*Rtai_lxrt_t)+1;
  if (DEBUG>2) DEBUG=0;
  if (DEBUG) {  
    DbgPrintf(NULL); /* Close window */
    DbgPrintf("Debuglevel:%d, calling lxrt:%d\n", DEBUG, DEBUG-1);
  }
  // DbgPrintf("DEBUG=%d\n", DEBUG);

  /* set size of return string */
  
  if ((*LVErr = NumericArrayResize( uB, 1L, (UHandle *)&Rtai_lxrt_t, sizeof(union rtai_lxrt_t)))) {
    goto out;
  } else {
    LStrLen(*Rtai_lxrt_t) = sizeof(union rtai_lxrt_t);
  }
  
  
  /* set size of argument string according to int[12], see rtai_rtai.h  */
  
  if ((*LVErr = NumericArrayResize( uB, 1L, (UHandle *)&Arg, sizeof(int[12])))) {
    goto out;
  } else {
    LStrLen(*Arg) = sizeof(int[12]);
  }
  
  iArg=(int*)LStrBuf(*Arg);
  
  /* do we have to insert a Buffer into the arguments? */
  if ((*BufPosInArg > 0) && (*BufPosInArg < 12)) {
    if (DEBUG) DbgPrintf("Handling BufferAdr to inserted at PosInArg=%d with BufferLen=%d\n", *BufPosInArg, LStrLen(*Buffer));
    /* copy Buffer to local mem on stack */
    if (DEBUG) DbgPrintf("Doing memcpy(0x%x, 0x%x, %d)", lbuf, LStrBuf(*Buffer), LStrLen(*Buffer));
    memcpy(lbuf, LStrBuf(*Buffer), LStrLen(*Buffer));
    /* and insert &lbuf into *Arg */
    ((int*)LStrBuf(*Arg))[*BufPosInArg] = (int)lbuf;
  }
  
  //*Size = (int16)LStrLen(*Arg);
  if (DEBUG) {  
    /* print arguments */
    DbgPrintf("(int) Arg[0...3]: 0x%x 0x%x 0x%x 0x%x\n", iArg[0],iArg[1],iArg[2],iArg[3]);
    DbgPrintf("(int) Arg[4...7]: 0x%x 0x%x 0x%x 0x%x\n", iArg[4],iArg[5],iArg[6],iArg[7]);
    DbgPrintf("(int) Arg[8..11]: 0x%x 0x%x 0x%x 0x%x\n", iArg[8],iArg[9],iArg[10],iArg[11]);
        
    if ((*BufPosInArg > 0) && (*BufPosInArg < 12)) {
      int i;
      DbgPrintf("Buffer string from Arg[%d]:", *BufPosInArg);
      for (i=0; i<LStrLen(*Buffer); i++) {
	DbgPrintf("0x%02x", (int) (((char*)(iArg[*BufPosInArg]))[i]));
      }
    }
  }
  if ((DEBUG==0) || (DEBUG==2)) {
    /* rtai_lxrt call */
    if (DEBUG==2) {
      DbgPrintf("Calling rtai_lxrt(Dynx=%d, Size=%d, Srq=%d, int Arg[0..11])\n",(int) *Dynx, (int) *Size, (int) *Srq);  
    }
    retval = rtai_lxrt( *Dynx, *Size, *Srq, LStrBuf(*Arg));
  }
  /* copy retval back to first eight bytes of LStrBuf(*Rtai_lxrt_t) */
  if (DEBUG==2) {
    DbgPrintf("Retval[0..1]: %x %x\n", retval.i[LOW], retval.i[HIGH]);
  }
  *((int32 *)LStrBuf(*Rtai_lxrt_t)) = retval.i[LOW];
  *((int32 *)LStrBuf(*Rtai_lxrt_t)+1) = retval.i[HIGH];
  
  /* if Buffer used copy back from Stack */
  if ((*BufPosInArg > 0) && (*BufPosInArg < 12)) {
    int i;
    if (DEBUG) DbgPrintf("Doing memcpy(0x%x, 0x%x, %d)", LStrBuf(*Buffer), lbuf, LStrLen(*Buffer));
    memcpy(LStrBuf(*Buffer), lbuf, LStrLen(*Buffer));
    if (DEBUG) {
      DbgPrintf("Buffer contents now:");
      for (i=0; i<LStrLen(*Buffer); i++) {
	DbgPrintf("0x%02x", (int) (((char*)LStrBuf(*Buffer))[i]));
      }
    }
  }
  
  *UnixErr = (int32) 0; //errno;
  *LVErr = (int32) 0; //UnixToLVErr();
 out:
  return noErr;
}
#include "cphidgetweightsensor.h"

#include "csocket.h"

#ifdef COMPILE_PHIDGETS_LABVIEW

#include "phidget_labview.h"

LV_CFHANDLE_0(, Attach, lvNothing)
LV_CFHANDLE_0(, Detach, lvNothing)
LV_CFHANDLE_0(, ServerConnect, lvNothing)
LV_CFHANDLE_0(, ServerDisconnect, lvNothing)
LV_CFHANDLE_BODY(, Error, lvError, void *userPtr, int val1, const char *val2)
	data->val1 = val1;
    data->val2=(LStrHandle)DSNewHandle(sizeof(int32)+255*sizeof(char));
	memset(LStrBuf(*data->val2),'\0',255);
	snprintf((char*)LStrBuf(*data->val2),255,"%s",val2);
	LStrLen(*data->val2)=strlen(val2);

    ret = PostLVUserEvent(ev, data);

	DSDisposeHandle(data->val2);
    DSDisposePtr(data);
	return EPHIDGET_OK;
}

LV_CFHANDLE_2(Accelerometer, AccelerationChange, lvIndexedDouble, int, double)

LV_CFHANDLE_2(AdvancedServo, PositionChange, lvIndexedDouble, int, double)
LV_CFHANDLE_2(AdvancedServo, VelocityChange, lvIndexedDouble, int, double)
LV_CFHANDLE_2(AdvancedServo, CurrentChange, lvIndexedDouble, int, double)