#include //#include #include #include #include #include #include #define RED 29 #define GREEN 30 #define BLUE 31 //static void timestamp_string(void) //{ // char str[64]; // // epicsTimeStamp t; // epicsTimeGetCurrent(&t); // epicsTimeToStrftime(str, sizeof(str), "%Y%m%d_%H%M%S", &t); // // printf("timestamp: %s\n", str); // //} static int conv_32bit(int raw) { int u = raw; int length = 18; u = (u & (1<<(length-1)))? ((~0x3ffff) | u) : u; return u; } static double conv_phase_err(int raw) { int u = (int) raw; int length = 18; double v; u = (u & (1<<(length-1)))? ((~0x3ffff) | u) : u; v = (double) u / (double)(0x1ffff +1); v /= 180.; return v; } static unsigned char get_led(int raw, int led_bit) { unsigned char led = (raw & 1<a; out_raw = (int *) prec->vala; raw18 = (int *) prec->valb; phase_error = (double *) prec->valc; red = (unsigned char *) prec->vald; green = (unsigned char *) prec->vale; blue = (unsigned char *) prec->valf; raw32 = (int *) prec->valg; for(i = 0; i< prec->noa; i++) { out_raw[i] = raw[i]; raw18[i] = raw[i] & (0x3ffff); phase_error[i] = conv_phase_err(raw18[i]); red[i] = get_led(out_raw[i], RED); green[i] = get_led(out_raw[i], GREEN); blue[i] = get_led(out_raw[i], BLUE); raw32[i] = conv_32bit(raw18[i]); } /* timestamp_string(); */ return 0; } static void split_integer(int *inp, int *lower, int *upper) { *lower = *inp & 0x0000ffff; *upper = (*inp >> 16) & 0x0000ffff; if(*lower & 0x8000) *lower |= 0xffff0000; if(*upper & 0x8000) *upper |= 0xffff0000; } static long aSubInitADCRingBuff(aSubRecord *prec) { return 0; } static long aSubProcADCRingBuff(aSubRecord *prec) { int i, *raw0, *raw1, *adc0, *adc1, *adc2, *adc3; raw0 = (int *) prec->a; raw1 = (int *) prec->b; adc0 = (int *) prec->vala; adc1 = (int *) prec->valb; adc2 = (int *) prec->valc; adc3 = (int *) prec->vald; for(i = 0; i < prec->noa; i++) { split_integer(raw0+i, adc0+i, adc1+i); split_integer(raw1+i, adc2+i, adc3+i); } return 0; } epicsRegisterFunction(aSubInitRingBuff); epicsRegisterFunction(aSubProcRingBuff); epicsRegisterFunction(aSubInitADCRingBuff); epicsRegisterFunction(aSubProcADCRingBuff);