/**
* Update STB register according to value and its mask register
* @param context
* @param val value of register
* @param mask name of mask register (enable register)
* @param stbBits bits to clear or set in STB
*/
void SCPIParser::regUpdateSTB(scpi_reg_val_t val, scpi_reg_name_t mask, scpi_reg_val_t stbBits) {
if (val & SCPI_RegGet(mask)) {
SCPI_RegSetBits(SCPI_REG_STB, stbBits);
} else {
SCPI_RegClearBits(SCPI_REG_STB, stbBits);
}
}
/**
* Update STB register according to value and its mask register
* @param context
* @param val value of register
* @param mask name of mask register (enable register)
* @param stbBits bits to clear or set in STB
*/
static void regUpdateSTB(scpi_t * context, scpi_reg_val_t val, scpi_reg_name_t mask, scpi_reg_val_t stbBits) {
if (val & SCPI_RegGet(context, mask)) {
SCPI_RegSetBits(context, SCPI_REG_STB, stbBits);
} else {
SCPI_RegClearBits(context, SCPI_REG_STB, stbBits);
}
}
/**
* Emit no error
* @param context scpi context
*/
static void SCPI_ErrorEmitEmpty(scpi_t * context) {
if ((SCPI_ErrorCount(context) == 0) && (SCPI_RegGet(context, SCPI_REG_STB) & STB_QMA)) {
SCPI_RegClearBits(context, SCPI_REG_STB, STB_QMA);
if (context->interface && context->interface->error) {
context->interface->error(context, 0);
}
}
}
/**
* STATus:QUEStionable[:EVENt]?
* @param context
* @return
*/
scpi_result_t SCPI_StatusQuestionableEventQ(scpi_t * context) {
/* return value */
SCPI_ResultInt32(context, SCPI_RegGet(context, SCPI_REG_QUES));
/* clear register */
SCPI_RegSet(context, SCPI_REG_QUES, 0);
return SCPI_RES_OK;
}
/**
* Set register value
* @param name - register name
* @param val - new value
*/
void SCPI_RegSet(scpi_t * context, scpi_reg_name_t name, scpi_reg_val_t val) {
scpi_bool_t srq = FALSE;
scpi_reg_val_t mask;
scpi_reg_val_t old_val;
if ((name >= SCPI_REG_COUNT) || (context->registers == NULL)) {
return;
}
/* store old register value */
old_val = context->registers[name];
/* set register value */
context->registers[name] = val;
/** @TODO: remove recutsion */
switch (name) {
case SCPI_REG_STB:
mask = SCPI_RegGet(context, SCPI_REG_SRE);
mask &= ~STB_SRQ;
if (val & mask) {
val |= STB_SRQ;
/* avoid sending SRQ if nothing has changed */
if (old_val != val) {
srq = TRUE;
}
} else {
val &= ~STB_SRQ;
}
break;
case SCPI_REG_SRE:
regUpdate(context, SCPI_REG_STB);
break;
case SCPI_REG_ESR:
regUpdateSTB(context, val, SCPI_REG_ESE, STB_ESR);
break;
case SCPI_REG_ESE:
regUpdate(context, SCPI_REG_ESR);
break;
case SCPI_REG_QUES:
regUpdateSTB(context, val, SCPI_REG_QUESE, STB_QES);
break;
case SCPI_REG_QUESE:
regUpdate(context, SCPI_REG_QUES);
break;
case SCPI_REG_OPER:
regUpdateSTB(context, val, SCPI_REG_OPERE, STB_OPS);
break;
case SCPI_REG_OPERE:
regUpdate(context, SCPI_REG_OPER);
break;
case SCPI_REG_COUNT:
/* nothing to do */
break;
}
/* set updated register value */
context->registers[name] = val;
if (srq) {
writeControl(context, SCPI_CTRL_SRQ, SCPI_RegGet(context, SCPI_REG_STB));
}
}
/**
* Update register value
* @param context
* @param name - register name
*/
static void regUpdate(scpi_t * context, scpi_reg_name_t name) {
SCPI_RegSet(context, name, SCPI_RegGet(context, name));
}
/**
* *STB?
* @param context
* @return
*/
scpi_result_t SCPI_CoreStbQ(scpi_t * context) {
SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_STB));
return SCPI_RES_OK;
}
/**
* *ESR?
* @param context
* @return
*/
scpi_result_t SCPI_CoreEsrQ(scpi_t * context) {
SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_ESR));
SCPI_RegSet(context, SCPI_REG_ESR, 0);
return SCPI_RES_OK;
}
/**
* *ESE?
* @param context
* @return
*/
scpi_result_t SCPI_CoreEseQ(scpi_t * context) {
SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_ESE));
return SCPI_RES_OK;
}
/**
* Clear register bits
* @param name - register name
* @param bits bit mask
*/
void SCPI_RegClearBits(scpi_t * context, scpi_reg_name_t name, scpi_reg_val_t bits) {
SCPI_RegSet(context, name, SCPI_RegGet(context, name) & ~bits);
}
/**
* STATus:QUEStionable:ENABle?
* @param context
* @return
*/
scpi_result_t SCPI_StatusQuestionableEnableQ(scpi_t * context) {
/* return value */
SCPI_ResultInt32(context, SCPI_RegGet(context, SCPI_REG_QUESE));
return SCPI_RES_OK;
}
/**
* *STB?
* @param context
* @return
*/
scpi_result_t SCPIParser::SCPI_CoreStbQ() {
SCPI_ResultInt(SCPI_RegGet(SCPI_REG_STB));
return SCPI_RES_OK;
}
/**
* *ESR?
* @param context
* @return
*/
scpi_result_t SCPIParser::SCPI_CoreEsrQ() {
SCPI_ResultInt(SCPI_RegGet(SCPI_REG_ESR));
SCPI_RegSet(SCPI_REG_ESR, 0);
return SCPI_RES_OK;
}
/**
* *ESE?
* @param context
* @return
*/
scpi_result_t SCPIParser::SCPI_CoreEseQ() {
SCPI_ResultInt(SCPI_RegGet(SCPI_REG_ESE));
return SCPI_RES_OK;
}
/**
* Clear register bits
* @param name - register name
* @param bits bit mask
*/
void SCPIParser::SCPI_RegClearBits(scpi_reg_name_t name, scpi_reg_val_t bits) {
SCPI_RegSet(name, SCPI_RegGet(name) & ~bits);
}
/**
* Update register value
* @param context
* @param name - register name
*/
void SCPIParser::regUpdate(scpi_reg_name_t name) {
SCPI_RegSet(name, SCPI_RegGet(name));
}
