From f73b07e6aeddf13923c51a413ba69889fd593d32 Mon Sep 17 00:00:00 2001
From: Jan Breuer <jan.breuer@jaybee.cz>
Date: 周二, 04 12月 2012 18:14:17 +0800
Subject: [PATCH] Code cleanup - remove "(void) context;"

---
 scpi/scpi_ieee488.c |  102 +++++++++++++++++++++++++--------------------------
 1 files changed, 50 insertions(+), 52 deletions(-)

diff --git a/scpi/scpi_ieee488.c b/scpi/scpi_ieee488.c
index a0983e3..0c3fcc0 100644
--- a/scpi/scpi_ieee488.c
+++ b/scpi/scpi_ieee488.c
@@ -39,15 +39,12 @@
 #include "scpi_error.h"
 #include "scpi_constants.h"
 
-/* register array */
-static scpi_reg_val_t regs[SCPI_REG_COUNT];
-
 /**
  * Update register value
  * @param name - register name
  */
-static void SCPI_RegUpdate(scpi_reg_name_t name) {
-    SCPI_RegSet(name, SCPI_RegGet(name));
+static void SCPI_RegUpdate(scpi_t * context, scpi_reg_name_t name) {
+    SCPI_RegSet(context, name, SCPI_RegGet(context, name));
 }
 
 /**
@@ -55,9 +52,9 @@
  * @param name - register name
  * @return register value
  */
-scpi_reg_val_t SCPI_RegGet(scpi_reg_name_t name) {
-    if (name < SCPI_REG_COUNT) {
-        return regs[name];
+scpi_reg_val_t SCPI_RegGet(scpi_t * context, scpi_reg_name_t name) {
+    if ((name < SCPI_REG_COUNT) && (context->registers != NULL)) {
+        return context->registers[name];
     } else {
         return 0;
     }
@@ -68,54 +65,61 @@
  * @param name - register name
  * @param val - new value
  */
-void SCPI_RegSet(scpi_reg_name_t name, scpi_reg_val_t val) {
-    if (name >= SCPI_REG_COUNT) {
+void SCPI_RegSet(scpi_t * context, scpi_reg_name_t name, scpi_reg_val_t val) {
+    bool_t srq = FALSE;
+    scpi_reg_val_t mask;
+
+    if ((name >= SCPI_REG_COUNT) || (context->registers == NULL)) {
         return;
     }
+    
 
     // set register value
-    regs[name] = val;
+    context->registers[name] = val;
 
     switch (name) {
         case SCPI_REG_STB:
-            if (val & (SCPI_RegGet(SCPI_REG_SRE) &~STB_SRQ)) {
+            mask = SCPI_RegGet(context, SCPI_REG_SRE);
+            mask &= ~STB_SRQ;
+            if (val & mask) {
                 val |= STB_SRQ;
+                srq = TRUE;
             } else {
                 val &= ~STB_SRQ;
             }
             break;
         case SCPI_REG_SRE:
-            SCPI_RegUpdate(SCPI_REG_STB);
+            SCPI_RegUpdate(context, SCPI_REG_STB);
             break;
         case SCPI_REG_ESR:
-            if (val & SCPI_RegGet(SCPI_REG_ESE)) {
-                SCPI_RegSetBits(SCPI_REG_STB, STB_ESR);
+            if (val & SCPI_RegGet(context, SCPI_REG_ESE)) {
+                SCPI_RegSetBits(context, SCPI_REG_STB, STB_ESR);
             } else {
-                SCPI_RegClearBits(SCPI_REG_STB, STB_ESR);
+                SCPI_RegClearBits(context, SCPI_REG_STB, STB_ESR);
             }
             break;
         case SCPI_REG_ESE:
-            SCPI_RegUpdate(SCPI_REG_ESR);
+            SCPI_RegUpdate(context, SCPI_REG_ESR);
             break;
         case SCPI_REG_QUES:
-            if (val & SCPI_RegGet(SCPI_REG_QUESE)) {
-                SCPI_RegSetBits(SCPI_REG_STB, STB_QES);
+            if (val & SCPI_RegGet(context, SCPI_REG_QUESE)) {
+                SCPI_RegSetBits(context, SCPI_REG_STB, STB_QES);
             } else {
-                SCPI_RegClearBits(SCPI_REG_STB, STB_QES);
+                SCPI_RegClearBits(context, SCPI_REG_STB, STB_QES);
             }
             break;
         case SCPI_REG_QUESE:
-            SCPI_RegUpdate(SCPI_REG_QUES);
+            SCPI_RegUpdate(context, SCPI_REG_QUES);
             break;
         case SCPI_REG_OPER:
-            if (val & SCPI_RegGet(SCPI_REG_OPERE)) {
-                SCPI_RegSetBits(SCPI_REG_STB, STB_OPS);
+            if (val & SCPI_RegGet(context, SCPI_REG_OPERE)) {
+                SCPI_RegSetBits(context, SCPI_REG_STB, STB_OPS);
             } else {
-                SCPI_RegClearBits(SCPI_REG_STB, STB_OPS);
+                SCPI_RegClearBits(context, SCPI_REG_STB, STB_OPS);
             }
             break;
         case SCPI_REG_OPERE:
-            SCPI_RegUpdate(SCPI_REG_OPER);
+            SCPI_RegUpdate(context, SCPI_REG_OPER);
             break;
             
             
@@ -125,8 +129,11 @@
     }
 
     // set updated register value
-    regs[name] = val;
+    context->registers[name] = val;
 
+    if (srq && context->interface && context->interface->srq) {
+        context->interface->srq(context);
+    }
 }
 
 /**
@@ -134,8 +141,8 @@
  * @param name - register name
  * @param bits bit mask
  */
-void SCPI_RegSetBits(scpi_reg_name_t name, scpi_reg_val_t bits) {
-    SCPI_RegSet(name, SCPI_RegGet(name) | bits);
+void SCPI_RegSetBits(scpi_t * context, scpi_reg_name_t name, scpi_reg_val_t bits) {
+    SCPI_RegSet(context, name, SCPI_RegGet(context, name) | bits);
 }
 
 /**
@@ -143,15 +150,15 @@
  * @param name - register name
  * @param bits bit mask
  */
-void SCPI_RegClearBits(scpi_reg_name_t name, scpi_reg_val_t bits) {
-    SCPI_RegSet(name, SCPI_RegGet(name) & ~bits);
+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);
 }
 
 /* ============ */
 
-void SCPI_EventClear(void) {
+void SCPI_EventClear(scpi_t * context) {
     // TODO
-    SCPI_RegSet(SCPI_REG_ESR, 0);
+    SCPI_RegSet(context, SCPI_REG_ESR, 0);
 }
 
 /**
@@ -161,11 +168,10 @@
  * @return 
  */
 scpi_result_t SCPI_CoreCls(scpi_t * context) {
-    (void) context;
-    SCPI_EventClear();
+    SCPI_EventClear(context);
     SCPI_ErrorClear(context);
-    SCPI_RegSet(SCPI_REG_OPER, 0);
-    SCPI_RegSet(SCPI_REG_QUES, 0);
+    SCPI_RegSet(context, SCPI_REG_OPER, 0);
+    SCPI_RegSet(context, SCPI_REG_QUES, 0);
     return SCPI_RES_OK;
 }
 
@@ -177,7 +183,7 @@
 scpi_result_t SCPI_CoreEse(scpi_t * context) {
     int32_t new_ESE;
     if (SCPI_ParamInt(context, &new_ESE, TRUE)) {
-        SCPI_RegSet(SCPI_REG_ESE, new_ESE);
+        SCPI_RegSet(context, SCPI_REG_ESE, new_ESE);
     }
     return SCPI_RES_OK;
 }
@@ -188,8 +194,7 @@
  * @return 
  */
 scpi_result_t SCPI_CoreEseQ(scpi_t * context) {
-    (void) context;
-    SCPI_ResultInt(context, SCPI_RegGet(SCPI_REG_ESE));
+    SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_ESE));
     return SCPI_RES_OK;
 }
 
@@ -199,9 +204,8 @@
  * @return 
  */
 scpi_result_t SCPI_CoreEsrQ(scpi_t * context) {
-    (void) context;
-    SCPI_ResultInt(context, SCPI_RegGet(SCPI_REG_ESR));
-    SCPI_RegSet(SCPI_REG_ESR, 0);
+    SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_ESR));
+    SCPI_RegSet(context, SCPI_REG_ESR, 0);
     return SCPI_RES_OK;
 }
 
@@ -211,7 +215,6 @@
  * @return 
  */
 scpi_result_t SCPI_CoreIdnQ(scpi_t * context) {
-    (void) context;
     SCPI_ResultString(context, SCPI_MANUFACTURE);
     SCPI_ResultString(context, SCPI_DEV_NAME);
     SCPI_ResultString(context, SCPI_DEV_VERSION);
@@ -224,8 +227,7 @@
  * @return 
  */
 scpi_result_t SCPI_CoreOpc(scpi_t * context) {
-    (void) context;
-    SCPI_RegSetBits(SCPI_REG_ESR, ESR_OPC);
+    SCPI_RegSetBits(context, SCPI_REG_ESR, ESR_OPC);
     return SCPI_RES_OK;
 }
 
@@ -235,7 +237,6 @@
  * @return 
  */
 scpi_result_t SCPI_CoreOpcQ(scpi_t * context) {
-    (void) context;
     // Operation is always completed
     SCPI_ResultInt(context, 1);
     return SCPI_RES_OK;
@@ -261,7 +262,7 @@
 scpi_result_t SCPI_CoreSre(scpi_t * context) {
     int32_t new_SRE;
     if (SCPI_ParamInt(context, &new_SRE, TRUE)) {
-        SCPI_RegSet(SCPI_REG_SRE, new_SRE);
+        SCPI_RegSet(context, SCPI_REG_SRE, new_SRE);
     }
     return SCPI_RES_OK;
 }
@@ -272,8 +273,7 @@
  * @return 
  */
 scpi_result_t SCPI_CoreSreQ(scpi_t * context) {
-    (void) context;
-    SCPI_ResultInt(context, SCPI_RegGet(SCPI_REG_SRE));
+    SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_SRE));
     return SCPI_RES_OK;
 }
 
@@ -283,8 +283,7 @@
  * @return 
  */
 scpi_result_t SCPI_CoreStbQ(scpi_t * context) {
-    (void) context;
-    SCPI_ResultInt(context, SCPI_RegGet(SCPI_REG_STB));
+    SCPI_ResultInt(context, SCPI_RegGet(context, SCPI_REG_STB));
     return SCPI_RES_OK;
 }
 
@@ -294,7 +293,6 @@
  * @return 
  */
 scpi_result_t SCPI_CoreTstQ(scpi_t * context) {
-    (void) context;
     int result = 0;
     if (context && context->interface && context->interface->test) {
         result = context->interface->test(context);

--
Gitblit v1.9.1