changeset 227:19f9395bb274

l1tm_func.c: l1tm_mode_set() reconstructed
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 15 Jan 2017 01:07:58 +0000
parents a5d619b2561c
children a40cdf33f1f6
files chipsetsw/layer1/tm_cfile/l1tm_func.c
diffstat 1 files changed, 19 insertions(+), 1 deletions(-) [+]
line wrap: on
line diff
--- a/chipsetsw/layer1/tm_cfile/l1tm_func.c	Sat Jan 14 23:27:22 2017 +0000
+++ b/chipsetsw/layer1/tm_cfile/l1tm_func.c	Sun Jan 15 01:07:58 2017 +0000
@@ -1003,7 +1003,25 @@
 
 void l1tm_mode_set(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)
 {
-/* TCS211 function missing in LoCosto, to be reconstructed from disasm */
+  /* TCS211 function missing in LoCosto, reconstructed from disassembly */
+  switch (prim->u.tm_params.index) {
+  case 0:
+    l1_config.TestMode = 0;
+    tm_return->status = E_OK;
+    break;
+  case 1:
+    l1_config.TestMode = 1;
+    l1_config.tx_pwr_code = 1;
+    l1_config.pwr_mngt = 0;
+    tm_return->status = E_OK;
+    Cust_tm_init();
+    l1tm_initialize_var();
+    break;
+  default:
+    tm_return->status = E_INVAL;
+  }
+  tm_return->index = 0;
+  tm_return->size = 0;
 }
 
 void l1tm_version_get(T_TESTMODE_PRIM *prim, T_TM_RETURN *tm_return)