-/*******************************************************************************
- * Copyright (C) 2013 Florian Feldbauer <florian@ep1.ruhr-uni-bochum.de>
- * - Helmholtz-Institut Mainz
- *
- * This file is part of devTrbnet
- *
- * devTrbnet is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 3 of the License, or
- * (at your option) any later version.
- *
- * devTrbnet is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
- *
- ******************************************************************************/
-
-/****** I N C L U D E S *******************************************************/
-
-/* ANSI C includes */
-#include <stdbool.h>
-#include <stdio.h>
-#include <stdlib.h>
-
-/* EPICS includes */
-#include <alarm.h>
-#include <cantProceed.h>
-#include <dbAccess.h>
-#include <dbFldTypes.h>
-#include <dbScan.h>
-#include <devSup.h>
-#include <errlog.h>
-#include <epicsExport.h>
-#include <epicsTypes.h>
-#include <iocLog.h>
-#include <iocsh.h>
-#include <longinRecord.h>
-#include <longoutRecord.h>
-#include <recGbl.h>
-#include <waveformRecord.h>
-
-/* local includes */
-#include "trberror.h"
-#include "trbnet.h"
-
-/****** D E F I N I T I O N S **************************************************/
-static long initLi( longinRecord* prec );
-static long initLo( longoutRecord* prec );
-static long initWaveform( waveformRecord* prec );
-static long processLi( longinRecord* prec );
-static long processLo( longoutRecord* prec );
-static long processWaveform( waveformRecord* prec );
-
-typedef struct {
- long number;
- DEVSUPFUN dev_report;
- DEVSUPFUN init;
- DEVSUPFUN init_record;
- DEVSUPFUN get_ioint_info;
- DEVSUPFUN process;
-} dev_dset_trbnet_t;
-
-typedef struct {
- epicsUInt16 trb_addr;
- epicsUInt16 reg_addr;
-} trbnet_info_t;
-
-/****** G L O B A L S **********************************************************/
-dev_dset_trbnet_t dev_trbnet_li = { 6, NULL, NULL, initLi, NULL, processLi };
-dev_dset_trbnet_t dev_trbnet_lo = { 6, NULL, NULL, initLo, NULL, processLo };
-dev_dset_trbnet_t dev_trbnet_waveform = { 6, NULL, NULL, initWaveform, NULL, processWaveform };
-
-/****** L O C A L S ************************************************************/
-static bool _trb_connected = false;
-
-/****** F U N C T I O N S ******************************************************/
-
-epicsExportAddress( dset, dev_trbnet_li );
-epicsExportAddress( dset, dev_trbnet_lo );
-epicsExportAddress( dset, dev_trbnet_waveform );
-
-/*----- Common initialization for all records ---------------------------------*/
-static long initCommon( dbCommon* prec, DBLINK* plink ) {
-
- trbnet_info_t *pinfo;
- epicsUInt32 trb_addr_buf = 0;
- epicsUInt32 reg_addr_buf = 0;
-
- if ( sscanf( plink->value.instio.string, "%x %x", &trb_addr_buf, ®_addr_buf ) != 2 ) {
- fprintf( stderr, "\033[31;1m%s: Invalid value of INP/OUT field '%s'\033[0m\n",
- prec->name, plink->value.instio.string );
- return -1;
- }
- if ( 0xffff < trb_addr_buf ) {
- fprintf( stderr, "\033[31;1m%s: Invalid trb address '%x'\033[0m\n",
- prec->name, trb_addr_buf );
- return -1;
- }
- if ( 0xffff < reg_addr_buf ) {
- fprintf( stderr, "\033[31;1m%s: Invalid register address '%x'\033[0m\n",
- prec->name, reg_addr_buf );
- return -1;
- }
-
- pinfo = callocMustSucceed( 1, sizeof(*pinfo), "devTrbnet::initCommon" );
- pinfo->trb_addr = (epicsUInt16)( trb_addr_buf & 0xffff );
- pinfo->reg_addr = (epicsUInt16)( reg_addr_buf & 0xffff );
-
- prec->dpvt = pinfo;
- prec->udf = FALSE;
-
- return 0;
-}
-
-/*----- initialization of longin records --------------------------------------*/
-static long initLi( longinRecord* prec ) {
- long status = 0;
- prec->pact = (epicsUInt8)true; /* disable record */
-
- status = initCommon( (dbCommon *)prec, &prec->inp );
- prec->pact = (epicsUInt8)false; /* enable record */
-
- return status;
-}
-
-/*----- initialization of longout records -------------------------------------*/
-static long initLo( longoutRecord* prec ) {
- long status = 0;
- prec->pact = (epicsUInt8)true; /* disable record */
-
- status = initCommon( (dbCommon *)prec, &prec->out );
- prec->pact = (epicsUInt8)false; /* enable record */
-
- return status;
-}
-
-/*----- initialization of waveform records ------------------------------------*/
-static long initWaveform( waveformRecord* prec ) {
- long status = 0;
- prec->pact = (epicsUInt8)true; /* disable record */
-
- if ( DBF_ULONG != prec->ftvl ) {
- fprintf( stderr, "\033[31;1m%s: Invalid field type of value\033[0m\n", prec->name );
- return -1;
- }
-
- status = initCommon( (dbCommon *)prec, &prec->inp );
- prec->pact = (epicsUInt8)false; /* enable record */
-
- return status;
-}
-
-/*----- process routine of longin records -------------------------------------*/
-static long processLi( longinRecord* prec ) {
- trbnet_info_t* pinfo = (trbnet_info_t*)prec->dpvt;
- epicsUInt32 data[2] = { 0 };
- int trb_stat = 0;
-
- if( !_trb_connected ){
- if( init_ports() == -1 ) {
- fprintf( stderr, "\033[31;1m%s: init_ports failed:\n%d %s\033[0m\n",
- prec->name, trb_errno, trb_strerror() );
- recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );
- return -1;
- }
- _trb_connected = true;
- }
-
- trb_stat = trb_register_read( pinfo->trb_addr, pinfo->reg_addr, data, 2 );
- if ( -1 == trb_stat ) {
- /* first try failed, do it again */
- if( init_ports() == -1 ) {
- fprintf( stderr, "\033[31;1m%s: init_ports failed:\n%d %s\033[0m\n",
- prec->name, trb_errno, trb_strerror() );
- recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );
- return -1;
- }
- trb_stat = trb_register_read( pinfo->trb_addr, pinfo->reg_addr, data, 2 );
- if ( -1 == trb_stat ) {
- /* second try failed, return error */
- fprintf( stderr, "\033[31;1m%s: read_register failed: %d %s\033[0m\n",
- prec->name, trb_errno, trb_strerror() );
- recGblSetSevr( prec, READ_ALARM, INVALID_ALARM );
- _trb_connected = false;
- return -1;
- }
- }
- /* Check Status-Bits */
- if ( TRB_STATUS_WARNING == trb_errno ) {
- fprintf( stderr, "%s: Warning: Status-Bit(s) have been set:\n%s\n",
- prec->name, trb_termstr( trb_term ) );
- return -1;
- }
-
- prec->val = data[1];
- return 0;
-}
-
-/*----- process routine of longout records ------------------------------------*/
-static long processLo( longoutRecord* prec ) {
- trbnet_info_t* pinfo = (trbnet_info_t*)prec->dpvt;
- epicsUInt32 value = prec->val;
- int trb_stat = 0;
-
- if( !_trb_connected ) {
- if( init_ports() == -1 ) {
- fprintf( stderr, "\033[31;1m%s: init_ports failed:\n%d %s\033[0m\n",
- prec->name, trb_errno, trb_strerror() );
- recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );
- return -1;
- }
- _trb_connected = true;
- }
-
- trb_stat = trb_register_write( pinfo->trb_addr, pinfo->reg_addr, value );
- if ( -1 == trb_stat ) {
- /* first try failed, do it again */
- if( init_ports() == -1 ) {
- fprintf( stderr, "\033[31;1m%s: init_ports failed:\n%d %s\033[0m\n",
- prec->name, trb_errno, trb_strerror() );
- recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );
- return -1;
- }
- trb_stat = trb_register_write( pinfo->trb_addr, pinfo->reg_addr, value );
- if ( -1 == trb_stat ) {
- /* second try failed, return error */
- fprintf( stderr, "\033[31;1m%s: write_register failed: %d %s\033[0m\n",
- prec->name, trb_errno, trb_strerror() );
- recGblSetSevr( prec, WRITE_ALARM, INVALID_ALARM );
- _trb_connected = false;
- return -1;
- }
- }
- if ( TRB_STATUS_WARNING == trb_errno ) {
- fprintf( stderr, "%s: Warning: Status-Bit(s) have been set:\n%s\n",
- prec->name, trb_termstr( trb_term ) );
- return -1;
- }
-
- return 0;
-}
-
-/*----- process routine of waveform records -----------------------------------*/
-static long processWaveform( waveformRecord* prec ) {
- trbnet_info_t *pinfo = (trbnet_info_t*)prec->dpvt;
- epicsUInt32 *pvalue = (epicsUInt32*)prec->bptr;
- epicsUInt32 *pdata_buf;
- epicsUInt32 count = prec->nelm;
- int trb_stat = 0;
- int i = 0;
-
- if( !_trb_connected ) {
- if( init_ports() == -1 ) {
- fprintf( stderr, "\033[31;1m%s: init_ports failed:\n%d %s\033[0m\n",
- prec->name, trb_errno, trb_strerror() );
- recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );
- return -1;
- }
- _trb_connected = true;
- }
-
- pdata_buf = callocMustSucceed( count, sizeof(epicsUInt32), "devTrbnet::processWaveform" );
-
- trb_stat = trb_register_read( pinfo->trb_addr, pinfo->reg_addr, pdata_buf, count );
- if ( -1 == trb_stat ) {
- /* first try failed, do it again */
- if( init_ports() == -1 ) {
- fprintf( stderr, "\033[31;1m%s: init_ports failed:\n%d %s\033[0m\n",
- prec->name, trb_errno, trb_strerror() );
- recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );
- return -1;
- }
- trb_stat = trb_register_read( pinfo->trb_addr, pinfo->reg_addr, pdata_buf, count );
- if ( -1 == trb_stat ) {
- fprintf( stderr, "\033[31;1m%s: read_register failed: %d %s\033[0m\n",
- prec->name, trb_errno, trb_strerror() );
- free( pdata_buf );
- recGblSetSevr( prec, READ_ALARM, INVALID_ALARM );
- _trb_connected = false;
- return -1;
- }
- }
- if ( TRB_STATUS_WARNING == trb_errno ) {
- fprintf( stderr, "%s: Warning: Status-Bit(s) have been set:\n%s\n",
- prec->name, trb_termstr( trb_term ) );
- return -1;
- }
-
- if ( trb_stat > prec->nelm ) trb_stat = prec->nelm;
- for( ; i < trb_stat; i++ ) pvalue[i] = pdata_buf[i];
-
- prec->nord = trb_stat;
-
- free( pdata_buf );
- return 0;
-}
-
+/****** I N C L U D E S *******************************************************/\r
+\r
+/* ANSI C includes */\r
+#include <stdbool.h>\r
+#include <stdio.h>\r
+#include <stdlib.h>\r
+#include <string.h>\r
+#include <math.h>\r
+\r
+/* EPICS includes */\r
+#include <alarm.h>\r
+#include <cantProceed.h>\r
+#include <dbAccess.h>\r
+#include <dbFldTypes.h>\r
+#include <dbScan.h>\r
+#include <devSup.h>\r
+#include <errlog.h>\r
+#include <epicsExport.h>\r
+#include <epicsTypes.h>\r
+#include <iocLog.h>\r
+#include <iocsh.h>\r
+#include <longinRecord.h>\r
+#include <longoutRecord.h>\r
+#include <recGbl.h>\r
+#include <waveformRecord.h>\r
+\r
+/* local includes */\r
+#include "trberror.h"\r
+#include "trbnet.h"\r
+\r
+\r
+#define LINELENGTH 250\r
+\r
+#define NumberOfBoards 1\r
+\r
+#define __Name 0\r
+#define __Scale 1\r
+#define __Unit 2\r
+#define __Format 3\r
+#define __Start 4\r
+#define __Bits 5\r
+#define __Rate 6\r
+#define __ErrorFlag 7\r
+#define __InvertFlag 8\r
+#define __Value 9\r
+\r
+/****** D E F I N I T I O N S **************************************************/\r
+static long initLi( longinRecord* prec );\r
+static long initLo( longoutRecord* prec );\r
+static long initWaveform( waveformRecord* prec );\r
+static long processLi( longinRecord* prec );\r
+static long processLo( longoutRecord* prec );\r
+static long processWaveform( waveformRecord* prec );\r
+\r
+typedef struct {\r
+ long number;\r
+ DEVSUPFUN dev_report;\r
+ DEVSUPFUN init;\r
+ DEVSUPFUN init_record;\r
+ DEVSUPFUN get_ioint_info;\r
+ DEVSUPFUN process;\r
+} dev_dset_trbnet_t;\r
+\r
+typedef struct {\r
+ epicsUInt16 trb_addr;\r
+ char* reg_name_buf;\r
+ char* reg_name_buf_nbr;\r
+ epicsUInt16 reg_addr;\r
+ //char entity_name[20];\r
+} trbnet_info_t;\r
+\r
+typedef struct{\r
+ epicsUInt16 regAddr;\r
+ char *name;\r
+ float scale;\r
+ char *unit;\r
+ char *format;\r
+ int start;\r
+ int bits;\r
+ int rate;\r
+ char *errorflag;\r
+ char *invertflag;\r
+ int value;\r
+}field_struct;\r
+\r
+typedef struct{\r
+ epicsUInt16 regAddr;\r
+ char *name;\r
+ char *purpose;\r
+ field_struct *field;\r
+ int size;\r
+ int used;\r
+ int value;\r
+}reg_struct;\r
+\r
+typedef struct{\r
+ epicsUInt16 address;\r
+ char *name;\r
+ reg_struct *Reg;\r
+ size_t size;\r
+ size_t used;\r
+}trb_struct;\r
+\r
+/****** G L O B A L S **********************************************************/\r
+dev_dset_trbnet_t dev_trbnet_li = { 6, NULL, NULL, initLi, NULL, processLi };\r
+dev_dset_trbnet_t dev_trbnet_lo = { 6, NULL, NULL, initLo, NULL, processLo };\r
+dev_dset_trbnet_t dev_trbnet_waveform = { 6, NULL, NULL, initWaveform, NULL, processWaveform };\r
+trb_struct *trb;\r
+int databaseSet = 0;\r
+\r
+/****** L O C A L S ************************************************************/\r
+static bool _trb_connected = false;\r
+\r
+/****** F U N C T I O N S ******************************************************/\r
+\r
+epicsExportAddress( dset, dev_trbnet_li );\r
+epicsExportAddress( dset, dev_trbnet_lo );\r
+epicsExportAddress( dset, dev_trbnet_waveform );\r
+\r
+/*----- TEST FUNKTION ---------------------------------------------------------*/\r
+int trb_register_readTESTFUNKTION( uint16_t trb_addr,\r
+ uint16_t addr,\r
+ uint32_t *data,\r
+ unsigned int dsize)\r
+{\r
+ int status = 0;\r
+ if (trb_addr== 0) {\r
+ if (addr== 0) {\r
+ data[0] = 0;\r
+ //data[1]=21400000; \r
+ data[1] = 557842432;\r
+ }\r
+ return 2;\r
+ }\r
+ else if(trb_addr == 1) {\r
+ data[0] = 0;\r
+ data[1] = 557842432;\r
+ data[2] = 1;\r
+ data[3] = 557845532;\r
+ data[4] = 2;\r
+ data[5] = 557823451;\r
+ data[6] = 3;\r
+ data[7] = 557733332;\r
+ data[8] = 4;\r
+ data[9] = 667823451;\r
+ data[10] = 5;\r
+ data[11] = 598733332;\r
+ return 12;\r
+ } else {\r
+ return -1;\r
+ }\r
+}\r
+\r
+int PadiwaSendCmd(uint32_t cmd, uint32_t board, uint32_t chain) {\r
+ \r
+ uint32_t c[] = { cmd,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,1<<chain,0x10001};\r
+ int i=0;\r
+ //for (i=0;i<99;i++){\r
+ trb_register_write_mem(board,0xd400,0,c,18);\r
+// fprintf(stderr,"ERR: %s \n",trb_strerror());\r
+ usleep(100);\r
+ //}\r
+ uint32_t c_ret[] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};\r
+ int ret=0;\r
+ ret = trb_register_read(board,0xd412,c_ret,18);\r
+ \r
+// fprintf(stderr,"1.: %08x 2:. %08x \n",c_ret[0], c_ret[1]);\r
+ \r
+ return c_ret[1];\r
+}\r
+\r
+\r
+/*----- Necessary Functions for Database --------------------------------------*/\r
+\r
+void initField(trb_struct *trb, size_t RegNumb) {\r
+ trb->Reg[RegNumb].field = (field_struct *)malloc(sizeof(field_struct)); // 1 field\r
+ trb->Reg[RegNumb].used = 0;\r
+ trb->Reg[RegNumb].size = 1;\r
+ //Init with start values\r
+ trb->Reg[RegNumb].field[trb->Reg[RegNumb].used].regAddr = trb->Reg[RegNumb].regAddr;\r
+ trb->Reg[RegNumb].field[trb->Reg[RegNumb].used].name = NULL;\r
+ trb->Reg[RegNumb].field[trb->Reg[RegNumb].used].scale = 1;\r
+ trb->Reg[RegNumb].field[trb->Reg[RegNumb].used].unit = NULL;\r
+ trb->Reg[RegNumb].field[trb->Reg[RegNumb].used].format = NULL;\r
+ trb->Reg[RegNumb].field[trb->Reg[RegNumb].used].start = 0;\r
+ trb->Reg[RegNumb].field[trb->Reg[RegNumb].used].bits = 32;\r
+ trb->Reg[RegNumb].field[trb->Reg[RegNumb].used].rate = -1;\r
+ trb->Reg[RegNumb].field[trb->Reg[RegNumb].used].errorflag = NULL;\r
+ trb->Reg[RegNumb].field[trb->Reg[RegNumb].used].invertflag = NULL;\r
+ trb->Reg[RegNumb].field[trb->Reg[RegNumb].used].value = -1;\r
+}\r
+\r
+void initReg(trb_struct *trb, size_t initialSize) {\r
+ trb->Reg = (reg_struct *)malloc(initialSize * sizeof(reg_struct));\r
+ trb->used = 0;\r
+ trb->size = initialSize;\r
+ int i=0;\r
+ for ( i; i < initialSize; i++) {\r
+ initField(trb, i); // trb_struct; i01= Element of Register\r
+ }\r
+}\r
+\r
+// Insert a new field. Only RegAddress is Set from default\r
+void insertField(reg_struct *reg) {\r
+ if (reg->used == reg->size) {\r
+ reg->size++;\r
+ reg->field = (field_struct *)realloc(reg->field, reg->size * sizeof(field_struct));\r
+ }\r
+ //Init with start values\r
+ reg->field[reg->used].regAddr = reg->regAddr; //set register Address\r
+ reg->field[reg->used].name = NULL;\r
+ reg->field[reg->used].scale = 1;\r
+ reg->field[reg->used].unit = NULL;\r
+ reg->field[reg->used].format = NULL;\r
+ reg->field[reg->used].start = 0;\r
+ reg->field[reg->used].bits = 32;\r
+ reg->field[reg->used].rate = -1;\r
+ reg->field[reg->used].errorflag = NULL;\r
+ reg->field[reg->used].invertflag = NULL;\r
+ reg->field[reg->used].value = -1;\r
+ reg->used++;\r
+}\r
+\r
+int setFieldPropertyInt(reg_struct *reg,int fieldNmb, int element, int data) {\r
+ if (fieldNmb < reg->used) {\r
+ if (element == __Start){ //field start\r
+ reg->field[fieldNmb].start = data;\r
+ } else if (element == __Bits){ //field bits\r
+ reg->field[fieldNmb].bits = data;\r
+ } else if (element == __Rate){ //field rate\r
+ reg->field[fieldNmb].rate = data;\r
+ } else if (element == __Value){ //field ratevalue\r
+ reg->field[fieldNmb].value = data;\r
+ } else {\r
+ printf("Element does not Fit to a INT Type property.\n");\r
+ }\r
+ return 0;\r
+ } else {\r
+ return 1; //Error\r
+ }\r
+}\r
+\r
+int setFieldPropertyStr(reg_struct *reg,int fieldNmb, int element, char *data) {\r
+ if (fieldNmb < reg->used) {\r
+ if(element == __Name){ //field NAME\r
+ reg->field[fieldNmb].name =strdup(data);\r
+ } else if (element == __Unit){ //field UNIT\r
+ reg->field[fieldNmb].unit = strdup(data);\r
+ } else if (element == __Format){ //field format\r
+ reg->field[fieldNmb].format = strdup(data);\r
+ } else if (element == __ErrorFlag){ //field errorflag\r
+ reg->field[fieldNmb].errorflag = strdup(data);\r
+ } else if (element == __InvertFlag){//field invertflag\r
+ reg->field[fieldNmb].invertflag = strdup(data);\r
+ } else {\r
+ printf("Element does not Fit to a STRING Type property.\n");\r
+ }\r
+ return 0;\r
+ } else {\r
+ return 1; //Error; Field does not exist\r
+ }\r
+}\r
+\r
+int setFieldPropertyFloat(reg_struct *reg, int fieldNmb, int element, float data) {\r
+ if (fieldNmb < reg->used) {\r
+ if (element == __Scale){ //field SCALE\r
+ reg->field[fieldNmb].scale = data;\r
+ } else {\r
+ printf("Element does not Fit to a FLOAT Type property.\n");\r
+ }\r
+ return 0;\r
+ } else {\r
+ return 1; //Error; Field does not exist\r
+ }\r
+}\r
+\r
+void insertReg(trb_struct *trb, int element) {\r
+ if (trb->used == trb->size) {\r
+ trb->size++;\r
+ trb->Reg = (reg_struct *)realloc(trb->Reg, trb->size * sizeof(reg_struct));\r
+ }\r
+ trb->Reg[trb->used].regAddr = element;\r
+ initField(trb, trb->used);\r
+ trb->used++;\r
+}\r
+\r
+// free the allocated memory of the fields of each Register\r
+void freeField(trb_struct *trb) {\r
+ int i=0;\r
+ for (i;i<trb->used;i++){\r
+ free(trb->Reg[i].field);\r
+ trb->Reg[i].field = NULL;\r
+ trb->Reg[i].used = trb->Reg[i].size = 0;\r
+ }\r
+}\r
+\r
+// free the allocated memory of each register\r
+void freeReg(trb_struct *trb) {\r
+ freeField(trb);\r
+ free(trb->Reg);\r
+ trb->Reg = NULL;\r
+ trb->used = trb->size = 0;\r
+}\r
+\r
+/*----- Common initialization for all records ---------------------------------*/\r
+\r
+static long initCommon( dbCommon* prec, DBLINK* plink ) {\r
+\r
+ trbnet_info_t *pinfo;\r
+ char entity_name_buf[20] = "";\r
+ char Reg_name_buf[20] = "";\r
+ epicsUInt32 trb_addr_buf = 0;\r
+ epicsUInt32 reg_addr_buf = 0;\r
+ \r
+ char linebuffer[LINELENGTH];\r
+\r
+ if ( sscanf( plink->value.instio.string, "%s %x %s", entity_name_buf, &trb_addr_buf, Reg_name_buf ) != 3 ) {\r
+ fprintf( stderr, "\033[31;1m%s: Invalid value of INP/OUT field '%s'\033[0m\n",\r
+ prec->name, plink->value.instio.string );\r
+ return -1;\r
+ }\r
+ if ( 0xffff < trb_addr_buf ) {\r
+ fprintf( stderr, "\033[31;1m%s: Invalid trb address '%x'\033[0m\n",\r
+ prec->name, trb_addr_buf );\r
+ return -1;\r
+ }\r
+\r
+ pinfo = callocMustSucceed( 1, sizeof(*pinfo), "devTrbnet::initCommon" );\r
+ pinfo->trb_addr = (epicsUInt16)( trb_addr_buf & 0xffff );\r
+// pinfo->reg_name_buf = strdup(Reg_name_buf);\r
+ prec->dpvt = pinfo;\r
+ prec->udf = FALSE;\r
+ int i=0;\r
+\r
+ // check special cases that are not inb XMLS Database\r
+ char * pname;\r
+// char reg_name_buf[30];\r
+// strcpy(reg_name_buf, pinfo->reg_name_buf);\r
+ pname = strtok(Reg_name_buf,"_");\r
+ pinfo->reg_name_buf = strdup(pname);\r
+\r
+ while (pname != NULL){\r
+// printf("Ausgabe: %s\n",pname);\r
+ pinfo->reg_name_buf_nbr = strdup(pname);\r
+ pname = strtok(NULL," ");\r
+ \r
+ }\r
+//printf("test: %s\n",pinfo->reg_name_buf);\r
+//printf("test2: %s\n",pinfo->reg_name_buf_nbr);\r
+//----------------------------------------------------------------//\r
+ \r
+ \r
+\r
+// create Memory for each TrbBoard\r
+ if (databaseSet==0)\r
+ { \r
+ trb = (trb_struct *) malloc(NumberOfBoards * sizeof(trb_struct));\r
+\r
+ for(i=0;i<NumberOfBoards;i++){\r
+ initReg(&trb[i], 1); // initially 2 Registers in first Trb; also inits first field\r
+ }\r
+ \r
+ //read the entity-file from cache\r
+ int gaddress=-1;\r
+ int raddress=-1,bits=0,start=0,rate=0,unit=0;\r
+ float scale=0.;\r
+ bool register_open=false,field_open=false,group_open=false;\r
+ char node[20]="",gname[25]="",gmode[2]="",rname[25]="",purpose[25]="",fname[20]="",fformat[10]="";\r
+ int trb_status; \r
+ char* filepath = getenv("EPICS_TRBNET_XML_PATH");\r
+ //char* name = {"TrbNet"};\r
+ char* name = getenv("EPICS_TRBNET_XML_NAME");\r
+ char filename[strlen(filepath)+strlen(name)+5];\r
+// char * test = getenv("XML_PATH");\r
+// fprintf(stderr,"ENVVAR: %s\n",test);\r
+ snprintf( filename , sizeof( filename ), "%s%s.xml", filepath, name );\r
+ fprintf(stderr,"DIR: %s\n",filename);\r
+\r
+ \r
+ FILE *fp;\r
+ fp = fopen( filename , "r");\r
+ //get each line of document\r
+ while(fgets(linebuffer, LINELENGTH, fp)){\r
+ char delimiter[] = " ";\r
+ char *ptr;\r
+ ptr = strtok(linebuffer, delimiter);\r
+ sscanf(ptr, "%s", node); \r
+ ptr = strtok(NULL, delimiter);\r
+\r
+ if (strcmp(node,"<group") == 0){\r
+ group_open = true;\r
+ }\r
+ if (strcmp(node,"</group>") == 0){\r
+ group_open = false;\r
+ }\r
+ if (strcmp(node,"<register") == 0){\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ insertReg(&trb[i], 0);\r
+ }\r
+ register_open = true;\r
+ }\r
+ if (strcmp(node,"</register>") == 0){\r
+ register_open = false;\r
+ }\r
+ if (strcmp(node,"<field") == 0){\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ insertField(&trb[i].Reg[trb[i].used-1]);\r
+ }\r
+ field_open = true;\r
+ }\r
+ if (strcmp(node,"</field>") == 0){\r
+ field_open = false;\r
+ }\r
+\r
+ // analyse each part of one line of .xml document\r
+ while(ptr != NULL) {\r
+ \r
+ if (group_open==true && register_open==false && field_open==false) {\r
+ sscanf(ptr, "address=\"%x\"", &gaddress);\r
+ sscanf(ptr, "name=\"%[A-z,_0-9]\"", gname);\r
+ sscanf(ptr, "mode=\"%[A-z,_,0-9]\"", gmode);\r
+ } \r
+ if (register_open==true && group_open==true && field_open==false){\r
+ if(sscanf(ptr, "address=\"%x\"", ®_addr_buf)==1){\r
+ pinfo->reg_addr = (epicsUInt16)( (reg_addr_buf + gaddress) & 0xffff );\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ trb[i].Reg[trb[i].used-1].regAddr = pinfo->reg_addr;\r
+ }\r
+ }\r
+ if(sscanf(ptr, "name=\"%[A-z,_0-9]\"", rname)==1){\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ trb[i].Reg[trb[i].used-1].name = strdup(rname);\r
+ printf("RNAME: %s\n", rname);\r
+ }\r
+ }\r
+\r
+ if(sscanf(ptr, "purpose=\"%[A-z,_0-9]\"", purpose)==1){\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ trb[i].Reg[trb[i].used-1].purpose = strdup(purpose);\r
+ }\r
+ }\r
+ }\r
+\r
+ if (field_open==true && group_open==true && register_open==true){\r
+ if (strcmp(ptr,"/>\n") == 0){\r
+ field_open=false;\r
+ }\r
+ if (sscanf(ptr, "name=\"%[A-z,_0-9]\"", fname)==1){\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ trb[i].Reg[trb[i].used-1].field[trb[i].Reg[trb[i].used-1].used-1].name = strdup(fname);\r
+ printf(" FNAME: %s %i\n", rname,NumberOfBoards);\r
+\r
+ }\r
+ }\r
+ if (sscanf(ptr, "format=\"%[A-z,_0-9]\"", fformat)==1){\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ trb[i].Reg[trb[i].used-1].field[trb[i].Reg[trb[i].used-1].used-1].format = strdup(fformat);\r
+ }\r
+ }\r
+ if (sscanf(ptr, "bits=%*c%i%*c", &bits)==1){\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ trb[i].Reg[trb[i].used-1].field[trb[i].Reg[trb[i].used-1].used-1].bits = bits;\r
+ }\r
+ }\r
+ if (sscanf(ptr, "start=%*c%i%*c", &start)==1){\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ trb[i].Reg[trb[i].used-1].field[trb[i].Reg[trb[i].used-1].used-1].start = start;\r
+ }\r
+ }\r
+ if (sscanf(ptr, "rate=%*c%i%*c", &rate )==1){\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ trb[i].Reg[trb[i].used-1].field[trb[i].Reg[trb[i].used-1].used-1].rate = rate;\r
+ }\r
+ }\r
+ if (sscanf(ptr, "unit=%*c%x%*c", &unit )==1){\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ trb[i].Reg[trb[i].used-1].field[trb[i].Reg[trb[i].used-1].used-1].unit = unit;\r
+ }\r
+ }\r
+ if (sscanf(ptr, "scale=%*c%f%*c", &scale )==1){\r
+ for (i=0; i < NumberOfBoards; i++){\r
+ trb[i].Reg[trb[i].used-1].field[trb[i].Reg[trb[i].used-1].used-1].scale = scale;\r
+ }\r
+ }\r
+ }\r
+\r
+\r
+ ptr = strtok(NULL, delimiter);\r
+ }//end while2\r
+ }//end while1\r
+\r
+\r
+ fclose(fp);\r
+ databaseSet = 1;\r
+ } \r
+ if ( 0xffff < reg_addr_buf ) {\r
+ fprintf( stderr, "\033[31;1m%s: Invalid register address '%x'\033[0m\n",prec->name, reg_addr_buf );\r
+ return -1;\r
+ }\r
+printf("%i\n",__LINE__);\r
+//----------------------------------------------------------------------//\r
+\r
+ // Test the fields\r
+ printf("Register Addres: %i\n", trb[0].Reg[2].regAddr); // getAddr of Register[0]\r
+ printf("Number of registers: %i\n", trb[0].size); // print number of fields in Register\r
+ printf("Number of fields:%i\n", trb[0].Reg[1].size); // print name of field 1 in Register 0\r
+ printf("Number of fields:%s\n", trb[0].Reg[2].field[0].name); // print name of field 1 in Register 0\r
+ printf("%i\n", trb[0].used); // getAddr of Register[0]\r
+\r
+//---------------------------------------------------------------------------------------------//\r
+ /*free memory\r
+ for(i=0;i<NumberOfBoards;i++){\r
+ freeReg(&trb[i]);\r
+ }\r
+\r
+ free(trb);\r
+ */\r
+//-------------------------------------------------------------------------------------------//\r
+printf("%i\n",__LINE__);\r
+ return 0;\r
+}\r
+\r
+/*----- initialization of longin records --------------------------------------*/\r
+static long initLi( longinRecord* prec ) {\r
+ long status = 0;\r
+ prec->pact = (epicsUInt8)true; /* disable record */\r
+\r
+ status = initCommon( (dbCommon *)prec, &prec->inp );\r
+ prec->pact = (epicsUInt8)false; /* enable record */\r
+\r
+ return status;\r
+}\r
+\r
+/*----- initialization of longout records -------------------------------------*/\r
+static long initLo( longoutRecord* prec ) {\r
+ long status = 0;\r
+ prec->pact = (epicsUInt8)true; /* disable record */\r
+\r
+ status = initCommon( (dbCommon *)prec, &prec->out );\r
+ prec->pact = (epicsUInt8)false; /* enable record */\r
+\r
+ return status;\r
+}\r
+\r
+/*----- initialization of waveform records ------------------------------------*/\r
+static long initWaveform( waveformRecord* prec ) {\r
+ long status = 0;\r
+ prec->pact = (epicsUInt8)true; /* disable record */\r
+\r
+ if ( DBF_DOUBLE != prec->ftvl ) {\r
+ fprintf( stderr, "\033[31;1m%s: Invalid field type of value\033[0m\n", prec->name );\r
+ return -1;\r
+ }\r
+\r
+ status = initCommon( (dbCommon *)prec, &prec->inp );\r
+\r
+ prec->pact = (epicsUInt8)false; /* enable record */\r
+\r
+ return status;\r
+}\r
+\r
+/*----- process routine of longin records -------------------------------------*/\r
+static long processLi( longinRecord* prec ) {\r
+ trbnet_info_t* pinfo = (trbnet_info_t*)prec->dpvt;\r
+ epicsUInt32 data[2] = { 0 };\r
+ int trb_stat = 0;\r
+\r
+ int j,k,i,address;\r
+ int search_stat = 0 ;\r
+ int trb_Nmb=0, reg_Nmb=0, field_Nmb=0;\r
+\r
+ if( !_trb_connected ){\r
+ if( init_ports() == -1 ) {\r
+ fprintf( stderr, "\033[31;1m%s: init_ports failed:\n%d %s\033[0m\n",\r
+ prec->name, trb_errno, trb_strerror() ); // could be a problem (prec->name)\r
+ recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );\r
+ return -1;\r
+ }\r
+ _trb_connected = true;\r
+ }\r
+\r
+\r
+\r
+ // READ Address from Database\r
+ for(i=0;i<NumberOfBoards;i++){\r
+\r
+ for(j=0;j<trb[i].used;j++){\r
+ if (strcmp(trb[i].Reg[j].name,pinfo->reg_name_buf) == 0){\r
+ search_stat = 0;\r
+ }\r
+ else {\r
+ for(k=0;k<trb[i].Reg[j].used;k++){\r
+\r
+ if (strcmp(trb[i].Reg[j].field[k].name, pinfo->reg_name_buf) == 0){\r
+ address = trb[i].Reg[j].field[k].regAddr;\r
+ search_stat = 0;\r
+ trb_Nmb=i; reg_Nmb=j; field_Nmb=k;\r
+ } else {\r
+ search_stat = -1;\r
+ }\r
+ }\r
+ }\r
+ }\r
+ }\r
+\r
+ if (search_stat){\r
+ int data_size = 2;\r
+ trb_stat = trb_register_read( pinfo->trb_addr, address, data, data_size );\r
+ //trb_stat = trb_register_readTESTFUNKTION( pinfo->trb_addr, address, data, data_size );\r
+ \r
+ //--------------------------------------//\r
+ if ( -1 == trb_stat ) {\r
+ /* first try failed, do it again */\r
+ if( init_ports() == -1 ) {\r
+ fprintf( stderr, "\033[31;1m%s: init_ports failed:\n%d %s\033[0m\n",\r
+ prec->name, trb_errno, trb_strerror() );\r
+ recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );\r
+ return -1;\r
+ }\r
+ trb_stat = trb_register_read( pinfo->trb_addr, address, data, data_size );\r
+ if ( -1 == trb_stat ) {\r
+ /* second try failed, return error */\r
+ fprintf( stderr, "\033[31;1m%s: read_register failed: %d %s\033[0m\n",\r
+ prec->name, trb_errno, trb_strerror() );\r
+ recGblSetSevr( prec, READ_ALARM, INVALID_ALARM );\r
+ _trb_connected = false;\r
+ return -1;\r
+ }\r
+ }\r
+ /* Check Status-Bits */\r
+ if ( TRB_STATUS_WARNING == trb_errno ) {\r
+ fprintf( stderr, "%s: Warning: Status-Bit(s) have been set:\n%s\n",\r
+ prec->name, trb_termstr( trb_term ) );\r
+ recGblSetSevr( prec, NULL, NULL);\r
+ return -1;\r
+ }\r
+ //------------------------------// \r
+ double output = -1;\r
+ epicsUInt32 start = pow(2, trb[trb_Nmb].Reg[reg_Nmb].field[field_Nmb].start);\r
+ epicsUInt32 end = pow(2, trb[trb_Nmb].Reg[reg_Nmb].field[field_Nmb].bits);\r
+ double scale = trb[trb_Nmb].Reg[reg_Nmb].field[field_Nmb].scale;\r
+\r
+ for (i=0; i< data_size;i+=2){\r
+ output = ((data[i+1]/start)%end )*scale;\r
+ prec->val = output;\r
+ }\r
+ //--------------------------------//\r
+\r
+ } else {\r
+ printf("No Address Name %s found!\n", pinfo->reg_name_buf);\r
+ } \r
+\r
+ return 0;\r
+}\r
+\r
+//----- LONGOUT IS NOT IN USE!!!-----------------------------------------------//\r
+/*----- process routine of longout records ------------------------------------*/\r
+static long processLo( longoutRecord* prec ) {\r
+ trbnet_info_t* pinfo = (trbnet_info_t*)prec->dpvt;\r
+ epicsUInt32 value = prec->val;\r
+ int trb_stat = 0;\r
+\r
+ if( !_trb_connected ) {\r
+ if( init_ports() == -1 ) {\r
+ fprintf( stderr, "\033[31;1m%s: init_ports failed:\n%d %s\033[0m\n",\r
+ prec->name, trb_errno, trb_strerror() );\r
+ recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );\r
+ return -1;\r
+ }\r
+ _trb_connected = true;\r
+ }\r
+\r
+ trb_stat = trb_register_write( pinfo->trb_addr, pinfo->reg_addr, value );\r
+ if ( -1 == trb_stat ) {\r
+ /* first try failed, do it again */\r
+ if( init_ports() == -1 ) {\r
+ fprintf( stderr, "\033[31;1m%s: init_ports failed:\n%d %s\033[0m\n",\r
+ prec->name, trb_errno, trb_strerror() );\r
+ recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );\r
+ return -1;\r
+ }\r
+ trb_stat = trb_register_write( pinfo->trb_addr, pinfo->reg_addr, value );\r
+ if ( -1 == trb_stat ) {\r
+ /* second try failed, return error */\r
+ fprintf( stderr, "\033[31;1m%s: write_register failed: %d %s\033[0m\n",\r
+ prec->name, trb_errno, trb_strerror() );\r
+ recGblSetSevr( prec, WRITE_ALARM, INVALID_ALARM );\r
+ _trb_connected = false;\r
+ return -1;\r
+ }\r
+ }\r
+ if ( TRB_STATUS_WARNING == trb_errno ) {\r
+ fprintf( stderr, "%s: Warning: Status-Bit(s) have been set:\n%s\n",\r
+ prec->name, trb_termstr( trb_term ) );\r
+ return -1;\r
+ }\r
+\r
+ return 0;\r
+}\r
+\r
+/*----- process routine of waveform records -----------------------------------*/\r
+static long processWaveform( waveformRecord* prec ) {\r
+ printf("%i\n",__LINE__);\r
+ trbnet_info_t *pinfo = (trbnet_info_t*)prec->dpvt;\r
+ epicsUInt32 *pdata_buf;\r
+ epicsUInt32 count = 200;//prec->nelm; // equal to 100 boards\r
+ int trb_stat = 0;\r
+ int i = 0;\r
+printf("%i\n",__LINE__);\r
+ \r
+ if( !_trb_connected ) {\r
+ if( init_ports() == -1 ) {\r
+ fprintf( stderr, "\033[31;1m%s: init_ports failed TEST:\n%d %s\033[0m\n",\r
+ prec->name, trb_errno, trb_strerror() ); // same as above\r
+ recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );\r
+ return -1;\r
+ }\r
+ _trb_connected = true;\r
+ }\r
+ printf("%i\n",__LINE__);\r
+ pdata_buf = callocMustSucceed( count, sizeof(epicsUInt32), "devTrbnet::processWaveform" );\r
+ printf("%i\n",__LINE__);\r
+ int j,k,address;\r
+ int search_stat = -1 ;\r
+ int trb_Nmb=0, reg_Nmb=0, field_Nmb=0;\r
+\r
+ if (strcmp(pinfo->reg_name_buf, "ADC") == 0){\r
+ search_stat = 1;\r
+} else {\r
+printf("%i\n",__LINE__);\r
+ for(i=0;i<NumberOfBoards;i++){\r
+ \r
+ for(j=0;j<trb[i].used;j++){ \r
+ printf("%i %i %i\n",i,j,__LINE__);\r
+ if (search_stat >= 0){ printf("%i\n",__LINE__);\r
+ //run without doing smtng\r
+ } else {\r
+ printf("%i %i %i\n",i,j,__LINE__);\r
+ printf("trb %s \n",trb[i].Reg[j].name);\r
+ printf("pinfo %s \n",pinfo->reg_name_buf);\r
+ printf("comp %i \n",strcmp(trb[i].Reg[j].name,pinfo->reg_name_buf));\r
+ if (strcmp(trb[i].Reg[j].name,pinfo->reg_name_buf) == 0){\r
+ search_stat = 0; printf("%i %i %i\n",i,j,__LINE__);\r
+ }\r
+ else {\r
+ printf("%i\n",__LINE__);\r
+ for(k=0;k<trb[i].Reg[j].used;k++){\r
+ //printf("Test: %i\n",strcmp(trb[i].Reg[j].field[k].name, pinfo->reg_name_buf));\r
+\r
+ if (strcmp(trb[i].Reg[j].field[k].name, pinfo->reg_name_buf) == 0){\r
+ address = trb[i].Reg[j].field[k].regAddr;\r
+ search_stat = 0;\r
+ trb_Nmb=i; reg_Nmb=j; field_Nmb=k;\r
+ } else {\r
+ search_stat = -1;\r
+ }\r
+ }\r
+ }\r
+ }//search_stat end if\r
+ } \r
+ }\r
+\r
+}\r
+printf("%i\n",__LINE__);\r
+ int data_size = 2;\r
+ unsigned int mode = 0;\r
+\r
+ if (search_stat == 1){\r
+ int channel[5] = {7,7,7,6,5};\r
+ int resolution[5][4] = {{2,1,2,1},{2,2,2,1},{2,2,2,4},{2,2,2,2},{3,3,2,2}};\r
+ double multiplier[5][4] = {{1.,1.,0.5,2.},{1.,1.,0.5,0.},{1.,1.,0.5,3.125},{1.,1.,0.5,0.5},{2.5,1.25,1.,0.5}};\r
+ int cmd = 0;\r
+\r
+ if (atoi(pinfo->reg_name_buf_nbr)>=0 && atoi(pinfo->reg_name_buf_nbr)<5) {\r
+ mode = atoi(pinfo->reg_name_buf_nbr);\r
+ } else {\r
+ mode = 0;\r
+ }\r
+\r
+ //prec->nelm = 10;\r
+ //prec->bptr = realloc(prec->bptr, prec->nelm * dbValueSize(prec->ftvl));\r
+\r
+ double *pvalue = (epicsUInt32*)prec->bptr;\r
+\r
+\r
+ cmd = 0xc1830000 + ( resolution[mode][0] << 25);\r
+ int test = trb_register_write(pinfo->trb_addr,0xd41a,25);\r
+//fprintf(stderr,"Test: %d %x\n", test,pinfo->trb_addr);\r
+ if (test==0){ // 0x8300\r
+ PadiwaSendCmd(cmd,pinfo->trb_addr,channel[mode]);\r
+ usleep(5000);\r
+ cmd = 0xd1830000 + ( resolution[mode][1] << 25);\r
+ pvalue[0]= ((( PadiwaSendCmd(cmd,pinfo->trb_addr,channel[mode])>>19)&0xfff)*multiplier[mode][0]);\r
+ // fprintf(stderr," 1: %f \n",(double) ((( PadiwaSendCmd(cmd,pinfo->trb_addr,channel[mode])>>19)&0xfff)*multiplier[mode][0]));\r
+ usleep(5000);\r
+ cmd = 0xe1830000 + ( resolution[mode][2] << 25);\r
+ pvalue[1]= ((( PadiwaSendCmd(cmd,pinfo->trb_addr,channel[mode])>>19)&0xfff)*multiplier[mode][1]);\r
+ // fprintf(stderr," 2: %f \n",(double) ((( PadiwaSendCmd(cmd,pinfo->trb_addr,channel[mode])>>19)&0xfff)*multiplier[mode][1]) );\r
+ usleep(1000);\r
+ cmd = 0xf1830000 + ( resolution[mode][3] << 25);\r
+ pvalue[2]= ((( PadiwaSendCmd(cmd,pinfo->trb_addr,channel[mode])>>19)&0xfff)*multiplier[mode][2]);\r
+ // fprintf(stderr," 3: %f \n",(double) ((( PadiwaSendCmd(cmd,pinfo->trb_addr,channel[mode])>>19)&0xfff)*multiplier[mode][2]) );\r
+ usleep(5000);\r
+ pvalue[3]= ((( PadiwaSendCmd(0xf3930000,pinfo->trb_addr,channel[mode])>>19)&0xfff)*multiplier[mode][3]);\r
+ // fprintf(stderr," 4: %f \n",(double) (((PadiwaSendCmd(0xf3930000,pinfo->trb_addr,channel[mode])>>19)&0xfff)*multiplier[mode][3]) );\r
+ usleep(5000);\r
+ pvalue[4]= ((( PadiwaSendCmd(0,pinfo->trb_addr,channel[mode])>>19)&0xfff)/16.);\r
+ // fprintf(stderr," 5: %3.2f \n", (double) (((PadiwaSendCmd(0,pinfo->trb_addr,channel[mode])>>19)&0xfff)/16.));\r
+\r
+ trb_register_write(pinfo->trb_addr,0xd41a,7);\r
+ } else {fprintf(stderr,"ERR in TEST");recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );}\r
+\r
+ } else if (search_stat == 0) {\r
+ trb_stat = trb_register_read( pinfo->trb_addr, address, pdata_buf, count ); //\r
+ if ( -1 == trb_stat ) {\r
+ /* first try failed, do it again */\r
+ if( init_ports() == -1 ) {\r
+ fprintf( stderr, "\033[31;1m%s: init_ports failed:\n%d %s\033[0m\n",\r
+ prec->name, trb_errno, trb_strerror() );\r
+ recGblSetSevr( prec, COMM_ALARM, INVALID_ALARM );\r
+ return -1;\r
+ }\r
+ trb_stat = trb_register_read( pinfo->trb_addr, address, pdata_buf, count );\r
+ if ( -1 == trb_stat ) {\r
+ fprintf( stderr, "\033[31;1m%s: read_register failed: %d %s\033[0m\n",\r
+ prec->name, trb_errno, trb_strerror() );\r
+ free( pdata_buf );\r
+ if (trb_errno == 12){\r
+ prec->nelm = prec->nelm * 2;\r
+ }\r
+ recGblSetSevr( prec, READ_ALARM, INVALID_ALARM );\r
+ _trb_connected = false;\r
+ return -1;\r
+ }\r
+ }\r
+ if ( TRB_STATUS_WARNING == trb_errno ) {\r
+ fprintf( stderr, "%s: Warning: Status-Bit(s) have been set:\n%s\n",\r
+ prec->name, trb_termstr( trb_term ) );\r
+ recGblSetSevr( prec, READ_ALARM, INVALID_ALARM );\r
+ return -1;\r
+ }\r
+\r
+ if ( trb_stat != prec->nelm ) { \r
+ prec->nelm = trb_stat;\r
+ prec->bptr = realloc(prec->bptr, prec->nelm * dbValueSize(prec->ftvl));\r
+ }\r
+\r
+\r
+ double *pvalue = (epicsUInt32*)prec->bptr;\r
+\r
+\r
+ //---------------------------------------------------//\r
+ double output = -1;\r
+ epicsUInt32 start = pow(2, trb[trb_Nmb].Reg[reg_Nmb].field[field_Nmb].start);\r
+ epicsUInt32 end = pow(2, trb[trb_Nmb].Reg[reg_Nmb].field[field_Nmb].bits);\r
+ double scale = trb[trb_Nmb].Reg[reg_Nmb].field[field_Nmb].scale;\r
+\r
+/* for( i=0; i < trb_stat; i+=2 ) {\r
+ output = ((pdata_buf[i+1]/start)%end )*scale;\r
+ pvalue[i] = pdata_buf[i];\r
+ pvalue[i+1] = output;\r
+ }\r
+*/\r
+ for( i=0; i<( prec->nelm/2); i+=1 ){\r
+ output = ((pdata_buf[(i*2)+1]/start)%end ) * scale;\r
+ pvalue[i] = pdata_buf[i*2];\r
+// pvalue[i+(trb_stat/2)] = output;\r
+ pvalue[i+(prec->nelm/2)] = output;\r
+ }\r
+\r
+ //---------------------------------------------------//\r
+\r
+ } else {\r
+ printf("No Address Name %s found!\n", pinfo->reg_name_buf);\r
+ } \r
+\r
+\r
+//--------------------------------//\r
+ prec->nord = prec->nelm;\r
+\r
+ free( pdata_buf );\r
+\r
+ return 0;\r
+}\r
+\r
jspc29 / epics.git / commitdiff