| | |
| | | * @return register value |
| | | */ |
| | | scpi_reg_val_t SCPI_RegGet(scpi_t * context, scpi_reg_name_t name) { |
| | | if ((name < SCPI_REG_COUNT) && (context->registers != NULL)) { |
| | | if ((name < SCPI_REG_COUNT) && context) { |
| | | return context->registers[name]; |
| | | } else { |
| | | return 0; |
| | |
| | | * @param val - new value |
| | | */ |
| | | void SCPI_RegSet(scpi_t * context, scpi_reg_name_t name, scpi_reg_val_t val) { |
| | | bool_t srq = FALSE; |
| | | scpi_bool_t srq = FALSE; |
| | | scpi_reg_val_t mask; |
| | | scpi_reg_val_t old_val; |
| | | |
| | | if ((name >= SCPI_REG_COUNT) || (context->registers == NULL)) { |
| | | if ((name >= SCPI_REG_COUNT) || (context == NULL)) { |
| | | return; |
| | | } |
| | | |
| | | |
| | | /* store old register value */ |
| | | old_val = context->registers[name]; |
| | | |
| | | /* set register value */ |
| | | context->registers[name] = val; |
| | |
| | | mask &= ~STB_SRQ; |
| | | if (val & mask) { |
| | | val |= STB_SRQ; |
| | | srq = TRUE; |
| | | /* avoid sending SRQ if nothing has changed */ |
| | | if (old_val != val) { |
| | | srq = TRUE; |
| | | } |
| | | } else { |
| | | val &= ~STB_SRQ; |
| | | } |
| | |
| | | case SCPI_REG_OPERE: |
| | | regUpdate(context, SCPI_REG_OPER); |
| | | break; |
| | | |
| | | |
| | | |
| | | |
| | | case SCPI_REG_COUNT: |
| | | // nothing to do |
| | | /* nothing to do */ |
| | | break; |
| | | } |
| | | |
| | | // set updated register value |
| | | /* set updated register value */ |
| | | context->registers[name] = val; |
| | | |
| | | if (srq) { |
| | |
| | | * @param context |
| | | */ |
| | | void SCPI_EventClear(scpi_t * context) { |
| | | // TODO |
| | | /* TODO */ |
| | | SCPI_RegSet(context, SCPI_REG_ESR, 0); |
| | | } |
| | | |
| | |
| | | */ |
| | | scpi_result_t SCPI_CoreEse(scpi_t * context) { |
| | | int32_t new_ESE; |
| | | if (SCPI_ParamInt(context, &new_ESE, TRUE)) { |
| | | SCPI_RegSet(context, SCPI_REG_ESE, new_ESE); |
| | | if (SCPI_ParamInt32(context, &new_ESE, TRUE)) { |
| | | SCPI_RegSet(context, SCPI_REG_ESE, (scpi_reg_val_t) new_ESE); |
| | | return SCPI_RES_OK; |
| | | } |
| | | return SCPI_RES_OK; |
| | | return SCPI_RES_ERR; |
| | | } |
| | | |
| | | /** |
| | |
| | | * @return |
| | | */ |
| | | scpi_result_t SCPI_CoreEseQ(scpi_t * context) { |
| | | SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_ESE)); |
| | | SCPI_ResultInt32(context, SCPI_RegGet(context, SCPI_REG_ESE)); |
| | | return SCPI_RES_OK; |
| | | } |
| | | |
| | |
| | | * @return |
| | | */ |
| | | scpi_result_t SCPI_CoreEsrQ(scpi_t * context) { |
| | | SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_ESR)); |
| | | SCPI_ResultInt32(context, SCPI_RegGet(context, SCPI_REG_ESR)); |
| | | SCPI_RegSet(context, SCPI_REG_ESR, 0); |
| | | return SCPI_RES_OK; |
| | | } |
| | | |
| | | /** |
| | | * *IDN? |
| | | * |
| | | * field1: MANUFACTURE |
| | | * field2: MODEL |
| | | * field4: SUBSYSTEMS REVISIONS |
| | | * |
| | | * example: MANUFACTURE,MODEL,0,01-02-01 |
| | | * @param context |
| | | * @return |
| | | */ |
| | | scpi_result_t SCPI_CoreIdnQ(scpi_t * context) { |
| | | SCPI_ResultString(context, SCPI_MANUFACTURE); |
| | | SCPI_ResultString(context, SCPI_DEV_NAME); |
| | | SCPI_ResultString(context, SCPI_DEV_VERSION); |
| | | int i; |
| | | for (i = 0; i < 4; i++) { |
| | | if (context->idn[i]) { |
| | | SCPI_ResultMnemonic(context, context->idn[i]); |
| | | } else { |
| | | SCPI_ResultMnemonic(context, "0"); |
| | | } |
| | | } |
| | | return SCPI_RES_OK; |
| | | } |
| | | |
| | |
| | | * @return |
| | | */ |
| | | scpi_result_t SCPI_CoreOpcQ(scpi_t * context) { |
| | | // Operation is always completed |
| | | SCPI_ResultInt(context, 1); |
| | | /* Operation is always completed */ |
| | | SCPI_ResultInt32(context, 1); |
| | | return SCPI_RES_OK; |
| | | } |
| | | |
| | |
| | | */ |
| | | scpi_result_t SCPI_CoreSre(scpi_t * context) { |
| | | int32_t new_SRE; |
| | | if (SCPI_ParamInt(context, &new_SRE, TRUE)) { |
| | | SCPI_RegSet(context, SCPI_REG_SRE, new_SRE); |
| | | if (SCPI_ParamInt32(context, &new_SRE, TRUE)) { |
| | | SCPI_RegSet(context, SCPI_REG_SRE, (scpi_reg_val_t) new_SRE); |
| | | return SCPI_RES_OK; |
| | | } |
| | | return SCPI_RES_OK; |
| | | return SCPI_RES_ERR; |
| | | } |
| | | |
| | | /** |
| | |
| | | * @return |
| | | */ |
| | | scpi_result_t SCPI_CoreSreQ(scpi_t * context) { |
| | | SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_SRE)); |
| | | SCPI_ResultInt32(context, SCPI_RegGet(context, SCPI_REG_SRE)); |
| | | return SCPI_RES_OK; |
| | | } |
| | | |
| | |
| | | * @return |
| | | */ |
| | | scpi_result_t SCPI_CoreStbQ(scpi_t * context) { |
| | | SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_STB)); |
| | | SCPI_ResultInt32(context, SCPI_RegGet(context, SCPI_REG_STB)); |
| | | return SCPI_RES_OK; |
| | | } |
| | | |
| | |
| | | * @return |
| | | */ |
| | | scpi_result_t SCPI_CoreTstQ(scpi_t * context) { |
| | | int result = 0; |
| | | if (context && context->interface && context->interface->test) { |
| | | result = context->interface->test(context); |
| | | } |
| | | SCPI_ResultInt(context, result); |
| | | (void) context; |
| | | SCPI_ResultInt32(context, 0); |
| | | return SCPI_RES_OK; |
| | | } |
| | | |
| | |
| | | */ |
| | | scpi_result_t SCPI_CoreWai(scpi_t * context) { |
| | | (void) context; |
| | | // NOP |
| | | /* NOP */ |
| | | return SCPI_RES_OK; |
| | | } |
| | | |