# HG changeset patch
# User Mychaela Falconia <falcon@freecalypso.org>
# Date 1484463764 0
# Node ID 09f0a502745e71c1fb5a9bdbfe9ac996c4328bc1
# Parent  a3ca660219a19802ec1585780d63e957c5255e0a
l1tm_func.c: l1tm_misc_param_read() reconstructed

diff -r a3ca660219a1 -r 09f0a502745e chipsetsw/layer1/tm_cfile/l1tm_func.c
--- a/chipsetsw/layer1/tm_cfile/l1tm_func.c	Sun Jan 15 06:49:27 2017 +0000
+++ b/chipsetsw/layer1/tm_cfile/l1tm_func.c	Sun Jan 15 07:02:44 2017 +0000
@@ -1155,17 +1155,35 @@
   switch (prim->u.tm_params.index) {
   case ADC_ENA_FLAG:
     l1_config.adc_enable = prim->u.tm_params.value;
-    tm_return->status = E_OK;
     break;
   default:
     Cust_tm_misc_param_write(tm_return, prim->u.tm_params.index,
                              prim->u.tm_params.value);
+    return;
   }
+  tm_return->status = E_OK;
 }
 
+/* TCS211 function missing in LoCosto, reconstructed from disassembly */
 void l1tm_misc_param_read(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
 {
-/* TCS211 function missing in LoCosto, to be reconstructed from disasm */
+  UWORD16 value;
+
+  tm_return->index = prim->u.tm_params.index;
+  switch (prim->u.tm_params.index) {
+  case ADC_ENA_FLAG:
+    value = l1_config.adc_enable;
+    break;
+  case CURRENT_TM_MODE:
+    value = l1_config.TestMode;
+    break;
+  default:
+    Cust_tm_misc_param_read(tm_return, prim->u.tm_params.index);
+    return;
+  }
+  memcpy(tm_return->result, &value, 2);
+  tm_return->size = 2;
+  tm_return->status = E_OK;
 }
 
 void l1tm_misc_enable(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)