From 11f2f2e329ef404d0e9c022cb2f9fbbb45bae285 Mon Sep 17 00:00:00 2001
From: nancy.liao <huihui.liao@greentest.com.cn>
Date: 周日, 27 4月 2025 17:33:31 +0800
Subject: [PATCH] 完成了SCPI命令语法分析器的完整规则
---
libscpi/src/ieee488.c | 356 +++++++++++++++++++++++++++++++++++++----------------------
1 files changed, 223 insertions(+), 133 deletions(-)
diff --git a/libscpi/src/ieee488.c b/libscpi/src/ieee488.c
index ad2bc78..09279ba 100644
--- a/libscpi/src/ieee488.c
+++ b/libscpi/src/ieee488.c
@@ -1,28 +1,29 @@
/*-
- * 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.
*/
/**
@@ -37,33 +38,77 @@
#include "scpi/parser.h"
#include "scpi/ieee488.h"
#include "scpi/error.h"
-#include "scpi/constants.h"
-
#include <stdio.h>
-/**
- * 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));
-}
+static const scpi_reg_info_t scpi_reg_details[SCPI_REG_COUNT] = {
+ { SCPI_REG_CLASS_STB, SCPI_REG_GROUP_STB },
+ { SCPI_REG_CLASS_SRE, SCPI_REG_GROUP_STB },
+ { SCPI_REG_CLASS_EVEN, SCPI_REG_GROUP_ESR },
+ { SCPI_REG_CLASS_ENAB, SCPI_REG_GROUP_ESR },
+ { SCPI_REG_CLASS_EVEN, SCPI_REG_GROUP_OPER },
+ { SCPI_REG_CLASS_ENAB, SCPI_REG_GROUP_OPER },
+ { SCPI_REG_CLASS_COND, SCPI_REG_GROUP_OPER },
+ { SCPI_REG_CLASS_EVEN, SCPI_REG_GROUP_QUES },
+ { SCPI_REG_CLASS_ENAB, SCPI_REG_GROUP_QUES },
+ { SCPI_REG_CLASS_COND, SCPI_REG_GROUP_QUES },
-/**
- * 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);
- }
-}
+#if USE_CUSTOM_REGISTERS
+#ifndef USER_REGISTER_DETAILS
+#error "No user register details defined"
+#else
+ USER_REGISTER_DETAILS
+#endif
+#endif
+
+};
+
+static const scpi_reg_group_info_t scpi_reg_group_details[SCPI_REG_GROUP_COUNT] = {
+ {
+ SCPI_REG_STB,
+ SCPI_REG_SRE,
+ SCPI_REG_NONE,
+ SCPI_REG_NONE,
+ SCPI_REG_NONE,
+ SCPI_REG_NONE,
+ 0
+ }, /* SCPI_REG_GROUP_STB */
+ {
+ SCPI_REG_ESR,
+ SCPI_REG_ESE,
+ SCPI_REG_NONE,
+ SCPI_REG_NONE,
+ SCPI_REG_NONE,
+ SCPI_REG_STB,
+ STB_ESR
+ }, /* SCPI_REG_GROUP_ESR */
+ {
+ SCPI_REG_OPER,
+ SCPI_REG_OPERE,
+ SCPI_REG_OPERC,
+ SCPI_REG_NONE,
+ SCPI_REG_NONE,
+ SCPI_REG_STB,
+ STB_OPS
+ }, /* SCPI_REG_GROUP_OPER */
+ {
+ SCPI_REG_QUES,
+ SCPI_REG_QUESE,
+ SCPI_REG_QUESC,
+ SCPI_REG_NONE,
+ SCPI_REG_NONE,
+ SCPI_REG_STB,
+ STB_QES
+ }, /* SCPI_REG_GROUP_QUES */
+
+#if USE_CUSTOM_REGISTERS
+#ifndef USER_REGISTER_GROUP_DETAILS
+#error "No user register group details defined"
+#else
+ USER_REGISTER_GROUP_DETAILS
+#endif
+#endif
+
+};
/**
* Get register value
@@ -71,7 +116,7 @@
* @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;
@@ -98,69 +143,100 @@
* @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)) {
+ if ((name >= SCPI_REG_COUNT) || (context == NULL)) {
return;
}
-
- /* store old register value */
- old_val = context->registers[name];
- /* set register value */
- context->registers[name] = val;
+ scpi_reg_group_info_t register_group;
- /** @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;
+ do {
+ scpi_reg_class_t register_type = scpi_reg_details[name].type;
+ register_group = scpi_reg_group_details[scpi_reg_details[name].group];
+
+ scpi_reg_val_t ptrans;
+
+ /* store old register value */
+ scpi_reg_val_t old_val = context->registers[name];
+
+ if (old_val == val) {
+ return;
+ } else {
+ context->registers[name] = val;
+ }
+
+ switch (register_type) {
+ case SCPI_REG_CLASS_STB:
+ case SCPI_REG_CLASS_SRE:
+ {
+ scpi_reg_val_t stb = context->registers[SCPI_REG_STB] & ~STB_SRQ;
+ scpi_reg_val_t sre = context->registers[SCPI_REG_SRE] & ~STB_SRQ;
+
+ if (stb & sre) {
+ ptrans = ((old_val ^ val) & val);
+ context->registers[SCPI_REG_STB] |= STB_SRQ;
+ if (ptrans & val)
+ {
+ writeControl(context, SCPI_CTRL_SRQ, context->registers[SCPI_REG_STB]);
+ }
+ } else
+ {
+ context->registers[SCPI_REG_STB] &= ~STB_SRQ;
}
- } else {
- val &= ~STB_SRQ;
+ break;
}
- 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;
- }
+ case SCPI_REG_CLASS_EVEN:
+ {
+ scpi_reg_val_t enable;
+ if(register_group.enable != SCPI_REG_NONE) {
+ enable = SCPI_RegGet(context, register_group.enable);
+ } else {
+ enable = 0xFFFF;
+ }
- /* set updated register value */
- context->registers[name] = val;
+ scpi_bool_t summary = val & enable;
- if (srq) {
- writeControl(context, SCPI_CTRL_SRQ, SCPI_RegGet(context, SCPI_REG_STB));
- }
+ name = register_group.parent_reg;
+ val = SCPI_RegGet(context, register_group.parent_reg);
+ if (summary) {
+ val |= register_group.parent_bit;
+ } else {
+ val &= ~(register_group.parent_bit);
+ }
+ break;
+ }
+ case SCPI_REG_CLASS_COND:
+ {
+ name = register_group.event;
+
+ if(register_group.ptfilt == SCPI_REG_NONE && register_group.ntfilt == SCPI_REG_NONE) {
+ val = ((old_val ^ val) & val) | SCPI_RegGet(context, register_group.event);
+ } else {
+ scpi_reg_val_t ptfilt = 0, ntfilt = 0;
+ scpi_reg_val_t transitions;
+ scpi_reg_val_t ntrans;
+
+ if(register_group.ptfilt != SCPI_REG_NONE) {
+ ptfilt = SCPI_RegGet(context, register_group.ptfilt);
+ }
+
+ if(register_group.ntfilt != SCPI_REG_NONE) {
+ ntfilt = SCPI_RegGet(context, register_group.ntfilt);
+ }
+
+ transitions = old_val ^ val;
+ ptrans = transitions & val;
+ ntrans = transitions & ~ptrans;
+
+ val = ((ptrans & ptfilt) | (ntrans & ntfilt)) | SCPI_RegGet(context, register_group.event);
+ }
+ break;
+ }
+ case SCPI_REG_CLASS_ENAB:
+ case SCPI_REG_CLASS_NTR:
+ case SCPI_REG_CLASS_PTR:
+ return;
+ }
+ } while(register_group.parent_reg != SCPI_REG_NONE);
}
/**
@@ -182,25 +258,20 @@
}
/**
- * Clear event register
- * @param context
- */
-void SCPI_EventClear(scpi_t * context) {
- /* TODO */
- SCPI_RegSet(context, SCPI_REG_ESR, 0);
-}
-
-/**
* *CLS - This command clears all status data structures in a device.
* For a device which minimally complies with SCPI. (SCPI std 4.1.3.2)
* @param context
* @return
*/
scpi_result_t SCPI_CoreCls(scpi_t * context) {
- SCPI_EventClear(context);
SCPI_ErrorClear(context);
- SCPI_RegSet(context, SCPI_REG_OPER, 0);
- SCPI_RegSet(context, SCPI_REG_QUES, 0);
+ int i;
+ for (i = 0; i < SCPI_REG_GROUP_COUNT; ++i) {
+ scpi_reg_name_t event_reg = scpi_reg_group_details[i].event;
+ if (event_reg != SCPI_REG_STB) {
+ SCPI_RegSet(context, event_reg, 0);
+ }
+ }
return SCPI_RES_OK;
}
@@ -209,12 +280,14 @@
* @param context
* @return
*/
-scpi_result_t SCPI_CoreEse(scpi_t * context) {
+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;
}
/**
@@ -223,7 +296,7 @@
* @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;
}
@@ -233,7 +306,7 @@
* @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;
}
@@ -250,10 +323,18 @@
* @return
*/
scpi_result_t SCPI_CoreIdnQ(scpi_t * context) {
- SCPI_ResultMnemonic(context, context->idn[0]);
- SCPI_ResultMnemonic(context, context->idn[1]);
- SCPI_ResultMnemonic(context, context->idn[2]);
- SCPI_ResultMnemonic(context, context->idn[3]);
+ int i;
+ for (i = 0; i < 4; i++)
+ {
+ if (context->idn[i])
+ {
+ char* outPut = "IDNS鍝嶅簲";
+ // context->interface->write(context,context->idn[i],0);
+ SCPI_ResultMnemonic(context, context->idn[i]);
+ } else {
+ SCPI_ResultMnemonic(context, "0");
+ }
+ }
return SCPI_RES_OK;
}
@@ -262,7 +343,8 @@
* @param context
* @return
*/
-scpi_result_t SCPI_CoreOpc(scpi_t * context) {
+scpi_result_t SCPI_CoreOpc(scpi_t * context)
+{
SCPI_RegSetBits(context, SCPI_REG_ESR, ESR_OPC);
return SCPI_RES_OK;
}
@@ -274,7 +356,7 @@
*/
scpi_result_t SCPI_CoreOpcQ(scpi_t * context) {
/* Operation is always completed */
- SCPI_ResultInt(context, 1);
+ SCPI_ResultInt32(context, 1);
return SCPI_RES_OK;
}
@@ -297,10 +379,11 @@
*/
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;
}
/**
@@ -308,8 +391,14 @@
* @param context
* @return
*/
-scpi_result_t SCPI_CoreSreQ(scpi_t * context) {
- SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_SRE));
+scpi_result_t SCPI_CoreSreQ(scpi_t * context)
+{
+ context->interface->write(context,"Registers request start",0);
+ for(int i =0;i<SCPI_REG_COUNT;i++)
+ {
+ context->interface->write(context,(char*)context->registers[i],0);
+ }
+ context->interface->write(context,"Registers request end",0);
return SCPI_RES_OK;
}
@@ -319,7 +408,7 @@
* @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;
}
@@ -330,7 +419,7 @@
*/
scpi_result_t SCPI_CoreTstQ(scpi_t * context) {
(void) context;
- SCPI_ResultInt(context, 0);
+ SCPI_ResultInt32(context, 0);
return SCPI_RES_OK;
}
@@ -345,3 +434,4 @@
return SCPI_RES_OK;
}
+
--
Gitblit v1.9.1