| | |
| | | /*- |
| | | * Copyright (c) 2012-2013 Jan Breuer, |
| | | * BSD 2-Clause License |
| | | * |
| | | * All Rights Reserved |
| | | * |
| | | * Copyright (c) 2012-2018, Jan Breuer |
| | | * All rights reserved. |
| | | * |
| | | * Redistribution and use in source and binary forms, with or without |
| | | * modification, are permitted provided that the following conditions are |
| | | * met: |
| | | * 1. Redistributions of source code must retain the above copyright notice, |
| | | * this list of conditions and the following disclaimer. |
| | | * 2. Redistributions in binary form must reproduce the above copyright |
| | | * notice, this list of conditions and the following disclaimer in the |
| | | * documentation and/or other materials provided with the distribution. |
| | | * |
| | | * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR |
| | | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
| | | * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
| | | * DISCLAIMED. IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE |
| | | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| | | * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| | | * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR |
| | | * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, |
| | | * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE |
| | | * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN |
| | | * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| | | * modification, are permitted provided that the following conditions are met: |
| | | * |
| | | * * Redistributions of source code must retain the above copyright notice, this |
| | | * list of conditions and the following disclaimer. |
| | | * |
| | | * * Redistributions in binary form must reproduce the above copyright notice, |
| | | * this list of conditions and the following disclaimer in the documentation |
| | | * and/or other materials provided with the distribution. |
| | | * |
| | | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| | | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| | | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
| | | * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE |
| | | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
| | | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR |
| | | * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER |
| | | * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
| | | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
| | | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| | | */ |
| | | |
| | | /** |
| | |
| | | |
| | | /** |
| | | * Update register value |
| | | * @param context |
| | | * @param name - register name |
| | | */ |
| | | static void SCPI_RegUpdate(scpi_t * context, scpi_reg_name_t name) { |
| | | static void regUpdate(scpi_t * context, scpi_reg_name_t name) { |
| | | SCPI_RegSet(context, name, SCPI_RegGet(context, name)); |
| | | } |
| | | |
| | | /** |
| | | * Update latching event register value based on bit transitions from 0 -> 1 |
| | | * in the condition register |
| | | * @param context |
| | | * @param condReg - condition register name |
| | | * @param eventReg - event register name |
| | | */ |
| | | static void regUpdateEvent(scpi_t * context, scpi_reg_val_t oldCondVal, scpi_reg_val_t newCondVal, scpi_reg_name_t eventReg) { |
| | | SCPI_RegSet(context, eventReg, ((oldCondVal ^ newCondVal) & newCondVal) | SCPI_RegGet(context, eventReg)); |
| | | } |
| | | |
| | | /** |
| | | * 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); |
| | | } |
| | | } |
| | | |
| | | /** |
| | |
| | | * @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; |
| | | } |
| | | } |
| | | |
| | | static size_t writeControl(scpi_t * context, int ctrl, scpi_reg_val_t val) { |
| | | /** |
| | | * Wrapper function to control interface from context |
| | | * @param context |
| | | * @param ctrl number of controll message |
| | | * @param value value of related register |
| | | */ |
| | | static size_t writeControl(scpi_t * context, scpi_ctrl_name_t ctrl, scpi_reg_val_t val) { |
| | | if (context && context->interface && context->interface->control) { |
| | | context->interface->control(context, ctrl, val); |
| | | } |
| | | return context->interface->control(context, ctrl, val); |
| | | } 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; |
| | | } |
| | | |
| | | |
| | | // set register value |
| | | /* 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; |
| | | srq = TRUE; |
| | | /* avoid sending SRQ if nothing has changed */ |
| | | if (old_val != val) { |
| | | srq = TRUE; |
| | | } |
| | | } else { |
| | | val &= ~STB_SRQ; |
| | | } |
| | | break; |
| | | case SCPI_REG_SRE: |
| | | SCPI_RegUpdate(context, SCPI_REG_STB); |
| | | regUpdate(context, SCPI_REG_STB); |
| | | break; |
| | | case SCPI_REG_ESR: |
| | | if (val & SCPI_RegGet(context, SCPI_REG_ESE)) { |
| | | SCPI_RegSetBits(context, SCPI_REG_STB, STB_ESR); |
| | | } else { |
| | | SCPI_RegClearBits(context, SCPI_REG_STB, STB_ESR); |
| | | } |
| | | regUpdateSTB(context, val, SCPI_REG_ESE, STB_ESR); |
| | | break; |
| | | case SCPI_REG_ESE: |
| | | SCPI_RegUpdate(context, SCPI_REG_ESR); |
| | | regUpdate(context, SCPI_REG_ESR); |
| | | break; |
| | | case SCPI_REG_QUES: |
| | | if (val & SCPI_RegGet(context, SCPI_REG_QUESE)) { |
| | | SCPI_RegSetBits(context, SCPI_REG_STB, STB_QES); |
| | | } else { |
| | | SCPI_RegClearBits(context, SCPI_REG_STB, STB_QES); |
| | | } |
| | | regUpdateSTB(context, val, SCPI_REG_QUESE, STB_QES); |
| | | break; |
| | | case SCPI_REG_QUESE: |
| | | SCPI_RegUpdate(context, SCPI_REG_QUES); |
| | | regUpdate(context, SCPI_REG_QUES); |
| | | break; |
| | | case SCPI_REG_QUESC: |
| | | regUpdateEvent(context, old_val, val, SCPI_REG_QUES); |
| | | break; |
| | | case SCPI_REG_OPER: |
| | | if (val & SCPI_RegGet(context, SCPI_REG_OPERE)) { |
| | | SCPI_RegSetBits(context, SCPI_REG_STB, STB_OPS); |
| | | } else { |
| | | SCPI_RegClearBits(context, SCPI_REG_STB, STB_OPS); |
| | | } |
| | | regUpdateSTB(context, val, SCPI_REG_OPERE, STB_OPS); |
| | | break; |
| | | case SCPI_REG_OPERE: |
| | | SCPI_RegUpdate(context, SCPI_REG_OPER); |
| | | regUpdate(context, SCPI_REG_OPER); |
| | | break; |
| | | |
| | | |
| | | case SCPI_REG_OPERC: |
| | | regUpdateEvent(context, old_val, val, 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) { |
| | |
| | | SCPI_RegSet(context, name, SCPI_RegGet(context, name) & ~bits); |
| | | } |
| | | |
| | | /* ============ */ |
| | | |
| | | /** |
| | | * Clear event register |
| | | * @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; |
| | | } |
| | | |